Alexander Posztos / Mbed 2 deprecated LabSK_Serial_Acc_FIltered

m3 accel

Dependencies:   MMA7660 mbed

Fork of Serial_HelloWorld_Mbed by mbed official

main.cpp@1:ad701230bd53, 2017-04-05 (annotated)

Committer:
PosztosAlex
Date:
Wed Apr 05 08:47:28 2017 +0000
Revision:
1:ad701230bd53
Parent:
0:879aa9d0247b 
m3 accel

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbed_official 0:879aa9d0247b 1 #include "mbed.h"
PosztosAlex 1:ad701230bd53 2 #include "MMA7660.h"
PosztosAlex 1:ad701230bd53 3
PosztosAlex 1:ad701230bd53 4 MMA7660 MMA(p28, p27);
mbed_official 0:879aa9d0247b 5 Serial pc(USBTX, USBRX); // tx, rx
PosztosAlex 1:ad701230bd53 6 DigitalOut led(LED1);
PosztosAlex 1:ad701230bd53 7 DigitalIn acc(p14);
mbed_official 0:879aa9d0247b 8
mbed_official 0:879aa9d0247b 9 int main() {
PosztosAlex 1:ad701230bd53 10 double x= 0,y=0,z=0;
PosztosAlex 1:ad701230bd53 11 double xr= 0,yr=0,zr=0;
PosztosAlex 1:ad701230bd53 12 int i; int n = 50;
mbed_official 0:879aa9d0247b 13 while(1) {
PosztosAlex 1:ad701230bd53 14
PosztosAlex 1:ad701230bd53 15 for(i = 0; i<n; i++)
PosztosAlex 1:ad701230bd53 16 {
PosztosAlex 1:ad701230bd53 17 x = x + MMA.x() ;
PosztosAlex 1:ad701230bd53 18 y = y + MMA.y() ;
PosztosAlex 1:ad701230bd53 19 z = z + MMA.z() ;
PosztosAlex 1:ad701230bd53 20 }
PosztosAlex 1:ad701230bd53 21 x = x / n;
PosztosAlex 1:ad701230bd53 22 y = y / n ;
PosztosAlex 1:ad701230bd53 23 z = z / n;
PosztosAlex 1:ad701230bd53 24 led=acc;
PosztosAlex 1:ad701230bd53 25 if(acc)
PosztosAlex 1:ad701230bd53 26 {
PosztosAlex 1:ad701230bd53 27 yr = y;
PosztosAlex 1:ad701230bd53 28 xr = x;
PosztosAlex 1:ad701230bd53 29 zr=z;
PosztosAlex 1:ad701230bd53 30 }
PosztosAlex 1:ad701230bd53 31
PosztosAlex 1:ad701230bd53 32 x -= xr;
PosztosAlex 1:ad701230bd53 33 y -= yr;
PosztosAlex 1:ad701230bd53 34 z -= zr;
PosztosAlex 1:ad701230bd53 35 pc.printf("%f,%f,%f\n",x,y,z);
PosztosAlex 1:ad701230bd53 36 wait_ms(5);
mbed_official 0:879aa9d0247b 37 }
mbed_official 0:879aa9d0247b 38 }