calculate

Dependencies:   mbed X_NUCLEO_IKS01A3 Mahony_Algorithm

main.cpp

Committer:
zollecy1
Date:
2020-05-01
Revision:
6:4641f2b2684b
Parent:
4:7d13076ecece

File content as of revision 6:4641f2b2684b:

            /**
|**********************************************************************;
* Project           : Projektarbeit Systemtechnik PES4
*
* Program name      : ................
*
* Author            : PES4 Team1
*
* Team              : **Team 1**
*                     Fabio Bernard
*                     Lukas Egli
*                     Matthias Ott
*                     Pascal Novacki
*                     Robin Wanner
*                     Vincent Vescoli
*                     Cyrill Zoller
*
* Date created      : 20.02.2020
*
* Purpose           : Main
*
|**********************************************************************;
**/

#include "mbed.h"
#include "CalculateData.h"
#include "Liste.h"


//initialise DigitalIO
DigitalOut myled(LED1);
DigitalIn user_button(USER_BUTTON);


//Generate object
CalculateData calculate(D14, D15, D4, D5, A3, D6, A4);





int main(){
    Liste myList;
    calculate.enable();
    while(1){    
        /*
        calculate.getValue(&myList);
        printf("\t\tX\t\tY\t\tZ\r\n");
        printf("ACC:\t\t%f\t%f\t%f\r\n", myList.accX, myList.accY, myList.accZ);
        printf("SPEED:\t\t%f\t%f\t%f\r\n", myList.speedX, myList.speedY, myList.speedZ);
        printf("POS:\t\t%f\t%f\t%f\r\n", myList.posX, myList.posY, myList.posZ);
        printf("\r\n\r\n-------------------------\r\n\r\n\r\n");
        */calculate.update();
        Thread::wait(100);
    }
}