实验二 机器人检测与显示实验.docx

实验二 机器人检测与显示实验 智能机器人实验报告（二）班 级：01540802班姓 名： 南 征学 号： 20080705信息与电子学院实验二 机器人检测与显示实验08级 通信工程专业 01540802班 南征（20080705） 第11组一、 实验目的学习机器人通过几种主要类型的传感器进行数据采集的基本方法，学习LCD的基本知识及其显示与控制方法。二、 实验仪器设备PC机，组装后的Boe-Bot机器人，USB连接线，PING)超声波测距传感器，红外线发光管，红外线接收器，220欧姆电阻，1k电阻，光敏电阻，2k电阻，发光二极管，470欧姆电阻，HM55B电子罗盘，连接导线，Parallax 216 Serial LCD。三、 实验原理通过对单片机编写程序控制车轮电机的转速，实现机器人小车的行走。四、 实验内容1. LCD显示实验(1) 需要部件：Parallax 216 Serial LCD，连接导线。(2) 关闭电源。(3) 连接部件：(4) LCD自检及对比度调节按图2-2所示LCD背面图及其设置方法，将LCD背面的SW1和SW2均拨至OFF位置，打开电源。LCD将进行自检。调节LCD背面的电位器使显示出的字符清晰可见。关闭电源。(5) LCD字符串信息显示新建程序LCD_ASCII.bs2，输入下述代码。 $STAMP BS2 $PBASIC 2.5SEROUT 14，84，22，12PAUSE 5SEROUT 14，84，“See this?”，13，“The LCD works!”END连接USB连接线，并打开电源。下装、运行程序，并观察运行结果，分析其工作原理。关闭电源。(6) LCD数字信息显示新建程序LCD_Number.bs2，输入下述代码。 $STAMP BS2 $PBASIC 2.5counter VAR ByteSEROUT 14，84，22，12PAUSE 5FOR counter = 0 TO 12SEROUT 14，84，DEC counter，“ ”PAUSE 500NEXTEND连接USB连接线，并打开电源。下装、运行程序，并观察运行结果，分析其工作原理。关闭电源。2. 超声波测距及LCD显示实验(1) 需要部件：PING)超声波测距传感器，连接导线，Parallax 216 Serial LCD。(2) 关闭电源。(3) 连接部件：(4) 超声波测距传感器检测及显示新建程序PingLCD.bs2，输入下述代码。 $STAMP BS2 $PBASIC 2.5CmConstant CON 2260cmDistance VAR Wordtime VAR WordSEROUT 14，84，22，12PAUSE 5DOPULSOUT 15，5PULSIN 15，1，timecmDistance = CmConstant * timeSEROUT 14，84，12 4SEROUT 14，84，“Distance=”，DEC cmDistance，“cm”PAUSE 500LOOPEND连接USB连接线，并打开电源。下装、运行程序，并通过移动机器人改变与物体间的距离观察运行结果，分析其工作原理。关闭电源。3. 电子罗盘检测及LCD显示实验(1) 需要部件：HM55B电子罗盘，Parallax 216 Serial LCD，连接导线。(2) 关闭电源。(3) 连接部件：(4) 热敏电阻检测及LED显示新建程序HM55B_LCD.bs2，输入下述代码。 $STAMP BS2px $PBASIC 2.5DinDout PIN 6 P6 transceives to/from Din/DoutClk PIN 5 P5 sends pulses to HM55Bs ClkEn PIN 4 P4 controls HM55Bs /EN(ABLE)Reset CON %0000 Reset command for HM55BMeasure CON %1000 Start measurement commandReport CON %1100 Get status/axis values commandReady CON %1100 11 - Done, 00 - no errorsNegMask CON %1111100000000000 For 11-bit negative to 16-bitsx VAR Word x-axis datay VAR Word y-axis datastatus VAR Nib Status flagsangle VAR Word Store angle measurement - Main Routine -SEROUT 14，84，22，12PAUSE 510DO Main loopGOSUB Get_Compass_Axes Get x, and y valuesangle = x ATN -y Convert x and y to bradsangle = angle */ 360 Convert brads to degreesSEROUT 14，84，12SEROUT 14，84，“Angle=”，DEC anglePAUSE 150 Debug delay for slower PCsLOOP Repeat main loop - Subroutines -Get_Compass_Axes: Compass module subroutineHIGH En: LOW En Send reset command to HM55BSHIFTOUT DinDout,clk,MSBFIRST,Reset4HIGH En: LOW En HM55B start measurement commandSHIFTOUT DinDout,clk,MSBFIRST,Measure4status = 0 Clear previous status flagsDO Status flag checking loopHIGH En: LOW En Measurement status commandSHIFTOUT DinDout,clk,MSBFIRST,Report4SHIFTIN DinDout,clk,MSBPOST,Status4 Get StatusLOOP UNTIL status = Ready Exit loop when status is readySHIFTIN DinDout,clk,MSBPOST,x11,y11 Get x & y axis valuesHIGH En Disable moduleIF (y.BIT10 = 1) THEN y = y | NegMask Store 11-bits as signed wordIF (x.BIT10 = 1) THEN x = x | NegMask Repeat for other axisRETURN连接USB连接线，并打开电源。下装、运行程序，并通过转动机器人改变其方位角，观察运行结果，分析其工作原理。关闭电源。五、 思考与练习1. 如何通过添加机器人运动控制指令，利用超声波测距传感器、红外线传感器、光敏电阻实现机器人避撞功能？当机器人通过超声波测距传感器、红外线传感器、光敏电阻检测到与前方障碍物的距离很近时，可以编写指令让机器人立即减速最终静止。2. 如何通过添加机器人运动控制指令，利用红外线传感器和光敏电阻实现边缘检测和躲避？当机器人通过红外线传感器和光敏电阻检测到机器人侧面的障碍物与机器人距离很近时，可以编写指令控制机器人两轮的转速，使其向对侧稍作转向；当与障碍物的距离超出一定范围之后，再令机器人沿直线前行。3. 如何利用超声波测距传感器和红外线传感器同时实现避撞和边缘检测与躲避两项功能？可分别在机器人的前方和两侧同时安装超声波测距传感器和红外线传感器，并按照以上1、2两题中的思想对机器人进行控制即可同时实现避撞和边缘检测与躲避的功能。4. 如何通过添加机器人运动控制指令，利用电子罗盘实现机器人的方位角控制，使其始终朝向某个指定方向？当机器人的行进方向与指定方向的偏离角度超过某一值时，可通过指令调整机器人两轮的转速。若机器人的行进方向偏左，则将左轮转速设置稍快于右轮。反之亦然。5. SEROUT的控制命令包含哪些参数？分别说明其含义。SEROUT的功能为在输出引脚写入串行数据。六、 心得体会本次实验中使用了超声波测距传感