drv_gpio.c 9.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353
  1. /*
  2. * Copyright (c) 2006-2021, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2021-07-29 KyleChan first version
  9. * 2022-01-19 Sherman add PIN2IRQX_TABLE
  10. */
  11. #include <drv_gpio.h>
  12. #ifdef RT_USING_PIN
  13. #define DBG_TAG "drv.gpio"
  14. #ifdef DRV_DEBUG
  15. #define DBG_LVL DBG_LOG
  16. #else
  17. #define DBG_LVL DBG_INFO
  18. #endif /* DRV_DEBUG */
  19. #ifdef R_ICU_H
  20. #include "gpio_cfg.h"
  21. static rt_base_t ra_pin_get_irqx(rt_uint32_t pin)
  22. {
  23. PIN2IRQX_TABLE(pin)
  24. }
  25. static struct rt_pin_irq_hdr pin_irq_hdr_tab[RA_IRQ_MAX] = {0};
  26. struct ra_pin_irq_map pin_irq_map[RA_IRQ_MAX] = {0};
  27. static void ra_irq_tab_init(void)
  28. {
  29. for (int i = 0; i < RA_IRQ_MAX; ++i)
  30. {
  31. pin_irq_hdr_tab[i].pin = -1;
  32. pin_irq_hdr_tab[i].mode = 0;
  33. pin_irq_hdr_tab[i].args = RT_NULL;
  34. pin_irq_hdr_tab[i].hdr = RT_NULL;
  35. }
  36. }
  37. static void ra_pin_map_init(void)
  38. {
  39. #ifdef VECTOR_NUMBER_ICU_IRQ0
  40. pin_irq_map[0].irq_ctrl = &g_external_irq0_ctrl;
  41. pin_irq_map[0].irq_cfg = &g_external_irq0_cfg;
  42. #endif
  43. #ifdef VECTOR_NUMBER_ICU_IRQ1
  44. pin_irq_map[1].irq_ctrl = &g_external_irq1_ctrl;
  45. pin_irq_map[1].irq_cfg = &g_external_irq1_cfg;
  46. #endif
  47. #ifdef VECTOR_NUMBER_ICU_IRQ2
  48. pin_irq_map[2].irq_ctrl = &g_external_irq2_ctrl;
  49. pin_irq_map[2].irq_cfg = &g_external_irq2_cfg;
  50. #endif
  51. #ifdef VECTOR_NUMBER_ICU_IRQ3
  52. pin_irq_map[3].irq_ctrl = &g_external_irq3_ctrl;
  53. pin_irq_map[3].irq_cfg = &g_external_irq3_cfg;
  54. #endif
  55. #ifdef VECTOR_NUMBER_ICU_IRQ4
  56. pin_irq_map[4].irq_ctrl = &g_external_irq4_ctrl;
  57. pin_irq_map[4].irq_cfg = &g_external_irq4_cfg;
  58. #endif
  59. #ifdef VECTOR_NUMBER_ICU_IRQ5
  60. pin_irq_map[5].irq_ctrl = &g_external_irq5_ctrl;
  61. pin_irq_map[5].irq_cfg = &g_external_irq5_cfg;
  62. #endif
  63. #ifdef VECTOR_NUMBER_ICU_IRQ6
  64. pin_irq_map[6].irq_ctrl = &g_external_irq6_ctrl;
  65. pin_irq_map[6].irq_cfg = &g_external_irq6_cfg;
  66. #endif
  67. #ifdef VECTOR_NUMBER_ICU_IRQ7
  68. pin_irq_map[7].irq_ctrl = &g_external_irq7_ctrl;
  69. pin_irq_map[7].irq_cfg = &g_external_irq7_cfg;
  70. #endif
  71. #ifdef VECTOR_NUMBER_ICU_IRQ8
  72. pin_irq_map[8].irq_ctrl = &g_external_irq8_ctrl;
  73. pin_irq_map[8].irq_cfg = &g_external_irq8_cfg;
  74. #endif
  75. #ifdef VECTOR_NUMBER_ICU_IRQ9
  76. pin_irq_map[9].irq_ctrl = &g_external_irq9_ctrl;
  77. pin_irq_map[9].irq_cfg = &g_external_irq9_cfg;
  78. #endif
  79. #ifdef VECTOR_NUMBER_ICU_IRQ10
  80. pin_irq_map[10].irq_ctrl = &g_external_irq10_ctrl;
  81. pin_irq_map[10].irq_cfg = &g_external_irq10_cfg;
  82. #endif
  83. #ifdef VECTOR_NUMBER_ICU_IRQ11
  84. pin_irq_map[11].irq_ctrl = &g_external_irq11_ctrl;
  85. pin_irq_map[11].irq_cfg = &g_external_irq11_cfg;
  86. #endif
  87. #ifdef VECTOR_NUMBER_ICU_IRQ12
  88. pin_irq_map[12].irq_ctrl = &g_external_irq12_ctrl;
  89. pin_irq_map[12].irq_cfg = &g_external_irq12_cfg;
  90. #endif
  91. #ifdef VECTOR_NUMBER_ICU_IRQ13
  92. pin_irq_map[13].irq_ctrl = &g_external_irq13_ctrl;
  93. pin_irq_map[13].irq_cfg = &g_external_irq13_cfg;
  94. #endif
  95. #ifdef VECTOR_NUMBER_ICU_IRQ14
  96. pin_irq_map[14].irq_ctrl = &g_external_irq14_ctrl;
  97. pin_irq_map[14].irq_cfg = &g_external_irq14_cfg;
  98. #endif
  99. #ifdef VECTOR_NUMBER_ICU_IRQ15
  100. pin_irq_map[15].irq_ctrl = &g_external_irq15_ctrl;
  101. pin_irq_map[15].irq_cfg = &g_external_irq15_cfg;
  102. #endif
  103. }
  104. #endif /* R_ICU_H */
  105. static void ra_pin_mode(rt_device_t dev, rt_base_t pin, rt_uint8_t mode)
  106. {
  107. fsp_err_t err;
  108. /* Initialize the IOPORT module and configure the pins */
  109. err = R_IOPORT_Open(&g_ioport_ctrl, &g_bsp_pin_cfg);
  110. if (err != FSP_SUCCESS)
  111. {
  112. LOG_E("GPIO open failed");
  113. return;
  114. }
  115. switch (mode)
  116. {
  117. case PIN_MODE_OUTPUT:
  118. err = R_IOPORT_PinCfg(&g_ioport_ctrl, pin, BSP_IO_DIRECTION_OUTPUT);
  119. if (err != FSP_SUCCESS)
  120. {
  121. LOG_E("PIN_MODE_OUTPUT configuration failed");
  122. return;
  123. }
  124. break;
  125. case PIN_MODE_INPUT:
  126. err = R_IOPORT_PinCfg(&g_ioport_ctrl, pin, BSP_IO_DIRECTION_INPUT);
  127. if (err != FSP_SUCCESS)
  128. {
  129. LOG_E("PIN_MODE_INPUT configuration failed");
  130. return;
  131. }
  132. break;
  133. case PIN_MODE_OUTPUT_OD:
  134. err = R_IOPORT_PinCfg(&g_ioport_ctrl, pin, IOPORT_CFG_NMOS_ENABLE);
  135. if (err != FSP_SUCCESS)
  136. {
  137. LOG_E("PIN_MODE_OUTPUT_OD configuration failed");
  138. return;
  139. }
  140. break;
  141. }
  142. }
  143. static void ra_pin_write(rt_device_t dev, rt_base_t pin, rt_uint8_t value)
  144. {
  145. bsp_io_level_t level = BSP_IO_LEVEL_HIGH;
  146. if (value != level)
  147. {
  148. level = BSP_IO_LEVEL_LOW;
  149. }
  150. R_BSP_PinAccessEnable();
  151. R_BSP_PinWrite(pin, level);
  152. R_BSP_PinAccessDisable();
  153. }
  154. static rt_ssize_t ra_pin_read(rt_device_t dev, rt_base_t pin)
  155. {
  156. if ((pin > RA_MAX_PIN_VALUE) || (pin < RA_MIN_PIN_VALUE))
  157. {
  158. return -RT_EINVAL;
  159. }
  160. return R_BSP_PinRead(pin);
  161. }
  162. static rt_err_t ra_pin_irq_enable(struct rt_device *device, rt_base_t pin, rt_uint8_t enabled)
  163. {
  164. #ifdef R_ICU_H
  165. rt_err_t err;
  166. rt_int32_t irqx = ra_pin_get_irqx(pin);
  167. if (PIN_IRQ_ENABLE == enabled)
  168. {
  169. if (0 <= irqx && irqx < sizeof(pin_irq_map) / sizeof(pin_irq_map[0]))
  170. {
  171. err = R_ICU_ExternalIrqOpen((external_irq_ctrl_t *const)pin_irq_map[irqx].irq_ctrl,
  172. (external_irq_cfg_t const * const)pin_irq_map[irqx].irq_cfg);
  173. /* Handle error */
  174. if (FSP_SUCCESS != err)
  175. {
  176. /* ICU Open failure message */
  177. LOG_E("\r\n**R_ICU_ExternalIrqOpen API FAILED**\r\n");
  178. return -RT_ERROR;
  179. }
  180. err = R_ICU_ExternalIrqEnable((external_irq_ctrl_t *const)pin_irq_map[irqx].irq_ctrl);
  181. /* Handle error */
  182. if (FSP_SUCCESS != err)
  183. {
  184. /* ICU Enable failure message */
  185. LOG_E("\r\n**R_ICU_ExternalIrqEnable API FAILED**\r\n");
  186. return -RT_ERROR;
  187. }
  188. }
  189. }
  190. else if (PIN_IRQ_DISABLE == enabled)
  191. {
  192. err = R_ICU_ExternalIrqDisable((external_irq_ctrl_t *const)pin_irq_map[irqx].irq_ctrl);
  193. if (FSP_SUCCESS != err)
  194. {
  195. /* ICU Disable failure message */
  196. LOG_E("\r\n**R_ICU_ExternalIrqDisable API FAILED**\r\n");
  197. return -RT_ERROR;
  198. }
  199. err = R_ICU_ExternalIrqClose((external_irq_ctrl_t *const)pin_irq_map[irqx].irq_ctrl);
  200. if (FSP_SUCCESS != err)
  201. {
  202. /* ICU Close failure message */
  203. LOG_E("\r\n**R_ICU_ExternalIrqClose API FAILED**\r\n");
  204. return -RT_ERROR;
  205. }
  206. }
  207. return RT_EOK;
  208. #else
  209. return -RT_ERROR;
  210. #endif
  211. }
  212. static rt_err_t ra_pin_attach_irq(struct rt_device *device, rt_base_t pin,
  213. rt_uint8_t mode, void (*hdr)(void *args), void *args)
  214. {
  215. #ifdef R_ICU_H
  216. rt_int32_t irqx = ra_pin_get_irqx(pin);
  217. if (0 <= irqx && irqx < (sizeof(pin_irq_map) / sizeof(pin_irq_map[0])))
  218. {
  219. int level = rt_hw_interrupt_disable();
  220. if (pin_irq_hdr_tab[irqx].pin == irqx &&
  221. pin_irq_hdr_tab[irqx].hdr == hdr &&
  222. pin_irq_hdr_tab[irqx].mode == mode &&
  223. pin_irq_hdr_tab[irqx].args == args)
  224. {
  225. rt_hw_interrupt_enable(level);
  226. return RT_EOK;
  227. }
  228. if (pin_irq_hdr_tab[irqx].pin != -1)
  229. {
  230. rt_hw_interrupt_enable(level);
  231. return -RT_EBUSY;
  232. }
  233. pin_irq_hdr_tab[irqx].pin = irqx;
  234. pin_irq_hdr_tab[irqx].hdr = hdr;
  235. pin_irq_hdr_tab[irqx].mode = mode;
  236. pin_irq_hdr_tab[irqx].args = args;
  237. rt_hw_interrupt_enable(level);
  238. }
  239. else return -RT_ERROR;
  240. return RT_EOK;
  241. #else
  242. return -RT_ERROR;
  243. #endif
  244. }
  245. static rt_err_t ra_pin_dettach_irq(struct rt_device *device, rt_base_t pin)
  246. {
  247. #ifdef R_ICU_H
  248. rt_int32_t irqx = ra_pin_get_irqx(pin);
  249. if (0 <= irqx && irqx < sizeof(pin_irq_map) / sizeof(pin_irq_map[0]))
  250. {
  251. int level = rt_hw_interrupt_disable();
  252. if (pin_irq_hdr_tab[irqx].pin == -1)
  253. {
  254. rt_hw_interrupt_enable(level);
  255. return RT_EOK;
  256. }
  257. pin_irq_hdr_tab[irqx].pin = -1;
  258. pin_irq_hdr_tab[irqx].hdr = RT_NULL;
  259. pin_irq_hdr_tab[irqx].mode = 0;
  260. pin_irq_hdr_tab[irqx].args = RT_NULL;
  261. rt_hw_interrupt_enable(level);
  262. }
  263. else
  264. {
  265. return -RT_ERROR;
  266. }
  267. return RT_EOK;
  268. #else
  269. return -RT_ERROR;
  270. #endif
  271. }
  272. static rt_base_t ra_pin_get(const char *name)
  273. {
  274. int pin_number = -1, port = -1, pin = -1;
  275. if (rt_strlen(name) != 4)
  276. return -1;
  277. if ((name[0] == 'P') || (name[0] == 'p'))
  278. {
  279. if ('0' <= (int)name[1] && (int)name[1] <= '9')
  280. {
  281. port = ((int)name[1] - 48) * 16 * 16;
  282. if ('0' <= (int)name[2] && (int)name[2] <= '9')
  283. {
  284. if ('0' <= (int)name[3] && (int)name[3] <= '9')
  285. {
  286. pin = ((int)name[2] - 48) * 10;
  287. pin += (int)name[3] - 48;
  288. pin_number = port + pin;
  289. }
  290. else return -1;
  291. }
  292. else return -1;
  293. }
  294. else return -1;
  295. }
  296. return pin_number;
  297. }
  298. const static struct rt_pin_ops _ra_pin_ops =
  299. {
  300. .pin_mode = ra_pin_mode,
  301. .pin_write = ra_pin_write,
  302. .pin_read = ra_pin_read,
  303. .pin_attach_irq = ra_pin_attach_irq,
  304. .pin_detach_irq = ra_pin_dettach_irq,
  305. .pin_irq_enable = ra_pin_irq_enable,
  306. .pin_get = ra_pin_get,
  307. };
  308. int rt_hw_pin_init(void)
  309. {
  310. #ifdef R_ICU_H
  311. ra_irq_tab_init();
  312. ra_pin_map_init();
  313. #endif
  314. return rt_device_pin_register("pin", &_ra_pin_ops, RT_NULL);
  315. }
  316. #ifdef R_ICU_H
  317. void irq_callback(external_irq_callback_args_t *p_args)
  318. {
  319. rt_interrupt_enter();
  320. if (p_args->channel == pin_irq_hdr_tab[p_args->channel].pin)
  321. {
  322. pin_irq_hdr_tab[p_args->channel].hdr(pin_irq_hdr_tab[p_args->channel].args);
  323. }
  324. rt_interrupt_leave();
  325. };
  326. #endif /* R_ICU_H */
  327. #endif /* RT_USING_PIN */