AT89S51单片机全地形八足机器人机械手的设计(17)
时间:2017-01-17 19:45 来源:毕业论文 作者:毕业论文 点击:次
P2 = FFW[v]; delay(t); v++; break; case 3: //手爪电机 P3 = FFW[v]; delay(t); v++; break; default:break; } } } else break; } Else //脉冲数和设定的相等，则停止运行 { number=0; onoff[i]=0; if(i==0) P0=0x0f; else if(i==1)P1=0X0f; else if(i==2)P2=0X0f; else P3=0x0f; break; } (2)电机反转程序和正转程序相似，只需将环形脉冲调用由FFW[v]改为REV[v]。 (3)电机停止程序: { if(i==0) P0=0x0f; else if(i==1)P1=0x0f; else if(i==2)P2=0X0f; else P3=0x0f; } 4.3 整个系统软件流程图 (1)上、下微机通讯流程图如图4.4所示： 图4.4 上、下位机通讯流程图 (2)下位机主控程序流程图如图4.5所示： 图4.5下位机主控程序流程图 (3)下位机控制电机运行程序流程图如图4.6所示 图4.6 下位机控制电机运行程序流程图如5系统调试 程序编好，编译无误后，通过烧写器将程序可执行文件烧入单片机。单片机通过USB转串口线与上位机串行口连接，运行上位机程序，输入控制命令，看机械手能否满足设计要求。程序烧写如图5.1所示： 图5.1 程序烧写界面 5.1实际调试硬件设施介绍 由于实验条件、时间和成本的限制，未做出机械手实体，整个调试过程是在一个二文云台上完成，二文云台由两个28BYJ-48步进电机组成，其为四相八拍型电机。为了更好地模拟四个电机的运行效果，我又额外加了两个步进电机，看这四个电机能否协调工作，由于步进电机型号换了，所以程序作了很小的改动，驱动芯片也换成了ULN2003，但总体思想还是一样，单片机部分直接用了RZ-51开发板，里面自带串口模块和I/O扩展口。具体调试实物如图5.2所示： (责任编辑：qin) |