asdf

Dependencies:   mbed

Committer:
madcowswe
Date:
Wed Mar 20 17:30:30 2013 +0000
Revision:
0:c4ec289ae3a7
first commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
madcowswe 0:c4ec289ae3a7 1 #include "mbed.h"
madcowswe 0:c4ec289ae3a7 2 DigitalOut EN(p25);
madcowswe 0:c4ec289ae3a7 3 PwmOut IN1(p21);
madcowswe 0:c4ec289ae3a7 4 PwmOut IN2(p22);
madcowswe 0:c4ec289ae3a7 5 PwmOut IN3(p23);
madcowswe 0:c4ec289ae3a7 6 PwmOut IN4(p24);
madcowswe 0:c4ec289ae3a7 7
madcowswe 0:c4ec289ae3a7 8 //from -1 to 1
madcowswe 0:c4ec289ae3a7 9 void motorpower(float left, float right){
madcowswe 0:c4ec289ae3a7 10 IN1 = right < 0 ? -right : 0;
madcowswe 0:c4ec289ae3a7 11 IN2 = right >= 0 ? right : 0;
madcowswe 0:c4ec289ae3a7 12 IN3 = left >= 0 ? left : 0;
madcowswe 0:c4ec289ae3a7 13 IN4 = left < 0 ? -left : 0;
madcowswe 0:c4ec289ae3a7 14 }
madcowswe 0:c4ec289ae3a7 15
madcowswe 0:c4ec289ae3a7 16 int main() {
madcowswe 0:c4ec289ae3a7 17
madcowswe 0:c4ec289ae3a7 18 motorpower(0, 0);
madcowswe 0:c4ec289ae3a7 19 EN = 1;
madcowswe 0:c4ec289ae3a7 20
madcowswe 0:c4ec289ae3a7 21 while(1) {
madcowswe 0:c4ec289ae3a7 22 wait(1);
madcowswe 0:c4ec289ae3a7 23 motorpower(0.2, 0.2);
madcowswe 0:c4ec289ae3a7 24 wait(1);
madcowswe 0:c4ec289ae3a7 25 motorpower(-0.2, 0.2);
madcowswe 0:c4ec289ae3a7 26 wait(1);
madcowswe 0:c4ec289ae3a7 27 motorpower(0,0);
madcowswe 0:c4ec289ae3a7 28 }
madcowswe 0:c4ec289ae3a7 29 }