传感器、电机驱动与控制电路

💡 核心思想：机器人的电子系统是其"神经系统"。传感器是感官，控制器是大脑，驱动器是肌肉。理解这三者的协作，才能让机器人真正"活"起来。

2.1 传感器原理与选型

传感器的作用

机器人需要感知自身状态和外部环境，才能做出正确的动作。传感器是机器人与物理世界的接口。

IMU（惯性测量单元）详解

IMU是机器人最重要的传感器之一，用于测量姿态、加速度和角速度。

MPU6050 — 入门首选

• 3轴加速度计 + 3轴陀螺仪（6轴）
• I²C接口，地址0x68或0x69
• 内置DMP（数字运动处理器），可直接输出四元数
• 价格：5~15元，适合Level 1-2

ICM-42688-P — 进阶推荐

• 6轴，噪声更低，精度更高
• SPI/I²C双接口，最高24MHz SPI
• 适合高速控制（1kHz+采样率）
• 价格：30~60元，适合Level 3-4

编码器详解

编码器用于测量电机转速和关节角度，是闭环控制的基础。

2.2 电机与驱动

电机类型对比

舵机控制原理

标准舵机通过PWM信号控制角度：

• 信号周期：20ms（50Hz）
• 脉宽范围：500μs（0°）~ 2500μs（180°）
• 中位：1500μs（90°）

Arduino控制舵机代码

#include <Servo.h>

Servo myServo;

void setup() {
    myServo.attach(9);  // 舵机信号线接D9
}

void loop() {
    // 扫描 0° → 180°
    for (int angle = 0; angle <= 180; angle++) {
        myServo.write(angle);
        delay(15);  // 等待舵机到位
    }
    // 扫描 180° → 0°
    for (int angle = 180; angle >= 0; angle--) {
        myServo.write(angle);
        delay(15);
    }
}

无刷电机（BLDC）与FOC控制

无刷电机是高性能机器人关节的首选，配合FOC（磁场定向控制）可以实现精确的力矩控制。

推荐方案：ODrive / SimpleFOC

2.3 主控板选型

常用主控板对比

分层控制架构

复杂机器人通常采用分层控制架构：

2.4 电路设计基础

机器人电路的基本组成

1. 电源系统：电池、BMS、稳压模块
2. 主控电路：MCU/SBC及其外围电路
3. 驱动电路：电机驱动、舵机驱动
4. 传感器电路：信号调理、ADC、通信接口
5. 通信电路：WiFi/BT/CAN/RS485
6. 保护电路：过流、过压、反接保护

常用通信接口

基本保护电路

电源设计

锂电池选型

稳压模块

• 5V/3A：给MCU、传感器供电（用LM2596或MP1584降压模块）
• 3.3V/1A：给ESP32、传感器供电（用AMS1117-3.3或LDO）
• 舵机电源：舵机需要独立5V/6V供电，不要与MCU共用（电流大，干扰大）
• 电机电源：直接用电池电压，通过驱动板控制

2.5 实战：多舵机控制板

基于Arduino Mega的16路舵机控制

Arduino Mega有15个硬件PWM引脚，可以直接控制15个舵机，加上软件PWM可扩展到更多。

硬件连接

PCA9685 — 16路PWM扩展芯片

当舵机数量超过Arduino PWM引脚时，使用PCA9685扩展：

• 16路12位PWM输出
• I²C接口，只占用2个引脚
• 可级联最多62个（992路PWM）
• 价格：约15元/块

#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>

Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();

#define SERVOMIN  150  // 最小脉宽（0°）
#define SERVOMAX  600  // 最大脉宽（180°）

void setup() {
    pwm.begin();
    pwm.setPWMFreq(50);  // 50Hz，标准舵机频率
}

// 设置舵机角度（0~180°）
void setServoAngle(uint8_t channel, float angle) {
    uint16_t pulse = map(angle, 0, 180, SERVOMIN, SERVOMAX);
    pwm.setPWM(channel, 0, pulse);
}

void loop() {
    setServoAngle(0, 90);   // 舵机0 → 90°
    setServoAngle(1, 45);   // 舵机1 → 45°
    delay(1000);
    setServoAngle(0, 0);
    setServoAngle(1, 180);
    delay(1000);
}

2.6 调试技巧

常见问题与解决方案

调试工具推荐

• 万用表：必备，测电压/电流/电阻
• 示波器（或逻辑分析仪）：查看PWM波形、通信时序
• 串口调试助手：监控MCU输出，调试通信
• 电流表：监控各路电流，发现异常
• 热成像仪（可选）：快速定位发热元件

2.7 本章小结

• ✅ 掌握了机器人常用传感器的原理和选型
• ✅ 理解了各类电机的特点和驱动方式
• ✅ 了解了主控板的选型和分层控制架构
• ✅ 学习了电路设计基础和电源管理
• ✅ 掌握了多舵机控制的实现方法