1 /*
2 * Copyright (c) 2021-2023 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 "usbfn_dev_mgr.h"
17 #include "hdf_base.h"
18 #include "hdf_log.h"
19 #include "osal_thread.h"
20 #include "osal_time.h"
21 #include "securec.h"
22 #include "usbfn_cfg_mgr.h"
23 #include "usbfn_io_mgr.h"
24 #include "usbd_wrapper.h"
25
26 #define HDF_LOG_TAG usbfn_dev_mgr
27 #define SLEEP_TIME_OUT 100
28 #define SLEEP_TIMES 20
29
30 static struct DListHead g_devEntry = {0};
31 static uint32_t g_intfCnt = 0;
32 static uint32_t g_epCnt = 1;
33 static uint32_t g_fnCntOld = 0;
GetInterfaceInfo(const struct UsbInterfaceDescriptor * intf,struct UsbFnDeviceMgr * devMgr,uint32_t fnCnt,const struct UsbFnConfiguration * config)34 static void GetInterfaceInfo(const struct UsbInterfaceDescriptor *intf, struct UsbFnDeviceMgr *devMgr, uint32_t fnCnt,
35 const struct UsbFnConfiguration *config)
36 {
37 if (g_fnCntOld != fnCnt) {
38 g_fnCntOld = fnCnt;
39 g_epCnt = 1;
40 }
41 struct UsbFnInterfaceInfo *info = NULL;
42 if (intf->bDescriptorType == USB_DDK_DT_INTERFACE && intf->bNumEndpoints > 0) {
43 if (g_intfCnt >= devMgr->fnDev.numInterfaces) {
44 HDF_LOGE("%{public}s: GetInterfaceInfo failed", __func__);
45 return;
46 }
47 info = &devMgr->interfaceMgr[g_intfCnt].interface.info;
48 info->index = intf->bInterfaceNumber;
49 info->interfaceClass = intf->bInterfaceClass;
50 info->subclass = intf->bInterfaceSubClass;
51 info->protocol = intf->bInterfaceProtocol;
52 info->numPipes = intf->bNumEndpoints;
53 info->configIndex = config->configurationValue;
54
55 devMgr->interfaceMgr[g_intfCnt].interface.object = &devMgr->fnDev.object;
56 devMgr->interfaceMgr[g_intfCnt].funcMgr = &devMgr->funcMgr[fnCnt];
57 devMgr->interfaceMgr[g_intfCnt].startEpId = (uint8_t)g_epCnt;
58 g_epCnt += intf->bNumEndpoints;
59 g_intfCnt++;
60 }
61 }
62
CreateInterface(struct UsbFnDeviceDesc * des,struct UsbFnDeviceMgr * devMgr)63 static void CreateInterface(struct UsbFnDeviceDesc *des, struct UsbFnDeviceMgr *devMgr)
64 {
65 uint32_t fnCnt = 0;
66 struct UsbInterfaceDescriptor *intf = NULL;
67 g_intfCnt = 0;
68 g_epCnt = 1;
69 g_fnCntOld = 0;
70
71 for (uint32_t i = 0; des->configs[i] != NULL; i++) {
72 for (uint32_t j = 0; des->configs[i]->functions[j] != NULL; j++) {
73 if (strncmp(des->configs[i]->functions[j]->funcName, FUNCTION_GENERIC, strlen(FUNCTION_GENERIC))) {
74 continue;
75 }
76 if (des->configs[i]->functions[j]->enable == false) {
77 continue;
78 }
79 DListHeadInit(&devMgr->funcMgr[fnCnt].reqEntry);
80 devMgr->funcMgr[fnCnt].object = &devMgr->fnDev.object;
81 int32_t ret = snprintf_s(devMgr->funcMgr[fnCnt].name, MAX_NAMELEN, MAX_NAMELEN - 1, "%s",
82 des->configs[i]->functions[j]->funcName);
83 if (ret < 0) {
84 HDF_LOGE("%{public}s: snprintf_s failed", __func__);
85 return;
86 }
87
88 for (uint32_t k = 0; des->configs[i]->functions[j]->fsDescriptors[k] != NULL; k++) {
89 intf = (struct UsbInterfaceDescriptor *)des->configs[i]->functions[j]->fsDescriptors[k];
90 GetInterfaceInfo(intf, devMgr, fnCnt, des->configs[i]);
91 }
92 fnCnt++;
93 }
94 }
95 }
96
97 #define MAX_LIST 32
FindEmptyId(void)98 static int32_t FindEmptyId(void)
99 {
100 int32_t devCnt = 1;
101 struct UsbObject *obj = NULL;
102 struct UsbObject *temp = NULL;
103 if (g_devEntry.next != 0 && !DListIsEmpty(&g_devEntry)) {
104 int32_t i;
105 for (i = 1; i < MAX_LIST; i++) {
106 int32_t isUse = 0;
107 DLIST_FOR_EACH_ENTRY_SAFE(obj, temp, &g_devEntry, struct UsbObject, entry) {
108 if (obj->objectId == i) {
109 isUse = 1;
110 break;
111 }
112 }
113 if (isUse == 0) {
114 break;
115 }
116 }
117 if (i == MAX_LIST) {
118 HDF_LOGE("%{public}s:%{public}d too much device created", __func__, __LINE__);
119 return -1;
120 }
121 devCnt = i;
122 }
123 return devCnt;
124 }
125
CreatDev(const char * udcName,struct UsbFnDeviceDesc * des,struct UsbFnDeviceMgr * fnDevMgr)126 static int32_t CreatDev(const char *udcName, struct UsbFnDeviceDesc *des, struct UsbFnDeviceMgr *fnDevMgr)
127 {
128 int32_t ret, devCnt;
129 struct UsbFnAdapterOps *fnOps = UsbFnAdapterGetOps();
130 devCnt = FindEmptyId();
131 if (devCnt < 0) {
132 return HDF_ERR_IO;
133 }
134
135 fnDevMgr->fnDev.object.objectId = devCnt;
136 ret = sprintf_s(fnDevMgr->name, MAX_NAMELEN, "g%d", devCnt);
137 if (ret < 0) {
138 return HDF_ERR_IO;
139 }
140 ret = strcpy_s(fnDevMgr->udcName, MAX_NAMELEN, udcName);
141 if (ret != EOK) {
142 return HDF_ERR_IO;
143 }
144 ret = fnOps->createDevice(udcName, fnDevMgr->name, des);
145 if (ret) {
146 return HDF_ERR_IO;
147 }
148 return 0;
149 }
150
GetInterfaceNum(struct UsbDescriptorHeader ** intf)151 static uint32_t GetInterfaceNum(struct UsbDescriptorHeader **intf)
152 {
153 uint32_t i;
154 uint32_t num = 0;
155 struct UsbInterfaceDescriptor *interface = NULL;
156 for (i = 0; intf[i] != NULL; i++) {
157 if (intf[i]->bDescriptorType == USB_DDK_DT_INTERFACE) {
158 interface = (struct UsbInterfaceDescriptor *)intf[i];
159 if (interface->bNumEndpoints > 0) {
160 num++;
161 }
162 }
163 }
164 return num;
165 }
166
AllocInterfaceAndFuncMgr(struct UsbFnDeviceMgr * fnDevMgr,struct UsbFnDeviceDesc * des)167 static int32_t AllocInterfaceAndFuncMgr(struct UsbFnDeviceMgr *fnDevMgr, struct UsbFnDeviceDesc *des)
168 {
169 uint32_t i, j;
170 for (i = 0; des->configs[i] != NULL; i++) {
171 for (j = 0; des->configs[i]->functions[j] != NULL; j++) {
172 if (strncmp(des->configs[i]->functions[j]->funcName, FUNCTION_GENERIC, strlen(FUNCTION_GENERIC))) {
173 continue;
174 }
175 if (des->configs[i]->functions[j]->enable == false) {
176 continue;
177 }
178 fnDevMgr->numFunc++;
179 fnDevMgr->fnDev.numInterfaces += GetInterfaceNum(des->configs[i]->functions[j]->fsDescriptors);
180 }
181 }
182 if (fnDevMgr->fnDev.numInterfaces == 0) {
183 HDF_LOGE("%{public}s functions is null", __func__);
184 return HDF_DEV_ERR_NO_DEVICE;
185 }
186
187 fnDevMgr->interfaceMgr = UsbFnMemCalloc(fnDevMgr->fnDev.numInterfaces * sizeof(struct UsbFnInterfaceMgr));
188 if (fnDevMgr->interfaceMgr == NULL) {
189 HDF_LOGE("%{public}s UsbFnMemCalloc failed", __func__);
190 return HDF_ERR_IO;
191 }
192
193 fnDevMgr->funcMgr = UsbFnMemCalloc(fnDevMgr->numFunc * sizeof(struct UsbFnFuncMgr));
194 if (fnDevMgr->funcMgr == NULL) {
195 HDF_LOGE("%{public}s UsbFnMemCalloc failed", __func__);
196 UsbFnMemFree(fnDevMgr->interfaceMgr);
197 return HDF_ERR_IO;
198 }
199 return 0;
200 }
201
202 static int32_t StartThreadIo(struct UsbFnDeviceMgr *fnDevMgr);
UsbFnMgrDeviceCreate(const char * udcName,struct UsbFnDeviceDesc * des,const struct DeviceResourceNode * node)203 const struct UsbFnDeviceMgr *UsbFnMgrDeviceCreate(
204 const char *udcName, struct UsbFnDeviceDesc *des, const struct DeviceResourceNode *node)
205 {
206 int32_t ret;
207
208 struct UsbFnDeviceMgr *fnDevMgr = NULL;
209 if (udcName == NULL || des == NULL) {
210 HDF_LOGE("%{public}s invalid param.", __func__);
211 return NULL;
212 }
213
214 fnDevMgr = UsbFnMemCalloc(sizeof(struct UsbFnDeviceMgr));
215 if (fnDevMgr == NULL) {
216 HDF_LOGE("%{public}s UsbFnMemCalloc failed", __func__);
217 return NULL;
218 }
219
220 ret = CreatDev(udcName, des, fnDevMgr);
221 if (ret) {
222 HDF_LOGE("%{public}s CreatDev failed", __func__);
223 goto FREE_DEVMGR;
224 }
225 if (g_devEntry.next == 0) {
226 DListHeadInit(&g_devEntry);
227 }
228 DListInsertTail(&fnDevMgr->fnDev.object.entry, &g_devEntry);
229 fnDevMgr->node = node;
230 fnDevMgr->des = des;
231
232 ret = AllocInterfaceAndFuncMgr(fnDevMgr, des);
233 if (ret == HDF_DEV_ERR_NO_DEVICE) {
234 return fnDevMgr;
235 } else if (ret != 0) {
236 HDF_LOGE("%{public}s AllocInterfaceAndFuncMgr failed", __func__);
237 goto FREE_DEVMGR;
238 }
239
240 CreateInterface(des, fnDevMgr);
241 fnDevMgr->running = true;
242 ret = StartThreadIo(fnDevMgr);
243 if (ret) {
244 HDF_LOGE("%{public}s: StartThreadIo failed", __func__);
245 goto FREE_INTF_FUNC_MGR;
246 }
247 return fnDevMgr;
248
249 FREE_INTF_FUNC_MGR:
250 UsbFnMemFree(fnDevMgr->interfaceMgr);
251 UsbFnMemFree(fnDevMgr->funcMgr);
252 FREE_DEVMGR:
253 UsbFnMemFree(fnDevMgr);
254 return NULL;
255 }
256
UsbFnMgrDeviceRemove(struct UsbFnDevice * fnDevice)257 int32_t UsbFnMgrDeviceRemove(struct UsbFnDevice *fnDevice)
258 {
259 int32_t ret;
260 int32_t i = 0;
261 if (fnDevice == NULL) {
262 return HDF_ERR_INVALID_PARAM;
263 }
264 struct UsbFnDeviceMgr *fnDevMgr = (struct UsbFnDeviceMgr *)fnDevice;
265 struct UsbFnAdapterOps *fnOps = UsbFnAdapterGetOps();
266
267 fnDevMgr->running = false;
268 while (!fnDevMgr->running) {
269 i++;
270 OsalMSleep(SLEEP_TIME_OUT);
271 if (i > SLEEP_TIMES) {
272 HDF_LOGE("%{public}s: wait thread exit timeout", __func__);
273 break;
274 }
275 }
276
277 ret = OsalThreadDestroy(&fnDevMgr->thread);
278 if (ret != HDF_SUCCESS) {
279 HDF_LOGE("%{public}s:%{public}d OsalThreadDestroy failed, ret = %{public}d", __func__, __LINE__, ret);
280 return ret;
281 }
282 ret = fnOps->delDevice(fnDevMgr->name, fnDevMgr->udcName, fnDevMgr->des);
283 if (ret) {
284 HDF_LOGE("%{public}s:%{public}d UsbFnMgrDeviceRemove failed", __func__, __LINE__);
285 return ret;
286 }
287 if (fnDevice->object.entry.prev != NULL && fnDevice->object.entry.next != NULL) {
288 DListRemove(&fnDevice->object.entry);
289 } else {
290 HDF_LOGE("%{public}s: The node prev or next is NULL", __func__);
291 }
292 UsbFnCfgMgrUnRegisterAllProp();
293
294 if (fnDevMgr->funcMgr != NULL) {
295 UsbFnMemFree(fnDevMgr->funcMgr);
296 fnDevMgr->funcMgr = NULL;
297 }
298 if (fnDevMgr->interfaceMgr != NULL) {
299 UsbFnMemFree(fnDevMgr->interfaceMgr);
300 fnDevMgr->interfaceMgr = NULL;
301 }
302 if (fnDevMgr->node) {
303 UsbFnCfgMgrFreeUsbFnDeviceDesc(fnDevMgr->des);
304 fnDevMgr->des = NULL;
305 }
306 UsbFnMemFree(fnDevMgr);
307 fnDevMgr = NULL;
308 return 0;
309 }
310
UsbFnMgrDeviceGet(const char * udcName)311 const struct UsbFnDeviceMgr *UsbFnMgrDeviceGet(const char *udcName)
312 {
313 if (udcName == NULL) {
314 HDF_LOGE("%{public}s invalid param.", __func__);
315 return NULL;
316 }
317 if (g_devEntry.next == 0 || DListIsEmpty(&g_devEntry)) {
318 HDF_LOGE("%{public}s no device created", __func__);
319 return NULL;
320 }
321
322 struct UsbObject *obj = NULL;
323 struct UsbObject *temp = NULL;
324 DLIST_FOR_EACH_ENTRY_SAFE(obj, temp, &g_devEntry, struct UsbObject, entry) {
325 struct UsbFnDeviceMgr *fnDevMgr = (struct UsbFnDeviceMgr *)obj;
326 if (strcmp(udcName, fnDevMgr->udcName) == 0) {
327 return fnDevMgr;
328 }
329 }
330 return NULL;
331 }
332
UsbFnMgrDeviceGetState(struct UsbFnDevice * fnDevice,UsbFnDeviceState * devState)333 int32_t UsbFnMgrDeviceGetState(struct UsbFnDevice *fnDevice, UsbFnDeviceState *devState)
334 {
335 if (fnDevice == NULL || devState == NULL) {
336 HDF_LOGE("%{public}s:%{public}d invalid param.", __func__, __LINE__);
337 return HDF_ERR_INVALID_PARAM;
338 }
339 struct UsbFnDeviceMgr *fnDevMgr = (struct UsbFnDeviceMgr *)fnDevice;
340 *devState = fnDevMgr->devState;
341 return 0;
342 }
343
UsbFnMgrDeviceGetInterface(struct UsbFnDevice * fnDevice,uint8_t interfaceIndex)344 const struct UsbFnInterfaceMgr *UsbFnMgrDeviceGetInterface(struct UsbFnDevice *fnDevice, uint8_t interfaceIndex)
345 {
346 if (fnDevice == NULL) {
347 HDF_LOGE("%{public}s:%{public}d fnDevice is null", __func__, __LINE__);
348 return NULL;
349 }
350 struct UsbFnDeviceMgr *fnDevMgr = (struct UsbFnDeviceMgr *)fnDevice;
351 if (interfaceIndex >= fnDevMgr->fnDev.numInterfaces) {
352 HDF_LOGE("%{public}s:%{public}d invalid param.", __func__, __LINE__);
353 return NULL;
354 }
355 return &(fnDevMgr->interfaceMgr[interfaceIndex]);
356 }
357
CollectEventHandle(struct UsbFnEventAll * event,struct UsbFnDeviceMgr * devMgr)358 static void CollectEventHandle(struct UsbFnEventAll *event, struct UsbFnDeviceMgr *devMgr)
359 {
360 uint8_t i, j;
361 struct UsbFnFuncMgr *funcMgr = NULL;
362 struct UsbFnInterfaceMgr *intfMgr = NULL;
363 struct UsbHandleMgr *handle = NULL;
364 event->ep0Num = 0;
365 event->epNum = 0;
366 for (i = 0; i < devMgr->numFunc; i++) {
367 funcMgr = devMgr->funcMgr + i;
368
369 if (funcMgr->fd > 0 && funcMgr->callback != NULL) {
370 event->ep0[event->ep0Num] = funcMgr->fd;
371 event->ep0Event[event->ep0Num].type = USB_EP0_INVALID;
372 event->ep0Num++;
373 }
374 }
375 for (i = 0; i < devMgr->fnDev.numInterfaces; i++) {
376 intfMgr = devMgr->interfaceMgr + i;
377 if (intfMgr == NULL || intfMgr->isOpen == false || intfMgr->handle == NULL) {
378 continue;
379 }
380 handle = intfMgr->handle;
381 for (j = 0; j < handle->numFd; j++) {
382 if (handle->fds[j] <= 0) {
383 continue;
384 }
385 event->epx[event->epNum] = handle->fds[j];
386 event->reqEvent[event->epNum] = handle->reqEvent[j];
387 event->numEvent[event->epNum] = 0;
388 event->epNum++;
389 }
390 }
391 }
392
HandleEp0IoEvent(const struct UsbFnFuncMgr * funcMgr,const struct UsbFnReqEvent * reqEvent)393 static void HandleEp0IoEvent(const struct UsbFnFuncMgr *funcMgr, const struct UsbFnReqEvent *reqEvent)
394 {
395 struct ReqList *reqList = NULL;
396 struct ReqList *temp = NULL;
397
398 DLIST_FOR_EACH_ENTRY_SAFE(reqList, temp, &funcMgr->reqEntry, struct ReqList, entry) {
399 if (reqList->buf == reqEvent->buf) {
400 HDF_LOGD("%{public}s: req.actual = %{public}d", __func__, reqList->req.actual);
401 reqList->req.actual = reqEvent->actual;
402 reqList->req.status = -reqEvent->status;
403 if (reqList->req.complete) {
404 reqList->req.complete(reqList->pipe, &reqList->req);
405 } else {
406 HDF_LOGE("no complete callback find");
407 }
408 break;
409 }
410 }
411 }
412
HandleEp0CtrlEvent(const struct UsbFnFuncMgr * funcMgr,struct UsbFnCtrlEvent * ctrlEvent)413 static void HandleEp0CtrlEvent(const struct UsbFnFuncMgr *funcMgr, struct UsbFnCtrlEvent *ctrlEvent)
414 {
415 struct UsbFnDeviceMgr *devMgr = (struct UsbFnDeviceMgr *)funcMgr->object;
416 struct UsbFnEvent fnEvnet;
417 if (((funcMgr->eventMask) & (1 << ctrlEvent->type)) == 0) {
418 return;
419 }
420 fnEvnet.setup = &ctrlEvent->u.setup;
421 fnEvnet.type = ctrlEvent->type;
422 fnEvnet.context = funcMgr->context;
423 devMgr->devState = ctrlEvent->type;
424 if (funcMgr->callback) {
425 funcMgr->callback(&fnEvnet);
426 } else {
427 HDF_LOGE("%{public}s: no callback find event=%{public}d", __func__, fnEvnet.type);
428 }
429 }
430
HandleEpsIoEvent(const struct UsbFnReqEvent * reqEvent,const struct UsbHandleMgr * handle)431 static void HandleEpsIoEvent(const struct UsbFnReqEvent *reqEvent, const struct UsbHandleMgr *handle)
432 {
433 struct ReqList *reqList = NULL;
434 struct ReqList *temp = NULL;
435 DLIST_FOR_EACH_ENTRY_SAFE(reqList, temp, &handle->reqEntry, struct ReqList, entry) {
436 if (reqList->buf == reqEvent->buf) {
437 reqList->req.actual = reqEvent->actual;
438 reqList->req.status = -reqEvent->status;
439 if (reqList->req.complete) {
440 reqList->req.complete(reqList->pipe, &reqList->req);
441 } else {
442 HDF_LOGE("no complete callback find");
443 }
444 break;
445 }
446 }
447 }
448
GetFuncMgr(const struct UsbFnDeviceMgr * devMgr,int32_t ep0)449 static struct UsbFnFuncMgr *GetFuncMgr(const struct UsbFnDeviceMgr *devMgr, int32_t ep0)
450 {
451 uint8_t i;
452
453 if (devMgr == NULL) {
454 HDF_LOGE("%{public}s:%{public}d devMgr is null.", __func__, __LINE__);
455 return NULL;
456 }
457 struct UsbFnFuncMgr *funcMgr = NULL;
458 for (i = 0; i < devMgr->numFunc; i++) {
459 funcMgr = devMgr->funcMgr + i;
460 if (funcMgr->fd == ep0) {
461 break;
462 }
463 }
464 return funcMgr;
465 }
466
GetHandleMgr(const struct UsbFnDeviceMgr * devMgr,int32_t epx)467 static struct UsbHandleMgr *GetHandleMgr(const struct UsbFnDeviceMgr *devMgr, int32_t epx)
468 {
469 uint8_t i, j;
470 struct UsbHandleMgr *handle = NULL;
471 struct UsbFnInterfaceMgr *intfMgr = NULL;
472
473 if (devMgr == NULL) {
474 HDF_LOGE("%{public}s:%{public}d devMgr is null.", __func__, __LINE__);
475 return NULL;
476 }
477 for (i = 0; i < devMgr->fnDev.numInterfaces; i++) {
478 intfMgr = devMgr->interfaceMgr + i;
479 if (!intfMgr->isOpen) {
480 continue;
481 }
482 handle = intfMgr->handle;
483 for (j = 0; j < handle->numFd; j++) {
484 if (epx == handle->fds[j]) {
485 return handle;
486 }
487 }
488 }
489 return handle;
490 }
491
HandleEp0Event(const struct UsbFnDeviceMgr * devMgr,struct UsbFnEventAll event)492 static void HandleEp0Event(const struct UsbFnDeviceMgr *devMgr, struct UsbFnEventAll event)
493 {
494 uint8_t i;
495 struct UsbFnFuncMgr *funcMgr = NULL;
496 for (i = 0; i < event.ep0Num; i++) {
497 funcMgr = GetFuncMgr(devMgr, event.ep0[i]);
498 if (funcMgr == NULL) {
499 HDF_LOGE("%{public}s:%{public}d GetFuncMgr failed.", __func__, __LINE__);
500 return;
501 }
502 if (event.ep0Event[i].type == USB_EP0_CTRL_EVENT) {
503 HandleEp0CtrlEvent(funcMgr, &event.ep0Event[i].ctrlEvent);
504 } else if (event.ep0Event[i].type == USB_EP0_IO_COMPLETED) {
505 HandleEp0IoEvent(funcMgr, &event.ep0Event[i].reqEvent);
506 }
507 }
508 }
509
UsbFnEventProcess(void * arg)510 static int32_t UsbFnEventProcess(void *arg)
511 {
512 struct UsbFnDeviceMgr *devMgr = (struct UsbFnDeviceMgr *)arg;
513 struct UsbFnAdapterOps *fnOps = UsbFnAdapterGetOps();
514 struct UsbFnEventAll event;
515 struct UsbHandleMgr *handle = NULL;
516 int32_t timeout = SLEEP_TIME_OUT;
517
518 while (true) {
519 if (devMgr == NULL || !devMgr->running) {
520 break;
521 }
522 if (memset_s(&event, sizeof(event), 0, sizeof(event)) != EOK) {
523 HDF_LOGE("%{public}s:%{public}d memset_s failed", __func__, __LINE__);
524 return HDF_FAILURE;
525 }
526
527 CollectEventHandle(&event, devMgr);
528 if (event.ep0Num + event.epNum == 0) {
529 continue;
530 }
531 int32_t ret = fnOps->pollEvent(&event, timeout);
532 if (ret != 0) {
533 if (devMgr == NULL || !devMgr->running) {
534 break;
535 }
536 OsalMSleep(1);
537 continue;
538 }
539 HandleEp0Event(devMgr, event);
540 for (uint8_t i = 0; i < event.epNum; i++) {
541 handle = GetHandleMgr(devMgr, event.epx[i]);
542 if (handle == NULL) {
543 continue;
544 }
545 for (uint8_t j = 0; j < event.numEvent[i]; j++) {
546 HandleEpsIoEvent(&event.reqEvent[i][j], handle);
547 }
548 }
549 }
550 if (devMgr) {
551 devMgr->running = true;
552 }
553 HDF_LOGI("%{public}s, exit", __func__);
554 return 0;
555 }
556
StartThreadIo(struct UsbFnDeviceMgr * fnDevMgr)557 static int32_t StartThreadIo(struct UsbFnDeviceMgr *fnDevMgr)
558 {
559 int32_t ret;
560 struct OsalThreadParam threadCfg;
561 ret = memset_s(&threadCfg, sizeof(threadCfg), 0, sizeof(threadCfg));
562 if (ret != EOK) {
563 HDF_LOGE("%{public}s:%{public}d memset_s failed", __func__, __LINE__);
564 return ret;
565 }
566 threadCfg.name = "usbfn process";
567 threadCfg.priority = OSAL_THREAD_PRI_LOW;
568 threadCfg.stackSize = HDF_PROCESS_STACK_SIZE;
569
570 ret = OsalThreadCreate(&fnDevMgr->thread, (OsalThreadEntry)UsbFnEventProcess, (void *)fnDevMgr);
571 if (ret != HDF_SUCCESS) {
572 HDF_LOGE("%{public}s:%{public}d OsalThreadCreate failed, ret = %{public}d ", __func__, __LINE__, ret);
573 return HDF_ERR_DEVICE_BUSY;
574 }
575 HDF_LOGD("%{public}s: Usb device OsalThreadCreate", __func__);
576 ret = OsalThreadStart(&fnDevMgr->thread, &threadCfg);
577 if (ret != HDF_SUCCESS) {
578 HDF_LOGE("%{public}s:%{public}d OsalThreadStart failed, ret = %{public}d ", __func__, __LINE__, ret);
579 return HDF_ERR_DEVICE_BUSY;
580 }
581 return 0;
582 }
583
UsbFnMgrStartRecvEvent(struct UsbFnInterface * interface,uint32_t eventMask,UsbFnEventCallback callback,void * context)584 int32_t UsbFnMgrStartRecvEvent(
585 struct UsbFnInterface *interface, uint32_t eventMask, UsbFnEventCallback callback, void *context)
586 {
587 struct UsbFnInterfaceMgr *interfaceMgr = (struct UsbFnInterfaceMgr *)interface;
588 struct UsbFnFuncMgr *funcMgr = interfaceMgr->funcMgr;
589 if (funcMgr->callback != NULL) {
590 HDF_LOGE("%{public}s: callback has Register", __func__);
591 return HDF_ERR_INVALID_PARAM;
592 }
593 funcMgr->context = context;
594 funcMgr->eventMask = eventMask;
595 funcMgr->callback = callback;
596 if (funcMgr->fd <= 0) {
597 int32_t ret = OpenEp0AndMapAddr(funcMgr);
598 if (ret != HDF_SUCCESS) {
599 HDF_LOGE("%{public}s: OpenEp0AndMapAddr failed, ret = %{public}d ", __func__, ret);
600 return HDF_ERR_IO;
601 }
602 }
603 return 0;
604 }
605
UsbFnStopRecvEvent(struct UsbFnInterface * interface)606 int32_t UsbFnStopRecvEvent(struct UsbFnInterface *interface)
607 {
608 int32_t ret;
609 struct UsbFnAdapterOps *fnOps = UsbFnAdapterGetOps();
610 struct UsbFnInterfaceMgr *interfaceMgr = (struct UsbFnInterfaceMgr *)interface;
611 struct UsbFnFuncMgr *funcMgr = interfaceMgr->funcMgr;
612 ret = fnOps->queueDel(funcMgr->fd);
613 if (ret) {
614 HDF_LOGE("%{public}s:%{public}d queueDel failed, ret = %{public}d ", __func__, __LINE__, ret);
615 return HDF_ERR_DEVICE_BUSY;
616 }
617 ret = fnOps->closePipe(funcMgr->fd);
618 if (ret) {
619 HDF_LOGE("%{public}s:%{public}d closePipe failed, ret = %{public}d ", __func__, __LINE__, ret);
620 return HDF_ERR_DEVICE_BUSY;
621 }
622 funcMgr->fd = -1;
623 funcMgr->callback = NULL;
624 return 0;
625 }
626