ok

Dependencies:   MMA8451Q SLCD mbed

Fork of ACC_LCD_341_all_axies by Stanley Cohen

acc_all_axies.cpp

Committer:
menchacaeli
Date:
2016-12-02
Revision:
6:88a2bae825ae
Parent:
5:9e4173e23e05

File content as of revision 6:88a2bae825ae:

#include "mbed.h"
#include <math.h>
//#include <tgmath.h>
#include <stdio.h> 
#include "MMA8451Q.h"
#include "SLCD.h"


#define NUMAXES 3
#define XAXIS 0
#define YAXIS 1
#define ZAXIS 2
#define NUMBUTS 2
#define LBUT PTC12  // port addresses for buttons
#define RBUT PTC3
#define BUTTONTIME 0.200
#define DATAINTERVAL 0.200
#define LCDWAIT  1.5
#define LCDDATALEN 10
#define PI 3.14159265

#define PROGNAME "ACC_LCD_all_axes_v1\r\n"

#define PRINTDBUG
// 
#if   defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
  PinName const SDA = PTE25;  // Data pins for the accelerometer/magnetometer.
  PinName const SCL = PTE24;  // DO NOT CHANGE
#elif defined (TARGET_KL05Z)
  PinName const SDA = PTB4;
  PinName const SCL = PTB3;
#else
  #error TARGET NOT DEFINED
#endif

#define MMA8451_I2C_ADDRESS (0x1d<<1)

SLCD slcd; //define LCD display
char lcdData[LCDDATALEN]; //buffer needs places dor decimal pt and colon
int currentAxis = XAXIS; // xaxis

MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
Serial pc(USBTX, USBRX);
Timer dataTimer;
Timer ButtonTimer; // for reading button states
DigitalIn buttons[NUMBUTS] = {RBUT, LBUT}; // set up buttons

char axisName[NUMAXES][LCDDATALEN] = {"<X<","<Y<", "<Z<"};   

void LCDMess(char *lMess){
        slcd.Home();
        slcd.clear();
        slcd.printf(lMess);
} 

void LCDsignedFloat(float theNumber){
    sprintf (lcdData," %3.0d",theNumber); 
    // changed SLCD.cpp to interpret < as -
    if (theNumber < 0.0) sprintf (lcdData,"<%3.0d",fabs(theNumber));   
    LCDMess(lcdData); 
} 

void LCDsignedAngle(float theAngle){
    sprintf (lcdData," %2.0f@",theAngle); 
    // changed SLCD.cpp to interpret @ as superscript 0 (degrees)
    if (theAngle < 0.0) sprintf (lcdData,"<%2.0f@",fabs(theAngle));   
    LCDMess(lcdData); 
}

void initialize_global_vars(){
    pc.printf(PROGNAME);
    // set up DAQ timers
    ButtonTimer.start();
    ButtonTimer.reset();
    dataTimer.start();
    dataTimer.reset(); 
    LCDMess(axisName[currentAxis]);  
    wait(LCDWAIT);  
    
} 

int main() {
    int i; // loop index
    float axisValue[NUMAXES]; // set up an array of axis values
    int buttonSum = 0;
   
    initialize_global_vars();
// main loop forever 
    while(true) {
        while (ButtonTimer > BUTTONTIME){ //Use a while instead of an if 
            buttonSum = 0; // Note
            buttonSum = !buttons[0] + !buttons[1];
            if (buttonSum != 0) {
                currentAxis = (currentAxis + 1 ) % NUMAXES; 
                                                        // Cycle through the 
                                                        // Axis with modulus
                                                        // to reset back to zero
                LCDMess(axisName[currentAxis]);  
                wait(LCDWAIT);           
            }// for loop to look at buttons
            ButtonTimer.reset(); // Make sure you reset the timer or..
                                // Groundhog Day.
        }
        while (dataTimer.read() > DATAINTERVAL){
            dataTimer.reset();             
            axisValue[XAXIS] = acc.getAccX();
            axisValue[YAXIS] = acc.getAccY(); 
            axisValue[ZAXIS] = acc.getAccZ();     
#ifdef PRINTDBUG
            for (i=0; i< NUMAXES;i++){
                pc.printf("Acc %d = %f@\r\n",i, axisValue[i]);
            }
#endif      
            //axisRead = axisValue[currentAxis];
            LCDsignedAngle(axisValue[currentAxis]);
       }
    }
}