AzulSCSI_platform.cpp 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614
  1. #include "AzulSCSI_platform.h"
  2. #include "gd32f20x_spi.h"
  3. #include "gd32f20x_dma.h"
  4. #include "AzulSCSI_log.h"
  5. #include "AzulSCSI_config.h"
  6. #include <SdFat.h>
  7. extern "C" {
  8. const char *g_azplatform_name = "GD32F205 AzulSCSI v1.x";
  9. static volatile uint32_t g_millisecond_counter;
  10. static uint32_t g_ns_to_cycles; // Q0.32 fixed point format
  11. unsigned long millis()
  12. {
  13. return g_millisecond_counter;
  14. }
  15. void delay(unsigned long ms)
  16. {
  17. uint32_t start = g_millisecond_counter;
  18. while ((uint32_t)(g_millisecond_counter - start) < ms);
  19. }
  20. void delay_ns(unsigned long ns)
  21. {
  22. if (ns <= 100) return; // Approximate call overhead
  23. ns -= 100;
  24. uint32_t VAL_start = SysTick->VAL;
  25. if (ns > 1000000)
  26. {
  27. int ms = ns / 1000000;
  28. ns = ns - ms * 1000000;
  29. delay(ms);
  30. }
  31. int cycles = ((uint64_t)ns * g_ns_to_cycles) >> 32;
  32. int end = (int)VAL_start - cycles;
  33. if (end <= 0)
  34. {
  35. end += SysTick->LOAD;
  36. while (SysTick->VAL < end);
  37. }
  38. while (SysTick->VAL > end);
  39. }
  40. void SysTick_Handler(void)
  41. {
  42. g_millisecond_counter++;
  43. }
  44. // Writes log data to the PB3 SWO pin
  45. void azplatform_log(const char *s)
  46. {
  47. while (*s)
  48. {
  49. // Write to SWO pin
  50. while (ITM->PORT[0].u32 == 0);
  51. ITM->PORT[0].u8 = *s++;
  52. }
  53. }
  54. // Initialize SPI and GPIO configuration
  55. // Clock has already been initialized by system_gd32f20x.c
  56. void azplatform_init()
  57. {
  58. SystemCoreClockUpdate();
  59. // Enable SysTick to drive millis()
  60. g_millisecond_counter = 0;
  61. g_ns_to_cycles = ((uint64_t)SystemCoreClock << 32) / 1000000000;
  62. SysTick_Config(SystemCoreClock / 1000U);
  63. NVIC_SetPriority(SysTick_IRQn, 0x00U);
  64. // Enable debug output on SWO pin
  65. DBG_CTL |= DBG_CTL_TRACE_IOEN;
  66. CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
  67. TPI->ACPR = SystemCoreClock / 2000000 - 1; // 2 Mbps baudrate for SWO
  68. TPI->SPPR = 2;
  69. TPI->FFCR = 0x100; // TPIU packet framing disabled
  70. // DWT->CTRL = (1 << DWT_CTRL_CYCTAP_Pos)
  71. // | (15 << DWT_CTRL_POSTPRESET_Pos)
  72. // | (1 << DWT_CTRL_PCSAMPLENA_Pos)
  73. // | (3 << DWT_CTRL_SYNCTAP_Pos)
  74. // | (1 << DWT_CTRL_CYCCNTENA_Pos);
  75. ITM->LAR = 0xC5ACCE55;
  76. ITM->TCR = (1 << ITM_TCR_DWTENA_Pos)
  77. | (1 << ITM_TCR_SYNCENA_Pos)
  78. | (1 << ITM_TCR_ITMENA_Pos);
  79. ITM->TER = 0xFFFFFFFF; // Enable all stimulus ports
  80. // Enable needed clocks for GPIO
  81. rcu_periph_clock_enable(RCU_GPIOA);
  82. rcu_periph_clock_enable(RCU_GPIOB);
  83. rcu_periph_clock_enable(RCU_GPIOC);
  84. rcu_periph_clock_enable(RCU_GPIOD);
  85. rcu_periph_clock_enable(RCU_GPIOE);
  86. // Switch to SWD debug port (disable JTAG) to release PB4 as GPIO
  87. gpio_pin_remap_config(GPIO_SWJ_SWDPENABLE_REMAP, ENABLE);
  88. // SCSI pins.
  89. // Initialize open drain outputs to high.
  90. gpio_bit_set(SCSI_OUT_PORT, SCSI_OUT_MASK);
  91. gpio_init(SCSI_OUT_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_MASK);
  92. gpio_init(SCSI_IN_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_IN_MASK);
  93. gpio_init(SCSI_ATN_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_ATN_PIN);
  94. gpio_init(SCSI_BSY_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_BSY_PIN);
  95. gpio_init(SCSI_SEL_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_SEL_PIN);
  96. gpio_init(SCSI_ACK_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_ACK_PIN);
  97. gpio_init(SCSI_RST_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_RST_PIN);
  98. // Terminator enable
  99. gpio_bit_set(SCSI_TERM_EN_PORT, SCSI_TERM_EN_PIN);
  100. gpio_init(SCSI_TERM_EN_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_2MHZ, SCSI_TERM_EN_PIN);
  101. // SD card pins
  102. gpio_init(SD_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SD_CS_PIN);
  103. gpio_init(SD_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, SD_CLK_PIN);
  104. gpio_init(SD_PORT, GPIO_MODE_IPU, 0, SD_MISO_PIN);
  105. gpio_init(SD_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, SD_MOSI_PIN);
  106. // DIP switches
  107. gpio_init(DIP_PORT, GPIO_MODE_IPD, 0, DIPSW1_PIN | DIPSW2_PIN | DIPSW3_PIN);
  108. // LED pins
  109. gpio_bit_set(LED_PORT, LED_PINS);
  110. gpio_init(LED_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_2MHZ, LED_PINS);
  111. // SWO trace pin on PB3
  112. gpio_init(GPIOB, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, GPIO_PIN_3);
  113. if (gpio_input_bit_get(DIP_PORT, DIPSW3_PIN))
  114. {
  115. azlog("DIPSW3 is ON: Enabling SCSI termination");
  116. gpio_bit_reset(SCSI_TERM_EN_PORT, SCSI_TERM_EN_PIN);
  117. }
  118. else
  119. {
  120. azlog("DIPSW3 is OFF: SCSI termination disabled");
  121. }
  122. if (gpio_input_bit_get(DIP_PORT, DIPSW2_PIN))
  123. {
  124. azlog("DIPSW2 is ON: enabling debug messages");
  125. g_azlog_debug = true;
  126. }
  127. else
  128. {
  129. g_azlog_debug = false;
  130. }
  131. }
  132. static void (*g_rst_callback)();
  133. void azplatform_set_rst_callback(void (*callback)())
  134. {
  135. g_rst_callback = callback;
  136. gpio_exti_source_select(SCSI_RST_EXTI_SOURCE_PORT, SCSI_RST_EXTI_SOURCE_PIN);
  137. exti_init(SCSI_RST_EXTI, EXTI_INTERRUPT, EXTI_TRIG_FALLING);
  138. NVIC_SetPriority(SCSI_RST_IRQn, 0x00U);
  139. }
  140. void SCSI_RST_IRQ (void)
  141. {
  142. if (exti_interrupt_flag_get(SCSI_RST_EXTI))
  143. {
  144. exti_interrupt_flag_clear(SCSI_RST_EXTI);
  145. if (g_rst_callback)
  146. {
  147. g_rst_callback();
  148. }
  149. }
  150. }
  151. /*****************************************/
  152. /* Crash handlers */
  153. /*****************************************/
  154. extern SdFs SD;
  155. void azplatform_emergency_log_save()
  156. {
  157. FsFile crashfile = SD.open(CRASHFILE, O_WRONLY | O_CREAT | O_TRUNC);
  158. if (!crashfile.isOpen())
  159. {
  160. // Try to reinitialize
  161. int max_retry = 10;
  162. while (max_retry-- > 0 && !SD.begin(SD_CONFIG));
  163. crashfile = SD.open(CRASHFILE, O_WRONLY | O_CREAT | O_TRUNC);
  164. }
  165. uint32_t startpos = 0;
  166. crashfile.write(azlog_get_buffer(&startpos));
  167. crashfile.write(azlog_get_buffer(&startpos));
  168. crashfile.flush();
  169. crashfile.close();
  170. }
  171. __attribute__((noinline))
  172. void show_hardfault(uint32_t *sp)
  173. {
  174. uint32_t pc = sp[6];
  175. uint32_t lr = sp[5];
  176. uint32_t cfsr = SCB->CFSR;
  177. azlog("--------------");
  178. azlog("CRASH!");
  179. azlog("Platform: ", g_azplatform_name);
  180. azlog("FW Version: ", g_azlog_firmwareversion);
  181. azlog("CFSR: ", cfsr);
  182. azlog("PC: ", pc);
  183. azlog("LR: ", lr);
  184. azlog("R0: ", sp[0]);
  185. azlog("R1: ", sp[1]);
  186. azlog("R2: ", sp[2]);
  187. azlog("R3: ", sp[3]);
  188. azplatform_emergency_log_save();
  189. while (1)
  190. {
  191. // Flash the crash address on the LED
  192. // Short pulse means 0, long pulse means 1
  193. int base_delay = 1000;
  194. for (int i = 31; i >= 0; i--)
  195. {
  196. LED_OFF();
  197. for (int j = 0; j < base_delay; j++) delay_ns(100000);
  198. int delay = (pc & (1 << i)) ? (3 * base_delay) : base_delay;
  199. LED_ON();
  200. for (int j = 0; j < delay; j++) delay_ns(100000);
  201. LED_OFF();
  202. }
  203. for (int j = 0; j < base_delay * 10; j++) delay_ns(100000);
  204. }
  205. }
  206. __attribute__((naked))
  207. void HardFault_Handler(void)
  208. {
  209. // Copies stack pointer into first argument
  210. asm("mrs r0, msp\n"
  211. "b show_hardfault": : : "r0");
  212. }
  213. __attribute__((naked))
  214. void MemManage_Handler(void)
  215. {
  216. asm("mrs r0, msp\n"
  217. "b show_hardfault": : : "r0");
  218. }
  219. __attribute__((naked))
  220. void BusFault_Handler(void)
  221. {
  222. asm("mrs r0, msp\n"
  223. "b show_hardfault": : : "r0");
  224. }
  225. __attribute__((naked))
  226. void UsageFault_Handler(void)
  227. {
  228. asm("mrs r0, msp\n"
  229. "b show_hardfault": : : "r0");
  230. }
  231. } /* extern "C" */
  232. /*****************************************/
  233. /* Driver for GD32 SPI for SdFat library */
  234. /*****************************************/
  235. extern volatile bool g_busreset;
  236. #define SCSI_WAIT_ACTIVE(pin) \
  237. if (!SCSI_IN(pin)) { \
  238. if (!SCSI_IN(pin)) { \
  239. while(!SCSI_IN(pin) && !g_busreset); \
  240. } \
  241. }
  242. #define SCSI_WAIT_INACTIVE(pin) \
  243. if (SCSI_IN(pin)) { \
  244. if (SCSI_IN(pin)) { \
  245. while(SCSI_IN(pin) && !g_busreset); \
  246. } \
  247. }
  248. #define SD_SPI SPI0
  249. #define SD_SPI_RX_DMA_CHANNEL DMA_CH1
  250. #define SD_SPI_TX_DMA_CHANNEL DMA_CH2
  251. class GD32SPIDriver : public SdSpiBaseClass
  252. {
  253. public:
  254. void begin(SdSpiConfig config) {
  255. rcu_periph_clock_enable(RCU_SPI0);
  256. rcu_periph_clock_enable(RCU_DMA0);
  257. dma_parameter_struct rx_dma_config =
  258. {
  259. .periph_addr = (uint32_t)&SPI_DATA(SD_SPI),
  260. .periph_width = DMA_PERIPHERAL_WIDTH_8BIT,
  261. .memory_addr = 0, // Set before transfer
  262. .memory_width = DMA_MEMORY_WIDTH_8BIT,
  263. .number = 0, // Set before transfer
  264. .priority = DMA_PRIORITY_ULTRA_HIGH,
  265. .periph_inc = DMA_PERIPH_INCREASE_DISABLE,
  266. .memory_inc = DMA_MEMORY_INCREASE_ENABLE,
  267. .direction = DMA_PERIPHERAL_TO_MEMORY
  268. };
  269. dma_init(DMA0, SD_SPI_RX_DMA_CHANNEL, &rx_dma_config);
  270. dma_parameter_struct tx_dma_config =
  271. {
  272. .periph_addr = (uint32_t)&SPI_DATA(SD_SPI),
  273. .periph_width = DMA_PERIPHERAL_WIDTH_8BIT,
  274. .memory_addr = 0, // Set before transfer
  275. .memory_width = DMA_MEMORY_WIDTH_8BIT,
  276. .number = 0, // Set before transfer
  277. .priority = DMA_PRIORITY_HIGH,
  278. .periph_inc = DMA_PERIPH_INCREASE_DISABLE,
  279. .memory_inc = DMA_MEMORY_INCREASE_ENABLE,
  280. .direction = DMA_MEMORY_TO_PERIPHERAL
  281. };
  282. dma_init(DMA0, SD_SPI_TX_DMA_CHANNEL, &tx_dma_config);
  283. }
  284. void activate() {
  285. spi_parameter_struct config = {
  286. SPI_MASTER,
  287. SPI_TRANSMODE_FULLDUPLEX,
  288. SPI_FRAMESIZE_8BIT,
  289. SPI_NSS_SOFT,
  290. SPI_ENDIAN_MSB,
  291. SPI_CK_PL_LOW_PH_1EDGE,
  292. SPI_PSC_256
  293. };
  294. // Select closest available divider based on system frequency
  295. int divider = SystemCoreClock / m_sckfreq;
  296. if (divider <= 2)
  297. config.prescale = SPI_PSC_2;
  298. else if (divider <= 4)
  299. config.prescale = SPI_PSC_4;
  300. else if (divider <= 8)
  301. config.prescale = SPI_PSC_8;
  302. else if (divider <= 16)
  303. config.prescale = SPI_PSC_16;
  304. else if (divider <= 32)
  305. config.prescale = SPI_PSC_32;
  306. else if (divider <= 64)
  307. config.prescale = SPI_PSC_64;
  308. else if (divider <= 128)
  309. config.prescale = SPI_PSC_128;
  310. else
  311. config.prescale = SPI_PSC_256;
  312. spi_init(SD_SPI, &config);
  313. spi_enable(SD_SPI);
  314. }
  315. void deactivate() {
  316. spi_disable(SD_SPI);
  317. }
  318. void wait_idle() {
  319. while (!(SPI_STAT(SD_SPI) & SPI_STAT_TBE));
  320. while (SPI_STAT(SD_SPI) & SPI_STAT_TRANS);
  321. }
  322. uint8_t receive() {
  323. // Wait for idle and clear RX buffer
  324. wait_idle();
  325. (void)SPI_DATA(SD_SPI);
  326. // Send dummy byte and wait for receive
  327. SPI_DATA(SD_SPI) = 0xFF;
  328. while (!(SPI_STAT(SD_SPI) & SPI_STAT_RBNE));
  329. return SPI_DATA(SD_SPI);
  330. }
  331. uint8_t receive(uint8_t* buf, size_t count) {
  332. // Wait for idle and clear RX buffer
  333. wait_idle();
  334. (void)SPI_DATA(SD_SPI);
  335. if (buf == m_stream_buffer + m_stream_status)
  336. {
  337. // Stream data directly to SCSI bus
  338. return stream_receive(buf, count);
  339. }
  340. // Stream to memory
  341. // Use DMA to stream dummy TX data and store RX data
  342. uint8_t tx_data = 0xFF;
  343. DMA_INTC(DMA0) = DMA_FLAG_ADD(DMA_FLAG_FTF | DMA_FLAG_ERR, SD_SPI_RX_DMA_CHANNEL);
  344. DMA_INTC(DMA0) = DMA_FLAG_ADD(DMA_FLAG_FTF | DMA_FLAG_ERR, SD_SPI_TX_DMA_CHANNEL);
  345. DMA_CHMADDR(DMA0, SD_SPI_RX_DMA_CHANNEL) = (uint32_t)buf;
  346. DMA_CHMADDR(DMA0, SD_SPI_TX_DMA_CHANNEL) = (uint32_t)&tx_data;
  347. DMA_CHCTL(DMA0, SD_SPI_TX_DMA_CHANNEL) &= ~DMA_CHXCTL_MNAGA; // No memory increment for TX
  348. DMA_CHCNT(DMA0, SD_SPI_RX_DMA_CHANNEL) = count;
  349. DMA_CHCNT(DMA0, SD_SPI_TX_DMA_CHANNEL) = count;
  350. DMA_CHCTL(DMA0, SD_SPI_RX_DMA_CHANNEL) |= DMA_CHXCTL_CHEN;
  351. DMA_CHCTL(DMA0, SD_SPI_TX_DMA_CHANNEL) |= DMA_CHXCTL_CHEN;
  352. SPI_CTL1(SD_SPI) |= SPI_CTL1_DMAREN | SPI_CTL1_DMATEN;
  353. uint32_t start = millis();
  354. while (!(DMA_INTF(DMA0) & DMA_FLAG_ADD(DMA_FLAG_FTF | DMA_FLAG_ERR, SD_SPI_RX_DMA_CHANNEL)))
  355. {
  356. if (millis() - start > 500)
  357. {
  358. azlog("ERROR: SPI DMA receive of ", (int)count, " bytes timeouted");
  359. return 1;
  360. }
  361. }
  362. if (DMA_INTF(DMA0) & DMA_FLAG_ADD(DMA_FLAG_ERR, SD_SPI_RX_DMA_CHANNEL))
  363. {
  364. azlog("ERROR: SPI DMA receive set DMA_FLAG_ERR");
  365. }
  366. SPI_CTL1(SD_SPI) &= ~(SPI_CTL1_DMAREN | SPI_CTL1_DMATEN);
  367. DMA_CHCTL(DMA0, SD_SPI_RX_DMA_CHANNEL) &= ~DMA_CHXCTL_CHEN;
  368. DMA_CHCTL(DMA0, SD_SPI_TX_DMA_CHANNEL) &= ~DMA_CHXCTL_CHEN;
  369. return 0;
  370. }
  371. // Stream data directly to SCSI bus
  372. uint8_t stream_receive(size_t count)
  373. {
  374. // Handle first byte
  375. SPI_DATA(SD_SPI) = 0xFF;
  376. while (!(SPI_STAT(SD_SPI) & SPI_STAT_RBNE));
  377. uint8_t data = SPI_DATA(SD_SPI);
  378. SCSI_OUT_DATA(data);
  379. SPI_DATA(SD_SPI) = 0xFF;
  380. SCSI_WAIT_INACTIVE(ACK);
  381. SCSI_OUT(REQ, 1);
  382. // Handle main payload
  383. for (size_t i = 1; i < count - 1; i++)
  384. {
  385. // Wait that host confirms previous reception
  386. SCSI_WAIT_ACTIVE(ACK);
  387. SCSI_OUT(REQ, 0);
  388. // Wait for received byte
  389. while (!(SPI_STAT(SD_SPI) & SPI_STAT_RBNE));
  390. data = SPI_DATA(SD_SPI);
  391. // Stream byte to SCSI
  392. SCSI_OUT_DATA(data);
  393. // Start SPI transfer for next byte
  394. SPI_DATA(SD_SPI) = 0xFF;
  395. SCSI_WAIT_INACTIVE(ACK); // This takes long enough to fullfill the 100 ns setup time.
  396. SCSI_OUT(REQ, 1);
  397. }
  398. // Handle last byte
  399. while (!(SPI_STAT(SD_SPI) & SPI_STAT_RBNE));
  400. data = SPI_DATA(SD_SPI);
  401. SCSI_OUT_DATA(data);
  402. delay_100ns(); // DB hold time before REQ (DTC-510B)
  403. SCSI_WAIT_INACTIVE(ACK);
  404. SCSI_OUT(REQ, 1);
  405. SCSI_WAIT_ACTIVE(ACK);
  406. SCSI_RELEASE_DATA_REQ();
  407. SCSI_WAIT_INACTIVE(ACK);
  408. m_stream_status += count;
  409. return 0;
  410. }
  411. void send(uint8_t data) {
  412. SPI_DATA(SD_SPI) = data;
  413. wait_idle();
  414. }
  415. void send(const uint8_t* buf, size_t count) {
  416. if (buf == m_stream_buffer + m_stream_status)
  417. {
  418. stream_send(count);
  419. return;
  420. }
  421. for (size_t i = 0; i < count; i++) {
  422. while (!(SPI_STAT(SD_SPI) & SPI_STAT_TBE));
  423. SPI_DATA(SD_SPI) = buf[i];
  424. }
  425. wait_idle();
  426. }
  427. // Stream data directly from SCSI bus
  428. void stream_send(size_t count)
  429. {
  430. for (size_t i = 0; i < count; i++) {
  431. SCSI_OUT(REQ, 1);
  432. SCSI_WAIT_ACTIVE(ACK);
  433. delay_100ns(); // ACK.Fall to DB output delay 100ns(MAX) (DTC-510B)
  434. uint8_t data = SCSI_IN_DATA();
  435. SCSI_OUT(REQ, 0);
  436. while (!(SPI_STAT(SD_SPI) & SPI_STAT_TBE));
  437. SPI_DATA(SD_SPI) = data;
  438. SCSI_WAIT_INACTIVE(ACK);
  439. }
  440. wait_idle();
  441. m_stream_status += count;
  442. }
  443. void setSckSpeed(uint32_t maxSck) {
  444. m_sckfreq = maxSck;
  445. }
  446. void prepare_stream(uint8_t *buffer)
  447. {
  448. m_stream_buffer = buffer;
  449. m_stream_status = 0;
  450. }
  451. size_t finish_stream()
  452. {
  453. size_t result = m_stream_status;
  454. m_stream_status = 0;
  455. m_stream_buffer = NULL;
  456. return result;
  457. }
  458. private:
  459. uint32_t m_sckfreq;
  460. uint8_t *m_stream_buffer;
  461. size_t m_stream_status; // Number of bytes transferred so far
  462. };
  463. void sdCsInit(SdCsPin_t pin)
  464. {
  465. }
  466. void sdCsWrite(SdCsPin_t pin, bool level)
  467. {
  468. if (level)
  469. GPIO_BOP(SD_PORT) = SD_CS_PIN;
  470. else
  471. GPIO_BC(SD_PORT) = SD_CS_PIN;
  472. }
  473. GD32SPIDriver g_sd_spi_port;
  474. SdSpiConfig g_sd_spi_config(0, DEDICATED_SPI, SD_SCK_MHZ(25), &g_sd_spi_port);
  475. void azplatform_prepare_stream(uint8_t *buffer)
  476. {
  477. g_sd_spi_port.prepare_stream(buffer);
  478. }
  479. size_t azplatform_finish_stream()
  480. {
  481. return g_sd_spi_port.finish_stream();
  482. }
  483. /**********************************************/
  484. /* Mapping from data bytes to GPIO BOP values */
  485. /**********************************************/
  486. #define PARITY(n) ((1 ^ (n) ^ ((n)>>1) ^ ((n)>>2) ^ ((n)>>3) ^ ((n)>>4) ^ ((n)>>5) ^ ((n)>>6) ^ ((n)>>7)) & 1)
  487. #define X(n) (\
  488. ((n & 0x01) ? (SCSI_OUT_DB0 << 16) : SCSI_OUT_DB0) | \
  489. ((n & 0x02) ? (SCSI_OUT_DB1 << 16) : SCSI_OUT_DB1) | \
  490. ((n & 0x04) ? (SCSI_OUT_DB2 << 16) : SCSI_OUT_DB2) | \
  491. ((n & 0x08) ? (SCSI_OUT_DB3 << 16) : SCSI_OUT_DB3) | \
  492. ((n & 0x10) ? (SCSI_OUT_DB4 << 16) : SCSI_OUT_DB4) | \
  493. ((n & 0x20) ? (SCSI_OUT_DB5 << 16) : SCSI_OUT_DB5) | \
  494. ((n & 0x40) ? (SCSI_OUT_DB6 << 16) : SCSI_OUT_DB6) | \
  495. ((n & 0x80) ? (SCSI_OUT_DB7 << 16) : SCSI_OUT_DB7) | \
  496. (PARITY(n) ? (SCSI_OUT_DBP << 16) : SCSI_OUT_DBP) | \
  497. (SCSI_OUT_REQ) \
  498. )
  499. const uint32_t g_scsi_out_byte_to_bop[256] =
  500. {
  501. X(0x00), X(0x01), X(0x02), X(0x03), X(0x04), X(0x05), X(0x06), X(0x07), X(0x08), X(0x09), X(0x0a), X(0x0b), X(0x0c), X(0x0d), X(0x0e), X(0x0f),
  502. X(0x10), X(0x11), X(0x12), X(0x13), X(0x14), X(0x15), X(0x16), X(0x17), X(0x18), X(0x19), X(0x1a), X(0x1b), X(0x1c), X(0x1d), X(0x1e), X(0x1f),
  503. X(0x20), X(0x21), X(0x22), X(0x23), X(0x24), X(0x25), X(0x26), X(0x27), X(0x28), X(0x29), X(0x2a), X(0x2b), X(0x2c), X(0x2d), X(0x2e), X(0x2f),
  504. X(0x30), X(0x31), X(0x32), X(0x33), X(0x34), X(0x35), X(0x36), X(0x37), X(0x38), X(0x39), X(0x3a), X(0x3b), X(0x3c), X(0x3d), X(0x3e), X(0x3f),
  505. X(0x40), X(0x41), X(0x42), X(0x43), X(0x44), X(0x45), X(0x46), X(0x47), X(0x48), X(0x49), X(0x4a), X(0x4b), X(0x4c), X(0x4d), X(0x4e), X(0x4f),
  506. X(0x50), X(0x51), X(0x52), X(0x53), X(0x54), X(0x55), X(0x56), X(0x57), X(0x58), X(0x59), X(0x5a), X(0x5b), X(0x5c), X(0x5d), X(0x5e), X(0x5f),
  507. X(0x60), X(0x61), X(0x62), X(0x63), X(0x64), X(0x65), X(0x66), X(0x67), X(0x68), X(0x69), X(0x6a), X(0x6b), X(0x6c), X(0x6d), X(0x6e), X(0x6f),
  508. X(0x70), X(0x71), X(0x72), X(0x73), X(0x74), X(0x75), X(0x76), X(0x77), X(0x78), X(0x79), X(0x7a), X(0x7b), X(0x7c), X(0x7d), X(0x7e), X(0x7f),
  509. X(0x80), X(0x81), X(0x82), X(0x83), X(0x84), X(0x85), X(0x86), X(0x87), X(0x88), X(0x89), X(0x8a), X(0x8b), X(0x8c), X(0x8d), X(0x8e), X(0x8f),
  510. X(0x90), X(0x91), X(0x92), X(0x93), X(0x94), X(0x95), X(0x96), X(0x97), X(0x98), X(0x99), X(0x9a), X(0x9b), X(0x9c), X(0x9d), X(0x9e), X(0x9f),
  511. X(0xa0), X(0xa1), X(0xa2), X(0xa3), X(0xa4), X(0xa5), X(0xa6), X(0xa7), X(0xa8), X(0xa9), X(0xaa), X(0xab), X(0xac), X(0xad), X(0xae), X(0xaf),
  512. X(0xb0), X(0xb1), X(0xb2), X(0xb3), X(0xb4), X(0xb5), X(0xb6), X(0xb7), X(0xb8), X(0xb9), X(0xba), X(0xbb), X(0xbc), X(0xbd), X(0xbe), X(0xbf),
  513. X(0xc0), X(0xc1), X(0xc2), X(0xc3), X(0xc4), X(0xc5), X(0xc6), X(0xc7), X(0xc8), X(0xc9), X(0xca), X(0xcb), X(0xcc), X(0xcd), X(0xce), X(0xcf),
  514. X(0xd0), X(0xd1), X(0xd2), X(0xd3), X(0xd4), X(0xd5), X(0xd6), X(0xd7), X(0xd8), X(0xd9), X(0xda), X(0xdb), X(0xdc), X(0xdd), X(0xde), X(0xdf),
  515. X(0xe0), X(0xe1), X(0xe2), X(0xe3), X(0xe4), X(0xe5), X(0xe6), X(0xe7), X(0xe8), X(0xe9), X(0xea), X(0xeb), X(0xec), X(0xed), X(0xee), X(0xef),
  516. X(0xf0), X(0xf1), X(0xf2), X(0xf3), X(0xf4), X(0xf5), X(0xf6), X(0xf7), X(0xf8), X(0xf9), X(0xfa), X(0xfb), X(0xfc), X(0xfd), X(0xfe), X(0xff)
  517. };
  518. #undef X