#include <Servo.h>
Servo myServo1;
Servo myServo2;
Servo myServo3;
Servo myServo4;
Servo myServo5;
Servo myServo6;
int sens_fl[6] = {A0, A1, A2, A3, A4, A5};
int angle_f[6];
int servoPosition[6];
void setup()
{
myServo1.attach(3);
myServo2.attach(5);
myServo3.attach(6);
myServo4.attach(9);
myServo5.attach(10);
myServo6.attach(11);
Serial.begin(9600);
}
void loop()
{
for (int i = 0; i<6; i++){
angle_f[i] = analogRead(sens_fl[i]);
servoPosition[i] = map(angle_f[i], 767, 964, 0, 180);
servoPosition[i] = constrain(servoPosition[i], 0, 180);
Serial.print("Angle ");
Serial.print(i);
Serial.print(" = ");
Serial.println(servoPosition[i]);
}
myServo1.write(servoPosition[0]);
myServo2.write(servoPosition[1]);
myServo3.write(servoPosition[2]);
myServo4.write(servoPosition[3]);
myServo5.write(servoPosition[4]);
myServo6.write(servoPosition[5]);
delay(20);
}