Implement new controller

Dependencies:   mbed-rtos mbed QEI BNO055 MPU6050_DMP_Nucleo-I2Cdev virgo3_imuHandler_Orion_PCB MAX17048 Servo

Fork of Orion_newPCB_test by Team Virgo v3

Revision:
5:099cb2e76c7d
Parent:
2:761e3c932ce0
--- a/02_Localization/localization.h	Wed Jan 20 04:01:37 2016 +0000
+++ b/02_Localization/localization.h	Mon Jan 25 07:28:40 2016 +0000
@@ -1,13 +1,15 @@
 #ifndef localization_H
 #define localization_H
 
+#include "mbed.h"
 #include "generalFunctions.h"
-#include "mbed.h"
+#include "config.h"
+
 
 class localization
 {
 public:
-    localization(float wheel_dia, float track_width);
+    localization();
     void getPosition(float *position_out[2], float heading, float revolutions[2]); //[x,y] position, heading in rad
     void setPosition(float position_in[2]); //[x,y] position