X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fdrivers%2Fao_gps_ublox.c;h=077698a90d514a24672b3d990d867118a1c67a9c;hp=8676a670fd86a092bdaf5fcdd8d7b8220ab92ac3;hb=af782e92c6a0c0a6b0fc2fa52519749a88ca8fb8;hpb=8b488bdd0f5c91be7e5aae1c8f0193e713734b14

diff --git a/src/drivers/ao_gps_ublox.c b/src/drivers/ao_gps_ublox.c
index 8676a670..077698a9 100644
--- a/src/drivers/ao_gps_ublox.c
+++ b/src/drivers/ao_gps_ublox.c
@@ -600,6 +600,14 @@ static const uint8_t ublox_enable_nav[] = {
 	UBLOX_NAV_TIMEUTC
 };
 
+void
+ao_gps_set_rate(uint8_t rate)
+{
+	uint8_t	i;
+	for (i = 0; i < sizeof (ublox_enable_nav); i++)
+		ao_ublox_set_message_rate(UBLOX_NAV, ublox_enable_nav[i], rate);
+}
+
 void
 ao_gps(void) __reentrant
 {
@@ -616,8 +624,7 @@ ao_gps(void) __reentrant
 		ao_ublox_set_message_rate(UBLOX_NAV, ublox_disable_nav[i], 0);
 
 	/* Enable all of the messages we want */
-	for (i = 0; i < sizeof (ublox_enable_nav); i++)
-		ao_ublox_set_message_rate(UBLOX_NAV, ublox_enable_nav[i], 1);
+	ao_gps_set_rate(1);
 
 	ao_ublox_set_navigation_settings((1 << UBLOX_CFG_NAV5_MASK_DYN) | (1 << UBLOX_CFG_NAV5_MASK_FIXMODE),
 					 UBLOX_CFG_NAV5_DYNMODEL_AIRBORNE_4G,