控制伺服机运转顺畅的ROS程序设计

来源:网络  作者:网络转载   2019-09-22 阅读:411

ROS(RobotOperatingSystem)是开源的机器人系统平台。使用这个之后,机器人就可以看见东西、测绘、导航,或是以最新的算法作用于周围的环境当中。假如想要制造复杂的机器人,已经准备好的ROS程序代码就能派上用场。ROS能在最低限度下运用。这可以透过RaspberryPi等级的计算机安装。

做为ROS的入门篇我们来看看如何控制伺服机。伺服机的缺点是会尽快遵照指令运转,因此头部常常会突然活动,以至于失去平衡。不过使用ROS之后,就可以进行正弦曲线运动,让机器人保持稳定。由于可以在ROS当中进行这项操作,因此无须改写控制用的程序代码。另外,连接伺服机和ROS的程序代码,以及伺服机的硬件都无须变更。再者,程序代码还可以任意使用。

ROS很适合用在Ubuntu或Debian上,无须编译。建置时要在Linux机器上执行Ubuntu,使用业余用伺服机、Arduino和普通的导线。ROS要在Ubuntu机器上启动,讯息则透过USB传送到Arduino。只要安装二进制的ROS套件,就会在主控台程序(像是gnome-terminal或konsole)追加以下指令,这样Arduino系统就能辨识ROS函式库。

cd~/sketchbook/libraries

rm-rfros_lib

rosrunrosserial_arduinomake_libraries.py.

Arduino的程序

接下来要将程序代码上传到Arduino当中,执行低阶的伺服机控制,以便能从Linux机器操作。这时要以限制范围内的百分比(0.0~1.0)指定伺服机的位置。之所以使用百分比而不是写明角度,是因为Arduino的程序代码限制了正确的角度,要避免在指定角度时发生冲突。

就如各位所见,使用ROS之后,一般的循环函数就会变得相当简单。循环函数只会订阅(subscribe)数据,任何Arduino循环都一样。设定时要将ROS初始化,将各个ROS讯息订阅者的订阅叫出来。每个订阅者会占据Arduino的RAM,数量取决于要用程序代码做什么,以6个到12个为限。

#include

#include

#include

#include

#defineSERVOPIN3

Servoservo;

voidservo_cb(conststd_msgs::Float32&msg)

{

constfloatmin=45;

constfloatrange=90;

floatv=msg.data;

if(v>1)v=1;

if(v<0)v=0;

floatangle=min+(range*v);

servo.write(angle);

}

ros::Subscriber

ros::NodeHandlenh;

voidsetup()

{

servo.attach(SERVOPIN);

nh.initNode();

nh.subscribe(sub);

}

voidloop()

{

nh.spinonce();

delay(1);}

接下来要设法透过Arduino在ROS的世界说话。最简单的方法是使用机器人启动档。虽然以下的档案内容非常简单,但是这里要追加启动档,如此一来即使是非常复杂的机器人,也能用一个指令启动。

$catrosservo.launch

$roslaunch./rosservo.lanch

rostopic指令可以看出ROS讯息传送到机器人的哪个部位。看了下面的程序代码就会发现,「/head/tilt」可以透过Arduino使用。讯息要使用「rostopic」传送。-1的选项只会发布(publish)讯息一次,通知/head/tilt传送一个浮点数。

$rostopiclist

/diagnostics

/head/tilt

/rosout

/rosout_agg

$rostopicpub-1/head/tiltstd_msgs/Float320.4

$rostopicpub-1/head/tiltstd_msgs/Float320.9

这个阶段当中,能够将所有发布数值到ROS的已知方法用在控制伺服机上。假如从0改成1,伺服机就会全速运行。这本来并没有问题,但实际上我们想要逐渐加速以达到全速,然后再逐渐减速,停在目标角度上。假如伺服机骤然运转,机器人的动作就会变得僵硬,让周围的人吓一跳。

用另一个节点平滑运动

Houndbot

Terry

