Servo - A class to control a model R/C servo, using a Pwm…

Users » simon » Code » Servo

A class to control a model R/C servo, using a PwmOut

Dependents: mbedDemoDisplay mbedDemoDisplay Servo_HelloWorld Initialmbedrobotprogram ... more

main.cpp@0:24148c673250, 2009-11-16 (annotated)

User	Revision	Line number	New contents of line
simon	0:24148c673250	1	#include "mbed.h"
simon	0:24148c673250	2	#include "Servo.h"
simon	0:24148c673250	3
simon	0:24148c673250	4	Servo myservo(p21);
simon	0:24148c673250	5	Serial pc(USBTX, USBRX);
simon	0:24148c673250	6
simon	0:24148c673250	7	int main() {
simon	0:24148c673250	8	printf("Servo Calibration Controls:\n");
simon	0:24148c673250	9	printf("1,2,3 - Position Servo (full left, middle, full right)\n");
simon	0:24148c673250	10	printf("4,5 - Decrease or Increase range\n");
simon	0:24148c673250	11
simon	0:24148c673250	12	float range = 0.0005;
simon	0:24148c673250	13	float position = 0.5;
simon	0:24148c673250	14
simon	0:24148c673250	15	while(1) {
simon	0:24148c673250	16	switch(pc.getc()) {
simon	0:24148c673250	17	case '1': position = 0.0; break;
simon	0:24148c673250	18	case '2': position = 0.5; break;
simon	0:24148c673250	19	case '3': position = 1.0; break;
simon	0:24148c673250	20	case '4': range += 0.0001; break;
simon	0:24148c673250	21	case '5': range -= 0.0001; break;
simon	0:24148c673250	22	}
simon	0:24148c673250	23	printf("position = %.1f, range = +/-%0.4f\n", position, range);
simon	0:24148c673250	24	myservo.calibrate(range, 45.0);
simon	0:24148c673250	25	myservo = position;
simon	0:24148c673250	26	}
simon	0:24148c673250	27	}