drv_gpio.c 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544
  1. /*
  2. * Copyright (c) 2006-2018, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2021-08-04 stackRyan first version
  9. */
  10. #include <rtthread.h>
  11. #include <rtdevice.h>
  12. #include <board.h>
  13. #include <rthw.h>
  14. #define MM32_PIN(index, rcc, gpio, gpio_index) { 0, RCC_##rcc##Periph_GPIO##gpio, GPIO##gpio, GPIO_Pin_##gpio_index, GPIO_PortSourceGPIO##gpio, GPIO_PinSource##gpio_index}
  15. #define MM32_PIN_DEFAULT {-1, 0, 0, 0, 0, 0}
  16. /* MM32 GPIO driver */
  17. struct pin_index
  18. {
  19. int index;
  20. uint32_t rcc;
  21. GPIO_TypeDef *gpio;
  22. uint32_t pin;
  23. uint8_t port_source;
  24. uint8_t pin_source;
  25. };
  26. static const struct pin_index mm32_pin_map[] =
  27. {
  28. MM32_PIN_DEFAULT,
  29. MM32_PIN(1, APB2, A, 0),
  30. MM32_PIN(2, APB2, A, 1),
  31. MM32_PIN(3, APB2, A, 2),
  32. MM32_PIN(4, APB2, A, 3),
  33. MM32_PIN(5, APB2, A, 4),
  34. MM32_PIN(6, APB2, A, 5),
  35. MM32_PIN(7, APB2, A, 6),
  36. MM32_PIN(8, APB2, A, 7),
  37. MM32_PIN(9, APB2, A, 8),
  38. MM32_PIN(10, APB2, A, 9),
  39. MM32_PIN(11, APB2, A, 10),
  40. MM32_PIN(12, APB2, A, 11),
  41. MM32_PIN(13, APB2, A, 12),
  42. MM32_PIN(14, APB2, A, 13),
  43. MM32_PIN(15, APB2, A, 14),
  44. MM32_PIN(16, APB2, A, 15),
  45. MM32_PIN(17, APB2, B, 0),
  46. MM32_PIN(18, APB2, B, 1),
  47. MM32_PIN(19, APB2, B, 2),
  48. MM32_PIN(20, APB2, B, 3),
  49. MM32_PIN(21, APB2, B, 4),
  50. MM32_PIN(22, APB2, B, 5),
  51. MM32_PIN(23, APB2, B, 6),
  52. MM32_PIN(24, APB2, B, 7),
  53. MM32_PIN(25, APB2, B, 8),
  54. MM32_PIN(26, APB2, B, 9),
  55. MM32_PIN(27, APB2, B, 10),
  56. MM32_PIN(28, APB2, B, 11),
  57. MM32_PIN(29, APB2, B, 12),
  58. MM32_PIN(30, APB2, B, 13),
  59. MM32_PIN(31, APB2, B, 14),
  60. MM32_PIN(32, APB2, B, 15),
  61. MM32_PIN(33, APB2, C, 0),
  62. MM32_PIN(34, APB2, C, 1),
  63. MM32_PIN(35, APB2, C, 2),
  64. MM32_PIN(36, APB2, C, 3),
  65. MM32_PIN(37, APB2, C, 4),
  66. MM32_PIN(38, APB2, C, 5),
  67. MM32_PIN(39, APB2, C, 6),
  68. MM32_PIN(40, APB2, C, 7),
  69. MM32_PIN(41, APB2, C, 8),
  70. MM32_PIN(42, APB2, C, 9),
  71. MM32_PIN(43, APB2, C, 10),
  72. MM32_PIN(44, APB2, C, 11),
  73. MM32_PIN(45, APB2, C, 12),
  74. MM32_PIN(46, APB2, C, 13),
  75. MM32_PIN(47, APB2, C, 14),
  76. MM32_PIN(48, APB2, C, 15),
  77. MM32_PIN(49, APB2, D, 0),
  78. MM32_PIN(50, APB2, D, 1),
  79. MM32_PIN(51, APB2, D, 2),
  80. MM32_PIN(52, APB2, D, 3),
  81. MM32_PIN(53, APB2, D, 4),
  82. MM32_PIN(54, APB2, D, 5),
  83. MM32_PIN(55, APB2, D, 6),
  84. MM32_PIN(56, APB2, D, 7),
  85. MM32_PIN(57, APB2, D, 8),
  86. MM32_PIN(58, APB2, D, 9),
  87. MM32_PIN(59, APB2, D, 10),
  88. MM32_PIN(60, APB2, D, 11),
  89. MM32_PIN(61, APB2, D, 12),
  90. MM32_PIN(62, APB2, D, 13),
  91. MM32_PIN(63, APB2, D, 14),
  92. MM32_PIN(64, APB2, D, 15),
  93. };
  94. struct pin_irq_map
  95. {
  96. rt_uint16_t pinbit;
  97. rt_uint32_t irqbit;
  98. enum IRQn irqno;
  99. };
  100. const struct pin_irq_map mm32_pin_irq_map[] =
  101. {
  102. {GPIO_Pin_0, EXTI_Line0, EXTI0_IRQn },
  103. {GPIO_Pin_1, EXTI_Line1, EXTI1_IRQn },
  104. {GPIO_Pin_2, EXTI_Line2, EXTI2_IRQn },
  105. {GPIO_Pin_3, EXTI_Line3, EXTI3_IRQn },
  106. {GPIO_Pin_4, EXTI_Line4, EXTI4_IRQn },
  107. {GPIO_Pin_5, EXTI_Line5, EXTI9_5_IRQn },
  108. {GPIO_Pin_6, EXTI_Line6, EXTI9_5_IRQn },
  109. {GPIO_Pin_7, EXTI_Line7, EXTI9_5_IRQn },
  110. {GPIO_Pin_8, EXTI_Line8, EXTI9_5_IRQn },
  111. {GPIO_Pin_9, EXTI_Line9, EXTI9_5_IRQn },
  112. {GPIO_Pin_10, EXTI_Line10, EXTI15_10_IRQn},
  113. {GPIO_Pin_11, EXTI_Line11, EXTI15_10_IRQn},
  114. {GPIO_Pin_12, EXTI_Line12, EXTI15_10_IRQn},
  115. {GPIO_Pin_13, EXTI_Line13, EXTI15_10_IRQn},
  116. {GPIO_Pin_14, EXTI_Line14, EXTI15_10_IRQn},
  117. {GPIO_Pin_15, EXTI_Line15, EXTI15_10_IRQn},
  118. };
  119. struct rt_pin_irq_hdr mm32_pin_irq_hdr_tab[] =
  120. {
  121. {-1, 0, RT_NULL, RT_NULL},
  122. {-1, 0, RT_NULL, RT_NULL},
  123. {-1, 0, RT_NULL, RT_NULL},
  124. {-1, 0, RT_NULL, RT_NULL},
  125. {-1, 0, RT_NULL, RT_NULL},
  126. {-1, 0, RT_NULL, RT_NULL},
  127. {-1, 0, RT_NULL, RT_NULL},
  128. {-1, 0, RT_NULL, RT_NULL},
  129. {-1, 0, RT_NULL, RT_NULL},
  130. {-1, 0, RT_NULL, RT_NULL},
  131. {-1, 0, RT_NULL, RT_NULL},
  132. {-1, 0, RT_NULL, RT_NULL},
  133. {-1, 0, RT_NULL, RT_NULL},
  134. {-1, 0, RT_NULL, RT_NULL},
  135. {-1, 0, RT_NULL, RT_NULL},
  136. {-1, 0, RT_NULL, RT_NULL},
  137. };
  138. #define ITEM_NUM(items) sizeof(items) / sizeof(items[0])
  139. const struct pin_index *get_pin(uint8_t pin)
  140. {
  141. const struct pin_index *index;
  142. if (pin < ITEM_NUM(mm32_pin_map))
  143. {
  144. index = &mm32_pin_map[pin];
  145. if (index->gpio == 0)
  146. index = RT_NULL;
  147. }
  148. else
  149. {
  150. index = RT_NULL;
  151. }
  152. return index;
  153. };
  154. void mm32_pin_write(rt_device_t dev, rt_base_t pin, rt_uint8_t value)
  155. {
  156. const struct pin_index *index;
  157. index = get_pin(pin);
  158. if (index == RT_NULL)
  159. {
  160. return;
  161. }
  162. if (value == PIN_LOW)
  163. {
  164. GPIO_ResetBits(index->gpio, index->pin);
  165. }
  166. else
  167. {
  168. GPIO_SetBits(index->gpio, index->pin);
  169. }
  170. }
  171. rt_ssize_t mm32_pin_read(rt_device_t dev, rt_base_t pin)
  172. {
  173. rt_ssize_t value;
  174. const struct pin_index *index;
  175. value = PIN_LOW;
  176. index = get_pin(pin);
  177. if (index == RT_NULL)
  178. {
  179. return -RT_EINVAL;
  180. }
  181. if (GPIO_ReadInputDataBit(index->gpio, index->pin) == Bit_RESET)
  182. {
  183. value = PIN_LOW;
  184. }
  185. else
  186. {
  187. value = PIN_HIGH;
  188. }
  189. return value;
  190. }
  191. void mm32_pin_mode(rt_device_t dev, rt_base_t pin, rt_uint8_t mode)
  192. {
  193. const struct pin_index *index;
  194. GPIO_InitTypeDef GPIO_InitStructure;
  195. index = get_pin(pin);
  196. if (index == RT_NULL)
  197. {
  198. return;
  199. }
  200. /* GPIO Periph clock enable */
  201. RCC_APB2PeriphClockCmd(index->rcc, ENABLE);
  202. /* Configure GPIO_InitStructure */
  203. GPIO_InitStructure.GPIO_Pin = index->pin;
  204. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
  205. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  206. if (mode == PIN_MODE_OUTPUT)
  207. {
  208. /* output setting */
  209. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
  210. }
  211. else if (mode == PIN_MODE_OUTPUT_OD)
  212. {
  213. /* output setting: od. */
  214. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_OD;
  215. }
  216. else if (mode == PIN_MODE_INPUT)
  217. {
  218. /* input setting: not pull. */
  219. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;
  220. }
  221. else if (mode == PIN_MODE_INPUT_PULLUP)
  222. {
  223. /* input setting: pull up. */
  224. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;
  225. }
  226. else
  227. {
  228. /* input setting:default. */
  229. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD;
  230. }
  231. GPIO_Init( index->gpio, &GPIO_InitStructure);
  232. }
  233. rt_inline rt_int32_t bit2bitno(rt_uint32_t bit)
  234. {
  235. int i;
  236. for (i = 0; i < 32; i++)
  237. {
  238. if ((0x01 << i) == bit)
  239. {
  240. return i;
  241. }
  242. }
  243. return -1;
  244. }
  245. rt_inline const struct pin_irq_map *get_pin_irq_map(uint32_t pinbit)
  246. {
  247. rt_int32_t mapindex = bit2bitno(pinbit);
  248. if (mapindex < 0 || mapindex >= ITEM_NUM(mm32_pin_irq_map))
  249. {
  250. return RT_NULL;
  251. }
  252. return &mm32_pin_irq_map[mapindex];
  253. };
  254. rt_err_t mm32_pin_attach_irq(struct rt_device *device, rt_base_t pin,
  255. rt_uint8_t mode, void (*hdr)(void *args), void *args)
  256. {
  257. const struct pin_index *index;
  258. rt_base_t level;
  259. rt_int32_t irqindex = -1;
  260. index = get_pin(pin);
  261. if (index == RT_NULL)
  262. {
  263. return -RT_ENOSYS;
  264. }
  265. irqindex = bit2bitno(index->pin);
  266. if (irqindex < 0 || irqindex >= ITEM_NUM(mm32_pin_irq_map))
  267. {
  268. return -RT_ENOSYS;
  269. }
  270. level = rt_hw_interrupt_disable();
  271. if (mm32_pin_irq_hdr_tab[irqindex].pin == pin &&
  272. mm32_pin_irq_hdr_tab[irqindex].hdr == hdr &&
  273. mm32_pin_irq_hdr_tab[irqindex].mode == mode &&
  274. mm32_pin_irq_hdr_tab[irqindex].args == args
  275. )
  276. {
  277. rt_hw_interrupt_enable(level);
  278. return RT_EOK;
  279. }
  280. if (mm32_pin_irq_hdr_tab[irqindex].pin != -1)
  281. {
  282. rt_hw_interrupt_enable(level);
  283. return -RT_EBUSY;
  284. }
  285. mm32_pin_irq_hdr_tab[irqindex].pin = pin;
  286. mm32_pin_irq_hdr_tab[irqindex].hdr = hdr;
  287. mm32_pin_irq_hdr_tab[irqindex].mode = mode;
  288. mm32_pin_irq_hdr_tab[irqindex].args = args;
  289. rt_hw_interrupt_enable(level);
  290. return RT_EOK;
  291. }
  292. rt_err_t mm32_pin_detach_irq(struct rt_device *device, rt_base_t pin)
  293. {
  294. const struct pin_index *index;
  295. rt_base_t level;
  296. rt_int32_t irqindex = -1;
  297. index = get_pin(pin);
  298. if (index == RT_NULL)
  299. {
  300. return -RT_ENOSYS;
  301. }
  302. irqindex = bit2bitno(index->pin);
  303. if (irqindex < 0 || irqindex >= ITEM_NUM(mm32_pin_irq_map))
  304. {
  305. return -RT_ENOSYS;
  306. }
  307. level = rt_hw_interrupt_disable();
  308. if (mm32_pin_irq_hdr_tab[irqindex].pin == -1)
  309. {
  310. rt_hw_interrupt_enable(level);
  311. return RT_EOK;
  312. }
  313. mm32_pin_irq_hdr_tab[irqindex].pin = -1;
  314. mm32_pin_irq_hdr_tab[irqindex].hdr = RT_NULL;
  315. mm32_pin_irq_hdr_tab[irqindex].mode = 0;
  316. mm32_pin_irq_hdr_tab[irqindex].args = RT_NULL;
  317. rt_hw_interrupt_enable(level);
  318. return RT_EOK;
  319. }
  320. rt_err_t mm32_pin_irq_enable(struct rt_device *device, rt_base_t pin,
  321. rt_uint8_t enabled)
  322. {
  323. const struct pin_index *index;
  324. const struct pin_irq_map *irqmap;
  325. rt_base_t level;
  326. rt_int32_t irqindex = -1;
  327. GPIO_InitTypeDef GPIO_InitStructure;
  328. NVIC_InitTypeDef NVIC_InitStructure;
  329. EXTI_InitTypeDef EXTI_InitStructure;
  330. index = get_pin(pin);
  331. if (index == RT_NULL)
  332. {
  333. return -RT_ENOSYS;
  334. }
  335. if (enabled == PIN_IRQ_ENABLE)
  336. {
  337. irqindex = bit2bitno(index->pin);
  338. if (irqindex < 0 || irqindex >= ITEM_NUM(mm32_pin_irq_map))
  339. {
  340. return -RT_ENOSYS;
  341. }
  342. level = rt_hw_interrupt_disable();
  343. if (mm32_pin_irq_hdr_tab[irqindex].pin == -1)
  344. {
  345. rt_hw_interrupt_enable(level);
  346. return -RT_ENOSYS;
  347. }
  348. irqmap = &mm32_pin_irq_map[irqindex];
  349. /* GPIO Periph clock enable */
  350. RCC_APB2PeriphClockCmd(index->rcc, ENABLE);
  351. /* Configure GPIO_InitStructure */
  352. GPIO_InitStructure.GPIO_Pin = index->pin;
  353. GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU;
  354. GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  355. GPIO_Init(index->gpio, &GPIO_InitStructure);
  356. NVIC_InitStructure.NVIC_IRQChannel = irqmap->irqno;
  357. NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2;
  358. NVIC_InitStructure.NVIC_IRQChannelSubPriority = 2;
  359. NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
  360. NVIC_Init(&NVIC_InitStructure);
  361. GPIO_EXTILineConfig(index->port_source, index->pin_source);
  362. EXTI_InitStructure.EXTI_Line = irqmap->irqbit;
  363. EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt;
  364. switch (mm32_pin_irq_hdr_tab[irqindex].mode)
  365. {
  366. case PIN_IRQ_MODE_RISING:
  367. EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Rising;
  368. break;
  369. case PIN_IRQ_MODE_FALLING:
  370. EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Falling;
  371. break;
  372. case PIN_IRQ_MODE_RISING_FALLING:
  373. EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Rising_Falling;
  374. break;
  375. }
  376. EXTI_InitStructure.EXTI_LineCmd = ENABLE;
  377. EXTI_Init(&EXTI_InitStructure);
  378. rt_hw_interrupt_enable(level);
  379. }
  380. else if (enabled == PIN_IRQ_DISABLE)
  381. {
  382. irqmap = get_pin_irq_map(index->pin);
  383. if (irqmap == RT_NULL)
  384. {
  385. return -RT_ENOSYS;
  386. }
  387. EXTI_InitStructure.EXTI_Line = irqmap->irqbit;
  388. EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt;
  389. EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Rising;
  390. EXTI_InitStructure.EXTI_LineCmd = DISABLE;
  391. EXTI_Init(&EXTI_InitStructure);
  392. }
  393. else
  394. {
  395. return -RT_ENOSYS;
  396. }
  397. return RT_EOK;
  398. }
  399. const static struct rt_pin_ops _mm32_pin_ops =
  400. {
  401. mm32_pin_mode,
  402. mm32_pin_write,
  403. mm32_pin_read,
  404. mm32_pin_attach_irq,
  405. mm32_pin_detach_irq,
  406. mm32_pin_irq_enable,
  407. RT_NULL,
  408. };
  409. int rt_hw_pin_init(void)
  410. {
  411. int result;
  412. result = rt_device_pin_register("pin", &_mm32_pin_ops, RT_NULL);
  413. return result;
  414. }
  415. INIT_BOARD_EXPORT(rt_hw_pin_init);
  416. rt_inline void pin_irq_hdr(int irqno)
  417. {
  418. EXTI_ClearITPendingBit(mm32_pin_irq_map[irqno].irqbit);
  419. if (mm32_pin_irq_hdr_tab[irqno].hdr)
  420. {
  421. mm32_pin_irq_hdr_tab[irqno].hdr(mm32_pin_irq_hdr_tab[irqno].args);
  422. }
  423. }
  424. void EXTI0_IRQHandler(void)
  425. {
  426. /* enter interrupt */
  427. rt_interrupt_enter();
  428. pin_irq_hdr(0);
  429. /* leave interrupt */
  430. rt_interrupt_leave();
  431. }
  432. void EXTI1_IRQHandler(void)
  433. {
  434. /* enter interrupt */
  435. rt_interrupt_enter();
  436. pin_irq_hdr(1);
  437. /* leave interrupt */
  438. rt_interrupt_leave();
  439. }
  440. void EXTI2_IRQHandler(void)
  441. {
  442. /* enter interrupt */
  443. rt_interrupt_enter();
  444. pin_irq_hdr(2);
  445. /* leave interrupt */
  446. rt_interrupt_leave();
  447. }
  448. void EXTI3_IRQHandler(void)
  449. {
  450. /* enter interrupt */
  451. rt_interrupt_enter();
  452. pin_irq_hdr(3);
  453. /* leave interrupt */
  454. rt_interrupt_leave();
  455. }
  456. void EXTI4_IRQHandler(void)
  457. {
  458. /* enter interrupt */
  459. rt_interrupt_enter();
  460. pin_irq_hdr(4);
  461. /* leave interrupt */
  462. rt_interrupt_leave();
  463. }
  464. void EXTI9_5_IRQHandler(void)
  465. {
  466. /* enter interrupt */
  467. rt_interrupt_enter();
  468. if (EXTI_GetITStatus(EXTI_Line5) != RESET)
  469. {
  470. pin_irq_hdr(5);
  471. }
  472. if (EXTI_GetITStatus(EXTI_Line6) != RESET)
  473. {
  474. pin_irq_hdr(6);
  475. }
  476. if (EXTI_GetITStatus(EXTI_Line7) != RESET)
  477. {
  478. pin_irq_hdr(7);
  479. }
  480. if (EXTI_GetITStatus(EXTI_Line8) != RESET)
  481. {
  482. pin_irq_hdr(8);
  483. }
  484. if (EXTI_GetITStatus(EXTI_Line9) != RESET)
  485. {
  486. pin_irq_hdr(9);
  487. }
  488. /* leave interrupt */
  489. rt_interrupt_leave();
  490. }
  491. void EXTI15_10_IRQHandler(void)
  492. {
  493. /* enter interrupt */
  494. rt_interrupt_enter();
  495. if (EXTI_GetITStatus(EXTI_Line10) != RESET)
  496. {
  497. pin_irq_hdr(10);
  498. }
  499. if (EXTI_GetITStatus(EXTI_Line11) != RESET)
  500. {
  501. pin_irq_hdr(11);
  502. }
  503. if (EXTI_GetITStatus(EXTI_Line12) != RESET)
  504. {
  505. pin_irq_hdr(12);
  506. }
  507. if (EXTI_GetITStatus(EXTI_Line13) != RESET)
  508. {
  509. pin_irq_hdr(13);
  510. }
  511. if (EXTI_GetITStatus(EXTI_Line14) != RESET)
  512. {
  513. pin_irq_hdr(14);
  514. }
  515. if (EXTI_GetITStatus(EXTI_Line15) != RESET)
  516. {
  517. pin_irq_hdr(15);
  518. }
  519. /* leave interrupt */
  520. rt_interrupt_leave();
  521. }