drv_gpio.c 5.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212
  1. /*
  2. * Copyright (c) 2006-2023, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Email: opensource_embedded@phytium.com.cn
  7. *
  8. * Change Logs:
  9. * Date Author Notes
  10. * 2023/7/24 liqiaozhong first add, support intr
  11. * 2024/6/3 zhangyan Adaptive drive
  12. *
  13. */
  14. #include "rtconfig.h"
  15. #include <rtthread.h>
  16. #include <rtdevice.h>
  17. #include "interrupt.h"
  18. #define LOG_TAG "gpio_drv"
  19. #include "drv_log.h"
  20. #ifdef RT_USING_SMART
  21. #include "ioremap.h"
  22. #endif
  23. #include <string.h>
  24. #if defined(TARGET_E2000)
  25. #include "fparameters.h"
  26. #endif
  27. #include "fkernel.h"
  28. #include "fcpu_info.h"
  29. #include "ftypes.h"
  30. #include "fio_mux.h"
  31. #include "board.h"
  32. #include "fiopad.h"
  33. #include "fgpio.h"
  34. #include "drv_gpio.h"
  35. /**************************** Type Definitions *******************************/
  36. typedef void (*FGpioOpsIrqHandler)(s32 vector, void *param);
  37. typedef struct
  38. {
  39. FGpioOpsIrqHandler irq_handler;
  40. void *irq_args;
  41. } FGpioOpsPinConfig;
  42. /***************** Macros (Inline Functions) Definitions *********************/
  43. /************************** Variable Definitions *****************************/
  44. static FGpio gpio_device[FGPIO_NUM];
  45. extern FGpioIntrMap fgpio_intr_map[FGPIO_CTRL_NUM];
  46. /*******************************Api Functions*********************************/
  47. static void FGpioOpsSetupIRQ(FGpio *ctrl)
  48. {
  49. rt_uint32_t cpu_id = rt_hw_cpu_id();
  50. u32 irq_num = ctrl->config.irq_num;
  51. LOG_D("In FGpioOpsSetupIRQ() -> cpu_id %d, irq_num %d\r\n", cpu_id, irq_num);
  52. rt_hw_interrupt_set_target_cpus(irq_num, cpu_id);
  53. rt_hw_interrupt_set_priority(irq_num, 0xd0); /* setup interrupt */
  54. rt_hw_interrupt_install(irq_num, FGpioInterruptHandler, NULL, NULL); /* register intr handler */
  55. rt_hw_interrupt_umask(irq_num);
  56. return;
  57. }
  58. /* on E2000, if u want use GPIO-4-11, set pin = FGPIO_OPS_PIN_INDEX(4, 0, 11) */
  59. static void drv_pin_mode(struct rt_device *device, rt_base_t pin, rt_uint8_t mode)
  60. {
  61. FGpio *instance = (FGpio *)device->user_data;
  62. FError err = FGPIO_SUCCESS;
  63. u32 index = (u32)pin;
  64. if (index >= FGPIO_NUM)
  65. {
  66. LOG_E("ctrl_id too large!!!");
  67. return;
  68. }
  69. FGpioConfig input_cfg = *FGpioLookupConfig(index);
  70. memset(&instance[index], 0, sizeof(FGpio));
  71. #ifdef RT_USING_SMART
  72. input_cfg.base_addr = (uintptr)rt_ioremap((void *)input_cfg.base_addr, 0x1000);
  73. #endif
  74. err = FGpioCfgInitialize(&instance[index], &input_cfg);
  75. if (FGPIO_SUCCESS != err)
  76. {
  77. LOG_E("Ctrl: %d init fail!!!\n");
  78. }
  79. FIOPadSetGpioMux(instance[index].config.ctrl, instance[index].config.pin);
  80. switch (mode)
  81. {
  82. case PIN_MODE_OUTPUT:
  83. FGpioSetDirection(&instance[index], FGPIO_DIR_OUTPUT);
  84. break;
  85. case PIN_MODE_INPUT:
  86. FGpioSetDirection(&instance[index], FGPIO_DIR_INPUT);
  87. break;
  88. default:
  89. rt_kprintf("Not support mode %d!!!\n", mode);
  90. break;
  91. }
  92. }
  93. void drv_pin_write(struct rt_device *device, rt_base_t pin, rt_uint8_t value)
  94. {
  95. FGpio *instance = (FGpio *)device->user_data;
  96. FError err = FGPIO_SUCCESS;
  97. u32 index = (u32)pin;
  98. FGpioSetOutputValue(&instance[index], (value == PIN_HIGH) ? FGPIO_PIN_HIGH : FGPIO_PIN_LOW);
  99. }
  100. rt_ssize_t drv_pin_read(struct rt_device *device, rt_base_t pin)
  101. {
  102. FGpio *instance = (FGpio *)device->user_data;
  103. FError err = FGPIO_SUCCESS;
  104. u32 index = (u32)pin;
  105. return FGpioGetInputValue(&instance[index]) == FGPIO_PIN_HIGH ? PIN_HIGH : PIN_LOW;
  106. }
  107. rt_err_t drv_pin_attach_irq(struct rt_device *device, rt_base_t pin,
  108. rt_uint8_t mode, void (*hdr)(void *args), void *args)
  109. {
  110. FGpio *instance = (FGpio *)device->user_data;
  111. FError err = FGPIO_SUCCESS;
  112. u32 index = (u32)pin;
  113. rt_base_t level;
  114. level = rt_hw_interrupt_disable();
  115. FGpioOpsSetupIRQ(&instance[index]);
  116. switch (mode)
  117. {
  118. case PIN_IRQ_MODE_RISING:
  119. FGpioSetInterruptType(&instance[index], FGPIO_IRQ_TYPE_EDGE_RISING);
  120. break;
  121. case PIN_IRQ_MODE_FALLING:
  122. FGpioSetInterruptType(&instance[index], FGPIO_IRQ_TYPE_EDGE_FALLING);
  123. break;
  124. case PIN_IRQ_MODE_LOW_LEVEL:
  125. FGpioSetInterruptType(&instance[index], FGPIO_IRQ_TYPE_LEVEL_LOW);
  126. break;
  127. case PIN_IRQ_MODE_HIGH_LEVEL:
  128. FGpioSetInterruptType(&instance[index], FGPIO_IRQ_TYPE_LEVEL_HIGH);
  129. break;
  130. default:
  131. LOG_E("Do not spport irq_mode: %d\n", mode);
  132. break;
  133. }
  134. FGpioRegisterInterruptCB(&instance[index], hdr, args); /* register intr callback */
  135. rt_hw_interrupt_enable(level);
  136. return RT_EOK;
  137. }
  138. rt_err_t drv_pin_detach_irq(struct rt_device *device, rt_base_t pin)
  139. {
  140. FGpio *instance = (FGpio *)device->user_data;
  141. FError err = FGPIO_SUCCESS;
  142. u32 index = (u32)pin;
  143. FGpioIntrMap *map = &fgpio_intr_map[instance[index].config.ctrl];
  144. rt_base_t level;
  145. level = rt_hw_interrupt_disable();
  146. if (instance[index].config.cap == FGPIO_CAP_IRQ_BY_PIN)
  147. {
  148. map->irq_cbs[instance[index].config.pin] = NULL;
  149. }
  150. rt_hw_interrupt_enable(level);
  151. return RT_EOK;
  152. }
  153. rt_err_t drv_pin_irq_enable(struct rt_device *device, rt_base_t pin, rt_uint8_t enabled)
  154. {
  155. FGpio *instance = (FGpio *)device->user_data;
  156. FError err = FGPIO_SUCCESS;
  157. u32 index = (u32)pin;
  158. FGpioSetInterruptMask(&instance[index], enabled);
  159. return RT_EOK;
  160. }
  161. const struct rt_pin_ops drv_pin_ops =
  162. {
  163. .pin_mode = drv_pin_mode,
  164. .pin_write = drv_pin_write,
  165. .pin_read = drv_pin_read,
  166. .pin_attach_irq = drv_pin_attach_irq,
  167. .pin_detach_irq = drv_pin_detach_irq,
  168. .pin_irq_enable = drv_pin_irq_enable,
  169. .pin_get = RT_NULL
  170. };
  171. int ft_pin_init(void)
  172. {
  173. rt_err_t ret = RT_EOK;
  174. ret = rt_device_pin_register("pin", &drv_pin_ops, gpio_device);
  175. rt_kprintf("Register pin with return: %d\n", ret);
  176. return ret;
  177. }
  178. INIT_DEVICE_EXPORT(ft_pin_init);