Diff: main.cpp

Revision:

11:c16a53584668

Parent:

4:81cea7a352b0

diff -r 3e42ca878d11 -r c16a53584668 main.cpp
--- a/main.cpp	Sun Jan 17 03:25:27 2016 +0000
+++ b/main.cpp	Wed Apr 13 12:34:56 2016 +0000
@@ -1,12 +1,86 @@
-#include "mbed.h"
+#include<mbed.h>
+
+uint16_t x_a,y_a,z_a;
+bool flag = 0;
+
+SPI spi_master(P0_6,P0_5,P0_7); //mosi miso sclk 
+DigitalOut cs(P0_4);
+
+//Serial pc(P0_23,P0_25);
+
+Serial pc(P0_9,P0_11);
 
-DigitalOut myled(LED1);
+uint8_t LIS3DH_SPI_RD(uint8_t addr)
+{
+    uint8_t  temp;
+    cs = 0;
+    wait_us(10);
+    spi_master.write(addr);      
+    temp=spi_master.write(0xff);
+    wait_us(10);
+    cs = 1;
+    return temp;
+}
+
+void LIS3DH_SPI_WR(uint8_t addr,uint8_t wrdata)
+{  
+    cs = 0;
+    wait_us(10);
+    spi_master.write(addr);
+    spi_master.write(wrdata);
+    wait_us(10);
+    cs = 1;
+}
 
-int main() {
-    while(1) {
-        myled = 1;
-        wait(0.2);
-        myled = 0;
-        wait(0.2);
+void SPI_LIS3DH_Init()
+{
+   spi_master.format(8,3);
+   spi_master.frequency(100000);
+   wait_ms(5);
+   LIS3DH_SPI_WR(0x24,0x80);
+   wait_ms(5);
+   LIS3DH_SPI_WR(0x20,0x17);
+   LIS3DH_SPI_WR(0x23,0x80);
+}
+
+void get_val(void)
+{
+    uint8_t Dx_L=1,Dy_L=1,Dz_L=1;
+    uint8_t Dx_H=1,Dy_H=1,Dz_H=1;
+    if(LIS3DH_SPI_RD(0x0f|0x80)==0x33)
+    {
+         printf("check device ok!\r\n");
+         flag=1;
+         Dx_H=LIS3DH_SPI_RD(0x29|0x80);   
+         Dx_L=LIS3DH_SPI_RD(0x28|0x80);
+         Dy_H=LIS3DH_SPI_RD(0x2b|0x80);
+         Dy_L=LIS3DH_SPI_RD(0x2A|0x80);
+         Dz_H=LIS3DH_SPI_RD(0x2d|0x80);
+         Dz_L=LIS3DH_SPI_RD(0x2C|0x80);  
     }
+    else
+    { 
+        printf("check device err!\r\n");
+        wait(1);
+    }
+    x_a=Dx_H<<8|Dx_L/16;
+    y_a=Dy_H<<8|Dy_L/16;
+    z_a=Dz_H<<8|Dz_L/16;
 }
+
+int main(void)
+{
+  SPI_LIS3DH_Init();
+  while(1)
+  {  
+     get_val();
+     if(flag)
+     {
+         printf("Dx=:%d\r\n",x_a);
+         printf("Dy=:%d\r\n",y_a);
+         printf("Dz=:%d\r\n",z_a);
+         flag=0;
+         wait(1);
+     }
+  }
+}