Preston Stephens / Mbed 2 deprecated MiniProject5_LightTracker

Final

Dependencies:   mbed

Fork of MiniProject5_LightTracker by Austin Sloop

ServoControl.cpp

Committer:
asloop18
Date:
2016-01-12
Revision:
14:69cad6d9a2e5
Parent:
13:871d01d0d250

File content as of revision 14:69cad6d9a2e5:

//Control Function for servo

#include "ServoControl.h"

PwmOut ServoSignal(p21);            //P21 is PWM signal out to servo 

void ServoInit(void){
    ServoSignal.period(0.020);
}

int ServoControl(signed int angle){
    if(angle<-90){angle=-89;}
    if(angle>90){angle=89;}
    ServoSignal.pulsewidth_us(1500+10*angle); 
    return angle;
}