.

Dependencies:   mbed tsi_sensor MMA8451Q

main.cpp

Committer:
Naza00
Date:
2020-05-12
Revision:
0:6c94c5ac5e8c
Child:
1:57b0bfa26afb

File content as of revision 0:6c94c5ac5e8c:

#include "mbed.h"
#include "MMA8451Q.h"

#define ESPERA 0
#define ORDEN 1
#define FIN 2

#define X 0
#define Y 1
#define Z 2
#define V 3
#define S 4

#if   defined (TARGET_KL25Z) || defined (TARGET_KL46Z)
  PinName const SDA = PTE25;
  PinName const SCL = PTE24;
#elif defined (TARGET_KL05Z)
  PinName const SDA = PTB4;
  PinName const SCL = PTB3;
#elif defined (TARGET_K20D50M)
  PinName const SDA = PTB1;
  PinName const SCL = PTB0;
#else
  #error TARGET NOT DEFINED
#endif
#define MMA8451_I2C_ADDRESS (0x1d<<1)

//Definimos que el puerto serie se llama pc
Serial pc(USBTX, USBRX);

//Variable donde se guarda lo leido
char   c = '\0';

//bit usado como flag para procesar datos
bool newdata = false;   //Se pone en true cuando hay nuevos datos


AnalogIn voltaje_entrada(PTC1);
DigitalIn entrada_digital(PTC7);

DigitalOut led1(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);

//Callback cuando se detecta una entrada
void onCharReceived(){
    
//Copiamos lo leido en c
    c = pc.getc();
    newdata = true;
}
 //Funciones
int acelerometro_x();
int acelerometro_y();
int acelerometro_z();
int adc();
int in_digital();
int lrc();

int estado=ESPERA;
float x,y,z;
int valor_x; //
int valor_y; // VALORES BIEN DEL ACELEROMETRO
int valor_z; //
unsigned int valor_adc;
float in_analog; //VALOR BIEN DE LA ENTRADA ANALOGICA
int valor_dig=0; // VALOR BIEN DE LA ENTRADA DIGITAL
int valor_analog;
char vector_respuesta[10]= {0};
int decena_valor_medido=0,unidad_valor_medido=0;
unsigned char valor_lrc=0;
int orden=0,a=0,j=0;

int main() {
    
    //Apagamos los leds
    led1 = 1;
    led2 = 1;
    led3 = 1;
    
    //Ejecutar onCharReceived por cada entrada por puerto
    pc.attach(&onCharReceived);
    
    while(true){
        if(newdata){
            newdata = false;
            switch(estado){
                
                case ESPERA:
                    if(c=='@'){
                        estado=ORDEN;
                        vector_respuesta[0]='@'; 
                        c = '\0';   
                    }
                break;
                
                case ORDEN:
                    switch(c){
                        
                        default:
                            estado = ESPERA;
                        break;
                            
                        case 'X':                        
                            acelerometro_x();
                            vector_respuesta[1]='X'; 
                            
                            vector_respuesta[2]=valor_x/10;
                            vector_respuesta[3]=valor_x - (vector_respuesta[2] * 10);
                            
                            a=vector_respuesta[2];
                            j=vector_respuesta[3];
                            orden='X';

                            lrc(); 
                            
                            if(c=='%'){
                                estado=FIN;    
                            }
                                                       
                            c = '\0';        
                        break; 
                        
                        case 'Y':
                            acelerometro_y();
                            vector_respuesta[1]='Y'; 
                            
                            vector_respuesta[2]=valor_y/10;
                            vector_respuesta[3]=valor_y - (vector_respuesta[2] * 10);
                            
                            a=vector_respuesta[2];
                            j=vector_respuesta[3];
                            orden='Y';
                            
                            lrc();
                            
                            if(c=='%'){
                                estado=FIN;    
                            }
                                                        
                            c = '\0';
                        break; 
                        
                        case 'Z':
                            acelerometro_z();
                            vector_respuesta[1]='Z'; 
                        
                            vector_respuesta[2]=valor_z/10;
                            vector_respuesta[3]=valor_z - (vector_respuesta[2] * 10);
                            
                            a=vector_respuesta[2];
                            j=vector_respuesta[3];
                            orden='Z';
                            
                            lrc();
                            
                            if(c=='%'){
                                estado=FIN;    
                            }
                            
                            c = '\0';
                        break; 
                        
                        case 'V':
                            adc();
                            vector_respuesta[1]='V'; 
                            
                            vector_respuesta[2]=valor_analog/10;
                            vector_respuesta[3]=valor_analog-(vector_respuesta[2]*10);
                            
                            a=vector_respuesta[2];
                            j=vector_respuesta[3];
                            orden='V';
                            
                            lrc();
                            wait_ms(250);
                            
                            if(c=='%'){
                                estado=FIN;    
                            }
                        
                            c = '\0';
                        break; 
                        
                        case 'S':
                            in_digital();
                            vector_respuesta[1]='S'; 
                            
                            vector_respuesta[2]=0;
                            vector_respuesta[3]=valor_dig;
                            a=0;
                            j=vector_respuesta[3];
                            orden='S';
                            
                            lrc();
                            wait_ms(250);
                            
                            if(c=='%'){
                                estado=FIN;    
                            }
                            
                            c = '\0';
                        break; 
                    
                        case '@':
                        break;   
                    }
                break;
                
                case FIN:
                    vector_respuesta[4]='%';
                    printf("\r\n%c%c%d%d%x%c",vector_respuesta[0],vector_respuesta[1],vector_respuesta[2],vector_respuesta[3],valor_lrc,vector_respuesta[4]);
                    estado=ESPERA;
                    c = '\0';
                break;
                            
            } //switch
       }// if newdata
    } //while
} //main


int acelerometro_x(){
    MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
    x = abs(acc.getAccX());
    wait(0.1f);
    valor_x=x*100;
    return valor_x;   
}

int acelerometro_y(){
    MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
    y = abs(acc.getAccY());
    wait(0.1f);
    valor_y=y*100;
    return valor_y;   
}

int acelerometro_z(){
    MMA8451Q acc(SDA, SCL, MMA8451_I2C_ADDRESS);
    z = abs(acc.getAccZ());
    wait(0.1f);
    valor_z=z*100;
    return valor_z;   
}

int adc(){
    valor_adc = voltaje_entrada.read_u16(); 
    in_analog = valor_adc * (3.3f / 65535.0f); 
    valor_analog = in_analog*10;
    return valor_analog;      
}

int in_digital(){
    if(entrada_digital==1)valor_dig=1;
    else valor_dig=0;
    
    return valor_dig;                
}

int lrc(){ 
    int inicio= '@';
    valor_lrc=0;
    valor_lrc ^= inicio;
    valor_lrc ^= orden;
    valor_lrc ^= (a + 48);
    valor_lrc ^= (j + 48);
    
    return valor_lrc;  
}