ROS基础篇之连接DIY aduino 传感器与执行器的应用

2023-11-01 00:50
文章标签 基础 应用 连接 传感器 ros diy 执行器 aduino

本文主要是介绍ROS基础篇之连接DIY aduino 传感器与执行器的应用，希望对大家解决编程问题提供一定的参考价值，需要的开发者们随着小编来一起学习吧！

 

说到机器人，可能我们首先想到是人形机器人，有手臂、有腿、有眼、耳朵以及大量传感器和执行器，是一个极为复杂的运动系统。

现在我们已经学会了如何在ROS里编写节点程序，并控制他们通过话题传递消息数据。接下来我们要学习如何在ROS中使用传感器和执行器，这样机器人就能与现实世界交互了。

回顾ROS的核心组件：


通信基础结构
ROS是一个分布式的进程（“节点”）框架。
传感器和执行器可以分布式部署。

机器人特定功能库
movebase
moveit
从功能库的输入输出，找到传感器与执行器的影子。

工具
rviz
传感器和执行器数据的可视化。

传感器和执行器


传感器
触碰、声呐、光电、磁感（霍尔）、陀螺仪 加速度计、激光雷达、摄像头等等
执行器 
电动机 、加热棒、扬声器、显示器
传感器和执行器元器件，需要微处理器控制，并制定通信协议。


创造传感器、执行器


传感器：矩阵键盘
原理：行列扫描确定按键
描述：按下按键时向上位机发送键值
通迅方式：串口 9600bps
通迅协议： [0-F]\n 形式的字串

代码

