Bayu Dharmaputra
/
Servo_control
Servo control for biorobotics project
Servo_test.cpp
- Committer:
- dbayuadi
- Date:
- 2015-10-09
- Revision:
- 0:b9edd20e67a6
File content as of revision 0:b9edd20e67a6:
#include "mbed.h" #include "Servo.h" Servo myservo(D3); Serial pc(USBTX, USBRX); int main() { pc.baud(115200); pc.printf("Servo Calibration Controls:\n"); pc.printf("1,2,3 - Position Servo (full left, middle, full right)\n"); pc.printf("4,5 - Decrease or Increase range\n"); float range = 0.0005*2; float position = 0.5; while(1) { switch(pc.getc()) { case '1': position = 0.0; break; case '2': position = 0.5; break; case '3': position = 1.0; break; case '4': position = 0.65; break; case '5': position += 0.01; break; case '6': position -= 0.01; break; } printf("position = %.1f, range = +/-%0.4f\n", position, range); myservo.calibrate(range, 45.0); myservo = position; } }