balancing-robot/main.cpp
2018-08-25 11:43:37 +02:00

31 lines
478 B
C++

#include <cmath>
#include "mbed.h"
#include "src/targets/revo_f4/pins.h"
PwmOut led1(D4); //PB_5
PwmOut led2(D5); //PB_4
int i = 0;
int main() {
led1.period_us(100);
led2.period_us(100);
led1.pulsewidth_us(1);
led2.pulsewidth_us(100);
while (true) {
i++;
if (i > 1000)
{
i = 1;
}
led1.pulsewidth_us(i);
led2.pulsewidth_us(1000-i);
wait(0.002);
}
}