Team Virgo v3 / Orion_newPCB_test_LV

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

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers localization.h Source File

localization.h

00001 #ifndef localization_H
00002 #define localization_H
00003 
00004 #include "mbed.h"
00005 #include "generalFunctions.h"
00006 #include "config.h"
00007 
00008 
00009 class Localization
00010 {
00011 public:
00012     Localization();
00013     float position[2];
00014     void updatePosition(float heading, float wheel_revolutions[2]); //heading in rad
00015     void setPosition(float position_in[2]); //[x,y] position
00016     
00017 private:
00018     float prevRevolutions[2]; //store previous iteration's revolutions
00019     float wheelDia;
00020     float trackWidth;
00021     float incrementalDistance;
00022 };
00023 
00024 
00025 #endif