Suad Suljic / Mbed OS Seismo2

se

Dependencies:   SDFileSystem circular_buffer MPU6050 SoftSerial

source/main.cpp@6:75ed671f455e, 2018-11-22 (annotated)

Committer:
suads
Date:
Thu Nov 22 17:50:31 2018 +0000
Revision:
6:75ed671f455e
Parent:
5:ea629a3fd6c1 
seismo;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
suads 5:ea629a3fd6c1 1 //#include <events/mbed_events.h>
OsmanKameric 0:a4de55cab4e2 2 #include <mbed.h>
OsmanKameric 0:a4de55cab4e2 3 #include "MPU6050.h"
OsmanKameric 4:147bbe6f9626 4 #include <string>
OsmanKameric 1:2cc1c9a45be7 5 #include <stdio.h>
OsmanKameric 4:147bbe6f9626 6
OsmanKameric 4:147bbe6f9626 7
OsmanKameric 4:147bbe6f9626 8
suads 5:ea629a3fd6c1 9 DigitalOut led(p25, 1);
suads 5:ea629a3fd6c1 10 MPU6050 mpu6050;
suads 5:ea629a3fd6c1 11 Serial pc(USBTX,USBRX);
OsmanKameric 4:147bbe6f9626 12
suads 5:ea629a3fd6c1 13 int main()
OsmanKameric 4:147bbe6f9626 14 {
suads 5:ea629a3fd6c1 15 pc.baud(115200);
suads 5:ea629a3fd6c1 16 pc.printf("START_1\n");
suads 5:ea629a3fd6c1 17 mpu6050.calibrate(accelBias, gyroBias);
suads 5:ea629a3fd6c1 18 mpu6050.initialize();
suads 5:ea629a3fd6c1 19 pc.printf("START_2\n");
suads 5:ea629a3fd6c1 20
suads 5:ea629a3fd6c1 21
suads 5:ea629a3fd6c1 22
suads 5:ea629a3fd6c1 23 /////////////////////////////////////////////////////////SERIAL////////////////////////////////////////////
suads 5:ea629a3fd6c1 24 while(0){
suads 5:ea629a3fd6c1 25 led = 0;
suads 5:ea629a3fd6c1 26 wait(1);
suads 5:ea629a3fd6c1 27 if(pc.readable()){
suads 5:ea629a3fd6c1 28 if(pc.getc()=='.'){
suads 5:ea629a3fd6c1 29 pc.putc(pc.getc());
suads 5:ea629a3fd6c1 30 led=1;
suads 5:ea629a3fd6c1 31 wait(1);
suads 5:ea629a3fd6c1 32 }
suads 5:ea629a3fd6c1 33 }
suads 5:ea629a3fd6c1 34
suads 5:ea629a3fd6c1 35 }
suads 5:ea629a3fd6c1 36
suads 5:ea629a3fd6c1 37 /////////////////////////////////////////////////////////SERIAL/////////////////////////////////////////////
suads 5:ea629a3fd6c1 38
suads 5:ea629a3fd6c1 39 /////////////////////////////////////////////////////////MPU6050////////////////////////////////////////////
suads 5:ea629a3fd6c1 40
suads 5:ea629a3fd6c1 41 while(0){
suads 5:ea629a3fd6c1 42 pc.printf("i am %d\n",mpu6050.getDeviceID());
suads 5:ea629a3fd6c1 43 wait(1);
suads 5:ea629a3fd6c1 44 }
suads 5:ea629a3fd6c1 45
suads 5:ea629a3fd6c1 46 /////////////////////////////////////////////////////////MPU6050/////////////////////////////////////////////
suads 5:ea629a3fd6c1 47
suads 5:ea629a3fd6c1 48
suads 5:ea629a3fd6c1 49
suads 5:ea629a3fd6c1 50 //////////////////////////////////////////////////////////////GET_DATA////////////////////////////////////////////
suads 5:ea629a3fd6c1 51 while(1){
suads 5:ea629a3fd6c1 52
OsmanKameric 4:147bbe6f9626 53 mpu6050.readAccelData(accelData);
OsmanKameric 4:147bbe6f9626 54 mpu6050.getAres();
OsmanKameric 4:147bbe6f9626 55 ax = accelData[0]*aRes - accelBias[0];
OsmanKameric 4:147bbe6f9626 56 ay = accelData[1]*aRes - accelBias[1];
OsmanKameric 4:147bbe6f9626 57 az = accelData[2]*aRes - accelBias[2];
OsmanKameric 4:147bbe6f9626 58 float accelValues[3] = {ax,ay,az};
OsmanKameric 4:147bbe6f9626 59 mpu6050.readGyroData(gyroData);
OsmanKameric 4:147bbe6f9626 60 mpu6050.getGres();
OsmanKameric 4:147bbe6f9626 61 gx = gyroData[0]*gRes - gyroBias[0];
OsmanKameric 4:147bbe6f9626 62 gy = gyroData[1]*gRes - gyroBias[1];
OsmanKameric 4:147bbe6f9626 63 gz = gyroData[2]*gRes - gyroBias[2];
OsmanKameric 4:147bbe6f9626 64 float gyroValues[3] = {gx,gy,gz};
suads 5:ea629a3fd6c1 65
suads 5:ea629a3fd6c1 66 if(pc.readable())
suads 5:ea629a3fd6c1 67 {
suads 5:ea629a3fd6c1 68 if(pc.getc()=='.'){
suads 5:ea629a3fd6c1 69
suads 5:ea629a3fd6c1 70 pc.printf("%f, ",gx);
suads 5:ea629a3fd6c1 71 pc.printf("%f, ",gy);
suads 5:ea629a3fd6c1 72 pc.printf("%f",gz);
suads 5:ea629a3fd6c1 73
OsmanKameric 4:147bbe6f9626 74 }
OsmanKameric 4:147bbe6f9626 75
OsmanKameric 4:147bbe6f9626 76 }
suads 5:ea629a3fd6c1 77
OsmanKameric 4:147bbe6f9626 78 }
OsmanKameric 4:147bbe6f9626 79 }