bugfixes in UBX driver, emit new SNR, Jamming and noise count indices

This commit is contained in:
Lorenz Meier
2014-05-23 15:08:33 +02:00
parent 7bf1f82f61
commit c4d79b84b4
5 changed files with 62 additions and 9 deletions
+25
View File
@@ -226,6 +226,13 @@ UBX::configure(unsigned &baudrate)
return 1;
}
configure_message_rate(UBX_CLASS_MON, UBX_MESSAGE_MON_HW, 1);
if (wait_for_ack(UBX_CONFIG_TIMEOUT) < 0) {
warnx("MSG CFG FAIL: MON HW");
return 1;
}
_configured = true;
return 0;
}
@@ -566,6 +573,24 @@ UBX::handle_message()
break;
}
case UBX_CLASS_MON: {
switch (_message_id) {
case UBX_MESSAGE_MON_HW: {
struct gps_bin_mon_hw_packet *p = (struct gps_bin_mon_hw_packet*) _rx_buffer;
_gps_position->noise_per_ms = p->noisePerMS;
_gps_position->jamming_indicator = p->jamInd;
ret = 1;
break;
}
default:
break;
}
}
default:
break;
}