Gert Lauritsen / throttleServo

init

throttle.cpp

Committer:
gert_lauritsen
Date:
2015-07-03
Revision:
1:0c3383524c95
Parent:
0:f9937e19c867
Child:
2:467ca29e1ce0

File content as of revision 1:0c3383524c95:

#include "throttle.h"

ThrottleCtrl::ThrottleCtrl(PinName servo): _servo(servo) {
//    MaxPos=1706; //Dette er det område vi har i første omgang
//    MinPos=806;    
    MaxPos=2000; //Dette er det område vi har i første omgang
    MinPos=620;    

}


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