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
|
/*
* Copyright (C) 2016 The Android Open Source Project
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#define LOG_TAG "GnssHAL_GnssNavigationMessageInterface"
#include <log/log.h>
#include "GnssNavigationMessage.h"
namespace android {
namespace hardware {
namespace gnss {
namespace V1_0 {
namespace implementation {
sp<IGnssNavigationMessageCallback> GnssNavigationMessage::sGnssNavigationMsgCbIface = nullptr;
GpsNavigationMessageCallbacks GnssNavigationMessage::sGnssNavigationMessageCb = {
.size = sizeof(GpsNavigationMessageCallbacks),
.navigation_message_callback = nullptr,
.gnss_navigation_message_callback = gnssNavigationMessageCb
};
GnssNavigationMessage::GnssNavigationMessage(
const GpsNavigationMessageInterface* gpsNavigationMessageIface) :
mGnssNavigationMessageIface(gpsNavigationMessageIface) {}
void GnssNavigationMessage::gnssNavigationMessageCb(LegacyGnssNavigationMessage* message) {
if (sGnssNavigationMsgCbIface == nullptr) {
ALOGE("%s: GnssNavigation Message Callback Interface configured incorrectly", __func__);
return;
}
if (message == nullptr) {
ALOGE("%s, received invalid GnssNavigationMessage from GNSS HAL", __func__);
return;
}
IGnssNavigationMessageCallback::GnssNavigationMessage navigationMsg;
navigationMsg.svid = message->svid;
navigationMsg.type =
static_cast<IGnssNavigationMessageCallback::GnssNavigationMessageType>(message->type);
navigationMsg.status = message->status;
navigationMsg.messageId = message->message_id;
navigationMsg.submessageId = message->submessage_id;
navigationMsg.data.setToExternal(message->data, message->data_length);
auto ret = sGnssNavigationMsgCbIface->gnssNavigationMessageCb(navigationMsg);
if (!ret.isOk()) {
ALOGE("%s: Unable to invoke callback", __func__);
}
}
// Methods from ::android::hardware::gnss::V1_0::IGnssNavigationMessage follow.
Return<GnssNavigationMessage::GnssNavigationMessageStatus> GnssNavigationMessage::setCallback(
const sp<IGnssNavigationMessageCallback>& callback) {
if (mGnssNavigationMessageIface == nullptr) {
ALOGE("%s: GnssNavigationMessage not available", __func__);
return GnssNavigationMessageStatus::ERROR_GENERIC;
}
sGnssNavigationMsgCbIface = callback;
return static_cast<GnssNavigationMessage::GnssNavigationMessageStatus>(
mGnssNavigationMessageIface->init(&sGnssNavigationMessageCb));
}
Return<void> GnssNavigationMessage::close() {
if (mGnssNavigationMessageIface == nullptr) {
ALOGE("%s: GnssNavigationMessage not available", __func__);
} else {
mGnssNavigationMessageIface->close();
}
return Void();
}
} // namespace implementation
} // namespace V1_0
} // namespace gnss
} // namespace hardware
} // namespace android
|
