ROS填坑记之树莓派图像处理

       我计划从树莓派上的摄像头采集图像数据到笔记本上,tensorflow处理完毕后再向树莓派发送操作指令,控制电机和舵机。ROS的双机连接还是挺简单的,首先树莓派和笔记本设置ssh免密码和用户名登录(具体请百度),从树莓派和笔记本上都可以互相无密码和用户名登录成功后,在树莓派上输入sudo vi ~/.bashrc,在最后增加export ROS_HOSTNAME=树莓派的ip,export ROS_MASTER_URI=http://笔记本的ip:11311,然后source ~/.bashrc;登录笔记本上sudo vi ~/.bashrc,最后增加 export ROS_HOSTNAME=笔记本ip,export ROS_MASTER_URI=http://笔记本ip:11311(我用笔记本当主机,如果用树莓派当主机,ROS_MASTER_URI地址更换就可以了)。然后树莓派、pc上安装opencv,树莓派上安装picamera。在笔记本上启动roscore,在树莓派用以下代码测试双机发送图像:

# -*- encoding:utf-8 -*-

# import the necessary packages

from picamera.array import PiRGBArray

from picamera import PiCamera

import time

import cv2

import sys

import rospy

from std_msgs.msg import String

from sensor_msgs.msg import Image

from cv_bridge import CvBridge, CvBridgeError

import io

import numpy as np

# initialize the camera and grab a reference to the raw camera capture

def talker():

    camera = PiCamera()

    camera.resolution = (320,240)

    time.sleep(1)

    #allow the camera to warmup

    image_pub = rospy.Publisher("image_topic_2",Image,queue_size=10)

    bridge = CvBridge()

    rospy.init_node('image_talker', anonymous=True)

    rate = rospy.Rate(10) # 10hz

    #以上是ros节点初始化完成

    # capture frames from the camera

    stream = io.BytesIO()

    for foo in camera.capture_continuous(stream, format='jpeg', use_video_port=True):

        # grab the raw NumPy array representing the image, then initialize the timestamp

        # and occupied/unoccupied text

        data = np.fromstring(stream.getvalue(), dtype=np.uint8)

        # 转换为CV2的mat格式

        image = cv2.imdecode(data, cv2.IMREAD_COLOR)

        (rows,cols,channels) = image.shape

        if cols > 60 and rows > 60 :

            cv2.circle(image, (50,50), 10, 255)

        image_pub.publish(bridge.cv2_to_imgmsg(image, "bgr8"))

        rate.sleep()


    stream.truncate()

    stream.seek(0)       

if __name__ == '__main__':

    try:

        talker()

    except rospy.ROSInterruptException:

        pass

在/catkin_ws/src/beginner_tutorials/src保存为test.py,chmod +x test.py。运行rosrun beginner_tutorials test.py。在笔记本上运营rqt_image_view查看图像。

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