Gert Lauritsen / throttleServo

init

throttle.cpp

Committer:
gert_lauritsen
Date:
2016-03-09
Revision:
3:756f6e19ee2d
Parent:
2:467ca29e1ce0

File content as of revision 3:756f6e19ee2d:

#include "throttle.h"

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


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