1 /*
2 * Copyright (c) 2021 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_syscall_adapter.h"
17 #include "hdf_log.h"
18 #include "hdf_sbuf.h"
19 #include "devsvc_manager_clnt.h"
20
21 #define HDF_LOG_TAG hdf_syscall_adapter
22
HdfSyscallAdapterDispatch(struct HdfObject * service,int cmdId,struct HdfSBuf * data,struct HdfSBuf * reply)23 int HdfSyscallAdapterDispatch (struct HdfObject *service, int cmdId, struct HdfSBuf *data, struct HdfSBuf *reply)
24 {
25 struct HdfIoService *ioService = (struct HdfIoService*)service;
26 struct HdfSyscallAdapter *adapter = NULL;
27
28 if (ioService == NULL || ioService->dispatcher == NULL) {
29 return HDF_ERR_INVALID_PARAM;
30 }
31
32 adapter = CONTAINER_OF(ioService, struct HdfSyscallAdapter, super);
33
34 if (adapter->client.device == NULL || adapter->client.device->service == NULL ||
35 adapter->client.device->service->Dispatch == NULL) {
36 return HDF_ERR_INVALID_OBJECT;
37 }
38
39 return adapter->client.device->service->Dispatch(&adapter->client, cmdId, data, reply);
40 }
41
HdfSyscallAdapterInstance(struct HdfDeviceObject * deviceObject)42 static struct HdfSyscallAdapter *HdfSyscallAdapterInstance(struct HdfDeviceObject *deviceObject)
43 {
44 struct HdfSyscallAdapter *adapter = NULL;
45
46 static struct HdfIoDispatcher kDispatcher = {
47 .Dispatch = HdfSyscallAdapterDispatch,
48 };
49
50 adapter = CONTAINER_OF(deviceObject, struct HdfSyscallAdapter, deviceObject);
51
52 if (adapter == NULL) {
53 return NULL;
54 }
55
56 DListHeadInit(&adapter->listenerList);
57 if (OsalMutexInit(&adapter->mutex)) {
58 HDF_LOGE("%s: Failed to create mutex", __func__);
59 OsalMemFree(adapter);
60 return NULL;
61 }
62
63 if (deviceObject == NULL) {
64 OsalMutexDestroy(&adapter->mutex);
65 OsalMemFree(adapter);
66 return NULL;
67 }
68
69 adapter->client.device = deviceObject;
70
71 if (deviceObject->service != NULL && deviceObject->service->Open != NULL) {
72 if (deviceObject->service->Open(&adapter->client) != HDF_SUCCESS) {
73 OsalMutexDestroy(&adapter->mutex);
74 OsalMemFree(adapter);
75 return NULL;
76 }
77 }
78
79 adapter->super.dispatcher = &kDispatcher;
80 return adapter;
81 }
82
HdfIoServiceAdapterObtain(const char * serviceName)83 struct HdfIoService *HdfIoServiceAdapterObtain(const char *serviceName)
84 {
85 struct HdfSyscallAdapter *adapter = NULL;
86 struct HdfDeviceObject *deviceObject = NULL;
87
88 int ret;
89
90 if (serviceName == NULL) {
91 return NULL;
92 }
93
94 ret = HdfLoadDriverByServiceName(serviceName);
95 if (ret != HDF_SUCCESS) {
96 HDF_LOGE("%s: load %s driver failed", __func__, serviceName);
97 return NULL;
98 }
99
100 deviceObject = DevSvcManagerClntGetDeviceObject(serviceName);
101 if (deviceObject == NULL) {
102 return NULL;
103 }
104
105 adapter = HdfSyscallAdapterInstance(deviceObject);
106 if (adapter == NULL) {
107 return NULL;
108 }
109
110 return &adapter->super;
111 }
112
HdfIoServiceAdapterRecycle(struct HdfIoService * ioService)113 void HdfIoServiceAdapterRecycle(struct HdfIoService *ioService)
114 {
115 struct HdfSyscallAdapter *adapter = NULL;
116
117 if (ioService == NULL) {
118 return;
119 }
120
121 adapter = CONTAINER_OF(ioService, struct HdfSyscallAdapter, super);
122 if (adapter->client.device != NULL && adapter->client.device->service != NULL &&
123 adapter->client.device->service->Release != NULL) {
124 adapter->client.device->service->Release(&adapter->client);
125 }
126
127 OsalMutexDestroy(&adapter->mutex);
128 }
129
AddListenerToAdapterLocked(struct HdfSyscallAdapter * adapter,struct HdfDevEventlistener * listener)130 static bool AddListenerToAdapterLocked(struct HdfSyscallAdapter *adapter, struct HdfDevEventlistener *listener)
131 {
132 struct HdfDevEventlistener *it = NULL;
133 DLIST_FOR_EACH_ENTRY(it, &adapter->listenerList, struct HdfDevEventlistener, listNode) {
134 if (it == listener) {
135 HDF_LOGE("Add a listener for duplicate dev-event");
136 return false;
137 }
138 }
139 DListInsertTail(&listener->listNode, &adapter->listenerList);
140 return true;
141 }
142
HdfDeviceRegisterEventListener(struct HdfIoService * target,struct HdfDevEventlistener * listener)143 int32_t HdfDeviceRegisterEventListener(struct HdfIoService *target, struct HdfDevEventlistener *listener)
144 {
145 if (target == NULL || listener == NULL) {
146 return HDF_ERR_INVALID_PARAM;
147 }
148
149 if (listener->callBack == NULL && listener->onReceive == NULL) {
150 HDF_LOGE("Listener onReceive func not implemented");
151 return HDF_ERR_INVALID_OBJECT;
152 }
153
154 struct HdfSyscallAdapter *adapter = CONTAINER_OF(target, struct HdfSyscallAdapter, super);
155
156 OsalMutexLock(&adapter->mutex);
157 if (!AddListenerToAdapterLocked(adapter, listener)) {
158 OsalMutexUnlock(&adapter->mutex);
159 return HDF_ERR_INVALID_PARAM;
160 }
161 OsalMutexUnlock(&adapter->mutex);
162 return HDF_SUCCESS;
163 }
164
HdfDeviceUnregisterEventListener(struct HdfIoService * target,struct HdfDevEventlistener * listener)165 int32_t HdfDeviceUnregisterEventListener(struct HdfIoService *target, struct HdfDevEventlistener *listener)
166 {
167 if (target == NULL || listener == NULL) {
168 return HDF_ERR_INVALID_PARAM;
169 }
170
171 if (listener->listNode.next == NULL || listener->listNode.prev == NULL) {
172 HDF_LOGE("%s: broken listener, may double unregister", __func__);
173 return HDF_ERR_INVALID_OBJECT;
174 }
175
176 struct HdfSyscallAdapter *adapter = CONTAINER_OF(target, struct HdfSyscallAdapter, super);
177 OsalMutexLock(&adapter->mutex);
178 DListRemove(&listener->listNode);
179 OsalMutexUnlock(&adapter->mutex);
180 return HDF_SUCCESS;
181 }
182
HdfDeviceSendEvent(const struct HdfDeviceObject * deviceObject,uint32_t id,const struct HdfSBuf * data)183 int32_t HdfDeviceSendEvent(const struct HdfDeviceObject *deviceObject, uint32_t id, const struct HdfSBuf *data)
184 {
185 const struct HdfSyscallAdapter *adapter = NULL;
186
187 if (deviceObject == NULL || data == NULL) {
188 return HDF_ERR_INVALID_PARAM;
189 }
190
191 struct HdfDeviceObject *inputDriverObject = GetHdfDeviceObject();
192
193 if (inputDriverObject == NULL) {
194 return HDF_ERR_NOT_SUPPORT;
195 }
196
197 if (deviceObject == inputDriverObject) {
198 adapter = CONTAINER_OF(deviceObject, struct HdfSyscallAdapter, deviceObject);
199 struct HdfDevEventlistener *listener = NULL;
200 DLIST_FOR_EACH_ENTRY(listener, &adapter->listenerList, struct HdfDevEventlistener, listNode) {
201 OsalMutexLock(&adapter->mutex);
202 if (listener->onReceive != NULL) {
203 (void)listener->onReceive(listener, &adapter->super, id, data);
204 } else if (listener->callBack != NULL) {
205 (void)listener->callBack(listener->priv, id, data);
206 }
207 OsalMutexUnlock(&adapter->mutex);
208 }
209 }
210 return HDF_SUCCESS;
211 }
212