Diff: behaviour.cpp

Revision:

4:99891561a38b

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/behaviour.cpp	Fri May 25 09:00:15 2018 +0000
@@ -0,0 +1,89 @@
+#include "mbed.h"
+#include "LSM6DSLSensor.h"
+#include "accgyro.h"
+
+DigitalOut led4(LED4);
+int32_t BEHAVIOUR_gyro_x;
+int32_t BEHAVIOUR_gyro_y;
+int32_t BEHAVIOUR_gyro_z;
+int32_t BEHAVIOUR_acc_x;
+int32_t BEHAVIOUR_acc_y;
+int32_t BEHAVIOUR_acc_z;
+
+EventQueue BEHAVIOUR_queue;
+
+void BEHAVIOUR_acc_x_set(int32_t temp)
+{
+    BEHAVIOUR_acc_x = temp;
+}
+
+void BEHAVIOUR_acc_y_set(int32_t temp)
+{
+    BEHAVIOUR_acc_y = temp;
+}
+
+void BEHAVIOUR_acc_z_set(int32_t temp)
+{
+    BEHAVIOUR_acc_z = temp;
+}
+
+int32_t BEHAVIOUR_acc_x_get()
+{
+    return BEHAVIOUR_acc_x;
+}
+
+int32_t BEHAVIOUR_acc_y_get()
+{
+    return BEHAVIOUR_acc_y;
+}
+
+int32_t BEHAVIOUR_acc_z_get()
+{
+    return BEHAVIOUR_acc_z;
+}
+
+void BEHAVIOUR_gyro_x_set(int32_t temp)
+{
+    BEHAVIOUR_gyro_x = temp;
+}
+
+void BEHAVIOUR_gyro_y_set(int32_t temp)
+{
+    BEHAVIOUR_gyro_y = temp;
+}
+
+void BEHAVIOUR_gyro_z_set(int32_t temp)
+{
+    BEHAVIOUR_gyro_z = temp;
+}
+
+int32_t BEHAVIOUR_gyro_x_get()
+{
+    return BEHAVIOUR_gyro_x;
+}
+
+int32_t BEHAVIOUR_gyro_y_get()
+{
+    return BEHAVIOUR_gyro_y;
+}
+
+int32_t BEHAVIOUR_gyro_z_get()
+{
+    return BEHAVIOUR_gyro_z;
+}
+
+void BEHAVIOUR_task()
+{
+    //printf("GYRO_x:        %6ld\r\n", BEHAVIOUR_gyro_x/1000);
+    //printf("GYRO_y:        %6ld\r\n", BEHAVIOUR_gyro_y/2000);
+    //printf("GYRO_z:        %6ld\r\n", BEHAVIOUR_gyro_z/2000);
+    //printf("ACC_x:        %6ld\r\n", BEHAVIOUR_acc_x);
+    //printf("ACC_y:        %6ld\r\n", BEHAVIOUR_acc_y/(160*6));
+    //printf("ACC_z:        %6ld\r\n", BEHAVIOUR_acc_z/(160*6));
+}
+
+void BEHAVIOUR_init()
+{
+    BEHAVIOUR_queue.call_every(100, BEHAVIOUR_task);
+    BEHAVIOUR_queue.dispatch();    
+}