Servo motor 1

#include <Servo.h>

// Declaramos la variable para controlar el servo

Servo servoMotor;

void setup() {

// Iniciamos el monitor serie para mostrar el resultado

Serial.begin(9600);

// Iniciamos el servo para que empiece a trabajar con el pin 9

servoMotor.attach(9);

// Inicializamos al ngulo 0 el servomotor

servoMotor.write(0);

void loop() {

// Vamos a tener dos bucles uno para mover en sentido positivo y otro en sentido negativo

// Para el sentido positivo

for (int i = 0; i <= 180; i++)

// Desplazamos al ngulo correspondiente

servoMotor.write(i);

// Hacemos una pausa de 25ms

delay(5);

}
 // Para el sentido negativo

for (int i = 179; i > 0; i--)

// Desplazamos al ngulo correspondiente

servoMotor.write(i);

// Hacemos una pausa de 25ms

delay(5);

Servo motor 2

#include <Servo.h> // Incluir la librera Servo

Servo servo1;

Servo servo2;// Crear un objeto tipo Servo llamado servo1

int angulo = 0 ;

int ang = 0;

int Eje_X = A1 ;

int Eje_Y = A2 ;

void setup()

servo1.attach(9) ; // Conectar servo1 al pin 9

servo2.attach(10);

void loop()
 {

angulo = map( analogRead(A1), 0, 1024, 0, 180);

servo1.write(angulo);

ang = map( analogRead(A2), 0, 1024, 0, 180);

servo2.write(ang);

delay(5) ;

Carrito (verificacin del funcionamiento de los motores)

#define LEFT_FORWARD 5

#define LEFT_BACKWARD 6

#define RIGHT_FORWARD 10

#define RIGHT_BACKWARD 9

void setup() {

pinMode(LEFT_FORWARD,OUTPUT);

pinMode(LEFT_BACKWARD,OUTPUT);

pinMode(RIGHT_FORWARD,OUTPUT);

pinMode(RIGHT_BACKWARD,OUTPUT);

digitalWrite(LEFT_FORWARD,LOW);

digitalWrite(LEFT_BACKWARD,LOW);

digitalWrite(RIGHT_FORWARD,LOW);

digitalWrite(RIGHT_BACKWARD,LOW);

void loop() {

digitalWrite(LEFT_FORWARD,HIGH);

//digitalWrite(RIGHT_FORWARD,HIGH);

// put your main code here, to run repeatedly:

}

Carrito (avance del cdigo)

#define LEFT_FORWARD 5

#define LEFT_BACKWARD 6

#define RIGHT_FORWARD 10

#define RIGHT_BACKWARD 9

void setup() {

Serial.begin(9600);

pinMode(LEFT_FORWARD,OUTPUT);

pinMode(LEFT_BACKWARD,OUTPUT);

pinMode(RIGHT_FORWARD,OUTPUT);

pinMode(RIGHT_BACKWARD,OUTPUT);

void loop(){

while(1) {

I_UP=0;

D_UP=0;

I_DOWN=0;

D_DOWN=0;

acc_x=0;

acc_y=0;

for (int i=0; i<1000; i++){

acc_x = acc_x + analogRead(A1);

acc_y = acc_y + analogRead(A0);

}
valorY = acc_y / 1000;

valorX = acc_x / 1000;