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
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
|
#include "dbus_server_navigationcore.h"
#include <QDebug>
#include <QDBusVariant>
#include <QDBusConnectionInterface>
#include <QGeoCoordinate>
dbus_server_navigationcore::dbus_server_navigationcore(QObject *parent) :
m_pathName("org.agl.naviapi"),
m_objName("/org/genivi/navicore"),
m_serverName("mapmatchedposition"),
m_object(parent)
{
setupDBus();
setupApi();
}
dbus_server_navigationcore::~dbus_server_navigationcore(){
QDBusConnection::sessionBus().unregisterObject(m_objName);
}
void dbus_server_navigationcore::setupDBus()
{
qDBusRegisterMetaType<qPositionPairElm>();
qDBusRegisterMetaType<qPosition>();
qDBusRegisterMetaType<qValuesToReturn>();
qDBusRegisterMetaType<qWaypointsList>();
qDBusRegisterMetaType<qSessionsListElm>();
qDBusRegisterMetaType<qSessionsList>();
if (!QDBusConnection::sessionBus().registerService(m_pathName))
qDebug() << m_serverName << "registerService() failed";
if (!QDBusConnection::sessionBus().registerObject(m_objName, this))
qDebug() << m_serverName << "registerObject() failed";
new MapMatchedPositionAdaptor(this);
new RoutingAdaptor(this);
new SessionAdaptor(this);
}
void dbus_server_navigationcore::setupApi(){
if(!QObject::connect(this,SIGNAL(doPauseSimulation()),
m_object,SLOT(doPauseSimulationSlot()))) {
qDebug() << m_serverName << "cppSIGNAL:doPauseSimulation to qmlSLOT:doPauseSimulationSlot connect is failed";
}
}
// Method
qPosition dbus_server_navigationcore::GetPosition(const qValuesToReturn &valuesToReturn){
double Latitude =0;
double Longitude =0;
qPosition result;
qPositionPairElm Pair_1,Pair_2;
QVariant m_Variant = m_object->property("currentpostion");
if(m_Variant.canConvert<QGeoCoordinate>()){
QGeoCoordinate coordinate = m_Variant.value<QGeoCoordinate>();
Latitude = coordinate.latitude();
Longitude = coordinate.longitude();
}
for(int i = 0; i < valuesToReturn.size(); i++){
switch(valuesToReturn[i]){
case 160:
Pair_1.key = 160;
Pair_1.value = QDBusVariant(Latitude);
result.insert(160,Pair_1);
break;
case 161:
Pair_2.key = 161;
Pair_2.value = QDBusVariant(Longitude);
result.insert(161,Pair_2);
break;
default:
break;
}
}
return result;
}
void dbus_server_navigationcore::PauseSimulation(uint sessionHandle){
qDebug() << m_serverName << sessionHandle << "call PauseSimulation";
emit doPauseSimulation();
return;
}
void dbus_server_navigationcore::SetSimulationMode(uint sessionHandle, bool activate){
qDebug() << m_serverName << sessionHandle << activate << "call SetSimulationMode";
return;
}
void dbus_server_navigationcore::CalculateRoute(uint sessionHandle, uint routeHandle){
qDebug() << m_objName << sessionHandle << routeHandle << "call dbus_server_routing";
return;
}
void dbus_server_navigationcore::CancelRouteCalculation(uint sessionHandle, uint routeHandle){
qDebug() << m_objName << sessionHandle << routeHandle << "call CancelRouteCalculation";
return;
}
uint dbus_server_navigationcore::CreateRoute(uint sessionHandle){
qDebug() << m_objName << sessionHandle << "call CreateRoute";
QVariant returnvalue;
uint result;
// call qml function
if(!QMetaObject::invokeMethod(m_object,"doGetAllRoutesSlot",Q_RETURN_ARG(QVariant, returnvalue)))
qDebug() << m_objName << "invokeMethod doGetAllRoutesSlot failed.";
// we only manage 1 route for now
result = (uint)returnvalue.toInt();
return result;
}
qRoutesList dbus_server_navigationcore::GetAllRoutes(){
qDebug() << m_objName << "call GetAllRoutes";
QVariant returnvalue;
qRoutesList result;
// call qml function
if(!QMetaObject::invokeMethod(m_object,"doGetAllRoutesSlot",Q_RETURN_ARG(QVariant, returnvalue)))
qDebug() << m_objName << "invokeMethod doGetAllRoutesSlot failed.";
// we only manage 1 route for now
int ret = returnvalue.toInt();
if(ret == 1){
result.append(ret);
}
return result;
}
void dbus_server_navigationcore::SetWaypoints(uint sessionHandle, uint routeHandle, bool startFromCurrentPosition, qWaypointsList waypointsList){
qDebug() << m_objName << sessionHandle << routeHandle << startFromCurrentPosition << "call SetWaypoints";
double Latitude =0;
double Longitude =0;
// analize waypointlist only manage 1 waypoint
for(int i = 0; i < 1; i++){
QMap<int32_t,qPositionPairElm>::const_iterator itr = waypointsList[i].constBegin();
while(itr != waypointsList[i].constEnd()){
switch(itr.key()){
case 160:
Latitude = itr.value().value.variant().toDouble();
itr++;
break;
case 161:
Longitude = itr.value().value.variant().toDouble();
itr++;
break;
default:
break;
}
}
}
// call qml function
if(!QMetaObject::invokeMethod(m_object,"doSetWaypointsSlot",Q_ARG(QVariant, Latitude),Q_ARG(QVariant, Longitude),Q_ARG(QVariant, startFromCurrentPosition)))
qDebug() << m_objName << "invokeMethod doSetWaypointsSlot failed.";
return;
}
qSessionsList dbus_server_navigationcore::GetAllSessions(){
qDebug() << m_objName << "call GetAllSessions";
qSessionsList result;
qSessionsListElm element;
element.key = 1;
element.value = "dummy";
result.append(element);
return result;
}
|
