写个无人机控制程序

以下是一个基本的无人机控制程序的示例，可以通过Arduino或其他类似的平台运行：

#include <Wire.h>
#include <Servo.h>

Servo motor1;
Servo motor2;
Servo motor3;
Servo motor4;

int motorSpeed1;
int motorSpeed2;
int motorSpeed3;
int motorSpeed4;

void setup() {
  // 初始化舵机引脚
  motor1.attach(9);
  motor2.attach(10);
  motor3.attach(11);
  motor4.attach(12);
  
  // 初始化串口通信
  Serial.begin(9600);
}

void loop() {
  // 读取控制指令
  if (Serial.available() > 0) {
    String command = Serial.readString();
    
    // 解析指令
    if (command.startsWith("M1")) {
      motorSpeed1 = command.substring(2).toInt();
      motor1.write(motorSpeed1);
    }
    else if (command.startsWith("M2")) {
      motorSpeed2 = command.substring(2).toInt();
      motor2.write(motorSpeed2);
    }
    else if (command.startsWith("M3")) {
      motorSpeed3 = command.substring(2).toInt();
      motor3.write(motorSpeed3);
    }
    else if (command.startsWith("M4")) {
      motorSpeed4 = command.substring(2).toInt();
      motor4.write(motorSpeed4);
    }
  }
}

该程序使用四个舵机控制无人机的四个电机，通过串口接收控制指令。指令应该以“M1”、“M2”、“M3”或“M4”开头，后面跟着控制电机速度的数值。例如，“M1 120”表示将电机1的速度设置为120。该程序可以与其他设备通信，比如蓝牙模块或Wi-Fi模块，以实现无线控制。请注意，该程序只是一个基本示例，实际的无人机控制程序需要更多的代码来处理传感器数据、姿态控制和其他功能。