|
| 1 | +/* |
| 2 | + * Copyright (c) 2025 Nordic Semiconductor ASA |
| 3 | + * Copyright 2025 NXP |
| 4 | + * |
| 5 | + * SPDX-License-Identifier: Apache-2.0 |
| 6 | + */ |
| 7 | + |
| 8 | +#include <zephyr/usb/usbh.h> |
| 9 | +#include <zephyr/logging/log.h> |
| 10 | + |
| 11 | +#include "usbh_class.h" |
| 12 | +#include "usbh_class_api.h" |
| 13 | + |
| 14 | +LOG_MODULE_REGISTER(usbh_class, CONFIG_USBH_LOG_LEVEL); |
| 15 | + |
| 16 | +int usbh_register_all_classes(struct usbh_context *uhs_ctx) |
| 17 | +{ |
| 18 | + int registered_count = 0; |
| 19 | + |
| 20 | + STRUCT_SECTION_FOREACH(usbh_class_data, cdata_existing) { |
| 21 | + struct usbh_class_data *cdata_registered; |
| 22 | + bool already_registered = false; |
| 23 | + |
| 24 | + /* Check if already registered */ |
| 25 | + SYS_SLIST_FOR_EACH_CONTAINER(&uhs_ctx->class_list, cdata_registered, node) { |
| 26 | + if (cdata_existing == cdata_registered) { |
| 27 | + already_registered = true; |
| 28 | + break; |
| 29 | + } |
| 30 | + } |
| 31 | + |
| 32 | + if (!already_registered) { |
| 33 | + sys_slist_append(&uhs_ctx->class_list, &cdata_existing->node); |
| 34 | + registered_count++; |
| 35 | + LOG_DBG("Auto-registered class: %s", cdata_existing->name); |
| 36 | + } |
| 37 | + } |
| 38 | + |
| 39 | + LOG_INF("Auto-registered %d classes to controller %s", |
| 40 | + registered_count, uhs_ctx->name); |
| 41 | + |
| 42 | + return 0; |
| 43 | +} |
| 44 | + |
| 45 | +int usbh_init_registered_classes(struct usbh_context *uhs_ctx) |
| 46 | +{ |
| 47 | + struct usbh_class_data *cdata; |
| 48 | + int ret; |
| 49 | + |
| 50 | + SYS_SLIST_FOR_EACH_CONTAINER(&uhs_ctx->class_list, cdata, node) { |
| 51 | + ret = usbh_class_init(cdata); |
| 52 | + if (ret != 0) { |
| 53 | + LOG_ERR("Failed to initialize class instance"); |
| 54 | + return ret; |
| 55 | + } |
| 56 | + } |
| 57 | + |
| 58 | + return 0; |
| 59 | +} |
0 commit comments