版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
1、. 移动机械臂 姓名:陶敏 学号:0863110312 班级:08级建筑学3班一、实物图 图1图2 如图为该移动机械臂的实物图,该系统是以8051单片机为核心的一个机械系统。目前还处于研究试验阶段。该系统为一移动机器人方案。该移动机器人可以夹物体,并且可以自动避开物体,由于处于实验阶段,所以实用性还不是很强。不过作为一个机器人系统还有很广阔的应用前景。 图3 把机器放在地上,按下电源开关机器便可运行。 图4 内置蓄电池,充电口接通220V家庭电路便可以充电。蜂鸣器发声用于状态指示。 图6 图5 减速齿轮组减速矩。 二、电路系统 H 桥电路用于双向驱动电动机 Vm输出到H桥电路,VCC输出到80
2、51单片机系统,4.7V输出到反射光电开关电路。Vin为12V电压输入。 反射式光电开关电路用于检测外部环境,如避开障碍物和用夹子夹夹起东西。 蜂鸣器电路用于状态指示 系统主控制电路1、 实验源程序#include<reg51.h> sbit M1A=P00;sbit M1B=P01; sbit M2A=P02;sbit M2B=P03; sbit M3A=P04;sbit M3B=P05;sbit M4A=P06;sbit M4B=P07; sbit M5A=P27;sbit M5B=P26; sbit M6A=P20;sbit M6B=P21;sbit M7A=P25;sbit
3、 M7B=P24; sbit Beep=P22;sbit Rin=P11;sbit Lin=P12; sbit Min=P15;void MSDelay (unsigned int); void Music1(void); void Music2(void); void Music3(void);void main(void) Rin=1; Lin=1; Min=1; M1A=0; M1B=1;/M1前进 while( Rin=0) M1A=1; M1B=1; MSDelay(40);/M1停止 Music2(); M1A=1; M1B=0; MSDelay(200); M1A=1; M1B=
4、1; MSDelay(40);/后退 M2A=1; M2B=0; MSDelay(150); M2A=1; M2B=1; MSDelay(40);/右转 while( Lin=0) M1A=1; M1B=1; MSDelay(40);/M1停止 Music2(); M1A=1; M1B=0; MSDelay(200); M1A=1; M1B=1; MSDelay(40);/后退 M2A=0; M2B=1; MSDelay(150); M2A=1; M2B=1; MSDelay(40);/左转 while( Min=0) M1A=1; M1B=1; MSDelay(40);/M1停止 Music
5、2(); Music3(); M7A=0; M7B=1; MSDelay(100); M7A=1; M7B=1; Music1();/开口 M5A=1; M5B=0; MSDelay(500); M5A=1; M5B=1; Music1();/上旋 M7A=1; M7B=0; MSDelay(100); M7A=1; M7B=1; Music1();/闭合 M6A=0; M6B=1; MSDelay(400); M6A=1; M6B=1; Music1();/下旋 M5A=0; M5B=1; MSDelay(500); M5A=1; M5B=1; Music1();/下旋 M4A=0; M4B
6、=1; MSDelay(500); M4A=1; M4B=1; Music1();/下旋 M3A=1; M3B=0; MSDelay(300); M3A=1; M3B=1; Music1();/逆时针 M7A=0; M7B=1; MSDelay(100); M7A=1; M7B=1; Music1();/开口 M7A=1; M7B=0; MSDelay(100); M7A=1; M7B=1; Music1();/闭合 M6A=1; M6B=0; MSDelay(400); M6A=1; M6B=1; Music1();/上旋 M4A=1; M4B=0; MSDelay(500); M4A=1;
7、 M4B=1; Music1();/上旋 M3A=0; M3B=1; MSDelay(300); M3A=1; M3B=1; Music1();/顺时针 void MSDelay(unsigned int itime) /时间延迟 unsigned int i,j; for(i=0;i<itime;i+) for(j=0;j<1275;j+); void Music1(void) /音乐1 unsigned int i,j; for(i=0;i<300;i+) Beep=0; for(j=0;j<30;j+); Beep=1; for(j=0;j<30;j+); Beep=1; void Music2(void) /音乐2 unsigned int i,j,k; for(k=0;k<10;k+) for(i=0;i<100;i+) Beep=0; for(j=0;j<30;j+); Beep=1; for(j=0;j<30;j+); Beep=1; MSDelay(10); Beep=1; void Music3(void) /音乐3 unsigned int i,j,k; for(k=
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
评论
0/150
提交评论