日韩性视频-久久久蜜桃-www中文字幕-在线中文字幕av-亚洲欧美一区二区三区四区-撸久久-香蕉视频一区-久久无码精品丰满人妻-国产高潮av-激情福利社-日韩av网址大全-国产精品久久999-日本五十路在线-性欧美在线-久久99精品波多结衣一区-男女午夜免费视频-黑人极品ⅴideos精品欧美棵-人人妻人人澡人人爽精品欧美一区-日韩一区在线看-欧美a级在线免费观看

歡迎訪問 生活随笔!

生活随笔

當前位置: 首頁 > 编程资源 > 编程问答 >内容正文

编程问答

rosserial_java_编写ros串口节点,使用官方serial包(示例代码)

發布時間:2025/3/15 编程问答 37 豆豆
生活随笔 收集整理的這篇文章主要介紹了 rosserial_java_编写ros串口节点,使用官方serial包(示例代码) 小編覺得挺不錯的,現在分享給大家,幫大家做個參考.

參考http://www.roswiki.com/read.php?tid=557&fid=39

1.通過sudo apt-get install ros--serial下載ROS對應版本的工具包

serial會安裝在opt/ros//share/serial目錄下,

重啟終端,輸入 roscd serial,可以檢測到serial包的路徑,說明serial包已經安裝成功

2.使用ros自帶的serial包,編寫節點

#include

#include ?//ROS已經內置了的串口包

#include

#include

serial::Serial ser; //聲明串口對象

//回調函數

void write_callback(const std_msgs::String::ConstPtr& msg)

{

ROS_INFO_STREAM("Writing to serial port" <data);

ser.write(msg->data); ? //發送串口數據

}

int main (int argc, char** argv)

{

//初始化節點

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

//聲明節點句柄

ros::NodeHandle nh;

//訂閱主題,并配置回調函數

ros::Subscriber write_sub = nh.subscribe("write", 1000, write_callback);

//發布主題

ros::Publisher read_pub = nh.advertise<:string>("read", 1000);

try

{

//設置串口屬性,并打開串口

ser.setPort("/dev/ttyUSB0");

ser.setBaudrate(115200);

serial::Timeout to = serial::Timeout::simpleTimeout(1000);

ser.setTimeout(to);

ser.open();

}

catch (serial::IOException& e)

{

ROS_ERROR_STREAM("Unable to open port ");

return -1;

}

//檢測串口是否已經打開,并給出提示信息

if(ser.isOpen())

{

ROS_INFO_STREAM("Serial Port initialized");

}

else

{

return -1;

}

//指定循環的頻率

ros::Rate loop_rate(50);

while(ros::ok())

{

if(ser.available()){

ROS_INFO_STREAM("Reading from serial port\n");

std_msgs::String result;

result.data = ser.read(ser.available());

ROS_INFO_STREAM("Read: " << result.data);

read_pub.publish(result);

}

//處理ROS的信息,比如訂閱消息,并調用回調函數

ros::spinOnce();

loop_rate.sleep();

}

}

總結

以上是生活随笔為你收集整理的rosserial_java_编写ros串口节点,使用官方serial包(示例代码)的全部內容,希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網站內容還不錯,歡迎將生活随笔推薦給好友。