话题发布:
#include <ros/ros.h>
#include <image_transport/image_transport.h>
#include <cv_bridge/cv_bridge.h>
#include <visp/vpImage.h>
#include <visp3/io/vpImageIo.h>
#include <opencv2/highgui/highgui.hpp>
int main(int argc, char** argv)
{
ros::init(argc, argv, "image_publisher");
ros::NodeHandle nh;
image_transport::ImageTransport it(nh);
image_transport::Publisher pub = it.advertise("/camera/image_raw", 1);
//vpImage<vpRGBa> I;
//vpImageIo::read(I, argv[1]);
cv::Mat image = cv::imread(argv[1], CV_LOAD_IMAGE_COLOR);
sensor_msgs::ImagePtr msg = cv_bridge::CvImage(std_msgs::Header(), "bgr8",image).toImageMsg();
ros::Rate loop_rate(5);
while (nh.ok(</