CMPS03 Compass HelloWorld Program
This program is an example of how to use the CMPS03 compass library.
People may also use the CMPS03 I2C library that can be found in Mbed component section.
main.cpp@2:4dae0a194d00, 2018-06-01 (annotated)
- Committer:
- haarkon
- Date:
- Fri Jun 01 07:06:28 2018 +0000
- Revision:
- 2:4dae0a194d00
- Parent:
- 1:96861dcaec35
Added comment
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
haarkon | 0:db5358403ca6 | 1 | #include "mbed.h" |
haarkon | 1:96861dcaec35 | 2 | #include "CMPS03.h" |
haarkon | 0:db5358403ca6 | 3 | |
haarkon | 2:4dae0a194d00 | 4 | Serial pc (PA_2, PA_3, 921600); //Create a serial link to PC |
haarkon | 0:db5358403ca6 | 5 | |
haarkon | 2:4dae0a194d00 | 6 | DigitalOut led1 (PA_5); // Added Led1 for test purpose |
haarkon | 2:4dae0a194d00 | 7 | DigitalOut led2 (PD_2); // Added Led2 for test purpose |
haarkon | 2:4dae0a194d00 | 8 | DigitalOut disquette (PA_12); // Added baloon destructor command (without it, you might see baloon destructor motor be set to full speed) |
haarkon | 0:db5358403ca6 | 9 | |
haarkon | 2:4dae0a194d00 | 10 | CMPS03 boussole (PC_4); // Added compass |
haarkon | 0:db5358403ca6 | 11 | |
haarkon | 0:db5358403ca6 | 12 | int main() |
haarkon | 0:db5358403ca6 | 13 | { |
haarkon | 0:db5358403ca6 | 14 | |
haarkon | 2:4dae0a194d00 | 15 | pc.printf ("\nHelloWorld\n\r"); // Welcome message |
haarkon | 2:4dae0a194d00 | 16 | led1 = 1; // Led1 is ON |
haarkon | 2:4dae0a194d00 | 17 | led2 = 0; // Led2 is OFF |
haarkon | 2:4dae0a194d00 | 18 | disquette = 0; // Switch baloon destructor to OFF |
haarkon | 0:db5358403ca6 | 19 | |
haarkon | 0:db5358403ca6 | 20 | while(1) { |
haarkon | 2:4dae0a194d00 | 21 | pc.printf("\r%5.2lf", boussole.getBearing()); // Get bearing informations |
haarkon | 2:4dae0a194d00 | 22 | led1 = !led1; // Switch Led1 |
haarkon | 2:4dae0a194d00 | 23 | led2 = !led2; // Switch Led2 |
haarkon | 2:4dae0a194d00 | 24 | wait (0.2); // Wait for 200ms |
haarkon | 0:db5358403ca6 | 25 | } |
haarkon | 0:db5358403ca6 | 26 | } |