Fixed several bugs.  Added rough telemetry parser.  Ready for flight test