fahim alavi / gnss

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependents:   example-gnss

Fork of gnss by u-blox

Diff: gnss_operations.cpp

Revision:
15:cb9861f0f4d8
Parent:
13:4b22bd505b93
Child:
17:7adca4350499
diff -r 105cf3ca48c9 -r cb9861f0f4d8 gnss_operations.cpp
--- a/gnss_operations.cpp	Tue Jul 24 16:02:21 2018 +0500
+++ b/gnss_operations.cpp	Wed Aug 01 13:14:52 2018 +0500
@@ -1,5 +1,11 @@
 #include "gnss_operations.h"
 
+#ifndef UBLOX_WEARABLE_FRAMEWORK
+#define SEND_LOGGING_MESSAGE printf
+#else
+#include "MessageView.h"
+#endif
+
 #define FIRST_BYTE 0x000000FF
 #define SECOND_BYTE 0x0000FF00
 #define THIRD_BYTE 0x00FF0000
@@ -27,14 +33,13 @@
 		length = GnssSerial::sendUbx(0x06, 0x01, enable_ubx_nav_pvt, sizeof(enable_ubx_nav_pvt));
 		if(length >= (int)(sizeof(enable_ubx_nav_pvt) + UBX_FRAME_SIZE))
 		{
-			printf("UBX-NAV-PVT was enabled\r\n");
-			printf("\r\nmessage length: %i\r\n\r\n", length);
+			SEND_LOGGING_MESSAGE("UBX-NAV-PVT was enabled\r\n");
 			wait(5);
 			break;
 		}
 		else
 		{
-			printf("enabling UBX-NAV-PVT...\r\n");
+			SEND_LOGGING_MESSAGE("enabling UBX-NAV-PVT...\r\n");
 			conf = conf - 1;
 		}
 	}
@@ -61,14 +66,13 @@
 			length = GnssSerial::sendUbx(0x06, 0x01, enable_ubx_nav_pvt, sizeof(enable_ubx_nav_pvt));
 			if(length >= (int)(sizeof(enable_ubx_nav_pvt) + UBX_FRAME_SIZE))
 			{
-				printf("UBX-NAV-PVT was disabled\r\n");
-				printf("\r\nmessage length: %i\r\n\r\n", length);
+				SEND_LOGGING_MESSAGE("UBX-NAV-PVT was disabled\r\n");
 				wait(5);
 				break;
 			}
 			else
 			{
-				printf("disabling UBX-NAV-PVT...\r\n");
+				SEND_LOGGING_MESSAGE("disabling UBX-NAV-PVT...\r\n");
 				conf = conf - 1;
 			}
 		}
@@ -92,13 +96,13 @@
 		length = GnssSerial::sendUbx(0x06, 0x24, ubx_cfg_nav5, sizeof(ubx_cfg_nav5));
 		if(length >= (int)(sizeof(ubx_cfg_nav5) + UBX_FRAME_SIZE))
 		{
-			printf("ubx_cfg_nav5 was enabled\r\n");
+			SEND_LOGGING_MESSAGE("ubx_cfg_nav5 was enabled\r\n");
 			wait(5);
 			break;
 		}
 		else
 		{
-			printf("enabling ubx_cfg_nav5...\r\n");
+			SEND_LOGGING_MESSAGE("enabling ubx_cfg_nav5...\r\n");
 			conf = conf - 1;
 		}
 	}
@@ -125,13 +129,13 @@
 		length = GnssSerial::sendUbx(0x06, 0x1E, ubx_cfg_odo, sizeof(ubx_cfg_odo));
 		if(length >= (int)(sizeof(ubx_cfg_odo) + UBX_FRAME_SIZE))
 		{
-			printf("UBX-ODO was enabled\r\n");
+			SEND_LOGGING_MESSAGE("UBX-ODO was enabled\r\n");
 			wait(5);
 			break;
 		}
 		else
 		{
-			printf("enabling UBX-ODO...\r\n");
+			SEND_LOGGING_MESSAGE("enabling UBX-ODO...\r\n");
 			conf = conf - 1;
 		}
 	}
@@ -152,13 +156,13 @@
 		length = GnssSerial::sendUbx(0x06, 0x1E, ubx_cfg_odo, sizeof(ubx_cfg_odo));
 		if(length >= (int)(sizeof(ubx_cfg_odo) + UBX_FRAME_SIZE))
 		{
-			printf("UBX-ODO was disabled\r\n");
+			SEND_LOGGING_MESSAGE("UBX-ODO was disabled\r\n");
 			wait(5);
 			break;
 		}
 		else
 		{
-			printf("disabling UBX-ODO...\r\n");
+			SEND_LOGGING_MESSAGE("disabling UBX-ODO...\r\n");
 			conf = conf - 1;
 		}
 	}
