tweaking the PID controller
completed the printf experiments; IMU compiles now