3m

Dependencies:   mbed

Fork of hudo by albatross

main.cpp

Committer:
YusukeWakuta
Date:
2016-11-23
Revision:
1:28852d0667a9
Parent:
0:a15561fab2ac
Child:
2:e1b3f635701b

File content as of revision 1:28852d0667a9:

#include "mbed.h"

#define SERVODEG 0.0
#define MaxDeg 25.0

PwmOut servo(p21);

double calcPulse(int deg){
    return (0.0006+(deg/180.0)*(0.00235-0.00045));
}

int main() {
    while(1){
      servo.pulsewidth(calcPulse(71.0 + SERVODEG - MaxDeg));//calcPulse = 90の時がニュートラル
      wait(1);
      }
  }