Diff: main.cpp

Revision:

1:92e66f3dbb78

Parent:

0:2c03c9f00e49

--- a/main.cpp	Fri Feb 19 09:52:24 2016 +0000
+++ b/main.cpp	Tue Feb 23 08:49:02 2016 +0000
@@ -1,18 +1,42 @@
 #include "mbed.h"
 
-PwmOut mypwm(PWM_OUT);
-
-DigitalOut myled(LED1);
-
+#include "LSM6DS3.h"
+#include "LSM6DS3_Types.h"
+#include "LSM6DS3_Registers.h"
+/*
+SPI device(SPI_MOSI, SPI_MISO, SPI_SCK);
+DigitalOut cs(SPI_CS);
+//DigitalOut led(LED1);
 int main() {
-    
-    mypwm.period_ms(10);
-    mypwm.pulsewidth_ms(1);
-  
-    printf("pwm set to %.2f %%\n", mypwm.read() * 100);
-    
-    while(1) {
-        myled = !myled;
-        wait(1);
+   int i = 0;
+   while(1) {
+       //device.write(0x55);
+       cs = 0;
+       device.write(i++);
+       //device.write(0xE0);
+       cs = 1;
+       //led = !led;
+       wait_us(50);
+   }
+}*/
+
+LSM6DS3 sensor(SPI_MODE, SPI_SCK);
+Serial pc(USBTX,USBRX);
+int main()
+{
+    if( sensor.begin() != 0 ) {
+        pc.printf("Problem starting the sensor with CS @ Pin PB_6.\r\n");
+    } else {
+        pc.printf("Sensor with CS @ Pin PB_6 started.\r\n");
     }
-}
+    sensor.setOffset(-141, 154, 82, 38, -79, -28);
+    while(true) {
+        float data_array[12];
+
+        data_array[0]  = sensor.readRawAccelX();
+        data_array[1]  = sensor.readRawAccelY();
+        data_array[8]  = sensor.readRawGyroZ();
+        pc.printf("Accel X: %d\r\n", data_array[8]);
+
+    }
+}
\ No newline at end of file