lye cypher / Mbed 2 deprecated ESeif-SSD541-HW141

3 axis accel

Dependencies:   MMA8451Q SLCD_minus_mod mbed

Fork of ACC_LCD_341_Basic by Stanley Cohen

acc_341.cpp@3:c5291c70af48, 2016-11-05 (annotated)

Committer:
scohennm
Date:
Sat Nov 05 23:46:00 2016 +0000
Revision:
3:c5291c70af48
Parent:
2:6003ed409def
Child:
4:1d559bac561a
Added negative sign for display and updated data interval.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
scohennm 0:203b4129a213 1 #include "mbed.h"
scohennm 3:c5291c70af48 2 #include <math.h>
scohennm 0:203b4129a213 3 #include "MMA8451Q.h"
scohennm 0:203b4129a213 4 #include "SLCD.h"
scohennm 0:203b4129a213 5
scohennm 0:203b4129a213 6 /*
scohennm 0:203b4129a213 7 Test of the accelerometer, digital I/O, on-board LCD screen.
scohennm 0:203b4129a213 8 Looing at vector product of the x-y components of the accelerometer.
scohennm 0:203b4129a213 9 Works pretty well. Still rough, program wise - sc 140710
scohennm 0:203b4129a213 10 */
scohennm 0:203b4129a213 11
scohennm 3:c5291c70af48 12 #define DATAINTERVAL 0.200
scohennm 0:203b4129a213 13
scohennm 3:c5291c70af48 14 #define PROGNAME "ACCLCD341-541\r\n"
scohennm 0:203b4129a213 15
scohennm 0:203b4129a213 16 #define PRINTDBUG
scohennm 2:6003ed409def 17 //
scohennm 0:203b4129a213 18 #if defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
scohennm 2:6003ed409def 19 PinName const SDA = PTE25; // Data pins for the accelerometer/magnetometer.
scohennm 2:6003ed409def 20 PinName const SCL = PTE24; // DO NOT CHANGE
scohennm 0:203b4129a213 21 #elif defined (TARGET_KL05Z)
scohennm 0:203b4129a213 22 PinName const SDA = PTB4;
scohennm 0:203b4129a213 23 PinName const SCL = PTB3;
scohennm 0:203b4129a213 24 #else
scohennm 0:203b4129a213 25 #error TARGET NOT DEFINED
scohennm 0:203b4129a213 26 #endif
scohennm 0:203b4129a213 27
scohennm 0:203b4129a213 28 #define MMA8451_I2C_ADDRESS (0x1d<<1)
scohennm 0:203b4129a213 29
scohennm 0:203b4129a213 30 SLCD slcd; //define LCD display
scohennm 0:203b4129a213 31
scohennm 0:203b4129a213 32 MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
scohennm 0:203b4129a213 33 Serial pc(USBTX, USBRX);
scohennm 3:c5291c70af48 34 Timer dataTimer;
scohennm 0:203b4129a213 35
scohennm 2:6003ed409def 36
scohennm 0:203b4129a213 37
scohennm 3:c5291c70af48 38 void LCDMess(char *lMess){
scohennm 0:203b4129a213 39 slcd.Home();
scohennm 0:203b4129a213 40 slcd.clear();
scohennm 0:203b4129a213 41 slcd.printf(lMess);
scohennm 0:203b4129a213 42 }
scohennm 3:c5291c70af48 43 void initialize_global_vars(){
scohennm 3:c5291c70af48 44 pc.printf(PROGNAME);
scohennm 3:c5291c70af48 45 dataTimer.start();
scohennm 3:c5291c70af48 46 dataTimer.reset();
scohennm 3:c5291c70af48 47 }
scohennm 0:203b4129a213 48
scohennm 0:203b4129a213 49 int main() {
scohennm 0:203b4129a213 50 float xAcc;
scohennm 3:c5291c70af48 51 float yAcc;
scohennm 0:203b4129a213 52 char lcdData[10]; //buffer needs places dor decimal pt and colon
scohennm 0:203b4129a213 53
scohennm 3:c5291c70af48 54 initialize_global_vars();
scohennm 0:203b4129a213 55 // main loop forever
scohennm 0:203b4129a213 56 while(true) {
scohennm 3:c5291c70af48 57 if(dataTimer.read() > DATAINTERVAL){
scohennm 3:c5291c70af48 58 dataTimer.reset();
scohennm 0:203b4129a213 59 //Get accelerometer data - tilt angles minus offset for zero mark.
scohennm 3:c5291c70af48 60 xAcc = acc.getAccX();
scohennm 3:c5291c70af48 61 yAcc = acc.getAccY();
scohennm 0:203b4129a213 62
scohennm 0:203b4129a213 63 #ifdef PRINTDBUG
scohennm 1:9340a340e588 64 pc.printf("xAcc = %f\r\n", xAcc);
scohennm 1:9340a340e588 65 pc.printf("yAcc = %f\r\n", yAcc);
scohennm 0:203b4129a213 66 #endif
scohennm 0:203b4129a213 67
scohennm 3:c5291c70af48 68 sprintf (lcdData,"%3.2f",xAcc);
scohennm 3:c5291c70af48 69 if (xAcc < 0) sprintf (lcdData,">%3.2f",fabs(xAcc));
scohennm 3:c5291c70af48 70 LCDMess(lcdData);
scohennm 0:203b4129a213 71 // Wait then do the whole thing again.
scohennm 3:c5291c70af48 72 }
scohennm 0:203b4129a213 73 }
scohennm 0:203b4129a213 74 }