calculate
Dependencies: mbed X_NUCLEO_IKS01A3 Mahony_Algorithm
main.cpp@2:4cccdc792719, 2020-04-15 (annotated)
- Committer:
- zollecy1
- Date:
- Wed Apr 15 12:13:15 2020 +0000
- Revision:
- 2:4cccdc792719
- Parent:
- 1:48e219526d0f
- Child:
- 3:795998b31c32
.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
zollecy1 | 2:4cccdc792719 | 1 | /** |
zollecy1 | 0:313fbc3a198a | 2 | |**********************************************************************; |
zollecy1 | 0:313fbc3a198a | 3 | * Project : Projektarbeit Systemtechnik PES4 |
zollecy1 | 0:313fbc3a198a | 4 | * |
zollecy1 | 0:313fbc3a198a | 5 | * Program name : ................ |
zollecy1 | 0:313fbc3a198a | 6 | * |
zollecy1 | 0:313fbc3a198a | 7 | * Author : PES4 Team1 |
zollecy1 | 0:313fbc3a198a | 8 | * |
zollecy1 | 0:313fbc3a198a | 9 | * Team : **Team 1** |
zollecy1 | 0:313fbc3a198a | 10 | * Fabio Bernard |
zollecy1 | 0:313fbc3a198a | 11 | * Lukas Egli |
zollecy1 | 0:313fbc3a198a | 12 | * Matthias Ott |
zollecy1 | 0:313fbc3a198a | 13 | * Pascal Novacki |
zollecy1 | 0:313fbc3a198a | 14 | * Robin Wanner |
zollecy1 | 0:313fbc3a198a | 15 | * Vincent Vescoli |
zollecy1 | 0:313fbc3a198a | 16 | * Cyrill Zoller |
zollecy1 | 0:313fbc3a198a | 17 | * |
zollecy1 | 0:313fbc3a198a | 18 | * Date created : 20.02.2020 |
zollecy1 | 0:313fbc3a198a | 19 | * |
zollecy1 | 0:313fbc3a198a | 20 | * Purpose : Main |
zollecy1 | 0:313fbc3a198a | 21 | * |
zollecy1 | 0:313fbc3a198a | 22 | |**********************************************************************; |
zollecy1 | 0:313fbc3a198a | 23 | **/ |
zollecy1 | 0:313fbc3a198a | 24 | |
zollecy1 | 0:313fbc3a198a | 25 | #include "mbed.h" |
zollecy1 | 0:313fbc3a198a | 26 | #include "CalculateData.h" |
zollecy1 | 0:313fbc3a198a | 27 | |
zollecy1 | 0:313fbc3a198a | 28 | |
zollecy1 | 0:313fbc3a198a | 29 | //initialise DigitalIO |
zollecy1 | 0:313fbc3a198a | 30 | DigitalOut myled(LED1); |
zollecy1 | 0:313fbc3a198a | 31 | DigitalIn user_button(USER_BUTTON); |
zollecy1 | 0:313fbc3a198a | 32 | |
zollecy1 | 0:313fbc3a198a | 33 | |
zollecy1 | 0:313fbc3a198a | 34 | //Generate object |
zollecy1 | 0:313fbc3a198a | 35 | CalculateData calculate(D14, D15, D4, D5, A3, D6, A4); |
zollecy1 | 0:313fbc3a198a | 36 | |
zollecy1 | 1:48e219526d0f | 37 | int pos[3]; |
zollecy1 | 1:48e219526d0f | 38 | int speed[3]; |
zollecy1 | 1:48e219526d0f | 39 | int acc[3]; |
zollecy1 | 0:313fbc3a198a | 40 | |
zollecy1 | 0:313fbc3a198a | 41 | int main(){ |
zollecy1 | 0:313fbc3a198a | 42 | calculate.enable(); |
zollecy1 | 1:48e219526d0f | 43 | while(1){ |
zollecy1 | 1:48e219526d0f | 44 | calculate.run(); |
zollecy1 | 1:48e219526d0f | 45 | calculate.getAccelerometer(acc); |
zollecy1 | 1:48e219526d0f | 46 | calculate.getSpeed(speed); |
zollecy1 | 1:48e219526d0f | 47 | calculate.getPosition(pos); |
zollecy1 | 1:48e219526d0f | 48 | |
zollecy1 | 1:48e219526d0f | 49 | printf("\r\n----------\r\n\n"); |
zollecy1 | 1:48e219526d0f | 50 | printf("Accelerometer: \t%5.2f\t%5.2f\t%5.2f\r\n",(double)acc[0], (double)acc[1], (double)acc[2]); |
zollecy1 | 2:4cccdc792719 | 51 | printf("Speed: \t\t%5.2f\t%5.2f\t%5.2f\r\n",(double)speed[0], (double)speed[1], (double)speed[2]); |
zollecy1 | 2:4cccdc792719 | 52 | printf("pos: \t\t%5.2f\t%5.2f\t%5.2f\r\n%i",(double)pos[0], (double)pos[1], (double)pos[2], calculate.t); |
zollecy1 | 1:48e219526d0f | 53 | printf("\r\n----------\r\n\n"); |
zollecy1 | 2:4cccdc792719 | 54 | wait_ms(1000); |
zollecy1 | 1:48e219526d0f | 55 | } |
zollecy1 | 0:313fbc3a198a | 56 | } |
zollecy1 | 0:313fbc3a198a | 57 | |
zollecy1 | 0:313fbc3a198a | 58 |