您好，登录后才能下订单哦！
密码登录
登录注册
点击 登录注册 即表示同意《亿速云用户服务条款》
# Python DIY超声波避障小车的方法是什么
## 引言
在当今快速发展的科技时代，智能机器人技术正逐渐走进普通爱好者的视野。其中，超声波避障小车作为机器人技术的入门项目，因其简单有趣且富有教育意义，深受创客和编程学习者的喜爱。本文将详细介绍如何使用Python语言和常见的硬件组件DIY一辆超声波避障小车。
通过本项目，您将学习到：
- 超声波传感器的工作原理
- 电机驱动和控制方法
- Python与硬件的交互技术
- 基本的避障算法实现
这个项目不仅适合有一定Python基础的爱好者，也适合想要探索物联网和机器人技术的初学者。我们将从零开始，逐步完成硬件组装、电路连接、程序编写和调试的全过程。
## 一、项目概述与原理
### 1.1 超声波避障小车的基本原理
超声波避障小车的核心原理是利用超声波传感器测量前方障碍物的距离，当距离小于安全阈值时，控制系统会发出指令让小车改变运动方向。整个过程可以分为三个主要部分：
1. **距离检测**：超声波传感器发射声波并接收回波，通过时间差计算距离
2. **数据处理**：微控制器处理传感器数据并做出决策
3. **运动控制**：根据决策结果控制电机转动方向
### 1.2 超声波测距原理
HC-SR04超声波传感器通过以下步骤测量距离：
1. 触发引脚接收10μs的高电平信号
2. 传感器发射8个40kHz的超声波脉冲
3. 超声波遇到障碍物后反射
4. 传感器接收回波并通过回响引脚输出高电平
5. 高电平持续时间与距离成正比（每58μs对应1cm）
距离计算公式为：
距离(cm) = (高电平时间(μs) / 58)
### 1.3 系统组成框图
+—————+ | 超声波传感器 | +——-┬——-+ | +——-▼——-+ +————+ | Raspberry Pi |—-| 电机驱动器 | +——-┬——-+ +——┬—–+ | | +——-▼——-+ +——▼—–+ | 电源系统 | | 直流电机 | +—————+ +————+
## 二、硬件准备与组装
### 2.1 所需材料清单
| 组件 | 型号/规格 | 数量 | 备注 |
|------|----------|------|------|
| 主控板 | Raspberry Pi 4B | 1 | 也可用Arduino或其他开发板 |
| 超声波传感器 | HC-SR04 | 1 | 测距范围2cm-400cm |
| 电机驱动模块 | L298N | 1 | 双H桥设计 |
| 直流减速电机 | TT马达 | 2 | 带车轮 |
| 万向轮 | | 1 | 用于平衡 |
| 电池组 | 18650锂电池 | 2 | 需配套电池盒 |
| 杜邦线 | 公对公/母对母 | 若干 | 用于连接电路 |
| 车体框架 | 亚克力/3D打印 | 1套 | 可自制 |
### 2.2 硬件连接示意图
#### Raspberry Pi与HC-SR04连接：
| 传感器引脚 | Raspberry Pi GPIO |
|------------|-------------------|
| VCC | 5V (Pin 2) |
| Trig | GPIO23 (Pin 16) |
| Echo | GPIO24 (Pin 18) |
| GND | GND (Pin 6) |
#### Raspberry Pi与L298N连接：
| L298N引脚 | Raspberry Pi GPIO |
|-----------|-------------------|
| IN1 | GPIO17 (Pin 11) |
| IN2 | GPIO27 (Pin 13) |
| IN3 | GPIO22 (Pin 15) |
| IN4 | GPIO10 (Pin 19) |
| 12V供电 | 电池正极 |
| GND | 电池负极 |
### 2.3 机械结构组装步骤
1. **安装底盘**：将亚克力板或3D打印框架组装成车体
2. **固定电机**：用螺丝将两个直流电机固定在车体后部两侧
3. **安装万向轮**：在前部中心位置安装万向轮保持平衡
4. **布置电路**：
- 将Raspberry Pi固定在车体中部
- 电机驱动器靠近电池放置
- 超声波传感器安装在前方高处
5. **走线管理**：使用扎带整理电线，避免缠绕
## 三、软件环境配置
### 3.1 操作系统准备
推荐使用Raspberry Pi OS Lite版本：
```bash
# 更新系统
sudo apt update && sudo apt upgrade -y
# 安装必要工具
sudo apt install -y python3-pip git vim
# 安装GPIO控制库
pip3 install RPi.GPIO
# 可选：安装更高级的gpiozero库
pip3 install gpiozero
# 安装用于电机控制的库
pip3 install l298n
创建test_ultrasonic.py文件：
import RPi.GPIO as GPIO
import time
# 引脚设置
TRIG = 23
ECHO = 24
def setup():
GPIO.setmode(GPIO.BCM)
GPIO.setup(TRIG, GPIO.OUT)
GPIO.setup(ECHO, GPIO.IN)
GPIO.output(TRIG, GPIO.LOW)
time.sleep(0.5)
def get_distance():
GPIO.output(TRIG, GPIO.HIGH)
time.sleep(0.00001)
GPIO.output(TRIG, GPIO.LOW)
while GPIO.input(ECHO) == 0:
pulse_start = time.time()
while GPIO.input(ECHO) == 1:
pulse_end = time.time()
pulse_duration = pulse_end - pulse_start
distance = pulse_duration * 17150 # 343m/s ÷ 2 × 100cm/m
return round(distance, 2)
if __name__ == '__main__':
try:
setup()
while True:
dist = get_distance()
print(f"距离: {dist}cm")
time.sleep(0.2)
except KeyboardInterrupt:
GPIO.cleanup()
运行测试：
python3 test_ultrasonic.py
创建motor_controller.py：
import RPi.GPIO as GPIO
import time
class MotorController:
def __init__(self):
# 引脚定义
self.IN1 = 17 # 左电机正转
self.IN2 = 27 # 左电机反转
self.IN3 = 22 # 右电机正转
self.IN4 = 10 # 右电机反转
# 初始化GPIO
GPIO.setmode(GPIO.BCM)
GPIO.setup(self.IN1, GPIO.OUT)
GPIO.setup(self.IN2, GPIO.OUT)
GPIO.setup(self.IN3, GPIO.OUT)
GPIO.setup(self.IN4, GPIO.OUT)
# PWM设置
self.left_pwm = GPIO.PWM(self.IN1, 100) # 频率100Hz
self.right_pwm = GPIO.PWM(self.IN3, 100)
self.left_pwm.start(0)
self.right_pwm.start(0)
def move_forward(self, speed=50):
self.left_pwm.ChangeDutyCycle(speed)
GPIO.output(self.IN2, GPIO.LOW)
self.right_pwm.ChangeDutyCycle(speed)
GPIO.output(self.IN4, GPIO.LOW)
def move_backward(self, speed=50):
GPIO.output(self.IN1, GPIO.LOW)
self.left_pwm.ChangeDutyCycle(speed, self.IN2)
GPIO.output(self.IN3, GPIO.LOW)
self.right_pwm.ChangeDutyCycle(speed, self.IN4)
def turn_left(self, speed=50):
self.left_pwm.ChangeDutyCycle(0)
GPIO.output(self.IN2, GPIO.LOW)
self.right_pwm.ChangeDutyCycle(speed)
GPIO.output(self.IN4, GPIO.LOW)
def turn_right(self, speed=50):
self.left_pwm.ChangeDutyCycle(speed)
GPIO.output(self.IN2, GPIO.LOW)
self.right_pwm.ChangeDutyCycle(0)
GPIO.output(self.IN4, GPIO.LOW)
def stop(self):
self.left_pwm.ChangeDutyCycle(0)
GPIO.output(self.IN2, GPIO.LOW)
self.right_pwm.ChangeDutyCycle(0)
GPIO.output(self.IN4, GPIO.LOW)
def cleanup(self):
self.stop()
GPIO.cleanup()
创建avoidance_algorithm.py：
from motor_controller import MotorController
import time
class AvoidanceCar:
def __init__(self):
self.motor = MotorController()
self.safe_distance = 20 # 安全距离(cm)
self.turn_duration = 0.5 # 转向持续时间(s)
def obstacle_avoidance(self, distance):
if distance > self.safe_distance:
self.motor.move_forward(60)
else:
self.motor.stop()
time.sleep(0.2)
self.motor.move_backward(40)
time.sleep(0.5)
self.motor.turn_right(60)
time.sleep(self.turn_duration)
self.motor.stop()
def run(self, get_distance_func):
try:
while True:
dist = get_distance_func()
print(f"当前距离: {dist}cm")
self.obstacle_avoidance(dist)
time.sleep(0.1)
except KeyboardInterrupt:
self.motor.cleanup()
创建main.py：
from avoidance_algorithm import AvoidanceCar
from test_ultrasonic import get_distance
if __name__ == '__main__':
car = AvoidanceCar()
car.run(get_distance)
class DistanceSensor:
def __init__(self, window_size=5):
self.window = []
self.window_size = window_size
def get_filtered_distance(self):
raw_dist = get_distance() # 原始获取距离
self.window.append(raw_dist)
if len(self.window) > self.window_size:
self.window.pop(0)
return sum(self.window)/len(self.window)
class PIDController:
def __init__(self, Kp, Ki, Kd):
self.Kp = Kp
self.Ki = Ki
self.Kd = Kd
self.last_error = 0
self.integral = 0
def compute(self, error, dt):
self.integral += error * dt
derivative = (error - self.last_error) / dt
output = self.Kp*error + self.Ki*self.integral + self.Kd*derivative
self.last_error = error
return output
多传感器融合：
无线遥控：
视觉识别：
数据记录：
Q1: 电机不转动或转动无力 - 检查电源电压是否足够（建议7-12V） - 确认电机驱动器使能引脚已接高电平 - 测量电机电阻，确认没有短路
Q2: 超声波传感器读数不稳定 - 确保传感器安装稳固，避免震动 - 添加软件滤波（如中值滤波） - 检查VCC和GND连接是否良好
Q1: 出现GPIO警告
GPIO.setwarnings(False) # 禁用警告
Q2: 程序无法控制电机 - 检查引脚定义是否正确 - 确认没有其他程序占用相同GPIO - 检查用户权限（需sudo或加入gpio组）
通过本项目，我们完成了一个基于Python的超声波避障小车从硬件组装到软件编程的全过程。这个项目不仅涵盖了电子电路、机械结构、Python编程等多个领域的知识，还展示了如何将理论应用于实际项目开发中。
[此处可插入Fritzing绘制的电路图]
项目代码仓库：GitHub链接
作者：智能小车爱好者
最后更新：2023年10月
版权声明：本文采用CC BY-NC-SA 4.0协议
“`
免责声明：本站发布的内容（图片、视频和文字）以原创、转载和分享为主，文章观点不代表本网站立场，如果涉及侵权请联系站长邮箱：is@yisu.com进行举报，并提供相关证据，一经查实，将立刻删除涉嫌侵权内容。