Bug fix to TelemetryPacket constructor
CommandPacketQueue class
TelemetryPacketQueue class