dp_hpd.c 2.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2021-2022, Qualcomm Innovation Center, Inc. All rights reserved.
  4. * Copyright (c) 2012-2021, The Linux Foundation. All rights reserved.
  5. */
  6. #include <linux/slab.h>
  7. #include <linux/device.h>
  8. #include <linux/delay.h>
  9. #include <linux/err.h>
  10. #include "dp_hpd.h"
  11. #include "dp_altmode.h"
  12. #include "dp_usbpd.h"
  13. #include "dp_gpio_hpd.h"
  14. #include "dp_lphw_hpd.h"
  15. #include "dp_debug.h"
  16. #include "dp_bridge_hpd.h"
  17. static void dp_hpd_host_init(struct dp_hpd *dp_hpd,
  18. struct dp_catalog_hpd *catalog)
  19. {
  20. if (!catalog) {
  21. DP_ERR("invalid input\n");
  22. return;
  23. }
  24. catalog->config_hpd(catalog, true);
  25. }
  26. static void dp_hpd_host_deinit(struct dp_hpd *dp_hpd,
  27. struct dp_catalog_hpd *catalog)
  28. {
  29. if (!catalog) {
  30. DP_ERR("invalid input\n");
  31. return;
  32. }
  33. catalog->config_hpd(catalog, false);
  34. }
  35. static void dp_hpd_isr(struct dp_hpd *dp_hpd)
  36. {
  37. }
  38. struct dp_hpd *dp_hpd_get(struct device *dev, struct dp_parser *parser,
  39. struct dp_catalog_hpd *catalog,
  40. struct dp_aux_bridge *aux_bridge,
  41. struct dp_hpd_cb *cb)
  42. {
  43. struct dp_hpd *dp_hpd = NULL;
  44. if (aux_bridge && (aux_bridge->flag & DP_AUX_BRIDGE_HPD)) {
  45. dp_hpd = dp_bridge_hpd_get(dev, cb, aux_bridge);
  46. if (!IS_ERR(dp_hpd)) {
  47. dp_hpd->type = DP_HPD_BRIDGE;
  48. goto config;
  49. }
  50. }
  51. dp_hpd = dp_lphw_hpd_get(dev, parser, catalog, cb);
  52. if (!IS_ERR_OR_NULL(dp_hpd)) {
  53. dp_hpd->type = DP_HPD_LPHW;
  54. goto config;
  55. }
  56. dp_hpd = dp_gpio_hpd_get(dev, cb);
  57. if (!IS_ERR_OR_NULL(dp_hpd)) {
  58. dp_hpd->type = DP_HPD_GPIO;
  59. goto config;
  60. }
  61. dp_hpd = dp_altmode_get(dev, cb);
  62. if (!IS_ERR_OR_NULL(dp_hpd)) {
  63. dp_hpd->type = DP_HPD_ALTMODE;
  64. goto config;
  65. }
  66. dp_hpd = dp_usbpd_get(dev, cb);
  67. if (!IS_ERR_OR_NULL(dp_hpd)) {
  68. dp_hpd->type = DP_HPD_USBPD;
  69. goto config;
  70. }
  71. DP_ERR("Failed to detect HPD type\n");
  72. goto end;
  73. config:
  74. if (!dp_hpd->host_init)
  75. dp_hpd->host_init = dp_hpd_host_init;
  76. if (!dp_hpd->host_deinit)
  77. dp_hpd->host_deinit = dp_hpd_host_deinit;
  78. if (!dp_hpd->isr)
  79. dp_hpd->isr = dp_hpd_isr;
  80. end:
  81. return dp_hpd;
  82. }
  83. void dp_hpd_put(struct dp_hpd *dp_hpd)
  84. {
  85. if (!dp_hpd)
  86. return;
  87. switch (dp_hpd->type) {
  88. case DP_HPD_USBPD:
  89. dp_usbpd_put(dp_hpd);
  90. break;
  91. case DP_HPD_ALTMODE:
  92. dp_altmode_put(dp_hpd);
  93. break;
  94. case DP_HPD_GPIO:
  95. dp_gpio_hpd_put(dp_hpd);
  96. break;
  97. case DP_HPD_LPHW:
  98. dp_lphw_hpd_put(dp_hpd);
  99. break;
  100. case DP_HPD_BRIDGE:
  101. dp_bridge_hpd_put(dp_hpd);
  102. break;
  103. default:
  104. DP_ERR("unknown hpd type %d\n", dp_hpd->type);
  105. break;
  106. }
  107. }