阶梯攀爬机器人

阶梯攀爬智能机器人---自动控制电路设计指导教师：杨萍李翠明许军山主讲：梁俊峰成员：常明黄志发苏军昌2013年6月设计内容一、阶梯攀爬机器人简介二、机械部分介绍变形轮、转向机构、传动系统、重心调节机构、底盘。三、机器人电路硬件设计控制系统方案设计、主控芯片、电机驱动、电源、舵机。四、机器人软件设计超声波测距程序、系统初始化程序、电机舵机控制程序。阶梯攀爬智能机器人简介机器人三维效果图阶梯攀爬智能机器人是一种可以在陆地和阶梯间任意前行的机器人。攀爬机器人主要由主控电路板、电机驱动板、超声波测距模块、变形轮、转向机构、底板以及重心转移机构组成。在平路上变形轮以不变形的状态像汽车一样可以在平路上以一定速度前行，在前行的过程中四个超声波传感器检测障碍物，四个传感器测得的距离经程序处理后来控制机器人该执行相应的程序。在遇到障碍物的时候，由舵机控制转向机构或者变形轮上的舵机动作，以实现机器人绕过障碍物或者是越过障碍物。主要创新点：变形轮的设计。一、阶梯攀爬机器人简介机器人实物图一、机械部分1、特色创新设计-变形轮楼梯攀爬智能机器人的主要创新机构是变形轮的设计，当车体在平地运行时，车轮为圆形轮毂式，通过电动机驱动使机器人前进或停止或后退，当超声波模块检测到到达阶梯时，机器人停止前进，单片机控制舵机使变形轮变形为三角形，接着机器人开始攀爬楼梯。通过实验计算，在此形状运行下车轮攀爬效果明显，所需要的驱动力小。正常状态变形状态安装在内盘上的舵机通过控制转动轴，将舵机转过的角度值传递给变形轮的轮毂，以实现用单片机控制舵机角度来控制变形轮的变形与恢复。2、变形轮变形机构变形机构三维图变形机构原理图变形轮实物重心调节机构是一个多杆机构，单片机通过控制舵机的转动带动连杆摆动，以实现重心调节机构调节整车的重心位置，从而达到机器人在攀爬阶梯的时候重心靠前。3、特色创新设计-重心调节机构重心调节机构三维效果图重心调节机构实物图安装在底盘上的舵机与连杆相连，控制平行四边形转向机构实现转向，单片机控制舵机逆时针转动时，转向机构向右转，舵机顺时针转动时，转向机构向左转。4、转向机构设计转向机构机构简图转向机构三维效果图转向机构实物图直流减速电机经过一级减速箱双向输出给传动轴，前后两根传动轴将动力传送给前后桥差速器，差速器经减速后输出给轮子上的输出轴以驱动轮子转动。创新点：通过电磁离合器的作用实现传动两驱变四驱。5、传动系统传动系统三维效果图直流减速电机经过减速比2.8的减速箱减速后双向输出给前后两个传动轴。5、1一级减速箱一级减速箱三维效果图一级减速箱实物图汽车在拐弯时车轮的轨线是圆弧，如果汽车向左转弯，圆弧的中心点在左侧，在相同的时间里，右侧轮子走的弧线比左侧轮子长，为了平衡这个差异，就要左边轮子慢一点，右边轮子快一点，用不同的转速来弥补距离的差异。减速电机的转速经前传动轴传送扫差速器的输入轴，经伞齿和行星轮系减速后输出到输出轴。5.2前后桥差速器差速器三维效果图底盘作用是支承、安装汽车发动机及其各部件、总成，形成汽车的整体造型，并接受发动机的动力，使汽车产生运动，保证正常行驶6、底盘底盘三维效果图三、电路部分1、特色创新设计-控制系统方案原理图2、主控芯片MC9S12XS128是16位单片机，由16位中央处理单元（CPU12X）、128KB程序Flash(P-lash)、8KBRAM、8KB数据Flash(D-lash)组成片内存储器。主要功能模包括：内部存储器、内部PLL锁相环模块、2个异步串口通讯SCI、1个串行外设接口SPI、MSCAN模块、1个8通道输入/输出比较定时器模块TIM、周期中断定时器模块PIT、16通道A/D转换模块ADC、1个8通道脉冲宽度调制模块PWM、输入/输出数字I/O口XS128最小系统BTS7960的芯片内部为一个半H桥，INH引脚为高电平，使能BTS7960.IN引脚确定那个MODFET导通，IN=1，INH=1时，高边MOSFET导通，OUT引脚输出高电平，IN=0，INH=1时，低边MOSFET导通，OUT引脚输出低电平，SR引脚外接电阻的大小，可以调节MOS管导通和关断的时间，具有防电磁干扰的功能，IS引脚是电流检测输出引脚。PP4=1，PP5=0电机正转，PP4=0，PP5=1电机反转。3、电机驱动电路电机驱动实物图电机驱动原理图4、超声波模块HC-SR04超声波测距模块可提供2cm-400cm的非接触式距离感测功能，测距精度可达高到3mm；模块包括超声波发射器、接收器与控制电路。HC-SR04实物图HC-SR04原理图5、稳压模块LM2596开关电压调节器是降压型电源管理单片集成电路，能够输出3A的驱动电流，同时具有很好的线性和负载调节特性。在特定的输入电压和输出负载的条件下，输出电压的误差可以保证在±4%的范围内，振荡频率误差在±15%的范围内。稳压模块实物图稳压模块原理图6、舵机控制电路舵机常用的控制信号是一个周期为20毫秒左右，宽度为1毫秒到2毫秒的脉冲信号。当舵机收到该信号后，会马上激发出一个与之相同的，宽度为1.5毫秒的负向标准的中位脉冲。之后二个脉冲在一个加法器中进行相加得到了所谓的差值脉冲。输入信号脉冲如果宽于负向的标准脉冲，得到的就是正的差值脉冲。如果输入脉冲比标准脉冲窄，相加后得到的肯定是负的脉冲。此差值脉冲放大后就是驱动舵机正反转动的动力信号。舵机电机的转动，通过齿轮组减速后，同时驱动转盘和标准脉冲宽度调节电位器转动。直到标准脉冲与输入脉冲宽度完全相同时，差值脉冲消失时才会停止转动。舵机原理图SR-811舵机四、软件部分1、超声波测距时序图(1)采用IO口TRIG触发测距，给最少10us的高电平信呈。(2)模块自动发送8个40khz的方波，自动检测是否有信号返回；(3)有信号返回，通过IO口ECHO输出一个高电平，高电平持续的时间就是超声波从发射到返回的时间。测试距离=(高电平时间*声速(340M/S))/2。超声波时序图while(1){if(PORTA_PA1==0)break;//等待if(Time1=5000){Error_Flag1=1;return0;}//超时}DisableInterrupts//关中断Length1=(float)((175*Time1)/100.0);//测得距离340m/s*T，2、超声波测距程序PORTA_PA0=1;//给控制端高电平delay(10);//高电平保持10usPORTA_PA0=0;//控制端拉低while(1){if(PORTA_PA1==1)break;//等待if(PORTA_PA1==0)Count1++;if(Count1=400){Error_Flag1=1;return0;}}Time1=0;PITCFLMT_PITE=1;//定时器使能PITCE_PCE0=1;//定时器0使能PITINTE_PINTE0=1;//定时器中断0使能EnableInterrupts//开中断3、PLL系统时钟初始化voidPLL_Init(void){CLKSEL=0X00;//disengagePLLtosystemPLLCTL_PLLON=1;//turnonPLLSYNR=0xc0|0x02;REFDV=0xc0|0x01;POSTDIV=0x00;//pllclock=2*osc*(1+SYNR)/(1+REFDV)=48MHz;24m_asm(nop);//BUSCLOCK=24MT=41.66ns_asm(nop);while(!(CRGFLG_LOCK==1));//whenpllissteady,thenuseit;CLKSEL_PLLSEL=1;//engagePLLtosystem;}3、PWM初始化流程图/************************************///通道1初始化PWMCLK_PCLK1=1;//选择时钟SAPWMPOL_PPOL1=1;//初始电平为高PWMCAE_CAE1=0;//左对齐输出PWMPER1=200;//输出周期50HZ=SA/200PWMDTY1=14;//舵机静止占空比为7.5%=15/200PWMCNT1=0;//计数器清零PWME_PWME1=1;//通道1使能/************************************/4、PWM初始化程序voidPWM_Init(void){PWME=0x00;//禁止通道PWMPRCLK=0x33;//A=B=24/8=3MHZPWMSCLA=150;//SA=A/2/150=10kHZPWMSCLB=150;//SB=B/2/150=10kHZ/********************************/PWMCTL_CON01=0;//01不级联//通道0初始化PWMCLK_PCLK0=1;//选择时钟SAPWMPOL_PPOL0=1;//初始电平为高PWMCAE_CAE0=0;//左对齐输出PWMPER0=200;//输出周期50HZ=SA/200PWMDTY0=12;//舵机静止占空比7.5%=15/200PWMCNT0=0;//计数器清零PWME_PWME0=1;//通道0使能/********************************/电机控制程序PWMCTL_CON45=0;//45不级联//通道4初始化PWMCLK_PCLK4=1;//选择时钟SAPWMPOL_PPOL4=1;//初始电平为高PWMCAE_CAE4=0;//左对齐输出PWMPER4=3;//输出周期20kHZ=SA/1PWMDTY4=0;//PWMCNT4=0;//计数器清零PWME_PWME4=1;//通道4使能/**********************///通道5初始化PWMCLK_PCLK5=1;//选择时钟APWMPOL_PPOL5=1;//初始电平为高PWMCAE_CAE5=0;//左对齐输出PWMPER5=3;//输出周期20kHZ=SA/1PWMDTY5=0;//电机静止占空比为0PWMCNT5=0;//计数器清零PWME_PWME5=1;//通道5使能voidDCMotor(intc,intd)//电机控制(3,0)反转,(0,3)正转{PWMDTY4=c;PWMDTY5=d;}5、电机与舵机控制程序七、舵机控制程序voiddeform(){intm;for(m=0;m26;m++){PWMDTY2=deform_table[m];Delay();if(PWMDTY2==25)break;}}voidregain(){intm,n;for(n=0;n26;n++){PWMDTY2=regain_table[n];Delay();if(PWMDTY2=0)break;}}变形程序恢复程序控制舵机用到的数组intdeform_table[26]={0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25};intregain_table[26]={25,24,23,22,21,20,19,18,17,16,15,14,13,12,11,10,9,8,7,6,5,4,3,2,1,0};谢谢各位评委老师精彩视屏