albatross / Mbed 2 deprecated hudo3m

3m

Dependencies:   mbed

Fork of hudo by albatross

main.cpp

Committer:
tsumagari
Date:
2016-11-23
Revision:
2:e1b3f635701b
Parent:
1:28852d0667a9

File content as of revision 2:e1b3f635701b:

#include "mbed.h"

#define SERVODEG 0.0
#define MaxDeg 25.0

PwmOut servo(p21);
AnalogIn input(p20);
double bairitu;

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

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