#include <Servo.h>
const unsigned int MOTOR_PIN1 = 9;
const unsigned int MOTOR_PIN2 = 10;
const unsigned int MOTOR_DELAY = 15;
const unsigned int SERIAL_DELAY = 5;
const unsigned int BAUD_RATE = 9600;
int yaw=92;
int pitch=97;
int track_delay=0;
int yaw_last,pitch_last;//control signal for actuators
Servo servo_1,servo_2; // <label id="code.motors.servo"/>
void setup() {
Serial.begin(BAUD_RATE);
servo_1.attach(MOTOR_PIN1); // <label id="code.motors.servo_attach"/>
servo_2.attach(MOTOR_PIN2);
delay(MOTOR_DELAY);
servo_1.write(yaw);
servo_2.write(pitch);
delay(MOTOR_DELAY);
Serial.flush();
}
void loop() {
const int MAX_ANGLE = 3;
//char buffer[10];
char degree_1[MAX_ANGLE + 1];
char degree_2[MAX_ANGLE + 1];
int x_tune,y_tune;// error for control
if (Serial.available()) {
int i = 0;
int j = 0;
int space_pos=10
Arduino双舵机串口控制源代码
最新推荐文章于 2024-02-18 20:45:56 发布