grua

 // C++ code

//

#include <Servo.h>

int SBase = 0;

int SBrazoInf = 0;

int SBrazoSup = 0;

int SPinza = 0;

Servo servo_3;

Servo servo_5;

Servo servo_6;

Servo servo_9;

void setup()

{

  pinMode(A0, INPUT);

  pinMode(A1, INPUT);

  pinMode(A2, INPUT);

  pinMode(A3, INPUT);

  servo_3.attach(3, 500, 2500);

  servo_5.attach(5, 500, 2500);

  servo_6.attach(6, 500, 2500);

  servo_9.attach(9, 500, 2500);

}

void loop()

{

  SBase = map(analogRead(A0), 0, 1023, 0, 180);

  SBrazoInf = map(analogRead(A1), 0, 1023, 0, 180);

  SBrazoSup = map(analogRead(A2), 0, 1023, 0, 180);

  SPinza = map(analogRead(A3), 0, 1023, 0, 180);

  servo_3.write(SBase);

  servo_5.write(SBrazoInf);

  servo_6.write(SBrazoSup);

  servo_9.write(SPinza);

  delay(10); // Delay a little bit to improve simulation performance

}