Cleanups, Stabilization, Housekeeping

Particularly, fixed the communication timeout issue. Also added the max_altitude parameter (meters).
We also now populate the angular velocity and linear acceleration of the IMU message (yay\!).