Add barebones, untested, and almost certainly UNSAFE MudPi controller class.
Try to make that slightly better for the camera yaw.
That is a little saner.
Disable xbees entirely for the moment.