more little fixes

1 files changed, 11 insertions, 0 deletions

diff --git a/driver_proto.c b/driver_proto.c
index 8f645d42..8736ed8c 100644
--- a/driver_proto.c
+++ b/driver_proto.c
@@ -321,6 +321,17 @@ static bool _proto__set_speed(struct gps_device_t *session, speed_t speed)
  */
 static void _proto__set_mode(struct gps_device_t *session, int mode)
 {
+    if (mode == MODE_NMEA) {
+	// _proto__to_nmea(session->gpsdata.gps_fd,session->gpsdata.baudrate); /* send the mode switch control string */
+	session->gpsdata.driver_mode = 0;	/* NMEA */
+	(void)gpsd_switch_driver(session, "Generic NMEA");
+    } else {
+	session->back_to_nmea = false;
+	session->gpsdata.driver_mode = 1;	/* binary */
+    }
+}
+
+{
     if (mode == 0) {
 	set_mode(session, session->gpsdata.baudrate);
 	session->gpsdata.driver_mode = 0;