Gert Lauritsen / throttleServo

init

throttle.cpp

Committer:
gert_lauritsen
Date:
2015-05-20
Revision:
0:f9937e19c867
Child:
1:0c3383524c95

File content as of revision 0:f9937e19c867:

#include "throttle.h"

ThrottleCtrl::ThrottleCtrl(PinName servo): _servo(servo) {
    MaxPos=2269; //Dette er det område vi har i første omgang
    MinPos=695;    
}


void ThrottleCtrl::set(float pos){
  _servo.pulsewidth_us(MinPos+pos*(MaxPos-MinPos));
}