Hello world program that just gets the m3pi moving

Dependencies:   m3pi_ng mbed

Fork of m3pi_HelloWorld by Chris Styles

Committer:
jograesser
Date:
Tue Mar 06 17:07:54 2018 +0000
Revision:
8:c9f5f6464497
Parent:
7:d0689e8f23bf
final;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
chris 0:93bba564574a 1 #include "mbed.h"
jograesser 8:c9f5f6464497 2 #include "m3pi_ng.h"
jograesser 8:c9f5f6464497 3 #include <string>
jograesser 8:c9f5f6464497 4
chris 0:93bba564574a 5
chris 7:d0689e8f23bf 6 m3pi m3pi;
jograesser 8:c9f5f6464497 7 Serial Ser(USBTX, USBRX); // tx, rx
jograesser 8:c9f5f6464497 8 char ser_data[20];
jograesser 8:c9f5f6464497 9 DigitalIn button(p21);
jograesser 8:c9f5f6464497 10 int raw_data[5];
jograesser 8:c9f5f6464497 11 BusOut led(p19);
jograesser 8:c9f5f6464497 12 BusOut led2(p20,p19,p18,p17,p16,p15,p14,p13);
chris 0:93bba564574a 13
chris 0:93bba564574a 14 int main() {
jograesser 8:c9f5f6464497 15 m3pi.reset();
jograesser 8:c9f5f6464497 16 led2 = 0;
jograesser 8:c9f5f6464497 17
chris 2:5a329194c74d 18 m3pi.locate(0,1);
jograesser 8:c9f5f6464497 19 float bat_vol = m3pi.battery();
jograesser 8:c9f5f6464497 20 m3pi.printf("%d",bat_vol);
jograesser 8:c9f5f6464497 21
jograesser 8:c9f5f6464497 22 char doh[] ="V1504E4C8D8E8C8D8E8F4D8E8F8D8E8F8GG8E8D8C4";
jograesser 8:c9f5f6464497 23 m3pi.playtune(doh,40);
jograesser 8:c9f5f6464497 24
jograesser 8:c9f5f6464497 25
jograesser 8:c9f5f6464497 26 for( int i=0; i<5;i++){
jograesser 8:c9f5f6464497 27
jograesser 8:c9f5f6464497 28 m3pi.raw_sensor(raw_data);
jograesser 8:c9f5f6464497 29 for(int u=0;u<5;u++){
jograesser 8:c9f5f6464497 30
jograesser 8:c9f5f6464497 31
jograesser 8:c9f5f6464497 32 Ser.printf("%d",raw_data[u]);
jograesser 8:c9f5f6464497 33 Ser.printf("\r\n");
jograesser 8:c9f5f6464497 34 }
jograesser 8:c9f5f6464497 35 wait(1);
jograesser 8:c9f5f6464497 36 Ser.printf("\n");
jograesser 8:c9f5f6464497 37 }
jograesser 8:c9f5f6464497 38
jograesser 8:c9f5f6464497 39
jograesser 8:c9f5f6464497 40
jograesser 8:c9f5f6464497 41 /*
jograesser 8:c9f5f6464497 42 //blinkenlights
jograesser 8:c9f5f6464497 43 while(button){
jograesser 8:c9f5f6464497 44
jograesser 8:c9f5f6464497 45 led= 255;
jograesser 8:c9f5f6464497 46 wait(1);
jograesser 8:c9f5f6464497 47 led =0 ;
jograesser 8:c9f5f6464497 48 wait(1);
jograesser 8:c9f5f6464497 49 }
jograesser 8:c9f5f6464497 50 */
jograesser 8:c9f5f6464497 51
jograesser 8:c9f5f6464497 52
jograesser 8:c9f5f6464497 53
jograesser 8:c9f5f6464497 54 /*
jograesser 8:c9f5f6464497 55
jograesser 8:c9f5f6464497 56 Ser.scanf(ser_data);
jograesser 8:c9f5f6464497 57 m3pi.printf(ser_data);
chris 0:93bba564574a 58
jograesser 8:c9f5f6464497 59 while(button){
jograesser 8:c9f5f6464497 60 m3pi.printf("P21");
jograesser 8:c9f5f6464497 61 wait(1);
jograesser 8:c9f5f6464497 62 m3pi.cls();
jograesser 8:c9f5f6464497 63 }
jograesser 8:c9f5f6464497 64
jograesser 8:c9f5f6464497 65 */
jograesser 8:c9f5f6464497 66 /*
jograesser 8:c9f5f6464497 67
jograesser 8:c9f5f6464497 68 m3pi.forward(0.25); // Forward half speed
jograesser 8:c9f5f6464497 69 wait (1); // wait half a second
jograesser 8:c9f5f6464497 70 m3pi.left(0.25); // Turn left at half speed
jograesser 8:c9f5f6464497 71 wait (1); // wait half a second
jograesser 8:c9f5f6464497 72 m3pi.backward(0.25);// Backward at half speed
jograesser 8:c9f5f6464497 73 wait (1); // wait half a second
jograesser 8:c9f5f6464497 74 m3pi.right(0.25); // Turn right at half speed
jograesser 8:c9f5f6464497 75 wait (1); // wait half a second
jograesser 8:c9f5f6464497 76 */
chris 0:93bba564574a 77
chris 7:d0689e8f23bf 78 m3pi.stop();
chris 0:93bba564574a 79 }