test

Dependencies:   mbed MMA8452Q

Fork of HelloWorld by Simon Ford

main.cpp

Committer:
vincentlabbe
Date:
2017-08-31
Revision:
17:c463c5a434ec
Parent:
16:0b58c14b639d
Child:
18:171cb8d2f243

File content as of revision 17:c463c5a434ec:

#include "mbed.h"    
#include "MMA8452Q.h"

Serial pc(USBTX, USBRX); // tx, rx
SPI accel(p11,p12,p13);
DigitalOut cs(p14);
// Communication I2C
//I2C comI2C(p9,p10); // sda, scl

int main() {
    
     float x, y, z ;
 
     MMA8452Q acc(p9,p10,0x1d);     // acceleration object
 
     while (true) {       
         x = acc.getAccX() ;
         y = acc.getAccY() ;
         z = acc.getAccZ() ;
        // printf("X[%.2f] Y[%.2f] Z[%.2f]\n",x, y, z) ;
         wait(0.1);

        float angle = 1-(((2*x*x+2*y*y)/(x*x+y*y+z*z)));
        pc.printf("avant acos = %f", angle);
        //float resultat = ((3.14/2.0) -( angle + (angle *angle * angle)/6.0 + (3*angle*angle*angle*angle*angle)/40.0))/2;
        float resultat = acos(angle)/2.0;
        pc.printf("valeur rad new= %f", resultat);
        float degree = resultat * 18000.0/314.0;
        pc.printf("valeur deg new = %f", degree);
        degree = degree * 10;
        int degreInt = (int)degree;
        pc.printf("valeur deg new = %d", degreInt);
        
        
        float resultat2 = (3.14/2.0) -( z + (z *z * z)/6.0 + (3*z*z*z*z*z)/40.0);
        pc.printf("valeur rad old = %f", resultat2);
        float degree2 = resultat2 * 18000.0/314.0;
        pc.printf("valeur deg old = %f", degree2);
        degree2 = degree2 * 10;
        int degreInt2 = (int)degree;
        pc.printf("valeur deg old = %d", degreInt2);
         
        int rep;
         // extracting digits
        int digits[4] = {0,0,0,0};
        int i = 0;
        while(degreInt > 0) {
        rep = degreInt % 10; //to get the right most digit
        digits[i]=rep;
        pc.printf("digit %d = %d, degree int: %d", i, digits[i], degreInt);
        degreInt /= 10;              //reduce the number by one digit
        ++i;
        }
         
         cs = 0;
         accel.write(0x76); // Clear display
         cs = 1;
         wait(0.1);
         cs = 0;
         accel.write(0x77); // Decimal control command
         accel.write(0x04);// Turn on decimal
         cs = 1;
         wait(0.01);
         cs = 0;
         accel.write(digits[3]);
         cs = 1;
         wait(0.01);
         cs = 0;
         accel.write(digits[2]);
         cs = 1;
         wait(0.01);
         cs = 0;
         accel.write(digits[1]);
         cs = 1;
         wait(0.01);
         cs = 0;
         accel.write(digits[0]);
         cs = 1;
         wait(0.1);
        }
}


/* communication SPI 
Serial pc(USBTX, USBRX); // tx, rx
SPI acc(p11,p12,p13);
DigitalOut cs(p14);
int main() {
    while(1){
    int nombre = 0;
    pc.printf("Entrez un nombre de 4 chiffres : ");
    pc.scanf("%d", &nombre);
    pc.printf("Votre numero entrez est le : %d", nombre);
  
    cs = 0;
    acc.write(nombre);
    cs = 1;
    wait(0.2);
    cs = 0;
    wait(1);
    }
}*/
 /*
Serial pc(USBTX, USBRX); // tx, rx
Serial mc(p13,p14);
int main() {
    
    int nombre = 0;
    pc.printf("Entrez un nombre de 4 chiffres : ");
    pc.scanf("%d", &nombre);
    pc.printf("Votre numero entrez est le : %d", nombre);
    mc.printf(nombre);
}
 */


/*
DigitalOut myled(LED2);

int main() {
    while(1) {
        myled = 1;
        wait(0.2);
        myled = 0;
        wait(0.2);
    }
}
*/