三个实战项目，三个难度等级

💡 学习路径：不要一上来就做人形机器人。先从简单的机械臂开始，掌握基本原理，再逐步升级。每个项目都是前一个的进阶。

项目总览

项目一：桌面机械臂 🦾

项目特点

• ✅ 成本低：核心部件300元以内
• ✅ 结构简单：4个舵机 + 3D打印结构件
• ✅ 学习曲线平缓：从舵机控制到逆运动学逐步深入
• ✅ 可扩展：后续可加摄像头、末端力控等

BOM清单（物料清单）

机械设计

自由度分配

3D打印件清单

• 底座 ×1
• 基座支架 ×1
• 大臂 ×2（左右对称）
• 小臂 ×2
• 夹爪 ×2（左右）
• 舵机支架盖 ×4

电路连接

Arduino代码

// 桌面机械臂控制程序 - Arduino
// 硬件：Arduino Uno + PCA9685 + 4个舵机

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

Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();

// 舵机参数（根据实际舵机调整）
#define SERVOMIN  150   // 0°脉宽
#define SERVOMAX  600   // 180°脉宽

// 舵机通道
#define BASE_SERVO     0  // 基座
#define SHOULDER_SERVO 1  // 肩关节
#define ELBOW_SERVO    2  // 肘关节
#define GRIPPER_SERVO  3  // 夹爪

// 当前角度
float angles[4] = {90, 90, 90, 90};

void setup() {
    Serial.begin(115200);
    pwm.begin();
    pwm.setPWMFreq(50);  // 50Hz
    
    // 初始化到中位
    setAllServos(90, 90, 90, 90);
    Serial.println("Robot Arm Ready!");
    Serial.println("Commands: B(angle) S(angle) E(angle) G(angle)");
}

void loop() {
    // 串口命令解析
    if (Serial.available() > 0) {
        char cmd = Serial.read();
        int angle = Serial.parseInt();
        
        switch (cmd) {
            case 'B':  // Base
            case 'b':
                angles[0] = constrain(angle, 0, 180);
                setServo(BASE_SERVO, angles[0]);
                break;
            case 'S':  // Shoulder
            case 's':
                angles[1] = constrain(angle, 0, 180);
                setServo(SHOULDER_SERVO, angles[1]);
                break;
            case 'E':  // Elbow
            case 'e':
                angles[2] = constrain(angle, 0, 180);
                setServo(ELBOW_SERVO, angles[2]);
                break;
            case 'G':  // Gripper
            case 'g':
                angles[3] = constrain(angle, 0, 180);
                setServo(GRIPPER_SERVO, angles[3]);
                break;
            case 'H':  // Home position
            case 'h':
                setAllServos(90, 90, 90, 90);
                break;
        }
        
        Serial.print("Angles: B=");
        Serial.print(angles[0]);
        Serial.print(" S=");
        Serial.print(angles[1]);
        Serial.print(" E=");
        Serial.print(angles[2]);
        Serial.print(" G=");
        Serial.println(angles[3]);
    }
}

void setServo(uint8_t channel, float angle) {
    uint16_t pulse = map(angle, 0, 180, SERVOMIN, SERVOMAX);
    pwm.setPWM(channel, 0, pulse);
}

void setAllServos(float b, float s, float e, float g) {
    setServo(BASE_SERVO, b);
    setServo(SHOULDER_SERVO, s);
    setServo(ELBOW_SERVO, e);
    setServo(GRIPPER_SERVO, g);
    angles[0] = b; angles[1] = s; angles[2] = e; angles[3] = g;
}

串口控制说明

通过串口发送命令控制机械臂：

逆运动学实现

如果要根据目标坐标(x, y)自动计算关节角度，可以使用逆运动学：

// 简化逆运动学（2DOF平面臂）
// 输入：目标位置(x, y)
// 输出：肩关节角度θ1，肘关节角度θ2

void inverseKinematics(float x, float y, float* theta1, float* theta2) {
    float L1 = 100.0;  // 大臂长度(mm)
    float L2 = 100.0;  // 小臂长度(mm)
    
    // 计算距离
    float dist = sqrt(x*x + y*y);
    
    // 限制工作空间
    if (dist > L1 + L2) {
        dist = L1 + L2 - 1;  // 防止超出范围
    }
    
    // 肘关节角度（余弦定理）
    float cos_theta2 = (x*x + y*y - L1*L1 - L2*L2) / (2 * L1 * L2);
    cos_theta2 = constrain(cos_theta2, -1, 1);
    *theta2 = acos(cos_theta2);
    
    // 肩关节角度
    float k1 = L1 + L2 * cos(*theta2);
    float k2 = L2 * sin(*theta2);
    *theta1 = atan2(y, x) - atan2(k2, k1);
    
    // 转换为度
    *theta1 = degrees(*theta1);
    *theta2 = degrees(*theta2);
    
    // 调整到舵机角度范围(0-180)
    *theta1 = 90 + *theta1;
    *theta2 = 180 - *theta2;
}

调试与常见问题

扩展方向

• 🔸 加摄像头：OpenCV识别物体，自动抓取
• 🔸 手机App：蓝牙控制，滑块调节角度
• 🔸 示教模式：手动拖动记录轨迹，自动回放
• 🔸 力控夹爪：加压力传感器，防止夹坏物品

