步行高级机器人技术.doc_第1页
步行高级机器人技术.doc_第2页
步行高级机器人技术.doc_第3页
步行高级机器人技术.doc_第4页
步行高级机器人技术.doc_第5页
免费预览已结束,剩余118页可下载查看

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

步行高级机器人技术学习指导手册版本 1.3第一章:安装步行机器人介绍步行机器人最新的产品构件无论它看起来是多么简单的,你将很快意识到这种需要两台伺服电机进行两足移动的步行机器人比两轮机器人(Boe-Bot)复杂的多,它通过机械运动和BASIC Stamp控制来实现步行机器人的行走。实际上,步行机器人的搭建使用了许多的传感器作为反馈。这其中包括有能观测一定距离内物体的红外线发射器及红外线检测器,还有用以观测红外线无法观测的物体的缓冲传感器(闪光脚趾),和一个用以测量倾斜参数的加速度计。如果你耐心的调节步行机器人硬件和软件,步行机器人能完成所有滚动机器人能完成的动作。步行机器人不仅比滚轮机器人有趣的多,而且你将发现通过学习BASIC Stamp芯片的进行编程,能更加熟练的掌握程序的编程。通过步行机器人编程将会使你学会如何设计PBASIC程序,包括如何使用常量和变量、程序的指针以及存储数据的EEPROM(电可擦除的只读存储器)。一个设计良好的程序标准是,能够在一些需要调整机械装置的场合中,不重新编写你的整个程序,只要通过简单的对程序进行修改就能实现你所要求的功能。步行机器人的运动主要来自于两台伺服电机(这通常用于操纵飞机的螺旋桨)。步行机器人两台伺服电机中,顶部的伺服电机控制双腿在机器人的重心位置两尺的范围内来回摆动,而底部的伺服电机用以机器人的前后行走。步行机器人的腿和脚踝之间采用了一个简单的平行连接件,确保双脚平行的站在地面上。两条腿都连接在同一个电机上,以实现一只脚向前,另一只则向后移动的行走动作。单独的控制一个电动机,机器人能实现步行机器人的前进,后退,左转,右转等动作。通过综合步行机器人的两台伺服电机的运动,就能实现更加协调,更加平稳的行走。通过一个BASIC Stamp2微型控制器来控制步行机器人的伺服电机和传感器。微控制器BASIC Stamp2是教学系统中运用很广的一种芯片,它提供了供步行机器人使用的大量的程序空间、存储空间,以及较快的处理速度。搭建步行机器人根据机器人在地面上行走的方式,步行机器人的装配方法有许多。合理的装配方式还取决于你加装的传感器及其他硬件设施、以及机器人行走的速度等因素。恰当的装配方法对于步行机器人的行走是很重要的,它将有利于程序的设计和步行机器人的行走。需要的工具在搭建步行机器人之前你需要以下的工具:l 活动扳手 (包含在零配件中)l 5/32 L型钥形扳钳(包含在零配件中)l 小钢丝钳附录A中有一个完整的配件清单及一个配件表格可供查找,我们可以很容易查找到我们所要用到配件。如果你的配套的工具中少了相应的配件,则将由Parallax公司为你免费提供。在日常的生产过程中,我们有着一套严格的时间机制和一套质量管理机制,但是我们偶尔也会出现一点工作上的失误。如果您丢失了一个配件,请您马上联系我们。如果您的配件破损了或者您想为您的步行机器人增加一些配件,您可以到我们元件商店订购任何一款您需要的配件。(下的“Products/Component Shop”)步骤1:安装顶部的“倾斜”伺服电机步骤1需要以下的配件l (4)4/40 3/8”长平头螺钉l (4) 4/40 螺母l (1)步行机器人的支架l (1)步行机器人的伺服电机用螺丝起子取出固定在电机连接部件和电机输出轴之间的螺钉。将每个电机连接部件从电机输出轴上取下来。将螺钉保存好,以备后面使用。如图1-1所示,正确安装步行机器人的伺服电机。用4个(4)4/40 3/8”平头螺钉和(4)4/40螺母将其固定。最简单的方法是一手扶螺母另一只手用螺丝刀将其拧紧。图1-1,安装倾斜伺服电机步骤2:安装底部的“大步”伺服电机步骤2需要以下的配件l (4)4/40 3/8”长平头螺钉l (4) 4/40 螺母l (1)步行机器人的伺服电机如图1-2所示,正确安装步行机器人的底部伺服电机。用4个(4)4/40 3/8”平头螺钉和(4)4/40螺母将其固定。 图1-2 安装踏步伺服电机步骤3:伺服电机的调整步骤3需要以下的配件l 电池盒l (4)AA电池(配件中不含)l 串口线(RS-232 DB-9 and straight-through)l 在你的电脑上安装并运行BASIC Stamp软件这个步骤应该在组装步行机器人之前完成。这将会减少之后编写程序时出现的问题。不能缺省这一步骤,因为它将使后面的调整更加容易。将两台伺服电机的连接插头插入步行机器人电路板内的X6和X7。字母B对应着伺服电机的黑色的导线。下一步,在面包板上,用一根跳线连接Vs1和Vss。用另一根跳线连接Vs2和Vss。按照图1-3所示连接BASIC Stamps电路板。为什么要连接Vs2和VSS呢?步行机器人与相扑机器人有着相同的控制器。当相扑机器人与对手比赛时,在向对手前进时,对手有可能正处在环外。此时,伺服电机与一个A/D转换器连接,能让我们辨认对手的位置,并做出相应的处理。下一步,将4个电池装入电池盒中。并将电源的开关拨至0位。电池盒的白线与步行机器人接合板“+”端相连,黑线与接合板上的“-”端相连。并用螺丝将其固定。通过一根串口线,将步行机器人的电路板与你的计算机相连。 步行机器人的电源开关有3个位置。每一个位置都对应着一种状态(下图所示)。三个位置中的“1”位给除伺服电机外的所有电路提供电源。在附录B中有一个完整的说明。位置“0” 不提供电源位置“1” 提供步行机器人电路板电源位置“2” 提供包括电路板、伺服电机在内的所有步行机器人的电源将电源开关拨至“2”位。下一步,进行BASIC Stamp的编程。在后面的章节中,我们会发现电源的这3个位置将是非常有用的。在调试机器人过程中,如果你要在不移动步行机器人的情况下,单独调试机器人的传感器,那么你可以通过转换电源的这3个位置来实现。打开BASIC Stamp的编辑窗口。写下或载入下面的调试伺服电机的程序:步行机器人的程序可以从我们公司的网站下载。在这里有我们其他类型的Stamps可供学习,但是在这些高级列表中,步行机器人的程序都相当的长。如果你直接下载他们,将省去你不少的时间。下载完步行机器人的程序,你可以通过菜单Run/Run或点击工具栏上的“ ”按钮来运行你的程序。这个程序是一个死循环,既两台伺服电机将一直处在运行的状态。直到你将电源开关拨至“0”位时,两台伺服电机也立刻停止运行。调试完成后,断开伺服电机与电路板的连线,取出电池盒中的电池,并拆除电池盒与电路板连接的导线。步骤4:安装伺服电机的连接部件步骤4需要以下的配件:l 两个伺服电机连接部件l (2)用以连接伺服电机和电机连接部件黑色小螺丝如图1-4所示,连接件与伺服电机通过的V型键槽连接。然后利用从步骤1和步骤2中取出的螺丝将连接件固定在伺服电机上。图1-4 安装伺服电机的连接部件步骤5:在大步伺服电机上安装黄铜夹头步骤5需要以下的配件:l (2)黄铜夹头(黄铜支架,固定螺丝和金属扣眼-也称为E-Z连接器)将两个黄铜夹头安装在伺服电机连接件上最外端的两个孔上(如图1-5所示,安装在伺服电机白色的塑料连接件的两端)。用钳子将橡胶夹头压入黄铜夹头内。再用两个小螺丝将它们固定,以至它们不会脱离。(图1-6)。 图1-5 在踏步电机上安装黄铜夹头 图1-6 固定黄铜夹头步骤6:安装顶板步骤6需要以下的配件:l 步行机器人的顶板l (4)4/40 3/8”平头螺钉l (4)4/40 螺母如图1-7所示,在步行机器人支架上安装顶板是相当容易。一只手将4/40 3/8”的平头螺钉从顶板的底部穿过顶板上的孔,另一只手将4/40的螺母放置于顶板的孔上将其上紧,并将支架与顶板连接。重复以上步骤3遍,便完成了顶板的安装。注意:这一步骤用到的是4/40的平头螺钉,而不是平底的圆头螺钉。图1-7 安装顶板步骤7:安装步行机器人身体与腿的不锈钢连接杆步骤7需要以下配件:l 3/16”3”不锈钢杆l (4)塑料垫圈如图1-8所示,将两根3”3/16”不锈钢杆从步行机器人的支架上的两个孔穿过,然后在杆的两端分别上上垫圈。这两个垫圈将减少步行机器人的腿与身体之间的摩擦。图1-8 安装连接杆步骤8:在步行机器人的身体上安装双腿步骤8需要以下的配件:l (4)步行机器人的腿如图1-9所示,将步行机器人的4条腿安装在两根不锈钢杆的上。 图1-9 安装四条腿步骤9:用轴环将腿固定步骤9需要以下的配件:l (4)3/16带有固定螺丝的轴环l L形的内六角扳手在配件中找到带有L形内六角扳手和3/16金属轴环的包装袋。将金属轴环套在不锈钢杆的两端。如图1-10所示,将每一个轴环用L形的内六角扳手将其固定在不锈钢金属杆上。如果螺丝拧的不够紧,则在感觉到有阻力的情况下再转过一个很小的角度,这样的松紧程度最为合适。但如果拧的太紧,它可能阻碍伺服电机的正常工作,致使步行机器人不能很好的行走。 图1-9 安装轴环步骤10:安装两腿间的连接件步骤10需要以下的配件:l (2)4/40白色的塑料垫圈(也称为E-Z调节角质托架)l 3/8” 4/40平头螺钉l (2)黄铜直角金属杆步骤10分为两个子步骤:首先,先将一颗3/8”4/40的平头螺钉穿过步行机器人左腿上的孔(如图1-11所示),并将其与塑料直角托架连接。在右腿上也重复以上的步骤。在拧螺丝时,要保证托架与螺丝在两腿上有足够的旋转空间。能进行180度的旋转。 图1-11 加装直角托架取出两根直角黄铜线,并将黄铜金属杆较长杆的一端穿过黄铜垫圈,如图1-12所示。将黄铜金属杆较短的一端穿过塑料直角托架。用手扶住金属杆,并用螺丝刀将其上紧。调整链结,保证两条腿没有倾斜,并能垂直的站立。假如你需要或者伺服电机被移动过,你可以再次校正伺服电机的中心位置。重复以上步骤,调整机器人的另一只脚。 图1-12 连接四条腿步骤11:加装步行机器人的脚踝步骤11需要以下的配件:l (2)脚踝配件l (4)4/40”的平头螺钉在步行机器人的腿上加装脚踝需要用到4颗4/40的平头螺钉(图1-13)。脚踝的较长的一端应该安装在步行机器人的后腿上,这样更有利于步行机器人在前进过程中重心的调整,以及更好的控制机器人。 图1-13 加装脚踝步骤12:安装步行机器人的双脚步骤12需要以下配件:l 步行机器人的左脚l 步行机器人的右脚l (4)4/40 不锈钢内六角螺钉l 3/32”L形内六角扳手如图1-14所示,将步行机器人脚踝安装在步行机器人脚掌上的第3个孔上。如果安装太紧的话,可以将双脚稍微向外侧弯曲。用两颗4/40的螺钉(这种螺钉有一个圆头作为脚踝与脚板之间的支承件)和3/32的L形内六角扳手,在步行机器人的脚踝上加装步行机器人的脚板。用同样的方法安装步行机器人的右脚。在编程前,保证每一只脚都能自由的倾斜。 图1-15 加装脚板步骤13:安装球形接头步骤12需要以下的配件l (4)球形接头(带有螺钉的球形接头,螺母)在步行机器人两脚的最外面的孔上安装上一个球形接头(图1-15)。然后用一把小扳手或用尖嘴钳将螺母拧紧。你可以一只手抓住螺母,另一只手转动球形接头,将它们固定。在装配时要注意,不要用钳子过于用力的夹球形接头,这样会损坏球形接头,并阻塞球形接头与塑料套管之间的自由转动。 图1-15 安装球形接头在伺服电机的控制连杆上安装两个球形接头(图1-16)。将球形接头固定在连杆的最外侧的孔上。 图1-16 在伺服电机上加装球形接头步骤14:安装倾斜杆步骤14需要以下的配件:l (2).090”直径5.4”不锈钢杆,2/56螺纹(在两端)l (4)带有2/56螺纹的球形接头塑料管在5.4”的不锈钢杆的两端分别旋入2个塑料球形接头管。测量伺服电机连接件上的球形接头与脚上的球形接头之间的距离。调整不锈钢杆的长度,连接的距离应以比步行机器人直立状态下的两点的距离长1/16”的距离最为合适。这将有利于机器人在拐弯时脚能紧贴在地面上。当你调整好合适的高度后,将不锈钢杆固定在机器人伺服电机和脚的球形接头上(图1-17)。 图1-17 安装倾斜杆用相同的方法加装另一根不锈钢杆。如果你要简单的调整一下倾斜杆的长度,需要将球形接头管从球形接头上取下,那么有一个很简单的方法。用一把螺丝刀在球形接头与管之间小心的翘一下,球形接头与球形套管就分离了。如果你调整完毕则只要将球形套管轻轻按入球形接头即可。步行机器人的微调:当步行机器人的身体是略往后倾斜时,步行机器人的性能是最佳的。也就是说,当两台伺服电机都处在中心位置时,步行机器人的双脚是平站在地面上的或者略微的有一点向后倾斜。当你完成了这一步骤之后你的步行机器人应该如图1-18所示的一样。当步行机器人的身体略微的向后倾斜时,机器人的性能最佳。当你检查机器人时,首先要确定步行机器人的双脚是平站在地面上的,或者略向前倾斜。如果需要再一次调整其他硬件,可以利用BASIC Stamp重新调整伺服电机的中心位置。图1-18 调整倾斜杆步骤15:安装电池盒步骤15需要以下的配件:l 电池盒l (2)4/40 3/8”长平头螺钉l (2)4/40 螺母将步行机器人直立摆放。如图1-19所示,用两颗4/40 3/8的平头螺钉和4/40的螺母将电池盒固定在步行机器人的顶部。拧紧平头螺钉,使平头螺钉嵌入电池盒中。且螺钉应穿过电池盒,从电池盒另一侧穿出。 图1-19 安装电池盒步骤16:安装四个支柱步骤16需要以下配件:l (4)4/40支柱l (4)4/40”平头螺钉如图1-20所示,在步行机器人的顶板上安装4个支柱。 图1-20 在顶板上安装支柱步骤17:连接步行机器人的电路板和电池盒之间的导线步骤17需要以下配件:l 步行机器人的BASIC Stamp电子板电池盒的白色导线与机器人电路板上的“+”接线头连接。另外一根导线与“-”接线头连接。用一把螺丝刀将它们固定(图1-21)。 图1-21连接电源线步骤18:装入4个AA电池步骤18需要以下的配件:l (4)AA电池(不包含在零配件中)如图1-22所示,安装4个电池。将步行机器人电路板上的电源开关拨至“1”位处,检验电源是否连接正确。如果正确,绿色的电源指示等将变亮。 图1-22 安装4节电池步骤19:安装步行机器人电路板步骤19需要以下的配件:l (4)4/40 1/4”平头螺钉如图1-23所示,在步行机器人的顶板上,用4个4/40的平头螺钉将机器人的电路板固定在4个支柱上。并将步行机器人底下的那台伺服电机(大步伺服电机)连接在电路板的P12处。而将前面的那台伺服电机(倾斜伺服电机)连接到电路板的P13处。图1-23 完成步行机器人安装步骤20:对伺服电机和机器人进行整体的调整最后一个步骤,重复前面的步骤3-对伺服电机进行中位调整。调整后的步行机器人的双脚应该均衡的平坦的站在地面上。当你继续向机器人的上部检查时,应保证步行机器人的双腿略向前倾斜。用最简单的方法用螺丝刀将球形套管从球形接头上成功的取出,以方便倾斜杆的调整。步行机器人的最佳行走状态是步行机器人的双脚不是直立在地面上的是略微向后倾斜1至2度,以保证重心处在两足之间。第2章:步行机器人的行走简单的控制及你的第一个程序步行机器人有36种独特的运动方式,要实现步行机器人行走需要耐心的调试。在下面的实验中你将学会如何编写程序让步行机器人向前走、向后走。在这一章中我们将介绍步行机器人的直线行走,而我们将在第三章向大家介绍步行机器人是如何实现转弯的,在第三章中,你将发现步行机器人要实现转弯需要用到许多这一章中介绍的连接件运动方式的一些步骤。例如,如果步行机器人要在地面上行走,首先必须先移动它的左脚。编写好基本的程序后,你将继续学习如何存储你的主运动及子运动的程序在EEPROM中,还能学到一些更有效的编程方法。在这一章中,我们进行的实验都是开环实验,也就是说没有反馈信号(这其中包括你要通知步行机器人走多远,或者什么时候左转,什么时候右转,也包括是否检测到前进的方向上有障碍物。)基本的伺服电机控制伺服电机是如何工作的伺服电机被广泛运用于无线电控制的汽车、轮船和飞机上,主要用来控制它们的运动方向及调节运动速度。伺服电机被设计用来控制某个事物到达一个特定的位置,例如无线电控制的飞机螺旋桨的操纵。它们可以进行90度至270度的位置控制,而且这种控制常被用于一些价格低廉、精度较高、力矩较大的位置控制中。我们利用一种信号来控制这些伺服电机的位置,我们称这种信号为脉冲序列,在下面的章节中我们将学习到这部分的内容。一般的伺服电机在转角为90度或者270度附近有一个机械限位装置。伺服电机内部都装有一个位置反馈的机械装置,通过一组反馈回来的脉冲序列以及电子电路板的控制来判断伺服电机所处的位置,并让直流伺服电机在特定的位置转弯。步行机器人使用的是未经改良的伺服电机,这种伺服电机能转过的最大角度大约是270度。时间参数和标准电压在这一本学习指南中,我们将多次提到几个重要的时间单位秒(s),毫秒(ms),微秒(us)。通常情况下,我们可以将秒缩写成“s ”。所以,我们也可以将1秒写成1s。毫秒 则被缩写成“ms”,1毫秒等于1/1000秒,1微秒等于1/1000000秒。在表2-1中说明了,秒、毫秒、微秒三者之间的关系。电压的单位是伏特,简写为V。在步行机器人的电路板上的Vss,Vdd和Vin的插孔分别对应着不同的电压值。Vss被称为系统地或称为参考电压。Vin通过一条导线与电池盒中的AA电池组连接,电压为6V。Vdd是一个5V的调整电压,它与Vss一起向步行机器人的电路板及面包板提供电源。 从BASIC Stamp中发送出来的一组控制伺服电机的控制信号被称为“脉冲序列”如图2-1所示。BASIC Stamp能够通过编程产生这样的信号,而且还能用它任意的一个I/O口进行信号的传输。在下面的例子中,BASIC Stamp向 P12(大步伺服电机)和P13(倾斜伺服电机)各发送一个1500微秒的脉冲信号。在1500微秒的高电平送出后,BASIC Stamp继续发送一个25毫秒的低电平给该引脚,产生一组脉冲序列。如图所示,这个脉冲序列由1500微秒的高电平和25毫秒的低电平组成。伺服电机的控制主要由1500微秒的高电平来控制,我们通常称这一段时间为脉宽。脉冲信号由低电平到高电平这一变化过程我们称为上升沿。同理,由高电平到低电平的变化我们称为下降沿。我们这里所用的伺服电机,理想的脉冲时间应为1040毫秒。如果高于或者低于这个范围,将影响伺服电机的正常运行。BASIC Stamp 2中的PULSOUT指令用来发送2微秒的高电平。例如要向P13脚发送1500微秒的高电平信号,程序如:PULSOUT 13,750步行机器人多种多样的运动方式程序不仅是一门科学还是一门艺术。通过各种不同的编程方法来达到同一个结果,这种多形式的编程方式有利于更有效的利用存储空间,也更有利于机器人的运动。在这章中,我们将看到步行机器人各式各样的运动,这其中包括向前走、向后走。我们使用的步行机器人可以实现36中不同的运动。我们将利用这36种不同的运动来实现步行机器人的行走。36种运动方式,每一种运动方式都有一些联系,也就是说,无论哪个动作都有相应的之前动作,或者有一个相应的之后动作。在这一章中,我们也将介绍,通过几种不同的编程方式来实现步行机器人的行走。下面,我们将介绍三种不同的编程方式。在这三种编程方式中,最后一种编程方式使用起来非常的复杂,但它是更加的灵活,更加的容易掌握,所以被大多数人所接受、使用。有经验的程序员可以直接学习最后一种编程方式,但我们建议三种编程方式都是值得学习的。方式1:顺序编程这种方式应用了大量的子程序,每一个子程序对应着一个动作。通过调用和组合这些子程序来完成步行机器人复杂的运动。这种方式简明易懂,但一一列出36种运动方式极大浪费了宝贵的存储空间,更加不利于程序的修改。例如,要改变运动速度这一参数,就必须修改程序中所有的运动速度参数,极不方便。方式2:数据表格这种方式通过找寻36种运动之间的共性,特别是在一些具有相似功能的程序中相同的参数值,把这些参数归纳到参数表中。通过对这些参数的管理就能将程序更加清晰的表现出来。方式3:状态迁移数据表格的方式实际上就是第一种方式和第二种方式的结合。运用这种方式,程序员必须记下步行机器人脚步的位置以及需要调用的例程,并且要在表格中填入适当的参数值。而这种状态迁移方式不同于前面的两种编程方式。步行机器人运动过程中机器人的双脚按照一定的轨迹运动。迁移是将现在所处的状态迁移到其他相似的状态中去。步行机器人的运动基本是以3倾斜、3大步的运动方式前进的。这就意味着它比其他的2种方式更加的简单,更少的使用到36种基本运动。步行机器人的运动原理:人的步行方式看起来是十分自然的,但实际是相当复杂的。人将视觉和触觉感受到的信息传回大脑,由大脑来协调各个肌肉之间的运动。而步行机器人采用了另一种相似的系统。它仅有两部伺服电机,仅能够实现有限运动,而且基本上没有反馈信号。虽然步行机器人无法自己行走,但你可以应用你对BASIC的理解,来简单的进行步行机器人行走程序的编写。人们通过控制双脚的运动来行走。首先,身体略微向前倾斜,然后迈出一只脚。人们就是通过不断重复这个过程来行走的,这一过程在人们的跑步中将更加的明显。如果没有调整好行走的步伐就会跌倒在地面上。步行机器人正是模仿了人类的步行方式进行行走的。因此,在步行机器人向前行走的同时,它的身体也随之前进。但是要实现这一过程,对于机器人本身来说是相当困难的。你可以尝试一下,向前倾斜你的身体,这是很容易的,但是这只是一个基本的控制步伐。步行机器人通过倾斜和平衡运动,来实现行走的。这就需要一系列简单的运动作为运动基础。步行机器人基本上能实现双脚向任何一边倾斜,或者平稳的站在地面上。无论是左脚还是右脚都能实现向前迈步,一只脚向前,一只脚向后,或者前后的反复运动。步行机器人有9个基本的脚步位置、从一个位置到另一个位置都有4种的过渡方式,共计36种迁移状态。通过组合这些有限的运动,步行机器人能在平地上相对平稳的移动。由于步行机器人有限的运动方式,限制了步行机器人只有2种基本的运动:直线行走和原地旋转。利用这两种基本运动,可以让步行机器人从A点移动到B点。步行机器人的行走的4个步骤a. 向一边倾斜b. 移动被提起的那只脚c. 向另一边倾斜d. 移动被提起的那只脚通过循环以上的步骤,就能实现步行机器人的直线行走。通过双脚的移动来控制行走的方向以及行走的距离。每一步移动的距离决定了步行机器人行走的距离。步行机器人移动的速度,则主要取决于电机运动的速度,以及双脚移动的距离。如果步行机器人没有倾斜足够的距离,则机器人将保持平衡。这意味着这个过程在以后的任意时刻能够被停止或者重新启动。这与人类的行走不同,人们必须双脚都落在地面上才能停止或者重新启动。在写程序控制步行机器人的运动中,动量扮演了一个很重要的角色。伺服电机精确的控制双脚的位置。通过对伺服电机的控制,能够快速或慢速的移动步行机器人的双腿,并能让它在移动中的任意位置停止运动。即使在倾斜很大的情况下,步行机器人仍然能保持平衡,但是如果步行机器人的移动速度过快,由于存在的较大的动量,步行机器人将很难保持平衡。如果提高双腿的移动速度,那么步行机器人双腿的动量也随之变大。要让步行机器人在指定的位置上停止,步行机器人的动量不能过大。过大的动量会使步行机器人跌倒。人类通过膝盖和脊椎关节来实现转弯的,而步行机器人没有类似的结构,它只能通过原地旋转来实现转弯。步行机器人的双脚总是向前的,所以它不能改变它的运动方向,只能进行直线运动。步行机器人通过原地旋转实现转弯的,步行机器人从A点直线运动到B点,在B点原地旋转,转向C点的方向,然后直线运动至C点。原地旋转也有4个步骤a.向一边倾斜b.移动被提起的那只腿c.两只腿同时着地d.分别向不同的两个方向移动双腿实际上,步行机器人的原地旋转是在最后一步(步行机器人的双脚同时在地面上)完成的。它基本的工作原理是一只脚向前运动时,另一只脚向后运动,通过双脚与地面间的摩擦里来实现原地旋转。而两脚与地面之间的摩擦系数应适当。过底的摩擦系数,导致机器人无法原地旋转。过大的摩擦系数则会使步行机器人跌倒。步行机器人在平坦的表面行走基本上是受到限制的。在这一类的表面上行走,步行机器人两脚与地面之间的摩擦系数较低,不利于机器人的行走。步行机器人适合在木板、硬地毯和厨房的油毡地板上行走。而稠密的地毯最适合步行机器人的行走。可以通过在步行机器人的脚板的底部加贴不同材质的胶带来增加步行机器人于地面间的摩擦系数,这里我们用胶带(电胶带,一片很小的紧固胶带)。关于摩擦系数的选择,没有一个非常标准的规定。你必须通过调整程序来控制步行机器人在这种表面上的行走。例如,两次原地旋转,步行机器人旋转的角度内小于90。在这里涉及到一个准确性的问题。步行机器人能够很好的进行移动,但是它的运动精度比滚轮机器人(宝贝车机器人)的运动精度差。如果步行机器人先向前走六步,再向后走六步,它几乎不可能回到原来出发前的位置。它可能是在原来位置的附近,但这个位置并不确定。如果删除所有的调整和一些转弯程序,步行机器人无法在一个相对较为宽广的地方步行。除非已经知道了步行机器人与地面之间的摩擦因数、和精确的机械运动参数,才能编程实现步行行走。如果没有这些参数,步行机器人则无法正常行走。除非你尝试用一个附加的滚动机器人的代码或尝试解决其中的一些困难。步行机器人的重复性限制比较小。对于大多数的实验来说,步行机器人的准确性并不是十分重要。我们可以为步行机器人加装一个罗盘,追踪步行机器人的运动方向。但是只有在一定范围内才能达到最佳的追踪效果。这个问题将不在本书讨论,但你可以在其他的地方查到许多相关资料。机器人,无论它通过轮子还是腿进行行走,都有一个非常具有挑战性和教育意义的问题:“机器人当前的位置控制”。这里,步行机器人的双腿上缺少了一个关节连接件来防止步行机器人撞到障碍物上,并且步行机器人无法在一个斜坡上行走。通过加装传感器,步行机器人能够避开障碍物。在下面的实验中,我们将使用一个步行机器人配套的红外线检测设备来识别障碍物。第一部分:基本的步行运动:顺序步行机器人是一个行走的机器人,所以这种编程方式是你学习编程的一个很好的起点。如图2-2所示,步行机器人行走的步骤。步行机器人通过运动0,1和2、以及运动3、4、5、6的重复运动来实现直线行走。接下来的几页中为你展示这些程序是如何让机器人运动的。运动2,除了对倾斜伺服电机和踏步伺服电机进行了调整外,运动2基本上与运动1十分的相似。运动1、3、5也使用了相同的例行程序,只是他们的参数值不同。同样,运动2,4,6也用了相同的例行程序,参数值也不同。M0的例行程序独有的。无论双脚当前处在什么位置,什么状态下,M0都是步行机器人的起步位置(双脚同时均衡的站在地面上)。如果双脚还没有到达或者正处于这种状态下,通过使用MO也可以立刻结束程序。在程序中,例行程序M1、M2用来作为除M0外的所有的运动例行程序的样例。运动M1是将步行机器人向右倾斜,通过同时向两台伺服电机发送脉冲来控制步行机器人。首先,发送相同脉宽的脉冲信号(上一步中的-M0,送给踏步伺服电机的脉冲信号)给踏步伺服电机,这意味着踏步伺服电机固定在原来的位置,双脚没有向前或向后移动。然后,给倾斜伺服电机发送一个不同脉宽的脉冲信号(不同于M0中送给倾斜伺服电机的脉宽信号),使倾斜伺服电机旋转,从而带动步行机器人的倾斜。例行程序M2与M1相似,只是在M2中,倾斜伺服电机保持不动,而通过改变踏步伺服电机的脉宽值来使得踏步伺服电机转动,从而带动双腿的前后运动,实现步行机器人的向前移动。在程序中使用了许多固定的名词来定义伺服电机一系列的脉宽限位值,在这些程序断中,都用常量定义了这些固定名词的参数值。这样,便于参数值不同的实验的进行,只要修改已定义的参量来修改程序的参数,就可以完成相应的实验,且与完全修改程序参数的效果一样,而且使得程序更加的简单。在下面的程序中,FOR.NEXT的循环中使用到了一个STEP变量。STEP变量不是一个物理量。在程序中它是一个步长,它用来发送一个增量脉冲给伺服电机来实现所要求的一系列运动。下面是一个步行机器人行走的程序,这个程序中包括了机器人行走所要的所有子例程。你可以通过改变程序中的常量来改变步行机器人的行走的速度,或步伐的大小。在修改常数前要注意,过大的参数值,可能使步行机器人跌倒。在步行机器人完成它的运动动作后,它的内部程序将被清除,此时,步行机器人的双脚将均衡的平稳的站在地面上。这样,我们才能更清楚了解步行机器人当前所处的位置,有利于下一段程序继续运行。注意在使用串口线下载程序时,应将步行机器人的电源开关拨至下载(“1”位)或者运行(“2”位)处。如果PC的串口线是足够长,而且在不影响步行机器人自由运动的同时,串口线可以与机器人保持连接。但是此时你必须用手抓着串口线,否则,它将略微影响步行机器人的稳定行走。当你要断开串口线前,首先要先将步行机器人的电源关闭。此后,你只须打开电源开关,步行机器人就会根据下载到存储器上的程序自主的进行行走。你也可以先将步行机器人的电源开关拨至“1”位置,按下复位键,再将电源开关拨至“2”处,机器人同样会自动向前行走。要让步行机器人更快行走,我们可以改变MoveDelay、TiltStep和StrideStep三个参数。减少MoveDelay值意味着发送给伺服电机的脉冲值将变小,机器人将走的更快。增大TiltStep和StrideStep将使得伺服电机的脉冲宽度变长,也提高了步行机器人的行走速度。如果你要让步行机器人不以双脚均衡平稳的站在地面上的状态开始运动的,或者你想让你的步行机器人走更大的步长,你可以修改CenterTilt和StrideCenter值。同时也需要修改两台伺服电机的左极限值和右极限值。思考题在事例中修改参数值。尝试以下实验:调整TiltStep和StrideStep的值,用一个较小值代入。观察步行机器人是如何工作的。代入一个较大值,观察步行机器人又是如何工作的。画出伺服电机的时间特性图,并说明在这两种情况下,步行机器人的运动状态不同的原因。用一个较小的值代入MoveDelay,并观察步行机器人是如何工作的。为你的步行机器人挑选适当的MoveDelay、TiltStep和StrideStep值,让步行机器人要照你的要求进行动作。记录这些参数值,为将来的程序设计做准备。第二部分:向后行走:顺序与向前行走相似,步行机器人能够实现向后行走。但要注意的是,不仅仅只是将前进的程序中的步骤顺序颠倒过来,就能实现后退功能。步行机器人的向后行走和背向行走是不同的。6个例行程序中的最后的一个例行程序是相当简单的。要改变步行机器人的运动方向不是非常困难的。记住这两个极为相似的程序,我们将在最后一章中,对其工作原理进行解释。在之前的程序中,步行机器人的每一个步骤对应着一个顺序代码。在这个程序中,这些步骤将会有略微的不同,所以我们需要使用不同的常量名。起步的步骤与先前的向前行走的起步步骤相同,但第二步开始就不同了,我们将用到运动9,我们用M9来命名它。与步行机器人向前行走的程序一样,步行机器人的起始步是以运动0、1和9。通过运动10、11、12和13的重复运动实现步行机器人的向后行走。下面是一个事例程序。在程序中调整不同的常量值,使你的步行机器人走的更快、步长更长。这个程序同样是以两脚同时站在地面上这种状态作为步行机器人行走的结束步。注意在第一个例行程序中,相同名称的参数被提取出来。我们不需要更高级的运动,只需要通过对36种行为的编写,就能基本上实现我们所要的工作性能。思考题尝试以下实验:在程序中,改变以下各项的数值。观察结果,并说明步行机器人的运动为什么与先前的运动不同。TiltStep CON 2 TiltServo step sizeStrideStep CON 2 StrideServo step sizeMoveDelay CON 12 in micrcoseconds写一个程序,实现步行机器人向前走,然后向后回到原地。第三部分:用一个表格来记录步行机器人的运动之前的两个长程序是比较相似的,但是许多复杂的程序需要更多的运动例行程序,这就使得程序更加的长。一个有效的方法是将运动信息简化在一个表格中。下面的样例就使用变量列表来编程,之前的两个程序都可以运用这种方法来编程。用BASIC Stamps的数据指令来存储表格数据。这个指令在你下载程序时已经将数据写到Stamps的存储器中。如果使用恰当,这个数据表格将使你的PBASIC程序更加的高效,更加的简短。注意:在许多由公司下载到的BASIC Stamp样例程序中将会多次出现这个数据指令。它基本上遵从以下的原则:l 数据能够以8位或16位的形式写入BASIC Stamp2s存储器中,从地址02048顺序的存储。你编写的程序则倒序存储在地址2048到地址0上的。 l 编程人员无法观察到自己重新编写的代码。l 下载并运行步行机器人的程序2.3First Steps Forward Using Tables.bs2,选择Run I Memory Map,你将看到数据和程序被存储在EEPROM中。这个例子用了两种方法来开发步行机器人的行走运动。下面的列表项目是一个包括步行机器人所有运动的列表清单。例如,从之前的两个程序可以知道,M1动作完后,运动M2将紧接着开始。而运动M2之后通过反复运动3、4、5和6来实现步行机器人的直线行走。StartForward DATA 1, 2, 0WalkForward DATA 3, 4, 5, 6, 0FinishForward DATA 3, 7, 8, 0在BASIC Stamp的EEPROM中,将数值1存储在地址0,数值2存储在地址1,数值0存储在地址3,数值3存储地址4中,。长变量列表被用于存储一系列的运动,你也可以向其中添加你所需要的更加复杂的运动。通过PBASIC的READ指令读取列表中的数据。这些运动包括了步行机器人倾斜伺服电机和踏步伺服电机所用到的数据值。每一个运动都有一个倾斜伺服电机的开始、结束值和踏步伺服电机的开始、结束值。在这个数据列表中,M1中存储的CenterTilt值,被存储在EEPROM的地址12和地址13中(EEPROM的起始地址是0,不是1),因为上面的三个直线代码占据了12位的空间。WORD16位数值M1 DATA WORD CenterTilt, WORD RightTilt,WORD StrideCenter, WORD StrideCenterM2 DATA WORD RightTilt, WORD RightTilt,WORD StrideCenter, WORD LeftForwardM3 DATA WORD RightTilt, WORD LeftTilt,WORD LeftForward, WORD LeftForwardM4 DATA WORD LeftTilt, WORD LeftTilt,WORD LeftForward, WORD RightForwardM5 DATA WORD LeftTilt, WORD RightTilt,WORD RightForward, WORD RightForwardM6 DATA WORD RightTilt, WORD RightTilt,WORD RightForward, WORD LeftForwardM7 DATA WORD LeftTilt, WORD LeftTilt,WORD LeftForward, WORD StrideCenterM8 DATA WORD LeftTilt, WORD CenterTilt,WORD StrideCenter, WORD StrideCenter在这个程序中只用到了8种运动方式。我们可以根据我们的需要将我们需要的36种运动中的任何一种添加到表格中去。这种方法与第一种顺序编程法相比,只需要很少的用于存放数据的存储空间。这个程序的主程序在例行程序Main_Program: 中,而相应的运动在例行程序Movement: 中。这个Main_Program:例行程序首先调用M0程序,M0:步行机器人的起始位置,两台伺服电机出在中心位置,步行机器人的双脚平稳的站在地面上。Mx的值实际上是程序中StartForward的值,通过数据表格中的地址0给出。在例程the Movement:中,这个值被存储在EEPROM中的Dx中,程序通过READ指令读出Dx的值,Dx现在的值为1.Mx值则每循环一次就增加1。通过程序对表格的第一次检索,将M1的地址值存储到Dx中。然后将地址Dx中的四个值读取出来,并附值给TiltStart, TiltEnd, StrideStart和 StrideEnd四个参数值。通过PULSOUT指令使步行机器人运动。这条指令:IF TiltStart = TiltEnd THEN MovementStride观察一个样例,当步行机器人不改变倾斜值 ,只让步行机器人的一只脚向前移动。有此可见,这条指令使步行机器人TiltStart保持不变时,保证步行机器人的平衡,只让踏步伺服电机发生变化。通过以上的程序能很容易的写出步行机器人向后走的程序,这里只需要做3处改动。一,在列表的合适位置和LOOKUP指令加入适当的运动。二,步行机器人向后行走的过程加入相应的长参数列表。最后,在运动例程中,加入表格的名字及调用表格的指令。这种方式比起在程序中加入许多例程的方式更加的方便。思考题尝试以下实验:通过修改TiltStep, StrideStep 和 MoveDelay的值,在步行机器人慢速行走的前提下,使步行机器人行走更加平稳,。修改WalkForward的数据值,增加步行机器人行走的步骤。第四部分:步行机器人的运动状态迁移现在我们用一种与前面两个例程完全不一样的编程方式来实现步行机器人的行走。前面的两个例程要求程序要有一系列的运动控制的子程序,并通过在合理的地方调用这些程序来实现步行机器人的行走。而我们下面介绍的方法,程序必须知道步行机器人之前所处的状态,以及哪些与它相关的运动例程可以被使用。这是一种较为简单的基本运动控制,但它是一种比较乏味的运动,也会使程序更加的复杂。原有的例程必须知道运动的起始状态到运动的结束状态的例程,这里介绍的这种状态迁移方式则只需要标明运动所需要达到的最终状态即可。程序保持当前的状态,并根据当前的状态做自身的调整。这样,就能把一系列的运动简化成这类型的运动,倾斜和踏步,使得步行机器人的运动仅有3种的运动顺序,每一种的运动顺序都是由这9种运动状态组成。注意!参考程序无法找到。仔细观察这张状态图。每一个圆对应着一种状态。圆中的图形代表了步行机器人的腿和身体的位置。圆中的箭头则标明了步行机器人的前进的方向。暗色的矩形框表示步行机器人与地面接触的腿。而白色的矩形框则表示步行机器悬空的腿。圆形顶部的两个字母表示了步行机器人当前所处的位置。第一个字母表示倾斜伺服电机的位置,第二个字母表示踏步伺服电机所处的位置。字母L,C或者R中C表示这台伺服电机的中心位置。以倾斜伺服电机为例,C表示倾斜伺服电机处在中心位置(步行机器人的双脚均衡的站在地面上)。以踏步伺服电机为例,字母C表示踏步伺服电机处在中心位置(步行机器人的双脚都在步行机器人中心轴线上),每一种状态都将用这种方法命名。图中的双箭头表示从一种状态到另一种状态的有效迁移。箭头上的标志表示哪种状态被改变。图中的Pivot与Stride意思相同,因为他引起了步行机器人原地转动,所以我们用Pivot来表示。九种运动状态,每一种都有4种可能的迁移状态,于是派生出36种不同的迁移状态。我们用步行机器人人的起始状态到步行机器人的结束状态来标志一个步行机器人的迁移状态例行程序,格式为TSxTS。而M0对应的格式为CCxRC,表示M0的起始位置是从双脚均衡的站在地面上状态CC,终止位置为步行机器人向右倾斜状态

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

最新文档

评论

0/150

提交评论