test

Dependencies:   mbed MMA8452Q

Fork of HelloWorld by Simon Ford

main.cpp

Committer:
kkalsi
Date:
2017-09-04
Revision:
24:0227ae0ad260
Parent:
23:262e3e171aaf
Child:
25:16a041dd21db

File content as of revision 24:0227ae0ad260:

#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


void UARTInit()
{
 uint16_t usFdiv;   
    
 // Power up the UART3 it's disabled on powerup.
 LPC_SC->PCONP       |=  (1 << 25);
 
  // Enable the pins on the device to use UART3 
 LPC_PINCON->PINSEL1 |= (3 << 18);   /* Pin P0.25 used as TXD0 (Com0) */
 LPC_PINCON->PINSEL1 |= (3 << 20);   /* Pin P0.26 used as RXD0 (Com0) */
    
 // Setup the PCLK for UART3
 LPC_SC->PCLKSEL1    &= ~(3 << 18); // Clean all to 0
 LPC_SC->PCLKSEL1    |=  (1 << 18); // PCLK = CCLK

 // Word select 8-bit character length and set DLAB
 LPC_UART3->LCR  =   0x83;  // 0000 0000 1000 0011

 usFdiv = (SystemCoreClock / (16*9600));
 LPC_UART3->DLM  =  usFdiv / 256;
 LPC_UART3->DLL  =   usFdiv % 256;

 //LPC_UART3->DLM  = ((SystemCoreClock / (16*9600))/256);
 //LPC_UART3->DLL  = ((SystemCoreClock / (16*9600))%256);

 // Enable and reset UART3 FIFOs.
 LPC_UART3->FCR       = 0x7;
 
  // Enable the interrupt
 // NVIC_EnableIRQ(UART3_IRQn);
 
 // Init the UART3 RX interrupt
 // LPC_UART3->IER = 0x01;

 // Clear DLAB
 LPC_UART3->LCR &= ~(1 << 7);
 
 //pc.printf("system clock : %d", SystemCoreClock);
}

char UART3Transmit(int out)
{
    LPC_UART3 -> THR = out;
    while(! (LPC_UART3->LSR & (0x01 << 0x06)));

    return 1;
}

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

        int X = x * 1000;
        int Y = y * 1000;
        int Z = z * 1000;

        int angle = (1000-(((2*X*X+2*Y*Y)*1000/(X*X+Y*Y+Z*Z))));
        
        pc.printf("avant acos = %d", angle);
        //float resultat = ((3.14/2.0) -( angle + (angle *angle * angle)/6.0 + (3*angle*angle*angle*angle*angle)/40.0))/2;
        float angleAcos = angle/1000.0;
        
        int resultat = 500*acos((angleAcos));
        pc.printf("valeur rad new= %d", resultat);
        int degree = resultat * 18000/31400;
        pc.printf("valeur deg new = %d", degree);
        //degree = degree * 10;
        int degreInt = degree;
        pc.printf("valeur deg new = %d", degreInt);
         
        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;
        }
         
        // Pour la communication UART
         UART3Transmit(0x76); // Clear display
         wait(0.1);
         UART3Transmit(0x77); // Decimal control command
         UART3Transmit(0x04);// Turn on decimal
         wait(0.1);
         UART3Transmit(digits[3]);
         wait(0.1);
         UART3Transmit(digits[2]);
         wait(0.1);
         UART3Transmit(digits[1]);
         wait(0.1);
         UART3Transmit(digits[0]);
         wait(0.1);
         
         // Pour la communication SPI
         /*
         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(p9,p10);
int main() {
    
    int nombre;
    pc.printf("Entrez un nombre de 4 chiffres : ");
    pc.scanf("%d", &nombre);
    pc.printf("Votre numero entrez est le : %d", nombre);
    //mc.printf(nombre);
    mc.putc(nombre);
}
 */


/*
DigitalOut myled(LED2);

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