@@ -183,13 +187,13 @@
 		length = GnssSerial::sendUbx(0x06, 0x01, ubx_nav_odo, sizeof(ubx_nav_odo));
 		if(length >= (int)(sizeof(ubx_nav_odo) + UBX_FRAME_SIZE))
 		{
-			printf("UBX-NAV-ODO was enabled\r\n");
+			SEND_LOGGING_MESSAGE("UBX-NAV-ODO was enabled\r\n");
 			wait(5);
 			break;
 		}
 		else
 		{
-			printf("enabling UBX-NAV-ODO...\r\n");
+			SEND_LOGGING_MESSAGE("enabling UBX-NAV-ODO...\r\n");
 			conf = conf - 1;
 		}
 	}
@@ -215,13 +219,13 @@
 		length = GnssSerial::sendUbx(0x06, 0x01, ubx_nav_odo, sizeof(ubx_nav_odo));
 		if(length >= (int)(sizeof(ubx_nav_odo) + UBX_FRAME_SIZE))
 		{
-			printf("UBX-NAV-ODO was disabled\r\n");
+			SEND_LOGGING_MESSAGE("UBX-NAV-ODO was disabled\r\n");
 			wait(5);
 			break;
 		}
 		else
 		{
-			printf("disabling UBX-NAV-ODO...\r\n");
+			SEND_LOGGING_MESSAGE("disabling UBX-NAV-ODO...\r\n");
 			conf = conf - 1;
 		}
 	}
@@ -245,13 +249,13 @@
 		length = GnssSerial::sendUbx(0x06, 0x93, enable_ubx_log_batch, sizeof(enable_ubx_log_batch));
 		if(length >= (int)(sizeof(enable_ubx_log_batch) + UBX_FRAME_SIZE))
 		{
-			printf("UBX_LOG_BATCH was enabled\r\n");
+			SEND_LOGGING_MESSAGE("UBX_LOG_BATCH was enabled\r\n");
 			wait(5);
 			break;
 		}
 		else
 		{
-			printf("enable ubx_batch_log...\r\n");
+			SEND_LOGGING_MESSAGE("enable ubx_batch_log...\r\n");
 			conf = conf - 1;
 		}
 	}
@@ -274,13 +278,13 @@
 		length = GnssSerial::sendUbx(0x06, 0x93, enable_ubx_log_batch, sizeof(enable_ubx_log_batch));
 		if(length >= (int)(sizeof(enable_ubx_log_batch) + UBX_FRAME_SIZE))
 		{
-			printf("UBX_LOG_BATCH was enabled\r\n");
+			SEND_LOGGING_MESSAGE("UBX_LOG_BATCH was enabled\r\n");
 			wait(5);
 			break;
 		}
 		else
 		{
-			printf("enable ubx_batch_log...\r\n");
+			SEND_LOGGING_MESSAGE("enable ubx_batch_log...\r\n");
 			conf = conf - 1;
 		}
 	}
@@ -315,7 +319,7 @@
  *
  *
  */
-int GnssOperations::cfg_power_mode(int power_mode)
+int GnssOperations::cfg_power_mode(Powermodes power_mode)
 {
 	int length = 0;
 	unsigned char semi_continuous_pms[] = {0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
@@ -342,6 +346,7 @@
 	switch (power_mode)
 	{
 	case SEMI_CONTINOUS:
+		SEND_LOGGING_MESSAGE("Configuring SEMI_CONTINOUS");
 		length = GnssSerial::sendUbx(0x06, 0x86, semi_continuous_pms, sizeof(semi_continuous_pms));
 		wait(5);
 		length = GnssSerial::sendUbx(0x06, 0x3B, semi_continuous_pm2, sizeof(semi_continuous_pm2));
@@ -350,6 +355,7 @@
 		break;
 
 	case AGGRESSIVE_CONTINUOS:
+		SEND_LOGGING_MESSAGE("Configuring AGGRESSIVE_CONTINUOS");
 		length = GnssSerial::sendUbx(0x06, 0x86, aggresive_continuous_pms, sizeof(aggresive_continuous_pms));
 		wait(5);
 		length = GnssSerial::sendUbx(0x06, 0x3B, aggresive_continuous_pm2, sizeof(aggresive_continuous_pm2));
@@ -358,6 +364,7 @@
 		break;
 
 	case CONSERVATIVE_CONTINOUS:
+		SEND_LOGGING_MESSAGE("Configuring CONSERVATIVE_CONTINOUS");
 		length = GnssSerial::sendUbx(0x06, 0x86, conservative_continuous_pms, sizeof(conservative_continuous_pms));
 		wait(5);
 		length = GnssSerial::sendUbx(0x06, 0x3B, conservative_continuous_pm2, sizeof(conservative_continuous_pm2));
@@ -366,6 +373,7 @@
 		break;
 
 	case FULL_POWER:
+		SEND_LOGGING_MESSAGE("Configuring FULL_POWER");
 		length = GnssSerial::sendUbx(0x06, 0x86, full_power_pms, sizeof(full_power_pms));
 		wait(5);
 		length = GnssSerial::sendUbx(0x06, 0x08, full_power_rate, sizeof(full_power_rate));