1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
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;
}
|
