《机器人课程设计报告材料》由会员分享，可在线阅读，更多相关《机器人课程设计报告材料（27页珍藏版）》请在金锄头文库上搜索。
1、实用标准智能机器人课程设计总结报告姓 名：组 员：指导老师:文案大全一、课程设计设计目的了解机器人技术的基本知识以及有关电工电子学、单片机、机械设计、传感器等相关技术。初步掌握机器人的运动学原理、 基于智能机器人的控制理论， 并应用于实践。通过学习，具体掌握智能机器人的控制技术，并使机器人能独立执行一定的任务。基本要求：要求设计一个能走迷宫（迷宫为立体迷宫）的机器人。要求设计机器人的行走机构，控制系统、传感器类型的选择及排列布局。要有走迷宫的策略（软件流程图）。对于走迷宫小车控制系统设计主要有几个方面：控制电路设计，传感器选择以及安放位置设计， 程序设计二、总体方案2.1机器人的寻路算法选择将
2、迷宫看成一个 m*n的网络，机器人通过传感器反馈的信息感知迷宫的形状，并将各 个节点的与周围节点的联通性信息存储于存储器中，再根据已经构建好的地图搜索离开迷宫的路径。这里可选择回溯算法。 对每个网格从左到右， 每个网格具有4个方向，分别定义。 并规定机器人行进过程中不停探测前方是否有障碍物，同时探测时按左侧规则，进入新网格后优先探测当前方向的左侧方向。探测过程中记录每个网格的四个方向上的状态：通路、不通或未知，探测得到不同状态后记记录，同时记录当前网格的四个方向是否已被探测过。若某网格四个方向全部探测过则利用标志位表示该网格已访问。为了寻找到从起点到终点的最佳路径，记录当前网格在四个方向上的邻
3、接网格序号，由此最后可在机器人已探测过的网格中利用Dijkstra 算法找到最佳路径。并为计算方便，记录网格所在迷宫中行号、列号。并 机器人探索过程中设置一个回溯网格栈记录机器人经过的迷宫网格序号及方向，此方向是从一个迷宫网格到下一个迷宫网格经过的方向。设置一个方向队列记录机器人在某网格内探测实用标准方向的顺序。设置一个回溯路径数组记录需要回溯时从回溯起点到回溯终点的迷宫网格序号及方向。考虑到迷宫比较简单， 且主要为纵横方向的直线， 可采用让小车在路口始终左转或者始 终右转的方法走迷宫，也就是让小车沿迷宫的边沿走。这样最终也能走出迷宫。本次课程设 计采用此方法。即控制策略为机器人左侧有缺口时，
4、向左进入缺口，当机器人前方有障碍是，向右旋转180。，其余情况保持前进。22传感器的选择由于需要检测机器人左侧和前方是否有通路，采用红外传感器对机器人行进方向和左侧进行感知。红外避障传感器是依据红外线的反射来工作的。当遇到障碍物时，发出的红外线被反射面反射回来，被传感器接收到，信号输出引脚就会给出低电平提示信号。本机器人系统的红外避障信号采用直接检测的方式进行，直接读取引脚电平。 传感器感应障碍物的距离阈值可以通过调节传感器上的变阻器来改变。行进过程中，机器人可能会偏绿迷宫的横轴或纵轴的方向。碰触传感器利用外力的作用传递给单片机信息，当碰触传感器碰到迷宫墙壁后，传感器检测到信号就可以判断小车碰
5、壁。 经过电路处理后，信号输出接口输出数字信号送给控制器，从而让控制器进行决策调整小车姿态。本机器人系统共使用了2个碰触传感器，分别安装在小车的左前方和右前方，使得机器人在偏离航向撞击迷宫侧面后可以立即对航向进行修正。四个传感器一共占用四个外部中断。3.3总体结构设计实用标准文案大全红外避障传感器三、具体实现3.1芯片选择最小系统已经设计好，本次课程设计采用的控制芯片为STM32F103RBT6GND-|1MT* 】tafVCOJICZFirifi nPCH 3 兀曲4 flSFTLESZZZmMi-u J-U2 HKVBATPCTj/AXTaKI+OCl： 蚊 W8CRFMD5C3NJDli
6、WtOCTFR5TMX ADC1JKL ADC I IIK： ADC1：PC： AIXZISVKAVDQAPAC AT1UP .WC 0 TB-r：_Czil_5TjLPA： ADCIE二C32緒m TX血UUK； 申卩Ar ；J2_RXADC?V5SVDOAVEDV5STOtmwjrm3QOTD iDATliH Lit PBSICCl KLTOH CHI 诵DCI.jftEJU：PB: HWTMCKWQPECT& J3 irzK12 KUPC1Q*PA25 7TDIPAH JTVK 羽TLX VDDP.13 JIMS 57310VCCiJ u75L5 24Q.芒一 *苗“PWBW. b&CH
7、ll- waITPJnADC4 PA12 3二jmPAJ fflX ADC4； PAll CANJ5frDMmfPM PH 2mT5G ADC尬一IV UIJIX TIMPA* Sm_l.J0t2 ADC 7 TTSLj Cm ?A VI Hi Tbll CLI1 K4 AK1IPC- AIKliPE匸 血 暑ThiLL常PB： ADCT&B C34PB2 3O0TIPi:c.isci_XLn_n: fiSn/DCl.WAVi.RXV5S VMcmwco PCS pc黑 pct PO5 psiPEB| 二也总.WSTMl邓:MP32j 5PE SCKTCrlL CZ12； ；Eci SMBAi
8、m a-m：filJ12DM；L 60apBour血 CS7KlR?5KLF_E.QLD1、工T1D2Ofc却| I471 1 1-0STLiEJ-13PAJXTnzkx-SJw EX41P.43T1汕51a5112 MKl433l它是32位的Cortex-M3 内盒的控制芯片，主频达到72MHz, 拥有128kB 闪存，20kBSRAM,锁相环，内置8MHz and 32kHz时钟电路，具有 PWM模块，方便电机转速的控制。3.2控制电路设计(1 )电机驱动:电机驱动电路原理图如图所示，采用BTS7960芯片驱动电机，以控制机器人的两个驱动轮，利用PWM 控制方法，通过改变 PWM波的占空比
9、，达到调节电机转速的目的，实 现机器人的前进，后退，转向，刹车等功能。每个电机都由一个H桥电路驱动，由两个输入信号共同控制。两个电机共由4路PWM波进行控制，结合上述的电机驱动原理，小车运动方式可以通过如下方式实现：四个控制信号均为低电平时，电机停转，小车停止；电机的左右轮电机同向等速运行时，可以实现前行或后退的动作；小车的左右转向通过两轮差速来实现。在本机器人的设计中，需要实现的90。角度转弯，是通过电机定速运动和延时的配合完成的，通过不断调试确定出最佳的旋转时间。（2 ）电源模块：采用电池供电，可行的供电方案原理图如下电源模块(ihDvcciGNDIfMJ（3）引脚（外部中断）分配：PA0
10、,PA4,PA5,PA15为中断输入引脚。PA0引脚对应的外部中断由机器人前向红外传感器触发，PA4，PA5分别连接机器人前进方向的左侧和右侧的碰撞开关，PA4，PA5的上升沿信号代表机器人与迷宫的左， 右侧发生碰撞，触发相应地终端服务程序， 调整航向。PA15 接收左侧红外传感器产生的触发信号， 当机器人左侧出现缺口时， 触发中断服务程序， 机器 人向左转向进入缺口。3.3程序设计部分（1 ）机器人的移动:两个驱动芯片进机器人靠两个驱动轮，一个从动轮进行移动，每个驱动轮由一个电机,行控制。驱动芯片输出电平的高低决定电机的转向，占空比决定了电机的转速。首先应配置芯片的 PWM模块，具体过程如下
11、：#i nclude pwm.hfloat mo1,mo2,mo3,mo4;void PWMnit(u16 arr,u16 psc)RCC-APB1ENR|=1CRL&=0X00FFFFFF;GPIOA-CRL|=OXBBOOOOOO;GPIOA-ODR|=16|1CRL&=0XFFFFFF00;GPIOB-CRL|=OXOOOOOOBB;GPIOB-ODR|=10|1ARR=arr;TIM3-PSC=psc;TIM3-CCER|=11|15|19|1CCMR1|=712|7CCMR1|=111|1CCMR2|=712|7CCMR2|=111|1CCER|=112|18|14|1CR1=0x0
12、080; /ARPEe 1? uTIM3-CR1|=1EGR |= 1CR1|=0x01;本段代码使能TIM3时钟，启用PA6 , PA7,PB0 , PB1引脚的复用功能，并对计数器进 行相应设置（向下计数），使得芯片能在这四个引脚上输出所需的PWM波。由于前进，后退，转向，都是重复性的动作，直接对这些操作进行宏定义，需要的时候直接调用，能减轻程序编写的负担：#define Moto_PwmMax 899/#define LEFT_MOTOR_FTIM3-CCR1#define LEFT_MOTOR_BTIM3-CCR2#define RIGHT_MOTOR_BTIM3-CCR3#defin
13、e RIGHT MOTOR FTIM3-CCR4注：TIM3产生PWM波相应寄存器的宏定义如下#defi ne go_forwardLEFT_MOTOR_F =3500;LEFT_MOTOR_B =0;RIGHT_MOTOR_F =3500;RIGHT_MOTOR_B =0;#defi ne go_backLEFT_MOTOR_F =0; LEFT_MOTOR_B =3500; RIGHT_MOTOR_F =0;RIGHT_MOTOR_B =3500;#defi ne turni_leftLEFT_MOTOR_F =0;LEFT_MOTOR_B =0;RIGHT_MOTOR_F =4000;RIGHT_MOTOR_B =0;#define turn_left_90LEFT_MOTOR_F =0;LEFT_MOTOR_B=0;RIGHT_MOTOR_F=4000;RIGHT_MOTOR_B=0;delay_ms(800);delay_ms(800);delay_ms(600);RIGHT_MOTOR_F=0;#define turn_rightLEFT_MOTOR_F =4000;LEFT_MOTOR_B =0;RIGHT_MOTOR_F =0;RIGHT_MOTOR_B =0; delay_ms(200);#defi netur n
