Fixed PacketDiagnostic

There was a bug in PacketDiagnostic::feedData(), where it would enter an infinite loop if the data ended partway through one of the float-type fields.

test_packets now seems to work continuously and correctly.
Merge branch 'master' of https://github.com/quadcopter5/quadcopter