Terry和Houndbot都是ROS机器人,以6061个铝合金零件制造而成。项目的目标是要尽量让这些机器人自主运动。

以下的Python脚本程序会监听「/head/tilt/smooth」的讯息,朝「/head/tilt」发布许多讯息,好让伺服机转到目标角度之前慢慢加速,再慢慢延迟旋转。当讯息抵达「/head/tilt/smooth」时一定会呼叫「moveServo_cb」。这个回调函式会从-90到+90度之间每10度产生1个数值,追加到角度数组当中。「sin()」会取这个角度,数值从-1到+1慢慢增加。该数值加1之后,范围就会变成0到+2,再除以2之后,0到+1的曲线数值数组就完成了。然后再看看m数组当中,每当发布讯息时,就会稍微前进一点,范围在r之内,直到1*r或是全范围为止。

#!/usr/bin/envpython

fromtimeimportsleep

importnumpyasnp

importrospy

fromstd_msgs.msgimportFloat32

currentPosition=0.5

pub=None

defmoveServo_cb(data):

globalcurrentPosition,pub

targetPosition=data.data

r=targetPosition-currentPosition

angles=np.array((range(190))[0::10])-90

m=(np.sin(angles*np.pi/180.)+1)/2

formiinnp.nditer(m):

pos=currentPosition+mi*r

print“pos:“,pos

pub.publish(pos)

sleep(0.05)

currentPosition=targetPosition

print“pos-e:“,currentPosition

pub.publish(currentPosition)

deflistener():

globalpub

rospy.init_node(‘servoencoder’,anonymous=True)

rospy.Subscriber(‘/head/tilt/smooth’,Float32,moveServo_cb)

pub=rospy.Publisher(‘/head/tilt’,Float32,queue_size=10)

rospy.spin()

if__name__==‘__main__’:

listener()

想要测试伺服机顺畅的动作,就要启动Python脚本,将讯息发布到「/head/tilt/smooth」,这样一来即可检视顺畅的动作。

$./servoencoder.py

$rostopicpub-1/head/tilt/smoothstd_msgs/Float321

$rostopicpub-1/head/tilt/smoothstd_msgs/Float320

ROS当中的名称也可以重新测绘。只要将「/head/tilt/smooth」重新测绘为「/head/tilt」,程序就能向伺服机发出命令,而不会意识到正弦曲线的数值在变化。

迎向未来

虽然这里只说明了简单的伺服机控制,ROS却有更多功能。假如想要知道妨碍机器人的东西是什么,不妨使用已经支持ROS的Kinect。就算导航堆栈使用这项数据测绘,也可以馈送简短的Python脚本,让伺服机动起来,命令机器人追踪附近的物体。没错,眼睛真的会追逐物体。

Terry是室内用机器人,搭载2个Kinect。一个专门用来导航,另一个则用于深度测绘。Terry使用6个Arduinos,能够从用了ROS的网络接口或PS3遥控器直接操作。

Houndbot是设计成要在户外使用。里头有遥控器、GPS、罗盘和ROS耳形控制器。后续计划要搭载导航用的PS4双镜头摄影机,因为Kinect不能在阳光下使用。这台机器人重量为20公斤。还可以追加了悬吊系统,为此需要自行制造铝合金客制化零件。

声明:本文为转载类文章,如涉及版权问题,请及时联系我们删除(QQ: 2737591964,不便之处,敬请谅解!

标签: 机运
打赏

免责声明:
本站部份内容系网友自发上传与转载,不代表本网赞同其观点;
如涉及内容、版权等问题,请在30日内联系,我们将在第一时间删除内容!

购物指南

支付方式

商家合作

关于我们

微信扫一扫

(c)2008-2018 DESTOON B2B SYSTEM All Rights Reserved
免责声明:以上信息由相关企业或个人自行免费发布,其真实性、准确性及合法性未证实。请谨慎采用,风险自负。本网对此不承担任何法律责任。

在线咨询

在线咨询:

QQ交流群

微信公众号