|
完成背景:在2019年1月26开始首期的虚谷号培训中的创客马拉松项目这是一台用自制的虚谷号编程电脑,进行程序编写。
使用自主设计的laserblock结构件和DF的扩展版进行结构搭建的避障小车。
代码
void qianjin() {
digitalWrite(4,LOW);
analogWrite(5,150);
digitalWrite(7,LOW);
analogWrite(6,150);
}
void houtui() {
digitalWrite(4,HIGH);
analogWrite(5,150);
digitalWrite(7,HIGH);
analogWrite(6,150);
}
float checkdistance_11_12() {
digitalWrite(11, LOW);
delayMicroseconds(2);
digitalWrite(11, HIGH);
delayMicroseconds(10);
digitalWrite(11, LOW);
float distance = pulseIn(12, HIGH) / 58.00;
delay(10);
return distance;
}
void tingzhi() {
digitalWrite(4,LOW);
analogWrite(5,0);
digitalWrite(7,LOW);
analogWrite(6,0);
}
void zhuanxiang() {
digitalWrite(4,LOW);
analogWrite(5,150);
digitalWrite(7,LOW);
analogWrite(6,0);
}
void setup(){
pinMode(4, OUTPUT);
pinMode(7, OUTPUT);
pinMode(11, OUTPUT);
pinMode(12, INPUT);
}
void loop(){
qianjin();
if (checkdistance_11_12() < 20) {
tingzhi();
delay(1000);
houtui();
delay(500);
zhuanxiang();
delay(500);
}
}
|
本帖子中包含更多资源
您需要 登录 才可以下载或查看,没有帐号?立即注册
x
|