机器人实训总结Word格式.docx
《机器人实训总结Word格式.docx》由会员分享,可在线阅读,更多相关《机器人实训总结Word格式.docx(19页珍藏版)》请在冰豆网上搜索。
![机器人实训总结Word格式.docx](https://file1.bdocx.com/fileroot1/2023-1/6/cbf60529-4f75-4055-ba5a-2808f6e82ba9/cbf60529-4f75-4055-ba5a-2808f6e82ba91.gif)
通过参考指导书的已
有程序,我们比较顺利的完成了该任务,任务程序如下:
(在试验中需要注意LED灯的正负
极)
#include<
intmain(void)
uart_Init();
printf("
TheLEDconnectedtoP1_0isblinking!
while
(1)
P1_1=1;
delay_nms(500);
P1_1=0;
任务二:
机器人触觉导航
该任务要求机器人碰到障碍物时,接触开关会有所察觉,通过编程让机器人避开障碍物。
在安装胡须时,需要注意胡须距传感立柱既不能太远也不能太近,太远会导致机器人碰到障碍物后反应过慢,太近则会使机器人在前方没有障碍物的情况下进行避障操作,影响小车正常行进。
胡须机器人避障程序如下:
intP1_4state(void)〃获取P1_4的状态,右胡须
return(P1&
0x10)?
1:
0;
intP2_3state(void)〃获取P2_3的状态,左胡须
return(P2&
0x08)?
voidForward(void)
delay_nus(1700);
delay_nus(1300);
delay_nms(20);
voidLeft_Turn(void)
inti;
for(i=1;
i<
=26;
i++)
delay_nus(1300);
delay_nms(20);
voidRight_Turn(void)
delay_nus(1700);
voidBackward(void)
=65;
P1_0=0;
ProgramRunning!
{if((P1_4state()==0)&
&
(P2_3state()==0))
Backward();
//向后
Left_Turn();
//向左
elseif(P1_4state()==0)
//向后Left_Turn();
elseif(P2_3state()==0)
//向后
Right_Turn();
//向右
else
Forward();
//向前
任务三:
机器人红外线导航
任务二触须接触导航是依靠接触变形来探测物体,而本任务是依靠红外线探测机器人前进路线,然后确定何时有光线从被探测物体反射回来,通过检测反射回来的红外光就可以确定前方是否有物体。
在本次任务中,我们需要使用三极管9013,这是因为C51的10驱动能力较弱,这里我们加入三极管使其工作在开关状态。
三极管是一种控制元件,主要用来控制电流大小,简单地说,是用小电流去控制大电流。
红外导航避障程序如下:
intrins.h>
#defineLeftIRP1_2//左边红外接收连接到P1_2
#defineRightIRP3_5//右边红外接收连接到P3_5
#defineLeftLaunchP1_3//左边红外发射连接到P1_3
#defineRightLaunchP3_6//右边红外发射连接到P3_6
voidIRLaunch(unsignedcharIR)
intcounter;
if(IR=='
L'
)
for(counter=0;
counter<
38;
counter++)
{LeftLaunch=1;
_nop_();
_nop_();
LeftLaunch=0;
}if(IR=='
R'
)for(counter=0;
counter++)//右边发射{
RightLaunch=1;
RightLaunch=0;
}
voidForward(void)//向前行走子程序
voidLeft_Turn(void)//左转子程序
for(i=1;
voidRight_Turn(void)//右转子程序
voidBackward(void)//向后行走子程序
intirDetectLeft,irDetectRight;
uart_Init();
while
(1)
IRLaunch('
//右边发射irDetectRight=RightIR;
//右边接收
//左边发射
irDetectLeft=LeftIR;
//左边接收
两边同时接收到红外线
if((irDetectLeft==0)&
(irDetectRight==0))//{Backward();
Left_Turn();
只有左边接收到红外线
elseif(irDetectLeft==0)//
只有右边接收到红外线
elseif(irDetectRight==0)//
任务四:
尾随小车
该任务的设计线路与任务三相同,故完成较为简单,试验程序如下:
左边红外接收连接到P1_2
右边红外接收连接到P3_5
左边红外发射连接到P1_3
右边红外发射连接到P3_6
#defineLeftIRP1_2//#defineRightIRP3_5//#defineLeftLaunchP1_3//#defineRightLaunchP3_6//voidIRLaunch(unsignedcharIR){
)//左边发射
LeftLaunch=1;
LeftLaunch=0;
)//右边发射for(counter=0;
intpulseLeft,pulseRight;
do
//右边接收IRLaunch('
//左边发射irDetectLeft=LeftIR;
//左边接收if((irDetectLeft==0)&
(irDetectRight==0))//{
pulseLeft=1300;
pulseRight=1700;
elseif((irDetectLeft==0)&
(irDetectRight==1))//
pulseLeft=1700;
elseif((irDetectLeft==1)&
(irDetectRight==0))//
pulseRight=1300;
else//前进
delay_nus(pulseLeft);
delay_nus(pulseRight);
任务五:
机器人的距离检测
向后退
右转
左转
用同样的IRLED探测电路检测距离,高灵敏度的频率可以探测远距离的物体,低灵敏度的频率可以探测距离较近的物体。
这使得距离探测就简单了。
选择5个不同频率,从最低灵敏度到最高灵敏度进行测试,依赖于探测器不能再检测到物体的红外线频率,就可以推断物体的大概位置。
测试扫描频率程序如下:
#include<
#defineLeftIR
P1_2//左边红外接受连接到P1_2
//#defineRightIR
P3_5//右边红外接收连接到P3_5
#defineLeftLaunch
P1_3//左边红外发射连接到P1_3
//#defineRightLaunchP3_6//右边红外发射连接到P3_6
unsignedinttime;
intleftdistance;
//
左边的距离
//intrightdistance;
右边的距离
intdistanceLeft,irDetectLeft;
//intdistanceRight,irDetectRight;
unsignedintfrequency[5]={29370,31230,33050,35700,38460};
voidtimer_init(void)
IE=0x82;
//开总中断EA允许定时器0中断ET0
TMOD|=0X01;
//定时器0工作在模式1:
16位定时器模式
time=256-(500000/Freq);
//根据频率计算初值
voidFreqOut(unsignedintFreq)
TH0=0XFF;
//高八位设FF
TL0=time;
//低八位根据公式计算
TR0=1;
//启动定时器
delay_nus(800);
//延时
TR0=0;
//停止定时器
voidTimer0_Interrupt(void)interrupt1{
LeftLaunch=~LeftLaunch;
//RightLaunch=~RightLaunch;
TH0=0XFF;
voidGet_lr_Distances()
unsignedintcount;
leftdistance=0;
//
//rightdistance=0;
for(count=0;
count<
5;
count++)
{FreqOut(frequency[count]);
irDetectLeft=LeftIR;
////irDetectRight=RightIR;
//printf("
f=%d\n"
time);
//取反
//重新设值
初始化左边的距离
//初始化右边的距离
左边接收
irDetectLeft=%d\n"
irDetectLeft);
//printf("
irDetectRight=%d\n"
irDetectRight);
if(irDetectLeft==1)
leftdistance++;
//if(irDetectRight==1)//rightdistance++;
timer_init();
printf("
ProgamRunning!
FREQENCYETECTED\n"
Get_lr_Distances();
distanceLeft=%d\n"
leftdistance);
distanceRight=%d\n"
rightdistance);
\n"
delay_nms(1000);
}在进行串口调试时,应注意串口的接线位置,安装符合自己电脑的串口调试助手。
任务六:
寻线搬运机器人可能是前几个任务完成太轻松的原因,是我们对实训产生了懈怠的想法,但最后的任务再一次提醒了我需要学习的东西还有很多,永远都不能骄傲自满。
经过一天多的调试,在机器人的运行和编程中,出现了以下几方面的问题:
一、转弯出现问题。
在一些路口中转弯出现了问题。
所以提倡用自定义转弯,提高成功率。
二、在运行机器人前要检查螺丝,检查机器人的性能是否良好,以免在运行过程中发生意外。
三、遇到错误时,要耐心,细心检查问题,分析问题,要互相讨论出解决方案。
四、电池的电量对小车运行影响极大最好选用质量较好的电池。
五、伺服电机的角度没有调好,导致机器人在运行过程中影响程序的运行。
六、熟悉自己的机器人,了解一些运行、编程的小技巧。
寻线搬运机器人编程如下:
AT89X52.h>
stdio.h>
#defineuintunsignedint
#defineucharunsignedchar
ucharQTIState;
voidTime1_init(void)
EA=1;
//硬件串口使用定时器1,供AT89S5与P(机通信使用
TMOD|=0x20;
SCON=0x50;
//TH1=0xFD;
TL1=0xFD;
TR1=1;
TI=1;
定时器1方式2.8位自动重装模式
模式1,8位数据
波特率为9600
起动定时器
voidPivot_Left(void)//
delay_nus(1350);
voidPivot_Right(void)//
delay_nus(1650);
左转子程序
右转子程序
voidRotate_right(void)
voidRotate_Left(void)
voidBackward(void)//向后行走子程序
voidGet_QTI_State(void)
QTIState=P2&
0x0e;
voidFollow_Line(void)
Get_QTI_State();
switch(QTIState)
case0x04:
Forward();
break;
case0x06:
Pivot_Right();
break;
case0x02:
Rotate_right();
case0x0c:
Pivot_Left();
case0x08:
Rotate_Left();
/*case0x0e:
*/
default:
voidmain(void)
{intcounter;
Time1_init();
programrunok!
"
for(counter=0;
350;
counter++)//{
Follow_Line();
}/*for(counter=0;
20;
}*/
33;
Pivot_Left();
65;
counter++)//
{Forward();
55;
Rotate_Left();
counter++)/