ROS灰度处理与边缘检测

因为比赛需要,打算开拓一个新领域,在ROS中写opencv,然后调用opencv里面的函数进行循白线的程序,接着串口通讯给单片机。

ROS这个工具总的来说在结合多传感器进行多任务处理的时候优势非常大,最明显的是像导航机器人或者无人驾驶这种需要用到。多点熟悉这个工具吧。

ROS中的语法跟opencv不太一样,不过也是可以转换的,使用cv_bridge这个包来进行转换,先从简单的开始写吧,按照学opencv的方法全部用ROS改写就行了。

下面这个是简单的灰度处理与边缘检测结合的程序,建议opencv全部使用Mat来写,可移植性强。

还需要注意的是CvImage的指针用法,貌似一个指针只能处理一个cv::Mat类型的图像。

测试效果图:


使用rqt_graph查看关系


#include//ros标准库头文件

#include//C++标准输入输出库

#include

#include

#include

#include

#include

#include

staticconststd::stringOPENCV_WINDOW1="Image window";//定义输入窗口名称

staticconststd::stringOPENCV_WINDOW2="Gray window";//定义输出窗口名称

staticconststd::stringOPENCV_WINDOW3="Canny window";//定义输出窗口名称

//定义一个转换的类

classRGB_GRAY

{

private:

ros::NodeHandlenh_;//定义ROS句柄

image_transport::ImageTransportit_;//定义一个image_transport实例

image_transport::Subscriberimage_sub_;//定义ROS图象接收器

image_transport::Publisherimage_pub_;//定义ROS图象发布器

public:

RGB_GRAY()

:it_(nh_)//构造函数

{

image_sub_=it_.subscribe("/cv_camera/image_raw",1,&RGB_GRAY::convert_callback,this);//定义图象接受器,订阅话题是“camera/rgb/image_raw”

image_pub_=it_.advertise("/image_converter/output_video",1);//定义图象发布器

//初始化输入输出窗口

cv::namedWindow(OPENCV_WINDOW1);

cv::namedWindow(OPENCV_WINDOW2);

cv::namedWindow(OPENCV_WINDOW3);

}

~RGB_GRAY()//析构函数

{

cv::destroyWindow(OPENCV_WINDOW1);

cv::destroyWindow(OPENCV_WINDOW2);

cv::destroyWindow(OPENCV_WINDOW3);

}

/*

这是一个ROS和OpenCV的格式转换回调函数,将图象格式从sensor_msgs/Image  --->  cv::Mat

*/

voidconvert_callback(constsensor_msgs::ImageConstPtr&msg)

{

cv_bridge::CvImagePtrcv_ptr1;// 声明一个CvImage指针的实例

cv_bridge::CvImagePtrcv_ptr2;// 声明一个CvImage指针的实例

try

{

cv_ptr1=cv_bridge::toCvCopy(msg,sensor_msgs::image_encodings::BGR8);//将ROS消息中的图象信息提取,生成新cv类型的图象,复制给CvImage指针

cv_ptr2=cv_bridge::toCvCopy(msg,sensor_msgs::image_encodings::BGR8);//将ROS消息中的图象信息提取,生成新cv类型的图象,复制给CvImage指针

}

catch(cv_bridge::Exception&e)//异常处理

{

ROS_ERROR("cv_bridge exception: %s",e.what());

return;

}

image_process1(cv_ptr1->image);//得到了cv::Mat类型的图象,在CvImage指针的image中,将结果传送给处理函数

image_process2(cv_ptr2->image);//得到了cv::Mat类型的图象,在CvImage指针的image中,将结果传送给处理函数

}

/*这是图象处理的主要函数,一般会把图像处理的主要程序写在这个函数中。这里的例子只是一个彩色图象到灰度图象的转化*/

voidimage_process1(cv::Matimg1)//这里是灰度处理

{

cv::Matimg_out1;

cv::cvtColor(img1,img_out1,CV_RGB2GRAY);//转换成灰度图象

cv::imshow(OPENCV_WINDOW1,img1);

cv::imshow(OPENCV_WINDOW2,img_out1);

cv::waitKey(5);

}

voidimage_process2(cv::Matimg2)//这里是边缘检测

{

cv::Matdstframe;

cv::Matedge;

cv::MatgrayVideo;

dstframe.create(img2.size(),img2.type());

cv::cvtColor(img2,grayVideo,CV_BGR2GRAY);

cv::blur(grayVideo,edge,cvSize(15,15));

cv::Canny(edge,edge,0,30,3);

cv::imshow(OPENCV_WINDOW3,edge);

cv::waitKey(5);

}

};

//主函数

intmain(intargc,char**argv)

{

ros::init(argc,argv,"RGB");

RGB_GRAY obj;

ros::spin();

}

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 203,456评论 5 477
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 85,370评论 2 381
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 150,337评论 0 337
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 54,583评论 1 273
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 63,596评论 5 365
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 48,572评论 1 281
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 37,936评论 3 395
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,595评论 0 258
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 40,850评论 1 297
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,601评论 2 321
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,685评论 1 329
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,371评论 4 318
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 38,951评论 3 307
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,934评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,167评论 1 259
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 43,636评论 2 349
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,411评论 2 342

推荐阅读更多精彩内容