# main.py -- put your code here!
"""
ESP8266超声波小车2.0:新增1.超声波测距中加入数据滤波增加测量准确性
"""
import machine
from machine import Pin
import time
left_pin1 = Pin(14,Pin.OUT)
left_pin2 = Pin(12,Pin.OUT)
right_pin1 = Pin(13,Pin.OUT)
right_pin2 = Pin(15,Pin.OUT)
Trig = Pin(5, Pin.OUT)
Echo = Pin(4, Pin.IN)
def Go():
left_pin1.value(1)
left_pin2.value(0)
right_pin1.value(1)
right_pin2.value(0)
def Back():
left_pin1.value(0)
left_pin2.value(1)
right_pin1.value(0)
right_pin2.value(1)
def Left():
left_pin1.value(1)
left_pin2.value(0)
right_pin1.value(0)
right_pin2.value(1)
def Right():
left_pin2.value(1)
left_pin1.value(0)
right_pin1.value(1)
right_pin2.value(0)
count = 0
distance_list = [0,1,2,3,4,5,6]
while True:
# 给一个高电平触发信号维持20微秒,然后变成低电平
Trig.value(1)
time.sleep_us(20)
Trig.value(0)
while (Echo.value() == 0): #如果没有收到信号
ESP8266超声波避障小车2.0---数据滤波
最新推荐文章于 2024-07-25 06:19:06 发布