Gert Lauritsen / throttleServo

init

throttle.cpp

Committer:
gert_lauritsen
Date:
2016-02-29
Revision:
2:467ca29e1ce0
Parent:
1:0c3383524c95
Child:
3:756f6e19ee2d

File content as of revision 2:467ca29e1ce0:

#include "throttle.h"

ThrottleCtrl::ThrottleCtrl(PinName servo): _servo(servo) {
//    MaxPos=1706; //Dette er det område vi har i første omgang
//    MinPos=806;    
    _servo.period(0.01);
    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));
}