1 /*
2 * Copyright (c) 2022 Huawei Device Co., Ltd.
3 * Licensed under the Apache License, Version 2.0 (the "License");
4 * you may not use this file except in compliance with the License.
5 * You may obtain a copy of the License at
6 *
7 * http://www.apache.org/licenses/LICENSE-2.0
8 *
9 * Unless required by applicable law or agreed to in writing, software
10 * distributed under the License is distributed on an "AS IS" BASIS,
11 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 * See the License for the specific language governing permissions and
13 * limitations under the License.
14 */
15
16 #include <hdf_base.h>
17 #include <hdf_device_desc.h>
18 #include "motion_uhdf_log.h"
19 #include <hdf_sbuf_ipc.h>
20 #include "v1_1/motion_interface_stub.h"
21
22 using namespace OHOS::HDI::Motion::V1_1;
23
24 struct HdfMotionInterfaceHost {
25 struct IDeviceIoService ioService;
26 OHOS::sptr<OHOS::IRemoteObject> stub;
27 };
28
MotionInterfaceDriverDispatch(struct HdfDeviceIoClient * client,int cmdId,struct HdfSBuf * data,struct HdfSBuf * reply)29 static int32_t MotionInterfaceDriverDispatch(struct HdfDeviceIoClient *client, int cmdId, struct HdfSBuf *data,
30 struct HdfSBuf *reply)
31 {
32 auto *hdfMotionInterfaceHost = CONTAINER_OF(client->device->service, struct HdfMotionInterfaceHost, ioService);
33
34 OHOS::MessageParcel *dataParcel = nullptr;
35 OHOS::MessageParcel *replyParcel = nullptr;
36 OHOS::MessageOption option;
37
38 if (SbufToParcel(data, &dataParcel) != HDF_SUCCESS) {
39 HDF_LOGE("%{public}s:invalid data sbuf object to dispatch", __func__);
40 return HDF_ERR_INVALID_PARAM;
41 }
42 if (SbufToParcel(reply, &replyParcel) != HDF_SUCCESS) {
43 HDF_LOGE("%{public}s:invalid reply sbuf object to dispatch", __func__);
44 return HDF_ERR_INVALID_PARAM;
45 }
46
47 if (hdfMotionInterfaceHost == nullptr) {
48 HDF_LOGE("%{public}s:hdfMotionInterfaceHost is nullptr", __func__);
49 return HDF_ERR_INVALID_PARAM;
50 }
51 if (hdfMotionInterfaceHost->stub == nullptr) {
52 HDF_LOGE("%{public}s:hdfMotionInterfaceHost->stub is nullptr", __func__);
53 return HDF_ERR_INVALID_PARAM;
54 }
55
56 return hdfMotionInterfaceHost->stub->SendRequest(cmdId, *dataParcel, *replyParcel, option);
57 }
58
HdfMotionInterfaceDriverInit(struct HdfDeviceObject * deviceObject)59 static int32_t HdfMotionInterfaceDriverInit(struct HdfDeviceObject *deviceObject)
60 {
61 (void)deviceObject;
62 HDF_LOGI("HdfMotionInterfaceDriverInit enter");
63 return HDF_SUCCESS;
64 }
65
HdfMotionInterfaceDriverBind(struct HdfDeviceObject * deviceObject)66 static int32_t HdfMotionInterfaceDriverBind(struct HdfDeviceObject *deviceObject)
67 {
68 HDF_LOGI("HdfMotionInterfaceDriverBind enter");
69
70 auto *hdfMotionInterfaceHost = new (std::nothrow) HdfMotionInterfaceHost;
71 if (hdfMotionInterfaceHost == nullptr) {
72 HDF_LOGE("%{public}s: failed to create create HdfMotionInterfaceHost object", __func__);
73 return HDF_FAILURE;
74 }
75
76 hdfMotionInterfaceHost->ioService.Dispatch = MotionInterfaceDriverDispatch;
77 hdfMotionInterfaceHost->ioService.Open = NULL;
78 hdfMotionInterfaceHost->ioService.Release = NULL;
79
80 auto serviceImpl = OHOS::HDI::Motion::V1_1::IMotionInterface::Get(true);
81 if (serviceImpl == nullptr) {
82 HDF_LOGE("%{public}s: failed to get of implement service", __func__);
83 delete hdfMotionInterfaceHost;
84 return HDF_FAILURE;
85 }
86
87 hdfMotionInterfaceHost->stub = OHOS::HDI::ObjectCollector::GetInstance().GetOrNewObject(serviceImpl,
88 OHOS::HDI::Motion::V1_1::IMotionInterface::GetDescriptor());
89 if (hdfMotionInterfaceHost->stub == nullptr) {
90 HDF_LOGE("%{public}s: failed to get stub object", __func__);
91 delete hdfMotionInterfaceHost;
92 return HDF_FAILURE;
93 }
94
95 deviceObject->service = &hdfMotionInterfaceHost->ioService;
96 return HDF_SUCCESS;
97 }
98
HdfMotionInterfaceDriverRelease(struct HdfDeviceObject * deviceObject)99 static void HdfMotionInterfaceDriverRelease(struct HdfDeviceObject *deviceObject)
100 {
101 HDF_LOGI("HdfMotionInterfaceDriverRelease enter");
102 auto *hdfMotionInterfaceHost = CONTAINER_OF(deviceObject->service, struct HdfMotionInterfaceHost, ioService);
103 delete hdfMotionInterfaceHost;
104 hdfMotionInterfaceHost = nullptr;
105 }
106
107 static struct HdfDriverEntry g_motioninterfaceDriverEntry = {
108 .moduleVersion = 1,
109 .moduleName = "motion_service",
110 .Bind = HdfMotionInterfaceDriverBind,
111 .Init = HdfMotionInterfaceDriverInit,
112 .Release = HdfMotionInterfaceDriverRelease,
113 };
114
115 #ifdef __cplusplus
116 extern "C" {
117 #endif /* __cplusplus */
118 HDF_INIT(g_motioninterfaceDriverEntry);
119 #ifdef __cplusplus
120 }
121 #endif /* __cplusplus */
122