utils.cpp File Reference

#include "utils.h"

Include dependency graph for utils.cpp:

Go to the source code of this file.

Defines
#define	VEC(p1)
Functions
double	getBIC (double loglh, size_t k, size_t n)
std_msgs::ColorRGBA	HSV_to_RGB (double h, double s, double v)
void	MAT_to_RPY (const btMatrix3x3 &mat, double &roll, double &pitch, double &yaw)
string	pose_to_string (const Pose &pose)
btMatrix3x3	RPY_to_MAT (double roll, double pitch, double yaw)
string	transform_to_string (const btTransform &p)
string	uncert_to_string (double sigma_position, double sigma_orientation)

---

Define Documentation

#define VEC

(

p1

)

Value:

"["<< \
p1.getOrigin().x() << "," << p1.getOrigin().y()<<","<<p1.getOrigin().z()<< \
"/"<< \
p1.getRotation().x() << "," << p1.getRotation().y()<<","<<p1.getRotation().z()<<","<<p1.getRotation().w()<< \
"]"

Definition at line 69 of file utils.cpp.

---

Function Documentation

double getBIC	(	double	loglh,
		size_t	k,
		size_t	n
	)

Definition at line 109 of file utils.cpp.

std_msgs::ColorRGBA HSV_to_RGB	(	double	h,
		double	s,
		double	v
	)

Definition at line 14 of file utils.cpp.

void MAT_to_RPY	(	const btMatrix3x3 &	mat,
		double &	roll,
		double &	pitch,
		double &	yaw
	)

Definition at line 63 of file utils.cpp.

string pose_to_string

(

const Pose &

pose

)

Definition at line 90 of file utils.cpp.

btMatrix3x3 RPY_to_MAT	(	double	roll,
		double	pitch,
		double	yaw
	)

Definition at line 48 of file utils.cpp.

string transform_to_string

(

const btTransform &

p

)

Definition at line 75 of file utils.cpp.

string uncert_to_string	(	double	sigma_position,
		double	sigma_orientation
	)

Definition at line 95 of file utils.cpp.