Mouse reader and stuff
Particle filter convergence monitoring
Read mouse sensor
Speed up serial baudrate and buffering
Setup proper delay and initial clock trigger
Updated with real map and reference generation implementation
Style fixes
Updated imu initialization
Some initialization stuff