clean up before RTOS

clean the unnecessary variables, add chibiOS, delete the computing methods to dedicate this to the StateAnalyser
add mutex for data storage
delete all unused methods
inline constructor
inline init for constructor
uppercase variable names