"VNERR" does not match beginning of message_to_send, so have to prevent it from returning due to the string compare. Also must prevent exiting the decode before the sentence has completed so that we can go on to print the error code term.
Fix bug preventing disabling of ASCII measurements
Instead of snprintf the command to message_to_send then executing run_command, allow run_command to accept a string and format spec
Add check to ensure message_to_send is greater than length 6 before attempting to read past 6
* This catches when there's a mismatch of GPSx_TYPE and EAHRS_SENSORS
when GPS is enabled
* Before this pre-arm, failure to set GPS_TYPE2 to 21 (ExternalAHRS)
resulted in silent rejection of the data in AP_GPS because the default
is off
* And fix a little logging bug
Signed-off-by: Ryan Friedman <ryanfriedman5410+github@gmail.com>