Domenico Vitale / Mbed 2 deprecated Accelerometro

Dependencies:   mbed

main.cpp

Committer:
domemort
Date:
2021-11-02
Revision:
0:e9410807b683

File content as of revision 0:e9410807b683:

#include "mbed.h"

SPI           acc(D11, D12, D13);
DigitalOut    cs(D7);

Serial        pc(USBTX, USBRX);
char          buffer[6];
int16_t       data[3];
float         x,y,z;

int main(){
    cs=1;
    acc.format(8,3);
    acc.frequency(2000000);
    cs=0;
    acc.write(0x31);
    acc.write(0x0B);
    cs=1;
    cs=0;
    acc.write(0x2D);
    acc.write(0x08);
    cs=1;
       while (1){
         wait(1);
         cs=0;
         acc.write(0x80|0x40|0x32);
         for (int i=0; i<=5; i++){
             buffer[i]=acc.write(0x00);
             }
    cs=1;
    data[0] = buffer[1]<<8 | buffer[0];
    data[1] = buffer[3]<<8 | buffer[2];
    data[2] = buffer[5]<<8 | buffer[4];
    x = 0.004*data[0]; 
    y = 0.004*data[1];
    z = 0.004*data[2];
    
    pc.printf("ax=%1.2fg\t  ay=%1.2fg\t az=%1.2fg\n\r", x, y, z);
      }
}