ZuluSCSI_platform.cpp 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558
  1. #include "ZuluSCSI_platform.h"
  2. #include "gd32f4xx_sdio.h"
  3. #include "gd32f4xx_fmc.h"
  4. #include "ZuluSCSI_log.h"
  5. #include "ZuluSCSI_config.h"
  6. #include <SdFat.h>
  7. #include <scsi.h>
  8. #include <assert.h>
  9. extern "C" {
  10. const char *g_azplatform_name = PLATFORM_NAME;
  11. static bool g_enable_apple_quirks = false;
  12. /*************************/
  13. /* Timing functions */
  14. /*************************/
  15. static volatile uint32_t g_millisecond_counter;
  16. static volatile uint32_t g_watchdog_timeout;
  17. static uint32_t g_ns_to_cycles; // Q0.32 fixed point format
  18. static void watchdog_handler(uint32_t *sp);
  19. unsigned long millis()
  20. {
  21. return g_millisecond_counter;
  22. }
  23. void delay(unsigned long ms)
  24. {
  25. uint32_t start = g_millisecond_counter;
  26. while ((uint32_t)(g_millisecond_counter - start) < ms);
  27. }
  28. void delay_ns(unsigned long ns)
  29. {
  30. uint32_t CNT_start = DWT->CYCCNT;
  31. if (ns <= 100) return; // Approximate call overhead
  32. ns -= 100;
  33. uint32_t cycles = ((uint64_t)ns * g_ns_to_cycles) >> 32;
  34. while ((uint32_t)(DWT->CYCCNT - CNT_start) < cycles);
  35. }
  36. void SysTick_Handler_inner(uint32_t *sp)
  37. {
  38. g_millisecond_counter++;
  39. if (g_watchdog_timeout > 0)
  40. {
  41. g_watchdog_timeout--;
  42. const uint32_t busreset_time = WATCHDOG_CRASH_TIMEOUT - WATCHDOG_BUS_RESET_TIMEOUT;
  43. if (g_watchdog_timeout <= busreset_time)
  44. {
  45. if (!scsiDev.resetFlag)
  46. {
  47. azlog("WATCHDOG TIMEOUT at PC ", sp[6], " LR ", sp[5], " attempting bus reset");
  48. scsiDev.resetFlag = 1;
  49. }
  50. if (g_watchdog_timeout == 0)
  51. {
  52. watchdog_handler(sp);
  53. }
  54. }
  55. }
  56. }
  57. __attribute__((interrupt, naked))
  58. void SysTick_Handler(void)
  59. {
  60. // Take note of stack pointer so that we can print debug
  61. // info in watchdog handler.
  62. asm("mrs r0, msp\n"
  63. "b SysTick_Handler_inner": : : "r0");
  64. }
  65. // This function is called by scsiPhy.cpp.
  66. // It resets the systick counter to give 1 millisecond of uninterrupted transfer time.
  67. // The total number of skips is kept track of to keep the correct time on average.
  68. void SysTick_Handle_PreEmptively()
  69. {
  70. static int skipped_clocks = 0;
  71. __disable_irq();
  72. uint32_t loadval = SysTick->LOAD;
  73. skipped_clocks += loadval - SysTick->VAL;
  74. SysTick->VAL = 0;
  75. if (skipped_clocks > loadval)
  76. {
  77. // We have skipped enough ticks that it is time to fake a call
  78. // to SysTick interrupt handler.
  79. skipped_clocks -= loadval;
  80. uint32_t stack_frame[8] = {0};
  81. stack_frame[6] = (uint32_t)__builtin_return_address(0);
  82. SysTick_Handler_inner(stack_frame);
  83. }
  84. __enable_irq();
  85. }
  86. /***************/
  87. /* GPIO init */
  88. /***************/
  89. // Initialize SPI and GPIO configuration
  90. // Clock has already been initialized by system_gd32f20x.c
  91. void azplatform_init()
  92. {
  93. SystemCoreClockUpdate();
  94. // Enable SysTick to drive millis()
  95. g_millisecond_counter = 0;
  96. SysTick_Config(SystemCoreClock / 1000U);
  97. NVIC_SetPriority(SysTick_IRQn, 0x00U);
  98. // Enable DWT counter to drive delay_ns()
  99. g_ns_to_cycles = ((uint64_t)SystemCoreClock << 32) / 1000000000;
  100. CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
  101. DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
  102. // Enable debug output on SWO pin
  103. DBG_CTL0 |= DBG_CTL0_TRACE_IOEN;
  104. if (TPI->ACPR == 0)
  105. {
  106. CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
  107. TPI->ACPR = SystemCoreClock / 2000000 - 1; // 2 Mbps baudrate for SWO
  108. // TPI->ACPR = SystemCoreClock / 30000000 - 1; // 30 Mbps baudrate for SWO
  109. TPI->SPPR = 2;
  110. TPI->FFCR = 0x100; // TPIU packet framing disabled
  111. // DWT->CTRL |= (1 << DWT_CTRL_EXCTRCENA_Pos);
  112. // DWT->CTRL |= (1 << DWT_CTRL_CYCTAP_Pos)
  113. // | (15 << DWT_CTRL_POSTPRESET_Pos)
  114. // | (1 << DWT_CTRL_PCSAMPLENA_Pos)
  115. // | (3 << DWT_CTRL_SYNCTAP_Pos)
  116. // | (1 << DWT_CTRL_CYCCNTENA_Pos);
  117. ITM->LAR = 0xC5ACCE55;
  118. ITM->TCR = (1 << ITM_TCR_DWTENA_Pos)
  119. | (1 << ITM_TCR_SYNCENA_Pos)
  120. | (1 << ITM_TCR_ITMENA_Pos);
  121. ITM->TER = 0xFFFFFFFF; // Enable all stimulus ports
  122. }
  123. // Enable needed clocks for GPIO
  124. rcu_periph_clock_enable(RCU_GPIOA);
  125. rcu_periph_clock_enable(RCU_GPIOB);
  126. rcu_periph_clock_enable(RCU_GPIOC);
  127. rcu_periph_clock_enable(RCU_GPIOD);
  128. rcu_periph_clock_enable(RCU_GPIOE);
  129. // SCSI pins.
  130. // Initialize open drain outputs to high.
  131. SCSI_RELEASE_OUTPUTS();
  132. // @TODO Check if the output speed should be set to 200MHZ
  133. gpio_mode_set(SCSI_OUT_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, SCSI_OUT_DATA_MASK | SCSI_OUT_REQ);
  134. gpio_output_options_set(SCSI_OUT_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_DATA_MASK | SCSI_OUT_REQ);
  135. gpio_mode_set(SCSI_OUT_IO_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, SCSI_OUT_IO_PIN);
  136. gpio_output_options_set(SCSI_OUT_IO_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_IO_PIN);
  137. gpio_mode_set(SCSI_OUT_CD_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, SCSI_OUT_CD_PIN);
  138. gpio_output_options_set(SCSI_OUT_CD_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_CD_PIN);
  139. gpio_mode_set(SCSI_OUT_SEL_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, SCSI_OUT_SEL_PIN);
  140. gpio_output_options_set(SCSI_OUT_SEL_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_SEL_PIN);
  141. gpio_mode_set(SCSI_OUT_MSG_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, SCSI_OUT_MSG_PIN);
  142. gpio_output_options_set(SCSI_OUT_MSG_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_MSG_PIN);
  143. gpio_mode_set(SCSI_OUT_RST_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, SCSI_OUT_RST_PIN);
  144. gpio_output_options_set(SCSI_OUT_RST_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_RST_PIN);
  145. gpio_mode_set(SCSI_OUT_BSY_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, SCSI_OUT_BSY_PIN);
  146. gpio_output_options_set(SCSI_OUT_BSY_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_BSY_PIN);
  147. gpio_mode_set(SCSI_IN_PORT, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SCSI_IN_MASK);
  148. gpio_mode_set(SCSI_ATN_PORT, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SCSI_ATN_PIN);
  149. gpio_mode_set(SCSI_BSY_PORT, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SCSI_BSY_PIN);
  150. gpio_mode_set(SCSI_SEL_PORT, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SCSI_SEL_PIN);
  151. gpio_mode_set(SCSI_ACK_PORT, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SCSI_ACK_PIN);
  152. gpio_mode_set(SCSI_RST_PORT, GPIO_MODE_INPUT, GPIO_PUPD_NONE, SCSI_RST_PIN);
  153. // Terminator enable
  154. gpio_bit_set(SCSI_TERM_EN_PORT, SCSI_TERM_EN_PIN);
  155. gpio_mode_set(SCSI_TERM_EN_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, SCSI_TERM_EN_PIN);
  156. gpio_output_options_set(SCSI_TERM_EN_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_2MHZ, SCSI_TERM_EN_PIN);
  157. #ifndef SD_USE_SDIO
  158. // SD card pins using SPI
  159. gpio_init(SD_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SD_CS_PIN);
  160. gpio_init(SD_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, SD_CLK_PIN);
  161. gpio_init(SD_PORT, GPIO_MODE_IPU, 0, SD_MISO_PIN);
  162. gpio_init(SD_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, SD_MOSI_PIN);
  163. #else
  164. // SD card pins using SDIO
  165. gpio_mode_set(SD_SDIO_DATA_PORT, GPIO_MODE_AF, GPIO_PUPD_NONE, SD_SDIO_D0 | SD_SDIO_D1 | SD_SDIO_D2 | SD_SDIO_D3);
  166. gpio_output_options_set(SD_SDIO_DATA_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SD_SDIO_D0 | SD_SDIO_D1 | SD_SDIO_D2 | SD_SDIO_D3);
  167. gpio_af_set(SD_SDIO_DATA_PORT, GPIO_AF_12, SD_SDIO_D0 | SD_SDIO_D1 | SD_SDIO_D2 | SD_SDIO_D3);
  168. gpio_mode_set(SD_SDIO_CLK_PORT, GPIO_MODE_AF, GPIO_PUPD_NONE, SD_SDIO_CLK);
  169. gpio_output_options_set(SD_SDIO_CLK_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SD_SDIO_CLK);
  170. gpio_af_set(SD_SDIO_CLK_PORT, GPIO_AF_12, SD_SDIO_CLK);
  171. gpio_mode_set(SD_SDIO_CMD_PORT, GPIO_MODE_AF, GPIO_PUPD_NONE, SD_SDIO_CMD);
  172. gpio_output_options_set(SD_SDIO_CMD_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, SD_SDIO_CMD);
  173. gpio_af_set(SD_SDIO_CMD_PORT, GPIO_AF_12, SD_SDIO_CMD);
  174. #endif
  175. // @TODO confirm dip switch 1 is not longer JTAG NJTRST
  176. // Switch to SWD debug port (disable JTAG) to release PB4 as GPIO
  177. //gpio_pin_remap_config(GPIO_SWJ_SWDPENABLE_REMAP, ENABLE);
  178. // DIP switches
  179. gpio_mode_set(DIP_PORT, GPIO_MODE_INPUT, GPIO_PUPD_PULLDOWN, DIPSW1_PIN | DIPSW2_PIN | DIPSW3_PIN);
  180. // LED pins
  181. gpio_bit_set(LED_PORT, LED_PINS);
  182. gpio_mode_set(LED_PORT, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, LED_PINS);
  183. gpio_output_options_set(LED_PORT, GPIO_OTYPE_PP, GPIO_OSPEED_2MHZ, LED_PINS);
  184. // SWO trace pin on PB3
  185. gpio_mode_set(GPIOB, GPIO_MODE_AF, GPIO_PUPD_NONE, GPIO_PIN_3);
  186. gpio_output_options_set(GPIOB, GPIO_OTYPE_PP, GPIO_OSPEED_50MHZ, GPIO_PIN_3);
  187. gpio_af_set(GPIOB, GPIO_AF_0, GPIO_PIN_3);
  188. }
  189. void azplatform_late_init()
  190. {
  191. if (gpio_input_bit_get(DIP_PORT, DIPSW3_PIN))
  192. {
  193. azlog("DIPSW3 is ON: Enabling SCSI termination");
  194. gpio_bit_reset(SCSI_TERM_EN_PORT, SCSI_TERM_EN_PIN);
  195. }
  196. else
  197. {
  198. azlog("DIPSW3 is OFF: SCSI termination disabled");
  199. }
  200. if (gpio_input_bit_get(DIP_PORT, DIPSW2_PIN))
  201. {
  202. azlog("DIPSW2 is ON: enabling debug messages");
  203. g_azlog_debug = true;
  204. }
  205. else
  206. {
  207. g_azlog_debug = false;
  208. }
  209. if (gpio_input_bit_get(DIP_PORT, DIPSW1_PIN))
  210. {
  211. azlog("DIPSW1 is ON: enabling Apple quirks by default");
  212. g_enable_apple_quirks = true;
  213. }
  214. }
  215. /*****************************************/
  216. /* Crash handlers */
  217. /*****************************************/
  218. extern SdFs SD;
  219. // Writes log data to the PB3 SWO pin
  220. void azplatform_log(const char *s)
  221. {
  222. while (*s)
  223. {
  224. // Write to SWO pin
  225. while (ITM->PORT[0].u32 == 0);
  226. ITM->PORT[0].u8 = *s++;
  227. }
  228. }
  229. void azplatform_emergency_log_save()
  230. {
  231. azplatform_set_sd_callback(NULL, NULL);
  232. SD.begin(SD_CONFIG_CRASH);
  233. FsFile crashfile = SD.open(CRASHFILE, O_WRONLY | O_CREAT | O_TRUNC);
  234. if (!crashfile.isOpen())
  235. {
  236. // Try to reinitialize
  237. int max_retry = 10;
  238. while (max_retry-- > 0 && !SD.begin(SD_CONFIG_CRASH));
  239. crashfile = SD.open(CRASHFILE, O_WRONLY | O_CREAT | O_TRUNC);
  240. }
  241. uint32_t startpos = 0;
  242. crashfile.write(azlog_get_buffer(&startpos));
  243. crashfile.write(azlog_get_buffer(&startpos));
  244. crashfile.flush();
  245. crashfile.close();
  246. }
  247. extern uint32_t _estack;
  248. __attribute__((noinline))
  249. void show_hardfault(uint32_t *sp)
  250. {
  251. uint32_t pc = sp[6];
  252. uint32_t lr = sp[5];
  253. uint32_t cfsr = SCB->CFSR;
  254. azlog("--------------");
  255. azlog("CRASH!");
  256. azlog("Platform: ", g_azplatform_name);
  257. azlog("FW Version: ", g_azlog_firmwareversion);
  258. azlog("CFSR: ", cfsr);
  259. azlog("SP: ", (uint32_t)sp);
  260. azlog("PC: ", pc);
  261. azlog("LR: ", lr);
  262. azlog("R0: ", sp[0]);
  263. azlog("R1: ", sp[1]);
  264. azlog("R2: ", sp[2]);
  265. azlog("R3: ", sp[3]);
  266. uint32_t *p = (uint32_t*)((uint32_t)sp & ~3);
  267. for (int i = 0; i < 8; i++)
  268. {
  269. if (p == &_estack) break; // End of stack
  270. azlog("STACK ", (uint32_t)p, ": ", p[0], " ", p[1], " ", p[2], " ", p[3]);
  271. p += 4;
  272. }
  273. azplatform_emergency_log_save();
  274. while (1)
  275. {
  276. // Flash the crash address on the LED
  277. // Short pulse means 0, long pulse means 1
  278. int base_delay = 1000;
  279. for (int i = 31; i >= 0; i--)
  280. {
  281. LED_OFF();
  282. for (int j = 0; j < base_delay; j++) delay_ns(100000);
  283. int delay = (pc & (1 << i)) ? (3 * base_delay) : base_delay;
  284. LED_ON();
  285. for (int j = 0; j < delay; j++) delay_ns(100000);
  286. LED_OFF();
  287. }
  288. for (int j = 0; j < base_delay * 10; j++) delay_ns(100000);
  289. }
  290. }
  291. __attribute__((naked, interrupt))
  292. void HardFault_Handler(void)
  293. {
  294. // Copies stack pointer into first argument
  295. asm("mrs r0, msp\n"
  296. "b show_hardfault": : : "r0");
  297. }
  298. __attribute__((naked, interrupt))
  299. void MemManage_Handler(void)
  300. {
  301. asm("mrs r0, msp\n"
  302. "b show_hardfault": : : "r0");
  303. }
  304. __attribute__((naked, interrupt))
  305. void BusFault_Handler(void)
  306. {
  307. asm("mrs r0, msp\n"
  308. "b show_hardfault": : : "r0");
  309. }
  310. __attribute__((naked, interrupt))
  311. void UsageFault_Handler(void)
  312. {
  313. asm("mrs r0, msp\n"
  314. "b show_hardfault": : : "r0");
  315. }
  316. void __assert_func(const char *file, int line, const char *func, const char *expr)
  317. {
  318. uint32_t dummy = 0;
  319. azlog("--------------");
  320. azlog("ASSERT FAILED!");
  321. azlog("Platform: ", g_azplatform_name);
  322. azlog("FW Version: ", g_azlog_firmwareversion);
  323. azlog("Assert failed: ", file , ":", line, " in ", func, ":", expr);
  324. uint32_t *p = (uint32_t*)((uint32_t)&dummy & ~3);
  325. for (int i = 0; i < 8; i++)
  326. {
  327. if (p == &_estack) break; // End of stack
  328. azlog("STACK ", (uint32_t)p, ": ", p[0], " ", p[1], " ", p[2], " ", p[3]);
  329. p += 4;
  330. }
  331. azplatform_emergency_log_save();
  332. while(1)
  333. {
  334. LED_OFF();
  335. for (int j = 0; j < 1000; j++) delay_ns(100000);
  336. LED_ON();
  337. for (int j = 0; j < 1000; j++) delay_ns(100000);
  338. }
  339. }
  340. } /* extern "C" */
  341. static void watchdog_handler(uint32_t *sp)
  342. {
  343. azlog("-------------- WATCHDOG TIMEOUT");
  344. show_hardfault(sp);
  345. }
  346. void azplatform_reset_watchdog()
  347. {
  348. // This uses a software watchdog based on systick timer interrupt.
  349. // It gives us opportunity to collect better debug info than the
  350. // full hardware reset that would be caused by hardware watchdog.
  351. g_watchdog_timeout = WATCHDOG_CRASH_TIMEOUT;
  352. }
  353. /***********************/
  354. /* Flash reprogramming */
  355. /***********************/
  356. bool azplatform_rewrite_flash_page(uint32_t offset, uint8_t buffer[AZPLATFORM_FLASH_PAGE_SIZE])
  357. {
  358. // @TODO rewrite this function for sector erases as page erases aren't available
  359. azlog("Flash rewrite not implemented for the GD32F4xx yet.");
  360. return false;
  361. if (offset == 0)
  362. {
  363. if (buffer[3] != 0x20 || buffer[7] != 0x08)
  364. {
  365. azlog("Invalid firmware file, starts with: ", bytearray(buffer, 16));
  366. return false;
  367. }
  368. }
  369. azdbg("Writing flash at offset ", offset, " data ", bytearray(buffer, 4));
  370. assert(offset % AZPLATFORM_FLASH_PAGE_SIZE == 0);
  371. assert(offset >= AZPLATFORM_BOOTLOADER_SIZE);
  372. fmc_unlock();
  373. // @TODO make sure this is no longer needed
  374. // fmc_bank0_unlock();
  375. fmc_state_enum status;
  376. // @TODO - rewrite this to do sector errases as page erase is not available for the gd32f450
  377. // status = fmc_page_erase(FLASH_BASE + offset);
  378. if (status != FMC_READY)
  379. {
  380. azlog("Erase failed: ", (int)status);
  381. return false;
  382. }
  383. uint32_t *buf32 = (uint32_t*)buffer;
  384. uint32_t num_words = AZPLATFORM_FLASH_PAGE_SIZE / 4;
  385. for (int i = 0; i < num_words; i++)
  386. {
  387. status = fmc_word_program(FLASH_BASE + offset + i * 4, buf32[i]);
  388. if (status != FMC_READY)
  389. {
  390. azlog("Flash write failed: ", (int)status);
  391. return false;
  392. }
  393. }
  394. fmc_lock();
  395. for (int i = 0; i < num_words; i++)
  396. {
  397. uint32_t expected = buf32[i];
  398. uint32_t actual = *(volatile uint32_t*)(FLASH_BASE + offset + i * 4);
  399. if (actual != expected)
  400. {
  401. azlog("Flash verify failed at offset ", offset + i * 4, " got ", actual, " expected ", expected);
  402. return false;
  403. }
  404. }
  405. return true;
  406. }
  407. void azplatform_boot_to_main_firmware()
  408. {
  409. uint32_t *mainprogram_start = (uint32_t*)(0x08000000 + AZPLATFORM_BOOTLOADER_SIZE);
  410. SCB->VTOR = (uint32_t)mainprogram_start;
  411. __asm__(
  412. "msr msp, %0\n\t"
  413. "bx %1" : : "r" (mainprogram_start[0]),
  414. "r" (mainprogram_start[1]) : "memory");
  415. }
  416. /**************************************/
  417. /* SCSI configuration based on DIPSW1 */
  418. /**************************************/
  419. void azplatform_config_hook(S2S_TargetCfg *config)
  420. {
  421. // Enable Apple quirks by dip switch
  422. if (g_enable_apple_quirks)
  423. {
  424. if (config->quirks == S2S_CFG_QUIRKS_NONE)
  425. {
  426. config->quirks = S2S_CFG_QUIRKS_APPLE;
  427. }
  428. }
  429. }
  430. /**********************************************/
  431. /* Mapping from data bytes to GPIO BOP values */
  432. /**********************************************/
  433. #define PARITY(n) ((1 ^ (n) ^ ((n)>>1) ^ ((n)>>2) ^ ((n)>>3) ^ ((n)>>4) ^ ((n)>>5) ^ ((n)>>6) ^ ((n)>>7)) & 1)
  434. #define X(n) (\
  435. ((n & 0x01) ? (SCSI_OUT_DB0 << 16) : SCSI_OUT_DB0) | \
  436. ((n & 0x02) ? (SCSI_OUT_DB1 << 16) : SCSI_OUT_DB1) | \
  437. ((n & 0x04) ? (SCSI_OUT_DB2 << 16) : SCSI_OUT_DB2) | \
  438. ((n & 0x08) ? (SCSI_OUT_DB3 << 16) : SCSI_OUT_DB3) | \
  439. ((n & 0x10) ? (SCSI_OUT_DB4 << 16) : SCSI_OUT_DB4) | \
  440. ((n & 0x20) ? (SCSI_OUT_DB5 << 16) : SCSI_OUT_DB5) | \
  441. ((n & 0x40) ? (SCSI_OUT_DB6 << 16) : SCSI_OUT_DB6) | \
  442. ((n & 0x80) ? (SCSI_OUT_DB7 << 16) : SCSI_OUT_DB7) | \
  443. (PARITY(n) ? (SCSI_OUT_DBP << 16) : SCSI_OUT_DBP) | \
  444. (SCSI_OUT_REQ) \
  445. )
  446. const uint32_t g_scsi_out_byte_to_bop[256] =
  447. {
  448. 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),
  449. 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),
  450. 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),
  451. 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),
  452. 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),
  453. 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),
  454. 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),
  455. 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),
  456. 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),
  457. 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),
  458. 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),
  459. 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),
  460. 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),
  461. 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),
  462. 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),
  463. 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)
  464. };
  465. #undef X