Curtis Sellier / Mbed 2 deprecated Project_Car_Curtis_Non_Tested

Dependencies:   Servo mbed

main.cpp

Committer:
kmarangi
Date:
2016-10-07
Revision:
0:65fd20a989e9
Child:
1:8c1e3382b4d7

File content as of revision 0:65fd20a989e9:

#include "mbed.h"
#include "Servo.h"
Serial pc(USBTX, USBRX); // USB serial interface
Servo cr_srv1(p21); // continuous rotation hobby servo right
Servo cr_srv2(p22); // continuous rotation hobby servo left

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


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

 init_servo();

 while(1) {


 // sernd the servo command to the servos themselves
 cr_srv1.write(0.6); // write to the continuous rotation servo1
 cr_srv2.write(0.4); // write to the continous servo2

 }
}