[机器人2.doc
文本预览下载声明
苏州市职业大学实验报告
院系 电子信息工程系 班级 09电气（4） 姓名 韩 成 学号 097301405
实验名称 有趣 的 搬 运 车 实验日期 2011 年 5 月 13 日
一、实验目的
1．掌握舵机控制原理，P/C舵机及CSD55xx舵机控制原理
2．掌握轮式机器人的运动控制
3．掌握机械手的动作规范
二、实验要求
搭建一个安装有机械手的四轮小车，需要完成如下任务：
1).打开电源开关时小车并不运动，通过拍手（利用声音传感器）或按钮（碰撞传感器）启动小车，并按照规定的动作进行；
2）前进5s，前进过程中0号灯亮；左转90°，转弯时1号灯亮；再进行5s。0号灯亮；停止前进，所有灯灭；
3）手拿物品接近机械手，所有灯亮（利用红外接近传感器），机械手张开3s后夹持住；
4）后退5s，2号灯亮；左转90°，1号灯亮；前进5s,0号灯亮；停止前进，所有灯灭；
5）机械手张开，所有灯亮，放下物品，完成所有任务，机械手恢复原状，等待；
再拍一次手或再按一次按钮，再次启动机器人重复上面的运动。
三、实验设备
MultiFLEX2-AVR控制器，1块；多功能调试器和电缆，一套；LDE灯，4个；红外线接近传感器，1个；KD舵机连接件，4个；小车底座，2个；舵机，7个；橡胶轮子，4个；声音或碰撞传感器，1个；连接件，若干。
四、实验过程及步骤
步骤1-安装底盘和舵机架
连接底板和舵机架；
安装舵机架时，需要注意其两端并不完全对称，需要根据实际情况来装配舵机，以保证轮子的对称发布。
步骤2-安装舵机
将舵机装入舵机架中用螺丝钉固定。
步骤3-安装橡胶轮
用连接件安装轮子，并用螺丝钉固定。
步骤4-修改ID号
取出多功能调试器和电源，连接好左前轮舵机。
查看端口号并打开串口。
右击“我的电脑”，选择“管理”-“设备管理器”-“端口COM和LPT”，即可看到端口号USB Serial Port(COM4)。
在RobotServo Terminal的Com框中输入端口号4，单击Open按钮打开串口。
查询，然后修改该舵机ID为1。
更换舵机，重复上述操作，将右前轮舵机ID设置为2，左后轮舵机ID设置为3，右后轮舵机ID设置为4。
第 1 页 共 7页 指导教师签名
苏州市职业大学实验报告
院系 电子信息工程系 班级 09电气（4） 姓名 韩 成 学号 097301405
实验名称 有 趣 的 搬 运 车 实验日期 2011 年 5月 13日
步骤5-组装机械手
在这里组装的是一个3自由度的机械手，即手掌、腕关节和肘关节。
打开RobotServo Terminal软件，把机械手的3个舵机ID设置为机械手端7、腕关节6、肘关节5，并把这3个舵机调到中位。
步骤6-安装传感器、LED灯和控制器
安装声音（或碰撞）传感器、红外线接近传感器、控制器和LED灯到上底板上，最后把上下两个底板安装到一起。
步骤7-接线
将声音（或碰撞）传感器接到IO11，红外线接近传感器接到IO11，LED灯分别接到IO0—IO3。将机械手上的舵机串联后接入控制器上的任意一个机器人接口，将轮子上的4个舵机两两相连，然后继而控制器多余的机器人接口。连接好多功能调试器、控制器和pc机。将直流稳压电源连接到控制器。
步骤8-新建工程及参数设置
新建工程，进入舵机设置界面，在“当前构型的舵机个数”中填入7。在“当前构型的舵机列表”
中，将前4个Mode设置为“电机模式”。单击下一步按钮进入AD设置，这一步不作设置，单击下一步按钮进入IO设置界面。
设置号，单击“完成”按钮进入主界面。
步骤9-增加while循环模块
拖入一个while模块，放在start和end之间，组成一个死循环，这样可以让整个程序永远运行。
步骤10-增加启动开关
拖入一个while模块，两个数字输入模块，一个if模块，一个break模块，一个variable模块，组成一个“软”开关。该开关与声音传感器相对应，可以实现拍手启动机器人。最后连接各模块。
步骤11-小车前进
从上面的分析可知，如果要让小车前进，左边舵机的速度应该设置为正值，右边舵机的速度应该设置为负值。
拖入一个舵机模块，设置属性1、3轮为左前和左后，设置其值为512,2、4轮为右前和右后，设置其值为-512。
拖入一个数字输出模块，选择通道为0，输出值设置为0。
拖入一个Delay模块，
显示全部