舵机的工作原理

舵机是一种通过控制信号精确控制输出轴位置的电机。它通常由电机、减速齿轮组、控制电路和反馈电位器组成。舵机接收PWM（脉宽调制）信号，根据信号脉冲宽度决定输出轴的角度位置。

标准舵机控制信号为周期20ms（50Hz）的PWM信号，脉冲宽度在0.5ms到2.5ms之间对应0°到180°的旋转角度。控制电路通过比较输入信号与电位器反馈信号来驱动电机转动，直到两者匹配。

舵机在机器人上的应用

机器人技术中，舵机常用于关节驱动、机械臂控制、机器人行走机构等场景。其优势在于体积小、力矩大、控制简单，适合需要精确角度控制的应用。典型应用包括：

• 机器人手臂关节驱动
• 双足机器人腿部运动
• 机器人头部转向机构
• 抓取机构的手指控制

C++控制舵机实例（基于Raspberry Pi）

以下代码展示如何使用C++通过Raspberry Pi的GPIO控制舵机：

#include <wiringPi.h>
#include <softPwm.h>
#include <iostream>

#define SERVO_PIN 1 // GPIO18对应wiringPi引脚1

void setServoAngle(int angle) {
    if(angle < 0) angle = 0;
    if(angle > 180) angle = 180;
    
    // 将角度转换为脉冲宽度（500-2500μs）
    int pulseWidth = 500 + angle * (2000 / 180);
    
    // 设置PWM占空比（范围50-250对应0.5ms-2.5ms）
    softPwmWrite(SERVO_PIN, pulseWidth / 100);
}

int main() {
    if(wiringPiSetup() == -1) {
        std::cerr << "wiringPi初始化失败" << std::endl;
        return 1;
    }
    
    // 创建软件PWM，范围100=20ms周期
    softPwmCreate(SERVO_PIN, 0, 100);
    
    // 控制舵机从0°到180°来回转动
    while(true) {
        for(int angle = 0; angle <= 180; angle += 10) {
            setServoAngle(angle);
            delay(500);
        }
        for(int angle = 180; angle >= 0; angle -= 10) {
            setServoAngle(angle);
            delay(500);
        }
    }
    
    return 0;
}

多舵机协同控制实例

机器人应用中常需要多个舵机协同工作。以下代码展示如何控制两个舵机模拟简单机械臂：

#include <wiringPi.h>
#include <softPwm.h>
#include <unistd.h>

#define BASE_SERVO 1
#define ARM_SERVO 2

void setupServo(int pin) {
    pinMode(pin, OUTPUT);
    softPwmCreate(pin, 0, 100);
}

void moveServo(int pin, int startAngle, int endAngle, int duration) {
    int step = (endAngle > startAngle) ? 1 : -1;
    for(int angle = startAngle; angle != endAngle; angle += step) {
        int pulseWidth = 500 + angle * (2000 / 180);
        softPwmWrite(pin, pulseWidth / 100);
        usleep(duration * 1000 / abs(endAngle - startAngle));
    }
}

int main() {
    wiringPiSetup();
    
    setupServo(BASE_SERVO);
    setupServo(ARM_SERVO);
    
    // 机械臂运动序列
    while(true) {
        // 底座转动同时手臂抬起
        moveServo(BASE_SERVO, 90, 45, 1000);
        moveServo(ARM_SERVO, 30, 90, 1000);
        
        // 手臂下放
        moveServo(ARM_SERVO, 90, 30, 500);
        
        // 底座回转
        moveServo(BASE_SERVO, 45, 135, 1500);
        
        // 完成工作循环
        delay(2000);
    }
}

舵机控制注意事项

1. 电源供应要充足，每个舵机可能需要300mA-1A电流
2. 避免让舵机长时间堵转，可能损坏电机
3. 机械结构设计时考虑舵机的扭矩限制
4. 复杂运动轨迹应考虑运动规划算法
5. 实际应用中建议加入限位保护

高级应用扩展

对于更复杂的机器人系统，可以结合PID控制算法提高舵机位置精度：

class ServoPIDController {
private:
    float Kp, Ki, Kd;
    float integral, prevError;
    
public:
    ServoPIDController(float p, float i, float d) : 
        Kp(p), Ki(i), Kd(d), integral(0), prevError(0) {}
        
    int compute(int setpoint, int current) {
        int error = setpoint - current;
        integral += error;
        int derivative = error - prevError;
        prevError = error;
        
        return Kp * error + Ki * integral + Kd * derivative;
    }
};

使用时可以将PID输出转换为舵机控制信号，实现更精确的位置控制。