curr firmware working with MLX/IMU and controller.cpp to process new IMU readings