$search
GazeboRosCamera Controller. More...
#include <gazebo_ros_camera.h>
Public Member Functions | |
GazeboRosCamera (Entity *parent) | |
Constructor. | |
virtual | ~GazeboRosCamera () |
Destructor. | |
Public Attributes | |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW | |
Protected Member Functions | |
virtual void | FiniChild () |
Finalize the controller, unadvertise topics. | |
virtual void | InitChild () |
Init the controller. | |
virtual void | LoadChild (XMLConfigNode *node) |
Load the controller. | |
virtual void | UpdateChild () |
Update the controller. | |
Private Member Functions | |
void | configCallback (gazebo_plugins::GazeboRosCameraConfig &config, uint32_t level) |
void | convertImageFormat (unsigned char *dst, const unsigned char *src) |
bool | fillDepthImage (pcl::PointCloud< pcl::PointXYZ > &point_cloud, uint32_t rows_arg, uint32_t cols_arg, uint32_t step_arg, void *data_arg) |
void | ImageConnect () |
void | ImageDisconnect () |
void | InfoConnect () |
void | InfoDisconnect () |
void | PointCloudConnect () |
void | PointCloudDisconnect () |
void | PublishCameraInfo () |
Publish CameraInfo to the ROS topic. | |
void | PutCameraData () |
Put camera data to the ROS topic. | |
void | SetHFOV (const std_msgs::Float64::ConstPtr &hfov) |
void | SetUpdateRate (const std_msgs::Float64::ConstPtr &update_rate) |
Private Attributes | |
ros::Publisher | camera_info_pub_ |
ros::Subscriber | cameraHFOVSubscriber_ |
sensor_msgs::CameraInfo | cameraInfoMsg |
std::string | cameraInfoTopicName |
ROS camera_info topic name. | |
ParamT< std::string > * | cameraInfoTopicNameP |
std::string | cameraName |
ROS camera name. | |
ParamT< std::string > * | cameraNameP |
ros::Subscriber | cameraUpdateRateSubscriber_ |
double | Cx |
ParamT< double > * | CxP |
double | CxPrime |
ParamT< double > * | CxPrimeP |
double | Cy |
ParamT< double > * | CyP |
int | depth |
double | distortion_k1 |
ParamT< double > * | distortion_k1P |
double | distortion_k2 |
ParamT< double > * | distortion_k2P |
double | distortion_k3 |
ParamT< double > * | distortion_k3P |
double | distortion_t1 |
ParamT< double > * | distortion_t1P |
double | distortion_t2 |
ParamT< double > * | distortion_t2P |
dynamic_reconfigure::Server < gazebo_plugins::GazeboRosCameraConfig > * | dyn_srv_ |
std::string | dynamicReconfigureName |
double | focal_length |
ParamT< double > * | focal_lengthP |
std::string | frameName |
ROS frame transform name to use in the image message header. This should typically match the link name the sensor is attached. | |
ParamT< std::string > * | frameNameP |
double | hack_baseline |
ParamT< double > * | hack_baselineP |
int | height |
size of image buffer | |
image_transport::Publisher | image_pub_ |
int | imageConnectCount |
Keep track of number of connctions. | |
sensor_msgs::Image | imageMsg |
ROS image message. | |
std::string | imageTopicName |
ROS image topic name. | |
ParamT< std::string > * | imageTopicNameP |
Parameters. | |
int | infoConnectCount |
Keep track of number of connctions for CameraInfo. | |
image_transport::ImageTransport * | itnode_ |
Time | last_camera_info_pub_time_ |
Time | last_image_pub_time_ |
Time | last_point_cloud_pub_time_ |
boost::mutex | lock |
A mutex to lock access to fields that are used in ROS message callbacks. | |
nodelet::Loader * | manager_ |
ros::NodeHandle * | managernode_ |
MonoCameraSensor * | myParent |
A pointer to the parent camera sensor. | |
ros::Publisher | point_cloud_pub_ |
int | pointCloudConnectCount |
Keep track of number of connctions for point clouds. | |
double | pointCloudCutoff |
ParamT< double > * | pointCloudCutoffP |
pcl::PointCloud< pcl::PointXYZ > | pointCloudMsg |
std::string | pointCloudTopicName |
ROS point cloud topic name. | |
ParamT< std::string > * | pointCloudTopicNameP |
std::string | robotNamespace |
ParamT< std::string > * | robotNamespaceP |
for setting ROS name space | |
ros::NodeHandle * | rosnode_ |
A pointer to the ROS node. A node will be instantiated if it does not exist. | |
int | skip |
std::string | type |
int | width |
GazeboRosCamera Controller.
<model:physical name="camera_model"> <body:empty name="camera_body_name"> <sensor:camera name="camera_sensor"> <controller:gazebo_ros_camera name="controller-name" plugin="libgazebo_ros_camera.so"> <alwaysOn>true</alwaysOn> <updateRate>15.0</updateRate> <imageTopicName>camera_name/image_raw</imageTopicName> <cameraInfoTopicName>camera_name/camera_info</cameraInfoTopicName> <frameName>camera_body_name</frameName> </controller:gazebo_ros_camera> </sensor:camera> </body:empty> </model:phyiscal>
Definition at line 112 of file gazebo_ros_camera.h.
gazebo::GazeboRosCamera::GazeboRosCamera | ( | Entity * | parent | ) |
Constructor.
parent | The parent entity, must be a Model or a Sensor |
Definition at line 65 of file gazebo_ros_camera.cpp.
gazebo::GazeboRosCamera::~GazeboRosCamera | ( | ) | [virtual] |
Destructor.
Definition at line 115 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::configCallback | ( | gazebo_plugins::GazeboRosCameraConfig & | config, | |
uint32_t | level | |||
) | [private] |
Definition at line 106 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::convertImageFormat | ( | unsigned char * | dst, | |
const unsigned char * | src | |||
) | [private] |
Definition at line 542 of file gazebo_ros_camera.cpp.
bool gazebo::GazeboRosCamera::fillDepthImage | ( | pcl::PointCloud< pcl::PointXYZ > & | point_cloud, | |
uint32_t | rows_arg, | |||
uint32_t | cols_arg, | |||
uint32_t | step_arg, | |||
void * | data_arg | |||
) | [private] |
Definition at line 650 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::FiniChild | ( | ) | [protected, virtual] |
Finalize the controller, unadvertise topics.
Definition at line 423 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::ImageConnect | ( | ) | [private] |
Definition at line 275 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::ImageDisconnect | ( | ) | [private] |
Definition at line 282 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::InfoConnect | ( | ) | [private] |
Definition at line 248 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::InfoDisconnect | ( | ) | [private] |
Definition at line 254 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::InitChild | ( | ) | [protected, virtual] |
Init the controller.
Compute camera parameters if set to 0
Definition at line 318 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::LoadChild | ( | XMLConfigNode * | node | ) | [protected, virtual] |
Load the controller.
node | XML config node |
Definition at line 140 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::PointCloudConnect | ( | ) | [private] |
Definition at line 296 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::PointCloudDisconnect | ( | ) | [private] |
Definition at line 304 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::PublishCameraInfo | ( | ) | [private] |
Publish CameraInfo to the ROS topic.
Definition at line 711 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::PutCameraData | ( | ) | [private] |
Put camera data to the ROS topic.
copy from depth to pointCloudMsg
Definition at line 439 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::SetHFOV | ( | const std_msgs::Float64::ConstPtr & | hfov | ) | [private] |
Definition at line 261 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::SetUpdateRate | ( | const std_msgs::Float64::ConstPtr & | update_rate | ) | [private] |
Definition at line 268 of file gazebo_ros_camera.cpp.
void gazebo::GazeboRosCamera::UpdateChild | ( | ) | [protected, virtual] |
Definition at line 170 of file gazebo_ros_camera.h.
Definition at line 234 of file gazebo_ros_camera.h.
Definition at line 176 of file gazebo_ros_camera.h.
std::string gazebo::GazeboRosCamera::cameraInfoTopicName [private] |
ROS camera_info topic name.
Definition at line 207 of file gazebo_ros_camera.h.
ParamT<std::string>* gazebo::GazeboRosCamera::cameraInfoTopicNameP [private] |
Definition at line 181 of file gazebo_ros_camera.h.
std::string gazebo::GazeboRosCamera::cameraName [private] |
ROS camera name.
Definition at line 203 of file gazebo_ros_camera.h.
ParamT<std::string>* gazebo::GazeboRosCamera::cameraNameP [private] |
Definition at line 183 of file gazebo_ros_camera.h.
Definition at line 235 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::Cx [private] |
Definition at line 215 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::CxP [private] |
Definition at line 187 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::CxPrime [private] |
Definition at line 214 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::CxPrimeP [private] |
Definition at line 186 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::Cy [private] |
Definition at line 216 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::CyP [private] |
Definition at line 188 of file gazebo_ros_camera.h.
int gazebo::GazeboRosCamera::depth [private] |
Definition at line 230 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::distortion_k1 [private] |
Definition at line 220 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::distortion_k1P [private] |
Definition at line 192 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::distortion_k2 [private] |
Definition at line 221 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::distortion_k2P [private] |
Definition at line 193 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::distortion_k3 [private] |
Definition at line 222 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::distortion_k3P [private] |
Definition at line 194 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::distortion_t1 [private] |
Definition at line 223 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::distortion_t1P [private] |
Definition at line 195 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::distortion_t2 [private] |
Definition at line 224 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::distortion_t2P [private] |
Definition at line 196 of file gazebo_ros_camera.h.
dynamic_reconfigure::Server<gazebo_plugins::GazeboRosCameraConfig>* gazebo::GazeboRosCamera::dyn_srv_ [private] |
Definition at line 241 of file gazebo_ros_camera.h.
std::string gazebo::GazeboRosCamera::dynamicReconfigureName [private] |
Definition at line 246 of file gazebo_ros_camera.h.
Definition at line 254 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::focal_length [private] |
Definition at line 217 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::focal_lengthP [private] |
Definition at line 189 of file gazebo_ros_camera.h.
std::string gazebo::GazeboRosCamera::frameName [private] |
ROS frame transform name to use in the image message header. This should typically match the link name the sensor is attached.
Definition at line 212 of file gazebo_ros_camera.h.
ParamT<std::string>* gazebo::GazeboRosCamera::frameNameP [private] |
Definition at line 184 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::hack_baseline [private] |
Definition at line 218 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::hack_baselineP [private] |
Definition at line 190 of file gazebo_ros_camera.h.
int gazebo::GazeboRosCamera::height [private] |
size of image buffer
Definition at line 230 of file gazebo_ros_camera.h.
Definition at line 171 of file gazebo_ros_camera.h.
int gazebo::GazeboRosCamera::imageConnectCount [private] |
Keep track of number of connctions.
Definition at line 140 of file gazebo_ros_camera.h.
ROS image message.
Definition at line 175 of file gazebo_ros_camera.h.
std::string gazebo::GazeboRosCamera::imageTopicName [private] |
ROS image topic name.
Definition at line 205 of file gazebo_ros_camera.h.
ParamT<std::string>* gazebo::GazeboRosCamera::imageTopicNameP [private] |
Parameters.
Definition at line 180 of file gazebo_ros_camera.h.
int gazebo::GazeboRosCamera::infoConnectCount [private] |
Keep track of number of connctions for CameraInfo.
Definition at line 150 of file gazebo_ros_camera.h.
Definition at line 172 of file gazebo_ros_camera.h.
Time gazebo::GazeboRosCamera::last_camera_info_pub_time_ [private] |
Definition at line 238 of file gazebo_ros_camera.h.
Time gazebo::GazeboRosCamera::last_image_pub_time_ [private] |
Definition at line 238 of file gazebo_ros_camera.h.
Time gazebo::GazeboRosCamera::last_point_cloud_pub_time_ [private] |
Definition at line 238 of file gazebo_ros_camera.h.
boost::mutex gazebo::GazeboRosCamera::lock [private] |
A mutex to lock access to fields that are used in ROS message callbacks.
Definition at line 227 of file gazebo_ros_camera.h.
nodelet::Loader* gazebo::GazeboRosCamera::manager_ [private] |
Definition at line 169 of file gazebo_ros_camera.h.
Definition at line 168 of file gazebo_ros_camera.h.
MonoCameraSensor* gazebo::GazeboRosCamera::myParent [private] |
A pointer to the parent camera sensor.
Definition at line 164 of file gazebo_ros_camera.h.
Definition at line 170 of file gazebo_ros_camera.h.
int gazebo::GazeboRosCamera::pointCloudConnectCount [private] |
Keep track of number of connctions for point clouds.
Definition at line 145 of file gazebo_ros_camera.h.
double gazebo::GazeboRosCamera::pointCloudCutoff [private] |
Definition at line 219 of file gazebo_ros_camera.h.
ParamT<double>* gazebo::GazeboRosCamera::pointCloudCutoffP [private] |
Definition at line 191 of file gazebo_ros_camera.h.
pcl::PointCloud<pcl::PointXYZ> gazebo::GazeboRosCamera::pointCloudMsg [private] |
Definition at line 177 of file gazebo_ros_camera.h.
std::string gazebo::GazeboRosCamera::pointCloudTopicName [private] |
ROS point cloud topic name.
Definition at line 209 of file gazebo_ros_camera.h.
ParamT<std::string>* gazebo::GazeboRosCamera::pointCloudTopicNameP [private] |
Definition at line 182 of file gazebo_ros_camera.h.
std::string gazebo::GazeboRosCamera::robotNamespace [private] |
Definition at line 200 of file gazebo_ros_camera.h.
ParamT<std::string>* gazebo::GazeboRosCamera::robotNamespaceP [private] |
for setting ROS name space
Definition at line 199 of file gazebo_ros_camera.h.
ros::NodeHandle* gazebo::GazeboRosCamera::rosnode_ [private] |
A pointer to the ROS node. A node will be instantiated if it does not exist.
Definition at line 167 of file gazebo_ros_camera.h.
int gazebo::GazeboRosCamera::skip [private] |
Definition at line 232 of file gazebo_ros_camera.h.
std::string gazebo::GazeboRosCamera::type [private] |
Definition at line 231 of file gazebo_ros_camera.h.
int gazebo::GazeboRosCamera::width [private] |
Definition at line 230 of file gazebo_ros_camera.h.