Curtis Sellier / Mbed 2 deprecated Project_Car_Curtis_Non_Tested

Dependencies:   Servo mbed

main.cpp

Committer:
csellier
Date:
2016-10-11
Revision:
2:0b86e6482e4b
Parent:
1:8c1e3382b4d7
Child:
3:581d391d248c

File content as of revision 2:0b86e6482e4b:

#include "mbed.h"
#include "Servo.h"
Serial pc (USBTX, USBRX); // USB serial interface
Servo ServoRight(p21); // continuous rotation hobby servo right
Servo ServoLeft(p22); // continuous rotation hobby servo left
PwmOut LEDleft(p23);
PwmOut LEDright(p24);
AnalogIn IRfront(p15);
AnalogIn IRleft(p16);
AnalogIn IRright(p17);
AnalogIn LDRleft(p18);
AnalogIn LDRright(p19);

void init_servo() {
 // calibrate the servos for +/-5ms over +/-45deg
 ServoRight.calibrate(0.0005,45);
 ServoLeft.calibrate(0.0005,45);
}
int main() {


 // set the USB serial interface baud rate
 pc.baud(921600);

 init_servo();

 while(1) {

 //Turn both LED's on for the line following feature
  LEDleft=1;
  LEDright=1;
  
 // sernd the servo command to the servos themselves
 ServoRight.write(0.6); // write to the continuous rotation servo1
 ServoLeft.write(0.4); // write to the continous servo2

 }
}