Matti Borchers / Mbed 2 deprecated mbed_amf_controlsystem

Dependencies:   mbed-rtos mbed

Revision:
13:34f7f783ad24
Parent:
0:8a6003b8bb5b
--- a/Periphery/SupportSystem.cpp	Thu Feb 04 21:43:08 2016 +0000
+++ b/Periphery/SupportSystem.cpp	Fri Feb 05 16:06:44 2016 +0000
@@ -137,6 +137,15 @@
 //
 //}
 
+void SupportSystem::writeImuConfig(float *config_register, size_t length) {
+    writeData(SUPPORT_SYSTEM_REGISTER_ADDRESS_IMU_CONVERSION_FACTOR, config_register, sizeof(float)*length);
+    
+    uint8_t command = 1<<2;
+    writeData(SUPPORT_SYSTEM_REGISTER_ADDRESS_IMU_COMMAND, &command, sizeof(uint8_t));
+    
+    wait(0.1);
+}
+
 
 IMU_RegisterDataBuffer_t *SupportSystem::getImuRegisterDataBuffer(){