calculate

Dependencies:   mbed X_NUCLEO_IKS01A3 Mahony_Algorithm

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?

UserRevisionLine numberNew 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