- 1、本文档共9页,可阅读全部内容。
- 2、有哪些信誉好的足球投注网站(book118)网站文档一经付费(服务费),不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
- 3、本站所有内容均由合作方或网友上传,本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺!文档内容仅供研究参考,付费前请自行鉴别。如您付费,意味着您自己接受本站规则且自行承担风险,本站不退款、不进行额外附加服务;查看《如何避免下载的几个坑》。如果您已付费下载过本站文档,您可以点击 这里二次下载。
- 4、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“版权申诉”(推荐),也可以打举报电话:400-050-0827(电话支持时间:9:00-18:30)。
- 5、该文档为VIP文档,如果想要下载,成为VIP会员后,下载免费。
- 6、成为VIP后,下载本文档将扣除1次下载权益。下载后,不支持退款、换文档。如有疑问请联系我们。
- 7、成为VIP后,您将拥有八大权益,权益包括:VIP文档下载权益、阅读免打扰、文档格式转换、高级专利检索、专属身份标志、高级客服、多端互通、版权登记。
- 8、VIP文档为合作方或网友上传,每下载1次, 网站将根据用户上传文档的质量评分、类型等,对文档贡献者给予高额补贴、流量扶持。如果你也想贡献VIP文档。上传文档
查看更多
避障代码
#include Servo.h
//定义四种状态
#define STOP 0
#define FORWARD 1
#define BACKWARD 2
#define TURNLEFT 3
#define TURNRIGHT 4
//引脚初始化
int leftMotor1 = 4;
int leftMotor2 = 5;
int rightMotor1 = 6;
int rightMotor2 = 7;
//舵机引脚初始化
int inputPin = 8;
int outputPin = 12;
Servo myServo;
void setup() {
myServo.attach(9); //测速引脚初始化
pinMode(leftMotor1, OUTPUT);
pinMode(leftMotor2, OUTPUT);
pinMode(rightMotor1, OUTPUT);
pinMode(rightMotor2, OUTPUT);
pinMode(inputPin, INPUT);
pinMode(outputPin, OUTPUT);
}
void loop() {
avoidance();
}
void motorRun(int cmd)
{
switch(cmd){
case FORWARD:
analogWrite(leftMotor1, 50);
analogWrite(leftMotor2, 0);
analogWrite(rightMotor1, 50);
analogWrite(rightMotor2, 0);
break;
case BACKWARD:
analogWrite(leftMotor1, 0);
analogWrite(leftMotor2, 50);
analogWrite(rightMotor1, 0);
analogWrite(rightMotor2, 50);
break;
case TURNLEFT:
analogWrite(leftMotor1, 0);
analogWrite(leftMotor2,150);
analogWrite(rightMotor1,150);
analogWrite(rightMotor2, 0);
break;
case TURNRIGHT:
analogWrite(leftMotor1, 150);
analogWrite(leftMotor2, 0);
analogWrite(rightMotor1, 0);
analogWrite(rightMotor2, 150);
break;
default:
analogWrite(leftMotor1, 0);
analogWrite(leftMotor2, 0);
analogWrite(rightMotor1, 0);
analogWrite(rightMotor2, 0);
break;
}
}
void avoidance()
{
int pos;
int dis[3];//距离
motorRun(FORWARD);
myServo.write(90);
dis[1]=getDistance(); //中间
if(dis[1]20)
{
motorRun(STOP);
for (pos = 90; pos = 170; pos += 1)
{
myServo.write(pos); // 将舵机转到“pos”的位置
delay(15);
}
dis[2]=getDistance(); //左边
for (pos = 170; pos = 10; pos -= 1)
{
myServo.write(pos); // 将舵机转到“pos”的位置
delay(15);
if(pos==90)
dis[1]=getDistance(); //中间
}
dis[
文档评论(0)