#include <Keypad.h>const byte ROWS = 4; //four rows
const byte COLS = 4; //four columns
//define the cymbols on the buttons of the keypads
char hexaKeys[ROWS][COLS] = {{'0','1','2','3'},{'4','5','6','7'},{'8','9','A','B'},{'C','D','E','F'}
};
byte rowPins[ROWS] = {3, 2, 8, 0}; //connect to the row pinouts of the keypad
byte colPins[COLS] = {7, 6, 5, 4}; //connect to the column pinouts of the keypad//initialize an instance of class NewKeypad
Keypad customKeypad = Keypad( makeKeymap(hexaKeys), rowPins, colPins, ROWS, COLS); 
int pc0=14;
int pc1=15;
int pc2=16;
int pc3=17;
int pc4=18;
int pc5=19;
void setup(){
pinMode(pc0,OUTPUT);
pinMode(pc1,OUTPUT);
pinMode(pc2,OUTPUT);
pinMode(pc3,OUTPUT);
pinMode(pc4,OUTPUT);
pinMode(pc5,OUTPUT);
digitalWrite(pc0, 1);
digitalWrite(pc1, 1);
digitalWrite(pc2, 1);
digitalWrite(pc3, 1);
digitalWrite(pc4, 1);
digitalWrite(pc5, 1);Serial.begin(9600);
}void loop(){char customKey = customKeypad.getKey();if (customKey){byte k=customKey;Serial.println(customKey);//byte a=k>=65?11+k-65:k-47;//Serial.println(a);digitalWrite(pc0, ((a&0x01)>>0)?0:1);digitalWrite(pc1, ((a&0x02)>>1)?0:1);digitalWrite(pc2, ((a&0x04)>>2)?0:1);digitalWrite(pc3, ((a&0x08)>>3)?0:1);digitalWrite(pc4, ((a&0x10)>>4)?0:1);digitalWrite(pc5, ((a&0x20)>>5)?0:1);}
}

 


执行器：舵机
原理：pmw波占空比控制位置
描述：接收位置命令后，到达指定的位置
通迅方式：串口 9600bps
通迅协议： #[0000-1023]! 形式的字串

代码

#include <Servo.h> Servo myservo;  // create servo object to control a servo int potpin = 0;  // analog pin used to connect the potentiometer
int val=0;    // variable to read the value from the analog pin 
int flag=1;
int nowposi=0;void setup() 
{ // Open serial communications and wait for port to open:Serial.begin(9600);while (!Serial) {; // wait for serial port to connect. Needed for Leonardo only}Serial.println("hello servo!");myservo.attach(9);  // attaches the servo on pin 9 to the servo object 
} byte bytedata[4]={0,0,0,0};byte pa=0;
void loop() 
{ /*val = nowposi;//analogRead(potpin);            // reads the value of the potentiometer (value between 0 and 1023) val = map(val, 0, 1023, 0, 179);     // scale it to use it with the servo (value between 0 and 180) myservo.write(val);                  // sets the servo position according to the scaled value nowposi+=flag;if(nowposi<=0)flag=1;else if(nowposi>1023){flag=-1;}  delay(15); // waits for the servo to get there */if (Serial.available()){byte a=Serial.read();if(a=='#'||a=='!'){if(a=='#'){Serial.write("#");pa=0;}if(a=='!'){Serial.write("!");if(pa==4){int data=0;data+=(bytedata[0]-48)*1000;data+=(bytedata[1]-48)*100;data+=(bytedata[2]-48)*10;data+=(bytedata[3]-48);//Serial.write(bytedata,4);//*Serial.println((bytedata[0]-48));Serial.println((bytedata[1]-48));Serial.println((bytedata[2]-48));Serial.println((bytedata[3]-48));Serial.println((data));//*/val = map(data, 0, 1023, 0, 179);     // scale it to use it with the servo (value between 0 and 180) //Serial.println(val);myservo.write(val);                  // sets the servo position according to the scaled value }else{Serial.write("e");}}}else{if(pa<4&&a>=48&&a<=58){bytedata[pa]=a;pa++;}else{pa=0;}}}
} 

项目规划


1、功能设定 ：使按键键值0-F（0-16）在顺序上与舵机转角从0度到180度对应。

2、连接传感器和执行器到计算机

3、检查连接状态与通迅测试

4、确定节点数量、每个节点的功能以及节点间的通迅方法
      
5、编程与测试


连接计算机和传感器、执行器，创建机器人
列出设备信息

ls -o /dev/ttyUSB*
crw-rw---- 1 root 188, 0 12月  8 09:46 /dev/ttyUSB0
crw-rw---- 1 root 188, 1 12月  8 09:42 /dev/ttyUSB1

更改权限

sudo chmod 777 /dev/ttyU*

检查设备信息

ls -o /dev/ttyU*
crwxrwxrwx 1 root 188, 1 12月  8 16:23 /dev/ttyUSB1
crwxrwxrwx 1 root 188, 2 12月  8 15:29 /dev/ttyUSB2

串口测试

cutecom

测试串口下对传感器和执行器的操作


节点功能与话题消息定义


传感器节点：获取键值
串口读
协议解析  0-F字串解码为int型0-15
发布消息到话题
源码

#include "ros/ros.h"
#include "std_msgs/String.h"
#include "std_msgs/UInt8.h"
#include <serial/serial.h>
//ROS已经内置了的串口包#include <std_msgs/Empty.h>serial::Serial ser; //声明串口对象
int hex2int(char c)
{if ((c >= 'A') && (c <= 'F')){return c - 'A' + 10;}else if ((c >= 'a') && (c <= 'f')){return c - 'a' + 10;}else if ((c >= '0') && (c <= '9')){return c - '0';}
}int main(int argc, char **argv)
{ros::init(argc, argv, "sread");ros::NodeHandle nh;//发布主题ros::Publisher read_pub = nh.advertise<std_msgs::UInt8>("pressButtonId", 10);try{//设置串口属性，并打开串口rosser.setPort("/dev/ttyUSB0");ser.setBaudrate(9600);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_INFO_STREAM("sread loop start");//指定循环的频率ros::Rate loop_rate(50);while(ros::ok()){if(ser.available()){ROS_INFO_STREAM("Reading from serial port\n");std::string str;std_msgs::UInt8 value;std_msgs::String result;//result.data = ser.read(ser.available());str =ser.readline();if(str.length()>1){//size_t s=str.find_last_of("\r\n");str=str.substr(0,1);value.data=hex2int(*str.c_str());ROS_INFO_STREAM("str="<<str<<" "<<value);read_pub.publish(value);//result.data=str.substr(0,1);//ROS_INFO_STREAM("Read: " << result.data);}}//处理ROS的信息，比如订阅消息,并调用回调函数ros::spinOnce();loop_rate.sleep();}return 0;
}


执行器节点：控制舵机
从话题接收消息
控制逻辑
通迅协议  0-15 转换为0-1024范围 输出#0000!字串
串口写
源码

#include "ros/ros.h"
#include "std_msgs/UInt8.h"
#include <serial/serial.h>serial::Serial ser; //声明串口对象void chatterCallback(const std_msgs::UInt8::ConstPtr& msg)
{ROS_INFO("recive: [%d]", msg->data);//0-15//xieyi//#0000!-#1023!int value=msg->data*(1024/16);char data[7]={'#',0,0,0,0,'!','\n'};data[1]=(value%10000)/1000+'0';data[2]=(value%1000)/100+'0';data[3]=(value%100)/10+'0';data[4]=value%10+'0';ser.write(data);   //发送串口数据
}int main(int argc, char **argv)
{ros::init(argc, argv, "swrite");ros::NodeHandle nh;try{//设置串口属性，并打开串口ser.setPort("/dev/ttyUSB1");ser.setBaudrate(9600);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::Subscriber sub = nh.subscribe("pressButtonId", 10, chatterCallback);ros::spin();return 0;
}

小结


1机器人中使用传感器和执行器是非常重要的，因为这是和现实世界进行互动的唯一途径。

2我们用简单的示例演示了如何配置、检查、使用传感器和执行器。

3学习了ros内置串口库的编程方法。通过实例，我们能更好的理解ROS中节点、话题、消息等概念，并能在实际项目中灵活运用进行数据交互。

这篇关于ROS基础篇之连接DIY aduino 传感器与执行器的应用的文章就介绍到这儿，希望我们推荐的文章对编程师们有所帮助！


http://www.chinasem.cn/article/319292。

相关文章

CSS中的Static、Relative、Absolute、Fixed、Sticky的应用与详细对比

CSS中的Static、Relative、Absolute、Fixed、Sticky的应用与详细对比

《CSS中的Static、Relative、Absolute、Fixed、Sticky的应用与详细对比》CSS中的position属性用于控制元素的定位方式，不同的定位方式会影响元素在页面中的布... css 中的 position 属性用于控制元素的定位方式，不同的定位方式会影响元素在页面中的布局和层叠关
阅读更多...
SpringBoot3应用中集成和使用Spring Retry的实践记录

SpringBoot3应用中集成和使用Spring Retry的实践记录

《SpringBoot3应用中集成和使用SpringRetry的实践记录》SpringRetry为SpringBoot3提供重试机制,支持注解和编程式两种方式,可配置重试策略与监听器,适用于临时性故... 目录1. 简介2. 环境准备3. 使用方式3.1 注解方式 基础使用自定义重试策略失败恢复机制注意事项
阅读更多...
从基础到进阶详解Pandas时间数据处理指南

从基础到进阶详解Pandas时间数据处理指南

《从基础到进阶详解Pandas时间数据处理指南》Pandas构建了完整的时间数据处理生态,核心由四个基础类构成,Timestamp,DatetimeIndex,Period和Timedelta,下面我... 目录1. 时间数据类型与基础操作1.1 核心时间对象体系1.2 时间数据生成技巧2. 时间索引与数据
阅读更多...
安装centos8设置基础软件仓库时出错的解决方案

安装centos8设置基础软件仓库时出错的解决方案

《安装centos8设置基础软件仓库时出错的解决方案》：本文主要介绍安装centos8设置基础软件仓库时出错的解决方案,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐... 目录安装Centos8设置基础软件仓库时出错版本 8版本 8.2.200android4版本 javas
阅读更多...
java连接opcua的常见问题及解决方法

java连接opcua的常见问题及解决方法

《java连接opcua的常见问题及解决方法》本文将使用EclipseMilo作为示例库,演示如何在Java中使用匿名、用户名密码以及证书加密三种方式连接到OPCUA服务器,若需要使用其他SDK,原理... 目录一、前言二、准备工作三、匿名方式连接3.1 匿名方式简介3.2 示例代码四、用户名密码方式连接4
阅读更多...
Python使用Tkinter打造一个完整的桌面应用

Python使用Tkinter打造一个完整的桌面应用

《Python使用Tkinter打造一个完整的桌面应用》在Python生态中,Tkinter就像一把瑞士军刀,它没有花哨的特效,却能快速搭建出实用的图形界面,作为Python自带的标准库,无需安装即可... 目录一、界面搭建：像搭积木一样组合控件二、菜单系统：给应用装上“控制中枢”三、事件驱动：让界面“活”
阅读更多...
MySQL 表的内外连接案例详解

MySQL 表的内外连接案例详解

《MySQL表的内外连接案例详解》本文给大家介绍MySQL表的内外连接,结合实例代码给大家介绍的非常详细,对大家的学习或工作具有一定的参考借鉴价值,需要的朋友参考下吧... 目录表的内外连接（重点）内连接外连接表的内外连接（重点）内连接内连接实际上就是利用where子句对两种表形成的笛卡儿积进行筛选，我
阅读更多...
Linux基础命令@grep、wc、管道符的使用详解

Linux基础命令@grep、wc、管道符的使用详解

《Linux基础命令@grep、wc、管道符的使用详解》：本文主要介绍Linux基础命令@grep、wc、管道符的使用,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐... 目录grep概念语法作用演示一演示二演示三，带选项 -nwc概念语法作用wc，不带选项-c，统计字节数-
阅读更多...
如何确定哪些软件是Mac系统自带的? Mac系统内置应用查看技巧

如何确定哪些软件是Mac系统自带的? Mac系统内置应用查看技巧

《如何确定哪些软件是Mac系统自带的?Mac系统内置应用查看技巧》如何确定哪些软件是Mac系统自带的？mac系统中有很多自带的应用，想要看看哪些是系统自带，该怎么查看呢？下面我们就来看看Mac系统内... 在MAC电脑上，可以使用以下方法来确定哪些软件是系统自带的：1.应用程序文件夹打开应用程序文件夹
阅读更多...
Apache 高级配置实战之从连接保持到日志分析的完整指南

Apache 高级配置实战之从连接保持到日志分析的完整指南

《Apache高级配置实战之从连接保持到日志分析的完整指南》本文带你从连接保持优化开始,一路走到访问控制和日志管理,最后用AWStats来分析网站数据,对Apache配置日志分析相关知识感兴趣的朋友... 目录Apache 高级配置实战：从连接保持到日志分析的完整指南前言 一、Apache 连接保持 - 性
阅读更多...

Copyright China编程 23002807@qq.com

沪ICP备2023033072号-2