drv_sdcard.c 7.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268
  1. /*
  2. * Copyright (c) 2006-2018, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. *
  7. * Change Logs:
  8. * Date Author Notes
  9. * 2018-01-13 Liu2guang the first version.
  10. */
  11. #include <rtthread.h>
  12. #include <rtdevice.h>
  13. #include "board.h"
  14. #include "drv_sdcard.h"
  15. #ifndef SDIO_CLK_DIV
  16. #define SDIO_CLK_DIV 2
  17. #endif
  18. #define SDIO_TIMEOUT ((uint32_t)0x100000)
  19. static SD_HandleTypeDef hsdcard;
  20. static DMA_HandleTypeDef hdma;
  21. static struct rt_semaphore sd_lock;
  22. void SDIO_IRQHandler(void)
  23. {
  24. rt_interrupt_enter();
  25. HAL_SD_IRQHandler(&hsdcard);
  26. rt_interrupt_leave();
  27. }
  28. #if defined(USING_SD_RX_DMA) || defined(USING_SD_TX_DMA)
  29. void DMA2_Channel4_5_IRQHandler(void)
  30. {
  31. rt_interrupt_enter();
  32. HAL_DMA_IRQHandler(&hdma);
  33. rt_interrupt_leave();
  34. }
  35. #endif
  36. rt_err_t stm32_read_blocks(uint32_t *data, uint32_t addr, uint32_t num)
  37. {
  38. uint32_t timeout = 0;
  39. HAL_SD_StateTypeDef state_return;
  40. HAL_SD_CardStateTypeDef sd_card_state_return;
  41. #if defined(USING_SD_RX_DMA) && defined(USING_SD_TX_DMA)
  42. hdma.Init.Direction = DMA_PERIPH_TO_MEMORY;
  43. hdma.Init.PeriphInc = DMA_PINC_DISABLE;
  44. hdma.Init.MemInc = DMA_MINC_ENABLE;
  45. HAL_DMA_DeInit(&hdma);
  46. HAL_DMA_Init(&hdma);
  47. #endif
  48. #if defined(USING_SD_RX_DMA)
  49. if (HAL_SD_ReadBlocks_DMA(&hsdcard, (uint8_t *)data, addr, num) != HAL_OK)
  50. #else
  51. if (HAL_SD_ReadBlocks(&hsdcard, (uint8_t *)data, addr, num, SDIO_TIMEOUT) != HAL_OK)
  52. #endif
  53. {
  54. return RT_EIO;
  55. }
  56. do
  57. {
  58. state_return = HAL_SD_GetState(&hsdcard);
  59. timeout++;
  60. }
  61. while ((HAL_SD_STATE_BUSY == state_return) && (SDIO_TIMEOUT > timeout));
  62. if (HAL_SD_STATE_READY != state_return)
  63. {
  64. return RT_ERROR;
  65. }
  66. do
  67. {
  68. sd_card_state_return = HAL_SD_GetCardState(&hsdcard);
  69. timeout++;
  70. }
  71. while ((HAL_SD_CARD_TRANSFER != sd_card_state_return) && (SDIO_TIMEOUT > timeout));
  72. if (SDIO_TIMEOUT <= timeout)
  73. {
  74. return RT_ETIMEOUT;
  75. }
  76. return RT_EOK;
  77. }
  78. rt_err_t stm32_write_blocks(uint32_t *data, uint32_t addr, uint32_t num)
  79. {
  80. uint32_t timeout = 0;
  81. HAL_SD_StateTypeDef state_return;
  82. HAL_SD_CardStateTypeDef sd_card_state_return;
  83. #if defined(USING_SD_RX_DMA) && defined(USING_SD_TX_DMA)
  84. hdma.Init.Direction = DMA_MEMORY_TO_PERIPH;
  85. hdma.Init.PeriphInc = DMA_MINC_ENABLE;
  86. hdma.Init.MemInc = DMA_PINC_DISABLE;
  87. HAL_DMA_DeInit(&hdma);
  88. HAL_DMA_Init(&hdma);
  89. #endif
  90. #if defined(USING_SD_TX_DMA)
  91. if (HAL_SD_WriteBlocks_DMA(&hsdcard, (uint8_t *)data, addr, num) != HAL_OK)
  92. #else
  93. if (HAL_SD_WriteBlocks(&hsdcard, (uint8_t *)data, addr, num, SDIO_TIMEOUT) != HAL_OK)
  94. #endif
  95. {
  96. return RT_ERROR;
  97. }
  98. do
  99. {
  100. state_return = HAL_SD_GetState(&hsdcard);
  101. timeout++;
  102. }
  103. while ((HAL_SD_STATE_BUSY == state_return) && (SDIO_TIMEOUT > timeout));
  104. if (HAL_SD_STATE_READY != state_return)
  105. {
  106. return RT_ERROR;
  107. }
  108. do
  109. {
  110. sd_card_state_return = HAL_SD_GetCardState(&hsdcard);
  111. timeout++;
  112. }
  113. while ((HAL_SD_CARD_TRANSFER != sd_card_state_return) && (SDIO_TIMEOUT > timeout));
  114. if (SDIO_TIMEOUT <= timeout)
  115. {
  116. return RT_ETIMEOUT;
  117. }
  118. return RT_EOK;
  119. }
  120. static rt_err_t stm32_sdcard_init(rt_device_t dev)
  121. {
  122. GPIO_InitTypeDef GPIO_InitStruct;
  123. if (rt_sem_init(&sd_lock, "sdlock", 1, RT_IPC_FLAG_FIFO) != RT_EOK)
  124. {
  125. return RT_ERROR;
  126. }
  127. __HAL_RCC_GPIOD_CLK_ENABLE();
  128. __HAL_RCC_GPIOC_CLK_ENABLE();
  129. GPIO_InitStruct.Pin = GPIO_PIN_8 | GPIO_PIN_9 | GPIO_PIN_10 | GPIO_PIN_11 |
  130. GPIO_PIN_12;
  131. GPIO_InitStruct.Mode = GPIO_MODE_AF_PP;
  132. GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH;
  133. HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
  134. GPIO_InitStruct.Pin = GPIO_PIN_2;
  135. HAL_GPIO_Init(GPIOD, &GPIO_InitStruct);
  136. #if defined(USING_SD_RX_DMA) || defined(USING_SD_TX_DMA)
  137. __HAL_RCC_DMA2_CLK_ENABLE();
  138. hdma.Instance = DMA2_Channel4;
  139. hdma.Init.PeriphDataAlignment = DMA_PDATAALIGN_WORD;
  140. hdma.Init.MemDataAlignment = DMA_MDATAALIGN_WORD;
  141. hdma.Init.Mode = DMA_NORMAL;
  142. hdma.Init.Priority = DMA_PRIORITY_HIGH;
  143. #if defined(USING_SD_RX_DMA)
  144. hdma.Init.Direction = DMA_PERIPH_TO_MEMORY;
  145. hdma.Init.PeriphInc = DMA_PINC_DISABLE;
  146. hdma.Init.MemInc = DMA_MINC_ENABLE;
  147. __HAL_LINKDMA(&hsdcard, hdmarx, hdma);
  148. #endif
  149. #if defined(USING_SD_TX_DMA)
  150. hdma.Init.Direction = DMA_MEMORY_TO_PERIPH;
  151. hdma.Init.PeriphInc = DMA_MINC_ENABLE;
  152. hdma.Init.MemInc = DMA_PINC_DISABLE;
  153. __HAL_LINKDMA(&hsdcard, hdmatx, hdma);
  154. #endif
  155. HAL_DMA_DeInit(&hdma);
  156. if (HAL_DMA_Init(&hdma) != HAL_OK)
  157. {
  158. rt_kprintf("HAL_DMA_Init error\n");
  159. return RT_EIO;
  160. }
  161. #endif
  162. HAL_NVIC_SetPriority(DMA2_Channel4_5_IRQn, 3, 0);
  163. HAL_NVIC_EnableIRQ(DMA2_Channel4_5_IRQn);
  164. __HAL_RCC_SDIO_CLK_ENABLE();
  165. hsdcard.Instance = SDIO;
  166. hsdcard.Init.ClockEdge = SDIO_CLOCK_EDGE_RISING;
  167. hsdcard.Init.ClockBypass = SDIO_CLOCK_BYPASS_DISABLE;
  168. hsdcard.Init.ClockPowerSave = SDIO_CLOCK_POWER_SAVE_DISABLE;
  169. hsdcard.Init.BusWide = SDIO_BUS_WIDE_1B;
  170. hsdcard.Init.HardwareFlowControl = SDIO_HARDWARE_FLOW_CONTROL_ENABLE;
  171. hsdcard.Init.ClockDiv = SDIO_CLK_DIV;
  172. HAL_SD_DeInit(&hsdcard);
  173. if (HAL_SD_Init(&hsdcard) != HAL_OK)
  174. {
  175. rt_kprintf("HAL_SD_Init error\n");
  176. return RT_EIO;
  177. }
  178. HAL_NVIC_SetPriority(SDIO_IRQn, 1, 0);
  179. HAL_NVIC_EnableIRQ(SDIO_IRQn);
  180. if (HAL_SD_ConfigWideBusOperation(&hsdcard, SDIO_BUS_WIDE_4B) != HAL_OK)
  181. {
  182. rt_kprintf("HAL_SD_ConfigWideBusOperation error\n");
  183. return RT_EIO;
  184. }
  185. return RT_EOK;
  186. }
  187. static rt_err_t stm32_sdcard_open(rt_device_t dev, rt_uint16_t oflag)
  188. {
  189. return RT_EOK;
  190. }
  191. static rt_err_t stm32_sdcard_close(rt_device_t dev)
  192. {
  193. return RT_EOK;
  194. }
  195. static rt_size_t stm32_sdcard_read(rt_device_t dev, rt_off_t pos, void *buffer, rt_size_t size)
  196. {
  197. int ret = RT_EOK;
  198. rt_sem_take(&sd_lock, RT_WAITING_FOREVER);
  199. ret = stm32_read_blocks((uint32_t *)buffer, pos, size);
  200. rt_sem_release(&sd_lock);
  201. if (ret != RT_EOK)
  202. {
  203. return 0;
  204. }
  205. return size;
  206. }
  207. static rt_size_t stm32_sdcard_write(rt_device_t dev, rt_off_t pos, const void *buffer, rt_size_t size)
  208. {
  209. int ret = RT_EOK;
  210. rt_sem_take(&sd_lock, RT_WAITING_FOREVER);
  211. ret = stm32_write_blocks((uint32_t *)buffer, pos, size);
  212. rt_sem_release(&sd_lock);
  213. if (ret != RT_EOK)
  214. {
  215. return 0;
  216. }
  217. return size;
  218. }
  219. static rt_err_t stm32_sdcard_control(rt_device_t dev, int cmd, void *args)
  220. {
  221. RT_ASSERT(dev != RT_NULL);
  222. // RT_DEVICE_CTRL_BLK_GETGEOME
  223. if (cmd == RT_DEVICE_CTRL_BLK_GETGEOME)
  224. {
  225. HAL_SD_CardInfoTypeDef sdcard_info;
  226. struct rt_device_blk_geometry *geometry;
  227. HAL_SD_GetCardInfo(&hsdcard, &sdcard_info);
  228. geometry = (struct rt_device_blk_geometry *)args;
  229. geometry->bytes_per_sector = sdcard_info.BlockSize;
  230. geometry->block_size = sdcard_info.BlockSize;
  231. geometry->sector_count = sdcard_info.BlockNbr;
  232. }
  233. return RT_EOK;
  234. }
  235. static struct rt_device device;
  236. int rt_hw_sdcard_init(void)
  237. {
  238. rt_err_t ret = RT_EOK;
  239. device.type = RT_Device_Class_Block;
  240. device.init = stm32_sdcard_init;
  241. device.open = stm32_sdcard_open;
  242. device.read = stm32_sdcard_read;
  243. device.write = stm32_sdcard_write;
  244. device.control = stm32_sdcard_control;
  245. device.close = stm32_sdcard_close;
  246. ret = rt_device_register(&device, "sd0",
  247. RT_DEVICE_FLAG_REMOVABLE |
  248. RT_DEVICE_FLAG_RDWR |
  249. RT_DEVICE_FLAG_STANDALONE);
  250. if (ret != RT_EOK)
  251. {
  252. return ret;
  253. }
  254. return RT_EOK;
  255. }
  256. INIT_DEVICE_EXPORT(rt_hw_sdcard_init);