1 files changed, 129 insertions, 0 deletions
diff --git a/enhanced-position-service/test/enhanced-position-client.cpp b/enhanced-position-service/test/enhanced-position-client.cpp
new file mode 100644
index 0000000..6b9e00a
--- /dev/null
+++ b/enhanced-position-service/test/enhanced-position-client.cpp
@@ -0,0 +1,129 @@
+/**************************************************************************
+* @licence app begin@
+*
+* SPDX-License-Identifier: MPL-2.0
+*
+* \ingroup EnhancedPositionService
+* \author Marco Residori <marco.residori@xse.de>
+*
+* \copyright Copyright (C) 2014, XS Embedded GmbH
+* 
+* \license
+* This Source Code Form is subject to the terms of the
+* Mozilla Public License, v. 2.0. If a copy of the MPL was not distributed with
+* this file, You can obtain one at http://mozilla.org/MPL/2.0/.
+*
+* @licence end@
+**************************************************************************/
+
+#include <signal.h>
+#include <stdio.h>
+
+#include "enhanced-position-client.h"
+#include "positioning-constants.h"
+#include "log.h"
+
+using namespace std;
+DBus::BusDispatcher dispatcher;
+DBus::DefaultTimeout *timeout;
+
+DLT_DECLARE_CONTEXT(gCtx);
+
+EnhancedPositionClient::EnhancedPositionClient(DBus::Connection &connection, const char *path, const char *name)
+  : DBus::ObjectProxy(connection, path, name)
+{
+}
+
+void EnhancedPositionClient::PositionUpdate(const std::vector< uint16_t >& changedValues)
+{
+  LOG_INFO_MSG(gCtx,"Position Update");
+  
+  // retrieve the data 
+  std::map< uint16_t, ::DBus::Variant > posData = GetData(changedValues);
+
+  for (int i = 0; i < changedValues.size(); i++)
+  {
+    if (changedValues[i] == POS_LATITUDE)
+    {
+      LOG_INFO(gCtx,"LAT=%lf", posData[POS_LATITUDE].reader().get_double());
+    }
+
+    if (changedValues[i] == POS_LONGITUDE)
+    {
+      LOG_INFO(gCtx,"LON=%lf", posData[POS_LONGITUDE].reader().get_double());
+    }
+
+    if (changedValues[i] == POS_ALTITUDE)
+    {
+      LOG_INFO(gCtx,"ALT=%d", posData[POS_ALTITUDE].reader().get_int32());
+    }
+
+    if (changedValues[i] == POS_SPEED)
+    {
+      LOG_INFO(gCtx,"SPEED=%lf", posData[POS_SPEED].reader().get_double());
+    }
+
+    if (changedValues[i] == POS_CLIMB)
+    {
+      LOG_INFO(gCtx,"CLIMB=%d", posData[POS_CLIMB].reader().get_int32());
+    }
+
+    if (changedValues[i] == POS_HEADING)
+    {
+      LOG_INFO(gCtx,"HEADING=%d", posData[POS_HEADING].reader().get_int32());
+    }
+  }
+
+}
+
+void EnhancedPositionClient::RotationRateUpdate(const std::vector< uint16_t >& changedValues)
+{
+  LOG_INFO_MSG(gCtx,"RotationRateUpdate");
+}
+
+void EnhancedPositionClient::AccuracyUpdate(const std::vector< uint16_t >& changedValues)
+{
+  LOG_INFO_MSG(gCtx,"AccuracyUpdate");
+}
+
+void EnhancedPositionClient::SatelliteInfoUpdate(const std::vector< uint16_t >& changedValues)
+{
+  LOG_INFO_MSG(gCtx,"SatelliteInfoUpdate");
+}
+
+void EnhancedPositionClient::StatusUpdate(const std::vector< uint16_t >& changedValues)
+{
+  LOG_INFO_MSG(gCtx,"StatusUpdate");
+}
+
+void signalhandler(int sig)
+{
+  LOG_INFO_MSG(gCtx,"Signal received");
+  dispatcher.leave();
+}
+
+int main()
+{
+  DLT_REGISTER_APP("ENHPOS", "EnhancedPositionClient");
+  DLT_REGISTER_CONTEXT(gCtx,"EPCL", "Global Context");
+
+  LOG_INFO_MSG(gCtx,"starting EnhancedPositionClient...");
+
+  signal(SIGTERM, signalhandler);
+  signal(SIGINT, signalhandler);
+
+  DBus::default_dispatcher = &dispatcher;
+
+  // increase DBus-C++ frequency
+  new DBus::DefaultTimeout(100, false, &dispatcher);
+
+  DBus::Connection conn = DBus::Connection::SessionBus();
+
+  EnhancedPositionClient client(conn, "/org/genivi/positioning/EnhancedPosition",
+                                "org.genivi.positioning.EnhancedPosition");
+
+  // dispatch
+  dispatcher.enter();
+
+  return 0;
+}