Wajahat Abbas
gnss
Diff: gnss_operations.cpp
- Revision:
- 16:cb9861f0f4d8
- Parent:
- 14:4b22bd505b93
- Child:
- 18:7adca4350499
--- 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));