usbh_gsm.c 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127
  1. /*
  2. * Copyright (c) 2025, sakumisu
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. #include "usbh_core.h"
  7. #include "usbh_serial.h"
  8. #undef USB_DBG_TAG
  9. #define USB_DBG_TAG "usbh_gsm"
  10. #include "usb_log.h"
  11. struct usbh_gsm {
  12. struct usb_endpoint_descriptor *intin;
  13. struct usbh_urb intin_urb;
  14. struct usb_osal_timer *modem_timer;
  15. uint16_t modem_status;
  16. };
  17. static int usbh_gsm_attach(struct usbh_serial *serial)
  18. {
  19. struct usb_endpoint_descriptor *ep_desc;
  20. int ret;
  21. struct usbh_gsm *gsm_class = usb_osal_malloc(sizeof(struct usbh_gsm));
  22. if (!gsm_class) {
  23. USB_LOG_ERR("No memory for gsm_class\r\n");
  24. return -USB_ERR_NOMEM;
  25. }
  26. memset(gsm_class, 0, sizeof(struct usbh_gsm));
  27. serial->priv = gsm_class;
  28. for (uint8_t i = 0; i < serial->hport->config.intf[serial->intf].altsetting[0].intf_desc.bNumEndpoints; i++) {
  29. ep_desc = &serial->hport->config.intf[serial->intf].altsetting[0].ep[i].ep_desc;
  30. if (USB_GET_ENDPOINT_TYPE(ep_desc->bmAttributes) == USB_ENDPOINT_TYPE_INTERRUPT) {
  31. if (ep_desc->bEndpointAddress & 0x80) {
  32. USBH_EP_INIT(gsm_class->intin, ep_desc);
  33. break;
  34. } else {
  35. }
  36. }
  37. }
  38. if (!gsm_class->intin) {
  39. USB_LOG_ERR("Failed to find interrupt endpoint\r\n");
  40. ret = -USB_ERR_NODEV;
  41. goto errout;
  42. }
  43. return 0;
  44. errout:
  45. serial->priv = NULL;
  46. usb_osal_free(gsm_class);
  47. return ret;
  48. }
  49. static void usbh_gsm_detach(struct usbh_serial *serial)
  50. {
  51. struct usbh_gsm *gsm_class;
  52. if (!serial || !serial->priv) {
  53. return;
  54. }
  55. gsm_class = (struct usbh_gsm *)serial->priv;
  56. if (gsm_class->intin) {
  57. usbh_kill_urb(&gsm_class->intin_urb);
  58. }
  59. serial->priv = NULL;
  60. usb_osal_free(gsm_class);
  61. }
  62. static const struct usbh_serial_driver gsm_driver = {
  63. .driver_name = "gsm",
  64. .ignore_rx_header = 0,
  65. .ignore_tx_header = 0,
  66. .attach = usbh_gsm_attach,
  67. .detach = usbh_gsm_detach,
  68. .set_flow_control = NULL,
  69. .set_line_coding = NULL,
  70. .get_line_coding = NULL,
  71. .set_line_state = NULL,
  72. .get_modem_status = NULL,
  73. };
  74. static int usbh_gsm_connect(struct usbh_hubport *hport, uint8_t intf)
  75. {
  76. return usbh_serial_probe(hport, intf, &gsm_driver) ? 0 : -USB_ERR_NOMEM;
  77. }
  78. static int usbh_gsm_disconnect(struct usbh_hubport *hport, uint8_t intf)
  79. {
  80. struct usbh_serial *serial = (struct usbh_serial *)hport->config.intf[intf].priv;
  81. if (serial) {
  82. usbh_serial_remove(serial);
  83. }
  84. return 0;
  85. }
  86. const struct usbh_class_driver gsm_class_driver = {
  87. .driver_name = "gsm",
  88. .connect = usbh_gsm_connect,
  89. .disconnect = usbh_gsm_disconnect
  90. };
  91. static const uint16_t gsm_id_table[][2] = {
  92. { 0x2C7C, 0x0120 }, /* Quectel EC20 */
  93. { 0x2C7C, 0x0121 }, /* Quectel EC21 */
  94. { 0x2C7C, 0x0125 }, /* Quectel EC25 */
  95. { 0x2C7C, 0x0191 }, /* Quectel EG91 */
  96. { 0x2C7C, 0x0195 }, /* Quectel EG95 */
  97. { 0x2C7C, 0x6002 }, /* Quectel EC200/EC600/EC800/EG91x */
  98. { 0x1E0E, 0x9001 }, /* SIMCOM SIM7600 */
  99. { 0, 0 },
  100. };
  101. CLASS_INFO_DEFINE const struct usbh_class_info gsm_class_info = {
  102. .match_flags = USB_CLASS_MATCH_VID_PID | USB_CLASS_MATCH_INTF_CLASS | USB_CLASS_MATCH_INTF_SUBCLASS | USB_CLASS_MATCH_INTF_PROTOCOL,
  103. .bInterfaceClass = 0xff,
  104. .bInterfaceSubClass = 0x00,
  105. .bInterfaceProtocol = 0x00,
  106. .id_table = gsm_id_table,
  107. .class_driver = &gsm_class_driver
  108. };