Initial

Fix alot a shit

Fix jar file

Added angular with correction

Fix main IMU

Fix main IMU

Added Temp

Fix some log stuff
(cherry picked from commit 85d8d0b)

Fix repos