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;