ZuluSCSI_platform.cpp 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647
  1. /**
  2. * ZuluSCSI™ - Copyright (c) 2022 Rabbit Hole Computing™
  3. *
  4. * ZuluSCSI™ firmware is licensed under the GPL version 3 or any later version. 
  5. *
  6. * https://www.gnu.org/licenses/gpl-3.0.html
  7. * ----
  8. * This program is free software: you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation, either version 3 of the License, or
  11. * (at your option) any later version. 
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16. * GNU General Public License for more details. 
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program.  If not, see <https://www.gnu.org/licenses/>.
  20. **/
  21. #include "ZuluSCSI_platform.h"
  22. #include "gd32f20x_sdio.h"
  23. #include "gd32f20x_fmc.h"
  24. #include "ZuluSCSI_log.h"
  25. #include "ZuluSCSI_config.h"
  26. #include "greenpak.h"
  27. #include <SdFat.h>
  28. #include <scsi.h>
  29. #include <assert.h>
  30. extern "C" {
  31. const char *g_platform_name = PLATFORM_NAME;
  32. static bool g_enable_apple_quirks = false;
  33. /*************************/
  34. /* Timing functions */
  35. /*************************/
  36. static volatile uint32_t g_millisecond_counter;
  37. static volatile uint32_t g_watchdog_timeout;
  38. static uint32_t g_ns_to_cycles; // Q0.32 fixed point format
  39. static void watchdog_handler(uint32_t *sp);
  40. unsigned long millis()
  41. {
  42. return g_millisecond_counter;
  43. }
  44. void delay(unsigned long ms)
  45. {
  46. uint32_t start = g_millisecond_counter;
  47. while ((uint32_t)(g_millisecond_counter - start) < ms);
  48. }
  49. void delay_ns(unsigned long ns)
  50. {
  51. uint32_t CNT_start = DWT->CYCCNT;
  52. if (ns <= 100) return; // Approximate call overhead
  53. ns -= 100;
  54. uint32_t cycles = ((uint64_t)ns * g_ns_to_cycles) >> 32;
  55. while ((uint32_t)(DWT->CYCCNT - CNT_start) < cycles);
  56. }
  57. void SysTick_Handler_inner(uint32_t *sp)
  58. {
  59. g_millisecond_counter++;
  60. if (g_watchdog_timeout > 0)
  61. {
  62. g_watchdog_timeout--;
  63. const uint32_t busreset_time = WATCHDOG_CRASH_TIMEOUT - WATCHDOG_BUS_RESET_TIMEOUT;
  64. if (g_watchdog_timeout <= busreset_time)
  65. {
  66. if (!scsiDev.resetFlag)
  67. {
  68. logmsg("WATCHDOG TIMEOUT at PC ", sp[6], " LR ", sp[5], " attempting bus reset");
  69. scsiDev.resetFlag = 1;
  70. }
  71. if (g_watchdog_timeout == 0)
  72. {
  73. watchdog_handler(sp);
  74. }
  75. }
  76. }
  77. }
  78. __attribute__((interrupt, naked))
  79. void SysTick_Handler(void)
  80. {
  81. // Take note of stack pointer so that we can print debug
  82. // info in watchdog handler.
  83. asm("mrs r0, msp\n"
  84. "b SysTick_Handler_inner": : : "r0");
  85. }
  86. // This function is called by scsiPhy.cpp.
  87. // It resets the systick counter to give 1 millisecond of uninterrupted transfer time.
  88. // The total number of skips is kept track of to keep the correct time on average.
  89. void SysTick_Handle_PreEmptively()
  90. {
  91. static int skipped_clocks = 0;
  92. __disable_irq();
  93. uint32_t loadval = SysTick->LOAD;
  94. skipped_clocks += loadval - SysTick->VAL;
  95. SysTick->VAL = 0;
  96. if (skipped_clocks > loadval)
  97. {
  98. // We have skipped enough ticks that it is time to fake a call
  99. // to SysTick interrupt handler.
  100. skipped_clocks -= loadval;
  101. uint32_t stack_frame[8] = {0};
  102. stack_frame[6] = (uint32_t)__builtin_return_address(0);
  103. SysTick_Handler_inner(stack_frame);
  104. }
  105. __enable_irq();
  106. }
  107. /***************/
  108. /* GPIO init */
  109. /***************/
  110. // Initialize SPI and GPIO configuration
  111. // Clock has already been initialized by system_gd32f20x.c
  112. void platform_init()
  113. {
  114. SystemCoreClockUpdate();
  115. // Enable SysTick to drive millis()
  116. g_millisecond_counter = 0;
  117. SysTick_Config(SystemCoreClock / 1000U);
  118. NVIC_SetPriority(SysTick_IRQn, 0x00U);
  119. // Enable DWT counter to drive delay_ns()
  120. g_ns_to_cycles = ((uint64_t)SystemCoreClock << 32) / 1000000000;
  121. CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
  122. DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
  123. // Enable debug output on SWO pin
  124. DBG_CTL |= DBG_CTL_TRACE_IOEN;
  125. if (TPI->ACPR == 0)
  126. {
  127. CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
  128. TPI->ACPR = SystemCoreClock / 2000000 - 1; // 2 Mbps baudrate for SWO
  129. // TPI->ACPR = SystemCoreClock / 30000000 - 1; // 30 Mbps baudrate for SWO
  130. TPI->SPPR = 2;
  131. TPI->FFCR = 0x100; // TPIU packet framing disabled
  132. // DWT->CTRL |= (1 << DWT_CTRL_EXCTRCENA_Pos);
  133. // DWT->CTRL |= (1 << DWT_CTRL_CYCTAP_Pos)
  134. // | (15 << DWT_CTRL_POSTPRESET_Pos)
  135. // | (1 << DWT_CTRL_PCSAMPLENA_Pos)
  136. // | (3 << DWT_CTRL_SYNCTAP_Pos)
  137. // | (1 << DWT_CTRL_CYCCNTENA_Pos);
  138. ITM->LAR = 0xC5ACCE55;
  139. ITM->TCR = (1 << ITM_TCR_DWTENA_Pos)
  140. | (1 << ITM_TCR_SYNCENA_Pos)
  141. | (1 << ITM_TCR_ITMENA_Pos);
  142. ITM->TER = 0xFFFFFFFF; // Enable all stimulus ports
  143. }
  144. // Enable needed clocks for GPIO
  145. rcu_periph_clock_enable(RCU_AF);
  146. rcu_periph_clock_enable(RCU_GPIOA);
  147. rcu_periph_clock_enable(RCU_GPIOB);
  148. rcu_periph_clock_enable(RCU_GPIOC);
  149. rcu_periph_clock_enable(RCU_GPIOD);
  150. rcu_periph_clock_enable(RCU_GPIOE);
  151. // Switch to SWD debug port (disable JTAG) to release PB4 as GPIO
  152. gpio_pin_remap_config(GPIO_SWJ_SWDPENABLE_REMAP, ENABLE);
  153. // SCSI pins.
  154. // Initialize open drain outputs to high.
  155. SCSI_RELEASE_OUTPUTS();
  156. gpio_init(SCSI_OUT_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_DATA_MASK | SCSI_OUT_REQ);
  157. gpio_init(SCSI_OUT_IO_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_IO_PIN);
  158. gpio_init(SCSI_OUT_CD_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_CD_PIN);
  159. gpio_init(SCSI_OUT_SEL_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_SEL_PIN);
  160. gpio_init(SCSI_OUT_MSG_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_MSG_PIN);
  161. gpio_init(SCSI_OUT_RST_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_RST_PIN);
  162. gpio_init(SCSI_OUT_BSY_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SCSI_OUT_BSY_PIN);
  163. gpio_init(SCSI_IN_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_IN_MASK);
  164. gpio_init(SCSI_ATN_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_ATN_PIN);
  165. gpio_init(SCSI_BSY_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_BSY_PIN);
  166. gpio_init(SCSI_SEL_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_SEL_PIN);
  167. gpio_init(SCSI_ACK_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_ACK_PIN);
  168. gpio_init(SCSI_RST_PORT, GPIO_MODE_IN_FLOATING, 0, SCSI_RST_PIN);
  169. // Terminator enable
  170. gpio_bit_set(SCSI_TERM_EN_PORT, SCSI_TERM_EN_PIN);
  171. gpio_init(SCSI_TERM_EN_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_2MHZ, SCSI_TERM_EN_PIN);
  172. #ifndef SD_USE_SDIO
  173. // SD card pins using SPI
  174. gpio_init(SD_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, SD_CS_PIN);
  175. gpio_init(SD_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, SD_CLK_PIN);
  176. gpio_init(SD_PORT, GPIO_MODE_IPU, 0, SD_MISO_PIN);
  177. gpio_init(SD_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, SD_MOSI_PIN);
  178. #else
  179. // SD card pins using SDIO
  180. gpio_init(SD_SDIO_DATA_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, SD_SDIO_D0 | SD_SDIO_D1 | SD_SDIO_D2 | SD_SDIO_D3);
  181. gpio_init(SD_SDIO_CLK_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, SD_SDIO_CLK);
  182. gpio_init(SD_SDIO_CMD_PORT, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, SD_SDIO_CMD);
  183. #endif
  184. // DIP switches
  185. gpio_init(DIP_PORT, GPIO_MODE_IPD, 0, DIPSW1_PIN | DIPSW2_PIN | DIPSW3_PIN);
  186. // LED pins
  187. gpio_bit_set(LED_PORT, LED_PINS);
  188. gpio_init(LED_PORT, GPIO_MODE_OUT_PP, GPIO_OSPEED_2MHZ, LED_PINS);
  189. // Ejection buttons
  190. gpio_init(EJECT_1_PORT, GPIO_MODE_IPU, 0, EJECT_1_PIN);
  191. gpio_init(EJECT_2_PORT, GPIO_MODE_IPU, 0, EJECT_2_PIN);
  192. // SWO trace pin on PB3
  193. gpio_init(GPIOB, GPIO_MODE_AF_PP, GPIO_OSPEED_50MHZ, GPIO_PIN_3);
  194. }
  195. void platform_late_init()
  196. {
  197. logmsg("Platform: ", g_platform_name);
  198. logmsg("FW Version: ", g_log_firmwareversion);
  199. #ifdef ZULUSCSI_V1_0_mini
  200. logmsg("DIPSW3 is ON: Enabling SCSI termination");
  201. #else
  202. if (gpio_input_bit_get(DIP_PORT, DIPSW3_PIN))
  203. {
  204. logmsg("DIPSW3 is ON: Enabling SCSI termination");
  205. gpio_bit_reset(SCSI_TERM_EN_PORT, SCSI_TERM_EN_PIN);
  206. }
  207. else
  208. {
  209. logmsg("DIPSW3 is OFF: SCSI termination disabled");
  210. }
  211. #endif // ZULUSCSI_V1_0_mini
  212. if (gpio_input_bit_get(DIP_PORT, DIPSW2_PIN))
  213. {
  214. logmsg("DIPSW2 is ON: enabling debug messages");
  215. g_log_debug = true;
  216. }
  217. else
  218. {
  219. g_log_debug = false;
  220. }
  221. if (gpio_input_bit_get(DIP_PORT, DIPSW1_PIN))
  222. {
  223. logmsg("DIPSW1 is ON: enabling Apple quirks by default");
  224. g_enable_apple_quirks = true;
  225. }
  226. greenpak_load_firmware();
  227. }
  228. void platform_disable_led(void)
  229. {
  230. gpio_init(LED_PORT, GPIO_MODE_IPU, 0, LED_PINS);
  231. logmsg("Disabling status LED");
  232. }
  233. /*****************************************/
  234. /* Supply voltage monitor */
  235. /*****************************************/
  236. // Use ADC to implement supply voltage monitoring for the +3.0V rail.
  237. // This works by sampling the Vrefint, which has
  238. // a voltage of 1.2 V, allowing to calculate the VDD voltage.
  239. static void adc_poll()
  240. {
  241. #if PLATFORM_VDD_WARNING_LIMIT_mV > 0
  242. static bool initialized = false;
  243. static int lowest_vdd_seen = PLATFORM_VDD_WARNING_LIMIT_mV;
  244. if (!initialized)
  245. {
  246. rcu_periph_clock_enable(RCU_ADC0);
  247. adc_enable(ADC0);
  248. adc_calibration_enable(ADC0);
  249. adc_tempsensor_vrefint_enable();
  250. adc_inserted_channel_config(ADC0, 0, ADC_CHANNEL_17, ADC_SAMPLETIME_239POINT5);
  251. adc_external_trigger_source_config(ADC0, ADC_INSERTED_CHANNEL, ADC0_1_2_EXTTRIG_INSERTED_NONE);
  252. adc_external_trigger_config(ADC0, ADC_INSERTED_CHANNEL, ENABLE);
  253. adc_software_trigger_enable(ADC0, ADC_INSERTED_CHANNEL);
  254. initialized = true;
  255. }
  256. // Read previous result and start new one
  257. int adc_value = ADC_IDATA0(ADC0);
  258. adc_software_trigger_enable(ADC0, ADC_INSERTED_CHANNEL);
  259. // adc_value = 1200mV * 4096 / Vdd
  260. // => Vdd = 1200mV * 4096 / adc_value
  261. // To avoid wasting time on division, compare against
  262. // limit directly.
  263. const int limit = (1200 * 4096) / PLATFORM_VDD_WARNING_LIMIT_mV;
  264. if (adc_value > limit)
  265. {
  266. // Warn once, and then again if we detect even a lower drop.
  267. int vdd_mV = (1200 * 4096) / adc_value;
  268. if (vdd_mV < lowest_vdd_seen)
  269. {
  270. logmsg("WARNING: Detected supply voltage drop to ", vdd_mV, "mV. Verify power supply is adequate.");
  271. lowest_vdd_seen = vdd_mV - 50; // Small hysteresis to avoid excessive warnings
  272. }
  273. }
  274. #endif
  275. }
  276. /*****************************************/
  277. /* Crash handlers */
  278. /*****************************************/
  279. extern SdFs SD;
  280. // Writes log data to the PB3 SWO pin
  281. void platform_log(const char *s)
  282. {
  283. while (*s)
  284. {
  285. // Write to SWO pin
  286. while (ITM->PORT[0].u32 == 0);
  287. ITM->PORT[0].u8 = *s++;
  288. }
  289. }
  290. void platform_emergency_log_save()
  291. {
  292. platform_set_sd_callback(NULL, NULL);
  293. SD.begin(SD_CONFIG_CRASH);
  294. FsFile crashfile = SD.open(CRASHFILE, O_WRONLY | O_CREAT | O_TRUNC);
  295. if (!crashfile.isOpen())
  296. {
  297. // Try to reinitialize
  298. int max_retry = 10;
  299. while (max_retry-- > 0 && !SD.begin(SD_CONFIG_CRASH));
  300. crashfile = SD.open(CRASHFILE, O_WRONLY | O_CREAT | O_TRUNC);
  301. }
  302. uint32_t startpos = 0;
  303. crashfile.write(log_get_buffer(&startpos));
  304. crashfile.write(log_get_buffer(&startpos));
  305. crashfile.flush();
  306. crashfile.close();
  307. }
  308. extern uint32_t _estack;
  309. __attribute__((noinline))
  310. void show_hardfault(uint32_t *sp)
  311. {
  312. uint32_t pc = sp[6];
  313. uint32_t lr = sp[5];
  314. uint32_t cfsr = SCB->CFSR;
  315. logmsg("--------------");
  316. logmsg("CRASH!");
  317. logmsg("Platform: ", g_platform_name);
  318. logmsg("FW Version: ", g_log_firmwareversion);
  319. logmsg("scsiDev.cdb: ", bytearray(scsiDev.cdb, 12));
  320. logmsg("scsiDev.phase: ", (int)scsiDev.phase);
  321. logmsg("CFSR: ", cfsr);
  322. logmsg("SP: ", (uint32_t)sp);
  323. logmsg("PC: ", pc);
  324. logmsg("LR: ", lr);
  325. logmsg("R0: ", sp[0]);
  326. logmsg("R1: ", sp[1]);
  327. logmsg("R2: ", sp[2]);
  328. logmsg("R3: ", sp[3]);
  329. uint32_t *p = (uint32_t*)((uint32_t)sp & ~3);
  330. for (int i = 0; i < 8; i++)
  331. {
  332. if (p == &_estack) break; // End of stack
  333. logmsg("STACK ", (uint32_t)p, ": ", p[0], " ", p[1], " ", p[2], " ", p[3]);
  334. p += 4;
  335. }
  336. platform_emergency_log_save();
  337. while (1)
  338. {
  339. // Flash the crash address on the LED
  340. // Short pulse means 0, long pulse means 1
  341. int base_delay = 1000;
  342. for (int i = 31; i >= 0; i--)
  343. {
  344. LED_OFF();
  345. for (int j = 0; j < base_delay; j++) delay_ns(100000);
  346. int delay = (pc & (1 << i)) ? (3 * base_delay) : base_delay;
  347. LED_ON();
  348. for (int j = 0; j < delay; j++) delay_ns(100000);
  349. LED_OFF();
  350. }
  351. for (int j = 0; j < base_delay * 10; j++) delay_ns(100000);
  352. }
  353. }
  354. __attribute__((naked, interrupt))
  355. void HardFault_Handler(void)
  356. {
  357. // Copies stack pointer into first argument
  358. asm("mrs r0, msp\n"
  359. "b show_hardfault": : : "r0");
  360. }
  361. __attribute__((naked, interrupt))
  362. void MemManage_Handler(void)
  363. {
  364. asm("mrs r0, msp\n"
  365. "b show_hardfault": : : "r0");
  366. }
  367. __attribute__((naked, interrupt))
  368. void BusFault_Handler(void)
  369. {
  370. asm("mrs r0, msp\n"
  371. "b show_hardfault": : : "r0");
  372. }
  373. __attribute__((naked, interrupt))
  374. void UsageFault_Handler(void)
  375. {
  376. asm("mrs r0, msp\n"
  377. "b show_hardfault": : : "r0");
  378. }
  379. void __assert_func(const char *file, int line, const char *func, const char *expr)
  380. {
  381. uint32_t dummy = 0;
  382. logmsg("--------------");
  383. logmsg("ASSERT FAILED!");
  384. logmsg("Platform: ", g_platform_name);
  385. logmsg("FW Version: ", g_log_firmwareversion);
  386. logmsg("scsiDev.cdb: ", bytearray(scsiDev.cdb, 12));
  387. logmsg("scsiDev.phase: ", (int)scsiDev.phase);
  388. logmsg("Assert failed: ", file , ":", line, " in ", func, ":", expr);
  389. uint32_t *p = (uint32_t*)((uint32_t)&dummy & ~3);
  390. for (int i = 0; i < 8; i++)
  391. {
  392. if (p == &_estack) break; // End of stack
  393. logmsg("STACK ", (uint32_t)p, ": ", p[0], " ", p[1], " ", p[2], " ", p[3]);
  394. p += 4;
  395. }
  396. platform_emergency_log_save();
  397. while(1)
  398. {
  399. LED_OFF();
  400. for (int j = 0; j < 1000; j++) delay_ns(100000);
  401. LED_ON();
  402. for (int j = 0; j < 1000; j++) delay_ns(100000);
  403. }
  404. }
  405. } /* extern "C" */
  406. static void watchdog_handler(uint32_t *sp)
  407. {
  408. logmsg("-------------- WATCHDOG TIMEOUT");
  409. show_hardfault(sp);
  410. }
  411. void platform_reset_watchdog()
  412. {
  413. // This uses a software watchdog based on systick timer interrupt.
  414. // It gives us opportunity to collect better debug info than the
  415. // full hardware reset that would be caused by hardware watchdog.
  416. g_watchdog_timeout = WATCHDOG_CRASH_TIMEOUT;
  417. }
  418. // Poll function that is called every few milliseconds.
  419. // Can be left empty or used for platform-specific processing.
  420. void platform_poll()
  421. {
  422. adc_poll();
  423. }
  424. uint8_t platform_get_buttons()
  425. {
  426. // Buttons are active low: internal pull-up is enabled,
  427. // and when button is pressed the pin goes low.
  428. uint8_t buttons = 0;
  429. if (!gpio_input_bit_get(EJECT_1_PORT, EJECT_1_PIN)) buttons |= 1;
  430. if (!gpio_input_bit_get(EJECT_2_PORT, EJECT_2_PIN)) buttons |= 2;
  431. // Simple debouncing logic: handle button releases after 100 ms delay.
  432. static uint32_t debounce;
  433. static uint8_t buttons_debounced = 0;
  434. if (buttons != 0)
  435. {
  436. buttons_debounced = buttons;
  437. debounce = millis();
  438. }
  439. else if ((uint32_t)(millis() - debounce) > 100)
  440. {
  441. buttons_debounced = 0;
  442. }
  443. return buttons_debounced;
  444. }
  445. /***********************/
  446. /* Flash reprogramming */
  447. /***********************/
  448. bool platform_rewrite_flash_page(uint32_t offset, uint8_t buffer[PLATFORM_FLASH_PAGE_SIZE])
  449. {
  450. if (offset == 0)
  451. {
  452. if (buffer[3] != 0x20 || buffer[7] != 0x08)
  453. {
  454. logmsg("Invalid firmware file, starts with: ", bytearray(buffer, 16));
  455. return false;
  456. }
  457. }
  458. dbgmsg("Writing flash at offset ", offset, " data ", bytearray(buffer, 4));
  459. assert(offset % PLATFORM_FLASH_PAGE_SIZE == 0);
  460. assert(offset >= PLATFORM_BOOTLOADER_SIZE);
  461. fmc_unlock();
  462. fmc_bank0_unlock();
  463. fmc_state_enum status;
  464. status = fmc_page_erase(FLASH_BASE + offset);
  465. if (status != FMC_READY)
  466. {
  467. logmsg("Erase failed: ", (int)status);
  468. return false;
  469. }
  470. uint32_t *buf32 = (uint32_t*)buffer;
  471. uint32_t num_words = PLATFORM_FLASH_PAGE_SIZE / 4;
  472. for (int i = 0; i < num_words; i++)
  473. {
  474. status = fmc_word_program(FLASH_BASE + offset + i * 4, buf32[i]);
  475. if (status != FMC_READY)
  476. {
  477. logmsg("Flash write failed: ", (int)status);
  478. return false;
  479. }
  480. }
  481. fmc_lock();
  482. for (int i = 0; i < num_words; i++)
  483. {
  484. uint32_t expected = buf32[i];
  485. uint32_t actual = *(volatile uint32_t*)(FLASH_BASE + offset + i * 4);
  486. if (actual != expected)
  487. {
  488. logmsg("Flash verify failed at offset ", offset + i * 4, " got ", actual, " expected ", expected);
  489. return false;
  490. }
  491. }
  492. return true;
  493. }
  494. void platform_boot_to_main_firmware()
  495. {
  496. uint32_t *mainprogram_start = (uint32_t*)(0x08000000 + PLATFORM_BOOTLOADER_SIZE);
  497. SCB->VTOR = (uint32_t)mainprogram_start;
  498. __asm__(
  499. "msr msp, %0\n\t"
  500. "bx %1" : : "r" (mainprogram_start[0]),
  501. "r" (mainprogram_start[1]) : "memory");
  502. }
  503. /**************************************/
  504. /* SCSI configuration based on DIPSW1 */
  505. /**************************************/
  506. void platform_config_hook(S2S_TargetCfg *config)
  507. {
  508. // Enable Apple quirks by dip switch
  509. if (g_enable_apple_quirks)
  510. {
  511. if (config->quirks == S2S_CFG_QUIRKS_NONE)
  512. {
  513. config->quirks = S2S_CFG_QUIRKS_APPLE;
  514. }
  515. }
  516. }
  517. /**********************************************/
  518. /* Mapping from data bytes to GPIO BOP values */
  519. /**********************************************/
  520. #define PARITY(n) ((1 ^ (n) ^ ((n)>>1) ^ ((n)>>2) ^ ((n)>>3) ^ ((n)>>4) ^ ((n)>>5) ^ ((n)>>6) ^ ((n)>>7)) & 1)
  521. #define X(n) (\
  522. ((n & 0x01) ? (SCSI_OUT_DB0 << 16) : SCSI_OUT_DB0) | \
  523. ((n & 0x02) ? (SCSI_OUT_DB1 << 16) : SCSI_OUT_DB1) | \
  524. ((n & 0x04) ? (SCSI_OUT_DB2 << 16) : SCSI_OUT_DB2) | \
  525. ((n & 0x08) ? (SCSI_OUT_DB3 << 16) : SCSI_OUT_DB3) | \
  526. ((n & 0x10) ? (SCSI_OUT_DB4 << 16) : SCSI_OUT_DB4) | \
  527. ((n & 0x20) ? (SCSI_OUT_DB5 << 16) : SCSI_OUT_DB5) | \
  528. ((n & 0x40) ? (SCSI_OUT_DB6 << 16) : SCSI_OUT_DB6) | \
  529. ((n & 0x80) ? (SCSI_OUT_DB7 << 16) : SCSI_OUT_DB7) | \
  530. (PARITY(n) ? (SCSI_OUT_DBP << 16) : SCSI_OUT_DBP) | \
  531. (SCSI_OUT_REQ) \
  532. )
  533. const uint32_t g_scsi_out_byte_to_bop[256] =
  534. {
  535. 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),
  536. 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),
  537. 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),
  538. 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),
  539. 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),
  540. 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),
  541. 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),
  542. 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),
  543. 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),
  544. 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),
  545. 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),
  546. 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),
  547. 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),
  548. 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),
  549. 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),
  550. 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)
  551. };
  552. #undef X