Paso 3: Código de Arduino
Descargar librerías y códigos de github:
Código principal: https://github.com/BTeTapxu/Drift-car-code-arduino
Descargar biblioteca: https://github.com/pololu/dual-vnh5019-motor-shield
CÓDIGO:
#include "DualVNH5019MotorShield.h"
Motor de DualVNH5019MotorShield;
unsigned char serial_in [7] = {};
int i = 0;
int analogPin = 3; potenciómetro conectado al pin analógico 3 int val = 0, comp;
void setup() {}
Serial.Begin(19200);
motor.init();
}
void loop() {}
motor_move();
servo();
Serial.println(COMP); de depuración
Si (Serial.available() > 0) {}
Si (i == 6) {}
i = 0;
}
i ++;
serial_in[i]=serial.Read();
}
}
void servo() {}
Si (comp < mapa (serial_in [4], 208,48, 14, 6)) {}
motor.setM2Speed(100);
}
else if (comp > mapa (serial_in [4], 208,48, 14, 6)) {}
motor.setM2Speed(100);
}
Else {}
motor.setM2Speed(0);
}
Comp = analogRead (analogPin) / 50;
}
void motor_move() {}
Si (serial_in [1] < 127) {}
motor.setM1Speed (mapa (serial_in [1], 127,50, 0 -400));
}
else if (serial_in [1] > 129) {}
motor.setM1Speed (mapa (serial_in [1], 129.210, 0, 400));
}
Else {}
motor.setM1Speed(0);
}
}