基于ARDIUNO,WEMOS的超声波避障小车

牛油火锅在加麻 牛油火锅在加麻 墨衍会员 · AI 创作全网分发 墨衍智能分发 通过墨衍一键同步至各平台 可同步平台 CSDN微信公众号微博知乎掘金百家号博客园抖音小红书 你的文章也可以这样分发 墨衍会员 ¥399起/年,写一次发全网 我也要 + 加入社区

实际代码:

#include<ESP8266WiFi.h>
//定义串口号和功能
#define Dong1 D6
#define Dong2 D7
#define Zhuan1 D4
#define Zhuan2 D5
#define Echo D2
#define Trig D8


char *ssid = "iPhone";
char *password = "1024575686";

int port = 8888; //端口号
WiFiServer server(port);//设置端口号


long getTime() { //得到来回时间

digitalWrite(Trig, HIGH);
delayMicroseconds(10);
digitalWrite(Trig, LOW);

return pulseIn(Echo, HIGH);
}


void initChaoShengBo() { //初始化超声波

pinMode(Echo, INPUT);
pinMode(Trig, OUTPUT);

}
void initWiFiSta() { //初始化WIFI模块

WiFi.mode(WIFI_STA);//设置STA模式
WiFi.begin(ssid, password);
while (WiFi.status() != WL_CONNECTED) {
Serial.print(",");
delay(500);
}
Serial.println(WiFi.localIP());//通过串口打印wemos的IP地址
}
void initL9110S() { //初始化911模块让为输出

pinMode(Dong1, OUTPUT);
pinMode(Dong2, OUTPUT);
pinMode(Zhuan1, OUTPUT);
pinMode(Zhuan2, OUTPUT);
}

//前后由后轮控制
void hou() {
digitalWrite(Dong1, HIGH);
digitalWrite(Dong2, LOW);
}

void qian() {
digitalWrite(Dong1, LOW);
digitalWrite(Dong2, HIGH);
}
//左右由前轮控制
void zuo() {
digitalWrite(Zhuan1, HIGH);
digitalWrite(Zhuan2, LOW);

}
void you() {
digitalWrite(Zhuan2, HIGH);
digitalWrite(Zhuan1, LOW);

}
void setup() {
// put your setup code here, to run once:
initL9110S();
initChaoShengBo();
Serial.begin(115200);
initWiFiSta();
server.begin();

}

void loop() {
// put your main code here, to run repeatedly:
char cmd;
long dis;
int mark = 0;

WiFiClient client = server.available(); //服务初始化
while (client.connected()) {
while (client.available() > 0) {
cmd = client.read();
dis = getTime() / 58;
if (dis < 10) {
hou();
} else {
mark = 0;
}
if (mark == 0) {
switch (cmd) {
case'q':
qian();

break;
case'h':
hou();
break;
case'z':
zuo();
break;
case'y':
you();
break;
}
}
}
}
}
...全文
评论 2
收藏 已收藏
分享
返回顶部