36 namespace perception {
45 return ((a.
r == b.
r) && (a.
g == b.
g) && (a.
b == b.
b));
48 inline T
abs(
const T &x) {
49 return (x > 0 ? x : -x);
52 inline int sign(
const T &x) {
53 return (x >= 0 ? 1 : -1);
60 inline T
bound(
const T &x,
const T &min,
const T &max) {
61 return (x < min ? min : (x > max ? max : x));
64 inline bool check_bound(
const T &x,
const T &min,
const T &max) {
65 return ((x < min) || (x > max));
67 inline int vlib_round(
float x) {
return static_cast<int>(x + 0.5F); }
68 inline int vlib_round(
double x) {
return static_cast<int>(x + 0.5); }
69 inline double gaussian(
double val,
double sigma) {
70 return exp(-
square(val / sigma) / 2) / (sqrt(2 * M_PI) * sigma);
PlanningContext is the runtime context in planning. It is persistent across multiple frames...
Definition: atomic_hash_map.h:25
T bound(const T &x, const T &min, const T &max)
Definition: misc.h:60
T abs(const T &x)
Definition: misc.h:48
double gaussian(double val, double sigma)
Definition: misc.h:69
bool check_bound(const T &x, const T &min, const T &max)
Definition: misc.h:64
uchar r
Definition: misc.h:40
uchar b
Definition: misc.h:42
T square(const T &x)
Definition: misc.h:56
unsigned char uchar
Definition: misc.h:38
int vlib_round(float x)
Definition: misc.h:67
bool operator==(const rgb &a, const rgb &b)
Definition: misc.h:44
uchar g
Definition: misc.h:41
int sign(const T &x)
Definition: misc.h:52