项目二：双足步行机器人 🦿

项目特点

• ✅ 难度适中：需要理解步态规划和平衡控制
• ✅ 视觉冲击力强：看到机器人走路很有成就感
• ✅ 进阶性好：后续可加手臂、头部变成人形
• ✅ 技术含量高：涉及逆运动学、ZMP、IMU等

BOM清单

自由度分配

步态规划核心代码

// 简化双足步态生成
// 生成单步周期的关节角度

const float T = 1.0;  // 步态周期（秒）

// 步态参数
float step_length = 40.0;   // 步长(mm)
float step_height = 20.0;   // 抬脚高度(mm)
float hip_swing = 15.0;     // 髋部摆动角度(度)

void generateGait(float t, float joints[8]) {
    float phase = fmod(t, T) / T;  // 0~1
    
    // 左腿相位
    float left_phase = phase;
    // 右腿相位（相差半个周期）
    float right_phase = fmod(phase + 0.5, 1.0);
    
    // === 左腿 ===
    if (left_phase < 0.5) {
        // 摆动相：抬腿前进
        float swing = sin(left_phase * 2 * PI);
        joints[0] = hip_swing * swing;           // 髋Yaw（侧摆）
        joints[2] = step_length * swing * 0.5;   // 髋Pitch（前后）
        joints[3] = -step_height * sin(left_phase * 4 * PI) * 0.5; // 膝
    } else {
        // 支撑相
        joints[0] = -hip_swing * 0.3;
        joints[2] = 0;
        joints[3] = 0;
    }
    
    // === 右腿 ===（相位相反）
    if (right_phase < 0.5) {
        float swing = sin(right_phase * 2 * PI);
        joints[4] = hip_swing * swing;
        joints[6] = step_length * swing * 0.5;
        joints[7] = -step_height * sin(right_phase * 4 * PI) * 0.5;
    } else {
        joints[4] = -hip_swing * 0.3;
        joints[6] = 0;
        joints[7] = 0;
    }
}

IMU平衡控制

// 简化平衡控制（基于IMU倾斜角）
// 当机器人前倾时，髋部后仰补偿

#include <Wire.h>
#include <MPU6050.h>

MPU6050 mpu;

float Kp_balance = 2.0;  // 平衡PID参数

void balanceControl(float* joints) {
    int16_t ax, ay, az, gx, gy, gz;
    mpu.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);
    
    // 计算俯仰角（简化）
    float pitch = atan2(ay, az) * 180 / PI;
    
    // 补偿控制
    float compensation = Kp_balance * pitch;
    
    // 两个髋关节同时补偿
    joints[2] += compensation;   // 左髋Pitch
    joints[6] += compensation;   // 右髋Pitch
}

扩展方向

• 🔸 加手臂：4个舵机做成双臂，可以抓取物体
• 🔸 视觉导航：加摄像头，识别路径
• 🔸 更复杂步态：跑步、上楼梯、踢球
• 🔸 遥控器控制：PS2手柄或手机App

项目三：小型人形机器人 🤖

项目特点

• ✅ 系统复杂度高：需要分层控制架构
• ✅ 功能丰富：行走、手势、视觉、语音
• ✅ 接近商用：接近目前市面小型人形机器水平
• ✅ 可定制性强：按需求增减功能

BOM清单（精简版）

自由度分配

分层控制架构

ROS集成示例

# ROS 2 节点示例：发布关节命令

import rclpy
from rclpy.node import Node
from sensor_msgs.msg import JointState
from std_msgs.msg import String

class HumanoidController(Node):
    def __init__(self):
        super().__init__('humanoid_controller')
        
        # 订阅关节命令
        self.joint_sub = self.create_subscription(
            JointState,
            '/joint_command',
            self.joint_callback,
            10)
        
        # 发布到底层控制器（通过串口）
        self.serial_pub = self.create_publisher(String, '/serial_out', 10)
        
        self.get_logger().info('Humanoid Controller Ready')
    
    def joint_callback(self, msg):
        # 将ROS JointState消息转换为串口命令
        cmd = "JOINTS:"
        for i, name in enumerate(msg.name):
            angle = msg.position[i]
            cmd += f"{name}:{angle:.1f},"
        
        # 发布到串口节点
        out_msg = String()
        out_msg.data = cmd.rstrip(',')
        self.serial_pub.publish(out_msg)
        self.get_logger().debug(f'Sent: {out_msg.data}')

def main(args=None):
    rclpy.init(args=args)
    node = HumanoidController()
    rclpy.spin(node)
    node.destroy_node()
    rclpy.shutdown()

if __name__ == '__main__':
    main()

核心功能模块

开发路线图

1. 第1阶段：完成机械组装，测试所有关节运动
2. 第2阶段：实现静态站立、简单步态
3. 第3阶段：加入IMU平衡控制
4. 第4阶段：开发上位机控制界面
5. 第5阶段：集成视觉、语音功能
6. 第6阶段：ROS集成、导航功能

本章小结

• ✅ 掌握了三个完整的机器人DIY项目
• ✅ 理解了从简单到复杂的渐进式学习路径
• ✅ 学会了BOM编制、电路连接、代码编写
• ✅ 了解了分层控制架构和ROS集成

"纸上得来终觉浅，绝知此事要躬行。"
—— 陆游