Ⅰ 求arino避障小车程序，急！（高额悬赏）
//舵机和超声波调试代码
#include <Servo.h>
#include <Metro.h>
Metro measureDistance = Metro(50);
Metro sweepServo = Metro(20);
unsigned long actualDistance = 0;
Servo myservo; //创建舵机
int pos = 60;
int sweepFlag = 1;
int URPWM = 3; //PWM输出0－25000us，每50us代表1cm
int URTRIG= 10; // PWM trigger pin PWM串口为10
uint8_t EnPwmCmd[4]={0x44,0x02,0xbb,0x01}; // distance measure command 距离测量命令
void setup(){ // Serial initialization 串行初始化
myservo.attach(9); //舵机串口为9
Serial.begin(9600); // Sets the baud rate to 9600
SensorSetup();
}
void loop(){
if(measureDistance.check() == 1){
actualDistance = MeasureDistance();
// Serial.println(actualDistance);
// delay(100);
}
if(sweepServo.check() == 1){
servoSweep();
}
}
void SensorSetup(){
pinMode(URTRIG,OUTPUT); // A low pull on pin COMP/TRIG
digitalWrite(URTRIG,HIGH); // Set to HIGH
pinMode(URPWM, INPUT); // Sending Enable PWM mode command 发送使能控制模式命令
for(int i=0;i<4;i++){
Serial.write(EnPwmCmd[i]);
}
}
int MeasureDistance(){ // a low pull on pin COMP/TRIG triggering a sensor reading 触发传感器读数
digitalWrite(URTRIG, LOW);
digitalWrite(URTRIG, HIGH); // reading Pin PWM will output pulses 读引脚脉宽调制将输出脉冲
unsigned long distance=pulseIn(URPWM,LOW);
if(distance==50000){ // the reading is invalid.阅读无效
Serial.print("Invalid");
}else{
distance=distance/50; // every 50us low level stands for 1cm
}
return distance;
}
void servoSweep(){
if(sweepFlag ){
if(pos>=60 && pos<=120){
pos=pos+1; // in steps of 1 degree 1度角度的转动
myservo.write(pos); // tell servo to go to position in variable 'pos' 告诉舵机转动的角度
}
if(pos>119) sweepFlag = false; // assign the variable again 重新分配变量
}else {
if(pos>=60 && pos<=120){
pos=pos-1;
myservo.write(pos);
}
if(pos<61) sweepFlag = true;
}
}
////////////////////////////////////////////////////////////
需要加载一个Metro.h的库，这只是调试机器，余下的完全看你的发挥了，加上电机
Ⅱ 51单片机红外避障小车教程
你好，我以前参加过飞思卡尔智能小车竞赛，程序已经找不到了，但我可以给回你一些建议。
寻路或者避障答，主要由光电和摄像头两种，如果你采用光电去做，你需要了解一写光电传感器，距离传感器的知识。如果你选择摄像头去做，你需要了解一些AD转换，图像处理的知识
C程序应该包括电机驱动，舵机驱动，当前传感器状态识别/当前图像处理等内容
Ⅲ 请问怎样使用tcrt5000光电开关实现智能小车自动避障，怎样调节避障距离啊怎样连接电路图啊，谢谢！
我用昌仔胡十三个对管，舵机控制转向，八个对管的话状态改下就行，给你参考下，不明白可以追问我，qq 181325995
#include<reg52.h>
#define uint unsigned int
#define uchar unsigned char
uint i,count;
uchar pro; //*驱动电机调速*//
uchar finish=0;//停车标志
sbit le1=P1^0; //*左边传感器*//
sbit le2=P1^1;
sbit le3=P1^2;
sbit le4=P1^3;
sbit le5=P1^4;
sbit le6=P1^5;
sbit mid=P1^6;//*中间传感器*//
sbit ri6=P1^7;
sbit ri5=P2^3;
sbit ri4=P2^4;
sbit ri3=P2^5;
sbit ri2=P2^6;
sbit ri1=P2^7;//*右边传感器*//
sbit ENA=P2^0; //驱动电机pwm//
sbit moto1=P2^1; //电机控制//
sbit moto2=P2^2;
sbit PWM=P3^5; //舵机pwm//
sbit bz=P3^7;//蔽障管耐拦
init()
{
TMOD=0x11;//设定双定时器
EA=1;
TR0=1;
TR1=1;
TH0 = 0x0B1;//设定定时初始值，可去下载个定时器计算软件，
TL0 = 0x0E0;
TH1=(65536-100)/256;
TL1=(65536-100)%256;
ET0=1;
ET1=1;
ENA=1;
}
void delay(uint n)//延时函数
{
uchar a,b,c;
for(c=1;c>0;c--)
for(b=n;b>0;b--)
for(a=2;a>0;a--);
}
void delay2(uint z)
{
uchar a,b,c;
for(a=2;a>0;a--)
for(b=100;b>0;b--)
for(c=z;c>0;c--);
}
void qctyp(void) //光电管全无状态时（脱离轨道），读取前次状态
{
le1=P1^0;
le2=P1^1;
le3=P1^2;
le4=P1^3;
le5=P1^4;
le6=P1^5;
mid=P1^6;
ri6=P1^7;
ri5=P2^3;
ri4=P2^4;
ri3=P2^5;
ri2=P2^6;
ri1=P2^7;
}
void hhig(uint y)//前进函数
{
pro=y;//变量y是改戚轿变小车速度这里范围是0--39
moto1=1;
moto2=0;
}
void back(uint z)//后退函数
{
pro=z;//改变z 可改变行驶速度
moto1=0;
moto2=1;
}
void dj(uint m) //舵机控制
{
PWM=1;
delay(m); //改变m可改变舵机转向角度，
PWM=0;
}
void check_stop()//检测终点线，我用十三个对管，八个管停车状态自己分析
{
uchar start_flag;
if((le3&&le4)&&(!le1&&!le6)&&mid&&(ri3&&ri4)&&(!ri1&&!ri6))
start_flag=1;
else if((le2&&le3)&&!le5&&(le6&&mid)&&(ri3&&ri4)&&(ri1&&ri6))
start_flag=1;
else if((le2&&le3)&&le6&&(!le5&&!mid)&&(ri3&&ri4)&&(ri1&&ri6))
start_flag=1;
else if((le2&&le3)&&!le4&&(le5&&le6)&&!mid&&(ri5&&ri4)&&ri1)
start_flag=1;
else if((le2&&le3)&&(!le4&&!le6)&&le5&&!mid&&!ri4&&(ri1&&ri2))
start_flag=1;
else if(le2&&!le3&&(le4&&mid)&&(le5&&le6)&&(ri1&&ri2))
start_flag=1;
else if((le3&&le4)&&le6&&(ri6&&mid)&&(ri2&&ri3)&&!ri5)
start_flag=1;
else if((le5&&le4)&&(!le1&&!mid)&&ri6&&(ri2&&ri3)&&!ri5)
start_flag=1;
else if((le5&&le6)&&(!le1&&!le2)&&ri5&&ri2&&!ri4)
start_flag=1;
else if((le5&&le4)&&(!le1&&!le2)&&(!mid||!ri6)&&ri5&&(ri1&&ri2)&&!ri4)
start_flag=1;
else start_flag=0;
if(start_flag)
{
count++;
delay2(50);
if (count==1)
else if(count==2)
else if(count==3)
{
count=0;
finish=1;
P0=0xa4;//加led显示只是为了方便调试，两圈之后停车
}
else
finish=0;
}
if(finish)
{
ENA=0;
TR1=0;//关定时器1，驱动电机停转
}
}
void xunji()//循迹函数，读取光电管状态
{
if(!le1&&!le2&&!le3&&!le4&&!le5&&!le6&&mid&&!ri6&&!ri5&&!ri4&&!ri3&&!ri2&&!ri1)
{
dj(109);
hhig(39);
}
else if(le6&&mid&&!ri6&&!ri5&&!ri4&&!ri3&&!ri2&&!ri1)
{
dj(114);
hhig(35);
}
。
。
。//分析八个光电管状态，看你的电路检测到黑线输出1或者是0
else
{
dj(109);//舵机归中
hhig(25);
}
}
void main()
{
init();
while(1)
{
check_stop();
if(bz==0)//检测到障碍，。。。
{
back(18);
}
}
}
void timer0() interrupt 1//产生pwm信号控制舵机，周期20ms
{
TH0=0xb1;
TL0=0xe0;
xunji();
}
void timer1() interrupt 3//产生pwm信号控制驱动电机速度
{
TH1=(65536-100)/256;
TL1=(65536-100)%256;
i++;
if(i<=pro)
{
ENA=1;
}
else
{
ENA=0;
}
if(i==40)
{
ENA=~ENA;
i=0;
}
}