Hello world program that just gets the m3pi moving
Fork of m3pi_HelloWorld by
main.cpp@8:c9f5f6464497, 2018-03-06 (annotated)
- Committer:
- jograesser
- Date:
- Tue Mar 06 17:07:54 2018 +0000
- Revision:
- 8:c9f5f6464497
- Parent:
- 7:d0689e8f23bf
final;
Who changed what in which revision?
User | Revision | Line number | New 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 | } |