Removed debugging message.
Fixed bugs in how PID values are handled in the flight controller.