Fix to ps3walk because armadillo
Improved the error reporting for servos
Added a small attempt to fix bad gyroscope values, need to check out what's up with the cm730