参考本人博客:在ROS中用openCV显示摄像头并发布图像数据
#include
#include
#include
#include
void imageCallback(const sensor_msgs::ImageConstPtr& msg)
{
try // 如果转换失败,则提跳转到catch语句
{
cv::imshow("view", cv_bridge::toCvShare(msg, "bgr8")->image); // 将图像转换openCV的格式,并输出到窗口
cv::waitKey(1); // 一定要有wiatKey(),要不然是黑框或者无窗口
}
catch(cv_bridge::Exception& e)
{
ROS_ERROR("Could not convert for '%s' to 'bgr8'.", msg->encoding.c_str());
}
}
int main(int argc, char** argv)
{
ros::init(argc, argv, "imageSub_node"); // 注册节点名
ros::NodeHandle nh; // 注册句柄
image_transport::ImageTransport it(nh); // 注册句柄
image_transport::Subscriber imageSub = it.subscribe("/cameraImage", 1, imageCallback); // 订阅/cameraImage话题,并添加回调函数
ros::spin(); // 循环等待回调函数触发
}
添加(最后两个的imageSub是生成可执行文件的名字,根据自己来设定):
find_package(OpenCV REQUIRED)
include_directories(${OpenCV_INCLUDE_DIRS})
add_executable(imageSub src/image_sub.cpp)
target_link_libraries(imageSub ${catkin_LIBRARIES} ${OpenCV_LIBS})
注:如果前两个已经添加了,可以不用再添加
未完待续
欢迎留言讨论,指出不足和建议!