ZuluSCSI_platform.cpp 45 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233
  1. /**
  2. * ZuluSCSI™ - Copyright (c) 2022-2025 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 "ZuluSCSI_log.h"
  23. #include <SdFat.h>
  24. #include <sdio.h>
  25. #include <scsi.h>
  26. #include <assert.h>
  27. #include <hardware/gpio.h>
  28. #include <hardware/pio.h>
  29. #include <hardware/uart.h>
  30. #include <hardware/pll.h>
  31. #include <hardware/clocks.h>
  32. #include <hardware/spi.h>
  33. #include <hardware/adc.h>
  34. #include <hardware/flash.h>
  35. #include <hardware/structs/xip_ctrl.h>
  36. #include <hardware/structs/usb.h>
  37. #include <hardware/sync.h>
  38. #include "scsi_accel_target.h"
  39. #include "custom_timings.h"
  40. #include <ZuluSCSI_settings.h>
  41. #ifdef SD_USE_RP2350_SDIO
  42. #include <sdio_rp2350.h>
  43. #else
  44. #include <sdio.h>
  45. #endif
  46. #ifndef PIO_FRAMEWORK_ARDUINO_NO_USB
  47. # include <SerialUSB.h>
  48. # include <class/cdc/cdc_device.h>
  49. #endif
  50. #include <pico/multicore.h>
  51. #ifdef ZULUSCSI_NETWORK
  52. extern "C" {
  53. # include <pico/cyw43_arch.h>
  54. }
  55. # ifdef ZULUSCSI_RM2
  56. # include <pico/cyw43_driver.h>
  57. # endif
  58. #endif // ZULUSCSI_NETWORK
  59. #ifdef PLATFORM_MASS_STORAGE
  60. #include "ZuluSCSI_platform_msc.h"
  61. #endif
  62. #ifdef ENABLE_AUDIO_OUTPUT_SPDIF
  63. # include "audio_spdif.h"
  64. #elif defined(ENABLE_AUDIO_OUTPUT_I2S)
  65. # include "audio_i2s.h"
  66. #endif // ENABLE_AUDIO_OUTPUT_SPDIF
  67. extern bool g_rawdrive_active;
  68. extern "C" {
  69. #include "timings_RP2MCU.h"
  70. const char *g_platform_name = PLATFORM_NAME;
  71. static bool g_scsi_initiator = false;
  72. static uint32_t g_flash_chip_size = 0;
  73. static bool g_uart_initialized = false;
  74. static bool g_led_blinking = false;
  75. static void usb_log_poll();
  76. /***************/
  77. /* GPIO init */
  78. /***************/
  79. // Helper function to configure whole GPIO in one line
  80. static void gpio_conf(uint gpio, gpio_function_t fn, bool pullup, bool pulldown, bool output, bool initial_state, bool fast_slew)
  81. {
  82. gpio_put(gpio, initial_state);
  83. gpio_set_dir(gpio, output);
  84. gpio_set_pulls(gpio, pullup, pulldown);
  85. gpio_set_function(gpio, fn);
  86. if (fast_slew)
  87. {
  88. pads_bank0_hw->io[gpio] |= PADS_BANK0_GPIO0_SLEWFAST_BITS;
  89. }
  90. }
  91. static void reclock() {
  92. // ensure UART is fully drained before we mess up its clock
  93. if (uart_is_enabled(uart0))
  94. uart_tx_wait_blocking(uart0);
  95. // switch clk_sys and clk_peri to pll_usb
  96. // see code in 2.15.6.1 of the datasheet for useful comments
  97. clock_configure(clk_sys,
  98. CLOCKS_CLK_SYS_CTRL_SRC_VALUE_CLKSRC_CLK_SYS_AUX,
  99. CLOCKS_CLK_SYS_CTRL_AUXSRC_VALUE_CLKSRC_PLL_USB,
  100. 48 * MHZ,
  101. 48 * MHZ);
  102. clock_configure(clk_peri,
  103. 0,
  104. CLOCKS_CLK_PERI_CTRL_AUXSRC_VALUE_CLKSRC_PLL_USB,
  105. 48 * MHZ,
  106. 48 * MHZ);
  107. // reset PLL
  108. pll_init(pll_sys,
  109. g_zuluscsi_timings->pll.refdiv,
  110. g_zuluscsi_timings->pll.vco_freq,
  111. g_zuluscsi_timings->pll.post_div1,
  112. g_zuluscsi_timings->pll.post_div2);
  113. // switch clocks back to pll_sys
  114. clock_configure(clk_sys,
  115. CLOCKS_CLK_SYS_CTRL_SRC_VALUE_CLKSRC_CLK_SYS_AUX,
  116. CLOCKS_CLK_SYS_CTRL_AUXSRC_VALUE_CLKSRC_PLL_SYS,
  117. g_zuluscsi_timings->clk_hz,
  118. g_zuluscsi_timings->clk_hz);
  119. clock_configure(clk_peri,
  120. 0,
  121. CLOCKS_CLK_PERI_CTRL_AUXSRC_VALUE_CLKSRC_PLL_SYS,
  122. g_zuluscsi_timings->clk_hz,
  123. g_zuluscsi_timings->clk_hz);
  124. // reset UART for the new clock speed
  125. if (uart_is_enabled(uart0))
  126. uart_init(uart0, 1000000);
  127. }
  128. uint32_t platform_sys_clock_in_hz()
  129. {
  130. return clock_get_hz(clk_sys);
  131. }
  132. bool platform_reclock(zuluscsi_speed_grade_t speed_grade)
  133. {
  134. CustomTimings ct;
  135. bool do_reclock = false;
  136. if (speed_grade != SPEED_GRADE_DEFAULT)
  137. {
  138. if (speed_grade == SPEED_GRADE_CUSTOM)
  139. {
  140. if (ct.use_custom_timings())
  141. {
  142. logmsg("Using custom timings found in \"", CUSTOM_TIMINGS_FILE, "\" for reclocking");
  143. ct.set_timings_from_file();
  144. do_reclock = true;
  145. }
  146. else
  147. {
  148. logmsg("Custom timings file, \"", CUSTOM_TIMINGS_FILE, "\" not found or disabled");
  149. }
  150. }
  151. else if (set_timings(speed_grade))
  152. do_reclock = true;
  153. if (do_reclock)
  154. {
  155. #ifdef ENABLE_AUDIO_OUTPUT
  156. if (g_zuluscsi_timings->audio.audio_clocked)
  157. logmsg("Reclocking with these settings are compatible with CD audio playback");
  158. else
  159. logmsg("Reclocking with these settings may cause audio playback to be too fast or slow ");
  160. #endif
  161. logmsg("Initial Clock set to ", (int) platform_sys_clock_in_hz(), "Hz");
  162. logmsg("Reclocking the MCU to ",(int) g_zuluscsi_timings->clk_hz, "Hz");
  163. #ifndef SD_USE_RP2350_SDIO
  164. logmsg("Setting the SDIO clock to ", (int)((g_zuluscsi_timings->clk_hz / g_zuluscsi_timings->sdio.clk_div_pio + (5 * MHZ / 10)) / MHZ) , "MHz");
  165. #endif
  166. usb_log_poll();
  167. reclock();
  168. logmsg("After reclocking, system reports clock set to ", (int) platform_sys_clock_in_hz(), "Hz");
  169. }
  170. }
  171. else
  172. logmsg("Speed grade is set to default, reclocking skipped");
  173. return do_reclock;
  174. }
  175. bool platform_rebooted_into_mass_storage()
  176. {
  177. volatile uint32_t* scratch0 = (uint32_t *)(WATCHDOG_BASE + WATCHDOG_SCRATCH0_OFFSET);
  178. if (*scratch0 == REBOOT_INTO_MASS_STORAGE_MAGIC_NUM)
  179. {
  180. *scratch0 = 0;
  181. return true;
  182. }
  183. return false;
  184. }
  185. #ifdef HAS_DIP_SWITCHES
  186. enum pin_setup_state_t {SETUP_FALSE, SETUP_TRUE, SETUP_UNDETERMINED};
  187. static pin_setup_state_t read_setup_ack_pin()
  188. {
  189. /* Revision 2022d of the RP2040 hardware has problems reading initiator DIP switch setting.
  190. * The 74LVT245 hold current is keeping the GPIO_ACK state too strongly.
  191. * Detect this condition by toggling the pin up and down and seeing if it sticks.
  192. *
  193. * Revision 2023b and 2023c of the Pico boards have issues reading TERM and DEBUG DIP switch
  194. * settings. GPIO_ACK is externally pulled down to ground for later revisions.
  195. * If the state is detected as undetermined then the board is the 2023b or 2023c revision.
  196. */
  197. // Strong output high, then pulldown
  198. // pin function pup pdown out state fast
  199. gpio_conf(SCSI_IN_ACK, GPIO_FUNC_SIO, false, false, true, true, false);
  200. gpio_conf(SCSI_IN_ACK, GPIO_FUNC_SIO, false, true, false, true, false);
  201. delay(1);
  202. bool ack_state1 = gpio_get(SCSI_IN_ACK);
  203. // Strong output low, then pullup
  204. // pin function pup pdown out state fast
  205. gpio_conf(SCSI_IN_ACK, GPIO_FUNC_SIO, false, false, true, false, false);
  206. gpio_conf(SCSI_IN_ACK, GPIO_FUNC_SIO, true, false, false, false, false);
  207. delay(1);
  208. bool ack_state2 = gpio_get(SCSI_IN_ACK);
  209. if (ack_state1 == ack_state2)
  210. {
  211. // Ok, was able to read the state directly
  212. return !ack_state1 ? SETUP_TRUE : SETUP_FALSE;
  213. }
  214. // Enable OUT_BSY for a short time.
  215. // If in target mode, this will force GPIO_ACK high.
  216. gpio_put(SCSI_OUT_BSY, 0);
  217. delay_100ns();
  218. gpio_put(SCSI_OUT_BSY, 1);
  219. return SETUP_UNDETERMINED;
  220. }
  221. #endif
  222. void platform_init()
  223. {
  224. // Make sure second core is stopped
  225. multicore_reset_core1();
  226. pio_clear_instruction_memory(pio0);
  227. pio_clear_instruction_memory(pio1);
  228. /* First configure the pins that affect external buffer directions.
  229. * RP2040 defaults to pulldowns, while these pins have external pull-ups.
  230. */
  231. // pin function pup pdown out state fast
  232. gpio_conf(SCSI_DATA_DIR, GPIO_FUNC_SIO, false,false, true, true, true);
  233. gpio_conf(SCSI_OUT_RST, GPIO_FUNC_SIO, false,false, true, true, true);
  234. gpio_conf(SCSI_OUT_BSY, GPIO_FUNC_SIO, false,false, true, true, true);
  235. gpio_conf(SCSI_OUT_SEL, GPIO_FUNC_SIO, false,false, true, true, true);
  236. /* Check dip switch settings */
  237. #ifdef HAS_DIP_SWITCHES
  238. gpio_conf(DIP_INITIATOR, GPIO_FUNC_SIO, false, false, false, false, false);
  239. gpio_conf(DIP_DBGLOG, GPIO_FUNC_SIO, false, false, false, false, false);
  240. gpio_conf(DIP_TERM, GPIO_FUNC_SIO, false, false, false, false, false);
  241. delay(10); // 10 ms delay to let pull-ups do their work
  242. bool working_dip = true;
  243. bool dbglog = false;
  244. bool termination = false;
  245. # if defined(ZULUSCSI_PICO) || defined(ZULUSCSI_PICO_2)
  246. // Initiator dip setting works on all rev 2023b, 2023c, and newer rev Pico boards
  247. g_scsi_initiator = !gpio_get(DIP_INITIATOR);
  248. working_dip = SETUP_UNDETERMINED != read_setup_ack_pin();
  249. if (working_dip)
  250. {
  251. dbglog = !gpio_get(DIP_DBGLOG);
  252. termination = !gpio_get(DIP_TERM);
  253. }
  254. # elif defined(ZULUSCSI_V2_0)
  255. pin_setup_state_t dip_state = read_setup_ack_pin();
  256. if (dip_state == SETUP_UNDETERMINED)
  257. {
  258. // This path is used for the few early RP2040 boards assembled with
  259. // Diodes Incorporated 74LVT245B, which has higher bus hold
  260. // current.
  261. working_dip = false;
  262. g_scsi_initiator = !gpio_get(DIP_INITIATOR); // Read fallback value
  263. }
  264. else
  265. {
  266. g_scsi_initiator = (SETUP_TRUE == dip_state);
  267. termination = !gpio_get(DIP_TERM);
  268. }
  269. // dbglog DIP switch works in any case, as it does not have bus hold.
  270. dbglog = !gpio_get(DIP_DBGLOG);
  271. g_log_debug = dbglog;
  272. # else
  273. g_scsi_initiator = !gpio_get(DIP_INITIATOR);
  274. termination = !gpio_get(DIP_TERM);
  275. dbglog = !gpio_get(DIP_DBGLOG);
  276. g_log_debug = dbglog;
  277. # endif
  278. #else
  279. delay(10);
  280. #endif // HAS_DIP_SWITCHES
  281. #ifndef DISABLE_SWO
  282. /* Initialize logging to SWO pin (UART0) */
  283. gpio_conf(SWO_PIN, GPIO_FUNC_UART,false,false, true, false, true);
  284. uart_init(uart0, 1000000);
  285. g_uart_initialized = true;
  286. #endif // DISABLE_SWO
  287. logmsg("Platform: ", g_platform_name);
  288. logmsg("FW Version: ", g_log_firmwareversion);
  289. #ifdef HAS_DIP_SWITCHES
  290. if (working_dip)
  291. {
  292. logmsg("DIP switch settings: debug log ", (int)dbglog, ", termination ", (int)termination);
  293. g_log_debug = dbglog;
  294. if (termination)
  295. {
  296. logmsg("SCSI termination is enabled");
  297. }
  298. else
  299. {
  300. logmsg("NOTE: SCSI termination is disabled");
  301. }
  302. }
  303. else
  304. {
  305. logmsg("SCSI termination is determined by the DIP switch labeled \"TERM\"");
  306. #if defined(ZULUSCSI_PICO) || defined(ZULUSCSI_PICO_2)
  307. logmsg("Debug logging can only be enabled via INI file \"DEBUG=1\" under [SCSI] in zuluscsi.ini");
  308. logmsg("-- DEBUG DIP switch setting is ignored on ZuluSCSI Pico FS Rev. 2023b and 2023c boards");
  309. g_log_debug = false;
  310. #endif
  311. }
  312. #else
  313. g_log_debug = false;
  314. logmsg ("SCSI termination is handled by a hardware jumper");
  315. #endif // HAS_DIP_SWITCHES
  316. // Get flash chip size
  317. uint8_t cmd_read_jedec_id[4] = {0x9f, 0, 0, 0};
  318. uint8_t response_jedec[4] = {0};
  319. uint32_t saved_irq = save_and_disable_interrupts();
  320. flash_do_cmd(cmd_read_jedec_id, response_jedec, 4);
  321. restore_interrupts(saved_irq);
  322. g_flash_chip_size = (1 << response_jedec[3]);
  323. logmsg("Flash chip size: ", (int)(g_flash_chip_size / 1024), " kB");
  324. // SD card pins
  325. // Card is used in SDIO mode for main program, and in SPI mode for crash handler & bootloader.
  326. // pin function pup pdown out state fast
  327. gpio_conf(SD_SPI_SCK, GPIO_FUNC_SPI, true, false, true, true, true);
  328. gpio_conf(SD_SPI_MOSI, GPIO_FUNC_SPI, true, false, true, true, true);
  329. gpio_conf(SD_SPI_MISO, GPIO_FUNC_SPI, true, false, false, true, true);
  330. gpio_conf(SD_SPI_CS, GPIO_FUNC_SIO, true, false, true, true, true);
  331. gpio_conf(SDIO_D1, GPIO_FUNC_SIO, true, false, false, true, true);
  332. gpio_conf(SDIO_D2, GPIO_FUNC_SIO, true, false, false, true, true);
  333. // LED pin
  334. gpio_conf(LED_PIN, GPIO_FUNC_SIO, false,false, true, false, false);
  335. #ifndef ENABLE_AUDIO_OUTPUT_SPDIF
  336. #ifdef GPIO_I2C_SDA
  337. // I2C pins
  338. // pin function pup pdown out state fast
  339. gpio_conf(GPIO_I2C_SCL, GPIO_FUNC_I2C, true,false, false, true, true);
  340. gpio_conf(GPIO_I2C_SDA, GPIO_FUNC_I2C, true,false, false, true, true);
  341. #endif // GPIO_I2C_SDA
  342. #else
  343. // pin function pup pdown out state fast
  344. gpio_conf(GPIO_EXP_AUDIO, GPIO_FUNC_SPI, true,false, false, true, true);
  345. gpio_conf(GPIO_EXP_SPARE, GPIO_FUNC_SIO, true,false, false, true, false);
  346. // configuration of corresponding SPI unit occurs in audio_setup()
  347. #endif // ENABLE_AUDIO_OUTPUT_SPDIF
  348. #ifdef GPIO_USB_POWER
  349. gpio_conf(GPIO_USB_POWER, GPIO_FUNC_SIO, false, false, false, false, false);
  350. #endif
  351. }
  352. // late_init() only runs in main application, SCSI not needed in bootloader
  353. void platform_late_init()
  354. {
  355. #if defined(HAS_DIP_SWITCHES) && defined(PLATFORM_HAS_INITIATOR_MODE)
  356. if (g_scsi_initiator == true)
  357. {
  358. logmsg("SCSI initiator mode selected by DIP switch, expecting SCSI disks on the bus");
  359. }
  360. else
  361. {
  362. logmsg("SCSI target/disk mode selected by DIP switch, acting as a SCSI disk");
  363. }
  364. #else
  365. g_scsi_initiator = false;
  366. logmsg("SCSI target/disk mode, acting as a SCSI disk");
  367. #endif // defined(HAS_DIP_SWITCHES) && defined(PLATFORM_HAS_INITIATOR_MODE)
  368. /* Initialize SCSI pins to required modes.
  369. * SCSI pins should be inactive / input at this point.
  370. */
  371. // SCSI data bus direction is switched by DATA_DIR signal.
  372. // Pullups make sure that no glitches occur when switching direction.
  373. // pin function pup pdown out state fast
  374. gpio_conf(SCSI_IO_DB0, GPIO_FUNC_SIO, true, false, false, true, true);
  375. gpio_conf(SCSI_IO_DB1, GPIO_FUNC_SIO, true, false, false, true, true);
  376. gpio_conf(SCSI_IO_DB2, GPIO_FUNC_SIO, true, false, false, true, true);
  377. gpio_conf(SCSI_IO_DB3, GPIO_FUNC_SIO, true, false, false, true, true);
  378. gpio_conf(SCSI_IO_DB4, GPIO_FUNC_SIO, true, false, false, true, true);
  379. gpio_conf(SCSI_IO_DB5, GPIO_FUNC_SIO, true, false, false, true, true);
  380. gpio_conf(SCSI_IO_DB6, GPIO_FUNC_SIO, true, false, false, true, true);
  381. gpio_conf(SCSI_IO_DB7, GPIO_FUNC_SIO, true, false, false, true, true);
  382. gpio_conf(SCSI_IO_DBP, GPIO_FUNC_SIO, true, false, false, true, true);
  383. if (!g_scsi_initiator)
  384. {
  385. // Act as SCSI device / target
  386. // SCSI control outputs
  387. // pin function pup pdown out state fast
  388. gpio_conf(SCSI_OUT_IO, GPIO_FUNC_SIO, false,false, true, true, true);
  389. gpio_conf(SCSI_OUT_MSG, GPIO_FUNC_SIO, false,false, true, true, true);
  390. // REQ pin is switched between PIO and SIO, pull-up makes sure no glitches
  391. gpio_conf(SCSI_OUT_REQ, GPIO_FUNC_SIO, true ,false, true, true, true);
  392. // Shared pins are changed to input / output depending on communication phase
  393. gpio_conf(SCSI_IN_SEL, GPIO_FUNC_SIO, true, false, false, true, true);
  394. if (SCSI_OUT_CD != SCSI_IN_SEL)
  395. {
  396. gpio_conf(SCSI_OUT_CD, GPIO_FUNC_SIO, false,false, true, true, true);
  397. }
  398. gpio_conf(SCSI_IN_BSY, GPIO_FUNC_SIO, true, false, false, true, true);
  399. if (SCSI_OUT_MSG != SCSI_IN_BSY)
  400. {
  401. gpio_conf(SCSI_OUT_MSG, GPIO_FUNC_SIO, false,false, true, true, true);
  402. }
  403. // SCSI control inputs
  404. // pin function pup pdown out state fast
  405. gpio_conf(SCSI_IN_ACK, GPIO_FUNC_SIO, true, false, false, true, false);
  406. gpio_conf(SCSI_IN_ATN, GPIO_FUNC_SIO, true, false, false, true, false);
  407. gpio_conf(SCSI_IN_RST, GPIO_FUNC_SIO, true, false, false, true, false);
  408. #ifdef ZULUSCSI_RM2
  409. uint rm2_pins[CYW43_PIN_INDEX_WL_COUNT] = {0};
  410. rm2_pins[CYW43_PIN_INDEX_WL_REG_ON] = GPIO_RM2_ON;
  411. rm2_pins[CYW43_PIN_INDEX_WL_DATA_OUT] = GPIO_RM2_DATA;
  412. rm2_pins[CYW43_PIN_INDEX_WL_DATA_IN] = GPIO_RM2_DATA;
  413. rm2_pins[CYW43_PIN_INDEX_WL_HOST_WAKE] = GPIO_RM2_DATA;
  414. rm2_pins[CYW43_PIN_INDEX_WL_CLOCK] = GPIO_RM2_CLK;
  415. rm2_pins[CYW43_PIN_INDEX_WL_CS] = GPIO_RM2_CS;
  416. assert(PICO_OK == cyw43_set_pins_wl(rm2_pins));
  417. if (platform_reclock(SPEED_GRADE_WIFI_RM2))
  418. {
  419. // The iface check turns on the LED on the RM2 early in the init process
  420. // Should tell the user that the RM2 is working
  421. if(platform_network_iface_check())
  422. {
  423. logmsg("RM2 found");
  424. }
  425. else
  426. {
  427. # ifdef ZULUSCSI_BLASTER
  428. logmsg("RM2 not found, upclocking");
  429. platform_reclock(SPEED_GRADE_AUDIO_I2S);
  430. # else
  431. logmsg("RM2 not found");
  432. # endif
  433. }
  434. }
  435. else
  436. {
  437. logmsg("WiFi RM2 timings not found");
  438. }
  439. #elif defined(ENABLE_AUDIO_OUTPUT_I2S)
  440. logmsg("I2S audio to expansion header enabled");
  441. if (!platform_reclock(SPEED_GRADE_AUDIO_I2S))
  442. {
  443. logmsg("Audio output timings not found");
  444. }
  445. #elif defined(ENABLE_AUDIO_OUTPUT_SPDIF)
  446. logmsg("S/PDIF audio to expansion header enabled");
  447. if (platform_reclock(SPEED_GRADE_AUDIO_SPDIF))
  448. {
  449. logmsg("Reclocked for Audio Ouput at ", (int) platform_sys_clock_in_hz(), "Hz");
  450. }
  451. else
  452. {
  453. logmsg("Audio Output timings not found");
  454. }
  455. #endif // ENABLE_AUDIO_OUTPUT_SPDIF
  456. // This should turn on the LED for Pico 1/2 W devices early in the init process
  457. // It should help indicate to the user that interface is working and the board is ready for DaynaPORT
  458. #if defined(ZULUSCSI_NETWORK) && ! defined(ZULUSCSI_RM2)
  459. platform_network_iface_check();
  460. #endif
  461. #ifdef ENABLE_AUDIO_OUTPUT
  462. // one-time control setup for DMA channels and second core
  463. audio_setup();
  464. #endif // ENABLE_AUDIO_OUTPUT_SPDIF
  465. }
  466. else
  467. {
  468. #ifndef PLATFORM_HAS_INITIATOR_MODE
  469. assert(false);
  470. #else
  471. // Act as SCSI initiator
  472. // pin function pup pdown out state fast
  473. gpio_conf(SCSI_IN_IO, GPIO_FUNC_SIO, true ,false, false, true, false);
  474. gpio_conf(SCSI_IN_MSG, GPIO_FUNC_SIO, true ,false, false, true, false);
  475. gpio_conf(SCSI_IN_CD, GPIO_FUNC_SIO, true ,false, false, true, false);
  476. gpio_conf(SCSI_IN_REQ, GPIO_FUNC_SIO, true ,false, false, true, false);
  477. gpio_conf(SCSI_IN_BSY, GPIO_FUNC_SIO, true, false, false, true, false);
  478. gpio_conf(SCSI_IN_RST, GPIO_FUNC_SIO, true, false, false, true, false);
  479. // Reinitialize OUT_RST to output mode. On RP Pico variant the pin is shared with IN_RST.
  480. gpio_conf(SCSI_OUT_RST, GPIO_FUNC_SIO, false, false, true, true, true);
  481. gpio_conf(SCSI_OUT_SEL, GPIO_FUNC_SIO, false,false, true, true, true);
  482. gpio_conf(SCSI_OUT_ACK, GPIO_FUNC_SIO, false,false, true, true, true);
  483. gpio_conf(SCSI_OUT_ATN, GPIO_FUNC_SIO, false,false, true, true, true);
  484. #endif // PLATFORM_HAS_INITIATOR_MODE
  485. }
  486. #ifndef PIO_FRAMEWORK_ARDUINO_NO_USB
  487. Serial.begin();
  488. #endif
  489. scsi_accel_rp2040_init();
  490. }
  491. void platform_post_sd_card_init() {}
  492. bool platform_is_initiator_mode_enabled()
  493. {
  494. return g_scsi_initiator;
  495. }
  496. void platform_write_led(bool state)
  497. {
  498. if (g_led_blinking) return;
  499. if (g_scsi_settings.getSystem()->invertStatusLed)
  500. state = !state;
  501. gpio_put(LED_PIN, state);
  502. }
  503. void platform_set_blink_status(bool status)
  504. {
  505. g_led_blinking = status;
  506. }
  507. void platform_write_led_override(bool state)
  508. {
  509. if (g_scsi_settings.getSystem()->invertStatusLed)
  510. state = !state;
  511. gpio_put(LED_PIN, state);
  512. }
  513. void platform_disable_led(void)
  514. {
  515. // pin function pup pdown out state fast
  516. gpio_conf(LED_PIN, GPIO_FUNC_SIO, false,false, false, false, false);
  517. logmsg("Disabling status LED");
  518. }
  519. uint8_t platform_no_sd_card_on_init_error_code()
  520. {
  521. return SDIO_ERR_RESPONSE_TIMEOUT;
  522. }
  523. /*****************************************/
  524. /* Crash handlers */
  525. /*****************************************/
  526. extern SdFs SD;
  527. extern uint32_t __StackTop;
  528. void platform_emergency_log_save()
  529. {
  530. if (g_rawdrive_active)
  531. return;
  532. platform_set_sd_callback(NULL, NULL);
  533. SD.begin(SD_CONFIG_CRASH);
  534. FsFile crashfile = SD.open(CRASHFILE, O_WRONLY | O_CREAT | O_TRUNC);
  535. if (!crashfile.isOpen())
  536. {
  537. // Try to reinitialize
  538. int max_retry = 10;
  539. while (max_retry-- > 0 && !SD.begin(SD_CONFIG_CRASH));
  540. crashfile = SD.open(CRASHFILE, O_WRONLY | O_CREAT | O_TRUNC);
  541. }
  542. uint32_t startpos = 0;
  543. crashfile.write(log_get_buffer(&startpos));
  544. crashfile.write(log_get_buffer(&startpos));
  545. crashfile.flush();
  546. crashfile.close();
  547. }
  548. static void usb_log_poll();
  549. static void usb_input_poll();
  550. __attribute__((noinline))
  551. void show_hardfault(uint32_t *sp)
  552. {
  553. uint32_t pc = sp[6];
  554. uint32_t lr = sp[5];
  555. logmsg("--------------");
  556. logmsg("CRASH!");
  557. logmsg("Platform: ", g_platform_name);
  558. logmsg("FW Version: ", g_log_firmwareversion);
  559. logmsg("scsiDev.cdb: ", bytearray(scsiDev.cdb, 12));
  560. logmsg("scsiDev.phase: ", (int)scsiDev.phase);
  561. logmsg("SP: ", (uint32_t)sp);
  562. logmsg("PC: ", pc);
  563. logmsg("LR: ", lr);
  564. logmsg("R0: ", sp[0]);
  565. logmsg("R1: ", sp[1]);
  566. logmsg("R2: ", sp[2]);
  567. logmsg("R3: ", sp[3]);
  568. uint32_t *p = (uint32_t*)((uint32_t)sp & ~3);
  569. for (int i = 0; i < 8; i++)
  570. {
  571. if (p == &__StackTop) break; // End of stack
  572. logmsg("STACK ", (uint32_t)p, ": ", p[0], " ", p[1], " ", p[2], " ", p[3]);
  573. p += 4;
  574. }
  575. platform_emergency_log_save();
  576. while (1)
  577. {
  578. usb_log_poll();
  579. // Flash the crash address on the LED
  580. // Short pulse means 0, long pulse means 1
  581. int base_delay = 500;
  582. for (int i = 31; i >= 0; i--)
  583. {
  584. LED_OFF();
  585. for (int j = 0; j < base_delay; j++) busy_wait_ms(1);
  586. int delay = (pc & (1 << i)) ? (3 * base_delay) : base_delay;
  587. LED_ON();
  588. for (int j = 0; j < delay; j++) busy_wait_ms(1);
  589. LED_OFF();
  590. }
  591. for (int j = 0; j < base_delay * 10; j++) busy_wait_ms(1);
  592. }
  593. }
  594. __attribute__((naked, interrupt))
  595. void isr_hardfault(void)
  596. {
  597. // Copies stack pointer into first argument
  598. asm("mrs r0, msp\n"
  599. "bl show_hardfault": : : "r0");
  600. }
  601. /*****************************************/
  602. /* Debug logging and watchdog */
  603. /*****************************************/
  604. static bool usb_serial_connected()
  605. {
  606. #ifdef PIO_FRAMEWORK_ARDUINO_NO_USB
  607. return false;
  608. #endif
  609. static bool connected;
  610. static uint32_t last_check_time;
  611. #ifdef PLATFORM_MASS_STORAGE
  612. if (platform_msc_lock_get()) return connected; // Avoid re-entrant USB events
  613. #endif
  614. if (last_check_time == 0 || (uint32_t)(millis() - last_check_time) > 50)
  615. {
  616. connected = bool(Serial);
  617. last_check_time = millis();
  618. }
  619. return connected;
  620. }
  621. // Send log data to USB UART if USB is connected.
  622. // Data is retrieved from the shared log ring buffer and
  623. // this function sends as much as fits in USB CDC buffer.
  624. //
  625. // This is normally called by platform_reset_watchdog() in
  626. // the normal polling loop. If code hangs, the watchdog_callback()
  627. // also starts calling this after 2 seconds.
  628. // This ensures that log messages get passed even if code hangs,
  629. // but does not unnecessarily delay normal execution.
  630. static void usb_log_poll()
  631. {
  632. #ifndef PIO_FRAMEWORK_ARDUINO_NO_USB
  633. static uint32_t logpos = 0;
  634. if (!usb_serial_connected()) return;
  635. #ifdef PLATFORM_MASS_STORAGE
  636. if (platform_msc_lock_get()) return; // Avoid re-entrant USB events
  637. #endif
  638. if (Serial.availableForWrite())
  639. {
  640. // Retrieve pointer to log start and determine number of bytes available.
  641. uint32_t available = 0;
  642. const char *data = log_get_buffer(&logpos, &available);
  643. // Limit to CDC packet size
  644. uint32_t len = available;
  645. if (len == 0) return;
  646. if (len > CFG_TUD_CDC_EP_BUFSIZE) len = CFG_TUD_CDC_EP_BUFSIZE;
  647. // Update log position by the actual number of bytes sent
  648. // If USB CDC buffer is full, this may be 0
  649. uint32_t actual = 0;
  650. actual = Serial.write(data, len);
  651. logpos -= available - actual;
  652. }
  653. #endif // PIO_FRAMEWORK_ARDUINO_NO_USB
  654. }
  655. // Grab input from USB Serial terminal
  656. static void usb_input_poll()
  657. {
  658. #ifndef PIO_FRAMEWORK_ARDUINO_NO_USB
  659. if (!usb_serial_connected()) return;
  660. #ifdef PLATFORM_MASS_STORAGE
  661. if (platform_msc_lock_get()) return; // Avoid re-entrant USB events
  662. #endif
  663. // Caputure reboot key sequence
  664. static bool mass_storage_reboot_keyed = false;
  665. static bool basic_reboot_keyed = false;
  666. volatile uint32_t* scratch0 = (uint32_t *)(WATCHDOG_BASE + WATCHDOG_SCRATCH0_OFFSET);
  667. int32_t available = Serial.available();
  668. if(available > 0)
  669. {
  670. int32_t read = Serial.read();
  671. switch((char) read)
  672. {
  673. case 'R':
  674. case 'r':
  675. basic_reboot_keyed = true;
  676. mass_storage_reboot_keyed = false;
  677. logmsg("Basic reboot requested, press 'y' to engage or any key to clear");
  678. break;
  679. case 'M':
  680. case 'm':
  681. mass_storage_reboot_keyed = true;
  682. basic_reboot_keyed = false;
  683. logmsg("Boot into mass storage requested, press 'y' to engage or any key to clear");
  684. *scratch0 = REBOOT_INTO_MASS_STORAGE_MAGIC_NUM;
  685. break;
  686. case 'Y':
  687. case 'y':
  688. if (basic_reboot_keyed || mass_storage_reboot_keyed)
  689. {
  690. logmsg("Rebooting", mass_storage_reboot_keyed ? " into mass storage": "");
  691. watchdog_reboot(0, 0, 2000);
  692. }
  693. break;
  694. case '\n':
  695. break;
  696. default:
  697. if (basic_reboot_keyed || mass_storage_reboot_keyed)
  698. logmsg("Cleared reboot setting");
  699. mass_storage_reboot_keyed = false;
  700. basic_reboot_keyed = false;
  701. }
  702. }
  703. #endif // PIO_FRAMEWORK_ARDUINO_NO_USB
  704. }
  705. // Use ADC to implement supply voltage monitoring for the +3.0V rail.
  706. // This works by sampling the temperature sensor channel, which has
  707. // a voltage of 0.7 V, allowing to calculate the VDD voltage.
  708. static void adc_poll()
  709. {
  710. #if PLATFORM_VDD_WARNING_LIMIT_mV > 0
  711. static bool initialized = false;
  712. static int lowest_vdd_seen = PLATFORM_VDD_WARNING_LIMIT_mV;
  713. if (!initialized)
  714. {
  715. adc_init();
  716. adc_set_temp_sensor_enabled(true);
  717. adc_set_clkdiv(65535); // Lowest samplerate, about 2 kHz
  718. #ifdef ZULUSCSI_BLASTER
  719. adc_select_input(8);
  720. #else
  721. adc_select_input(4);
  722. #endif
  723. adc_fifo_setup(true, false, 0, false, false);
  724. adc_run(true);
  725. initialized = true;
  726. }
  727. #ifdef ENABLE_AUDIO_OUTPUT_SPDIF
  728. /*
  729. * If ADC sample reads are done, either via direct reading, FIFO, or DMA,
  730. * at the same time a SPI DMA write begins, it appears that the first
  731. * 16-bit word of the DMA data is lost. This causes the bitstream to glitch
  732. * and audio to 'pop' noticably. For now, just disable ADC reads when audio
  733. * is playing.
  734. */
  735. if (audio_is_active()) return;
  736. #endif // ENABLE_AUDIO_OUTPUT_SPDIF
  737. int adc_value_max = 0;
  738. while (!adc_fifo_is_empty())
  739. {
  740. int adc_value = adc_fifo_get();
  741. if (adc_value > adc_value_max) adc_value_max = adc_value;
  742. }
  743. // adc_value = 700mV * 4096 / Vdd
  744. // => Vdd = 700mV * 4096 / adc_value
  745. // To avoid wasting time on division, compare against
  746. // limit directly.
  747. const int limit = (700 * 4096) / PLATFORM_VDD_WARNING_LIMIT_mV;
  748. if (adc_value_max > limit)
  749. {
  750. // Warn once, and then again if we detect even a lower drop.
  751. int vdd_mV = (700 * 4096) / adc_value_max;
  752. if (vdd_mV < lowest_vdd_seen)
  753. {
  754. logmsg("WARNING: Detected supply voltage drop to ", vdd_mV, "mV. Verify power supply is adequate.");
  755. lowest_vdd_seen = vdd_mV - 50; // Small hysteresis to avoid excessive warnings
  756. }
  757. }
  758. #endif // PLATFORM_VDD_WARNING_LIMIT_mV > 0
  759. }
  760. // This function is called for every log message.
  761. void platform_log(const char *s)
  762. {
  763. if (g_uart_initialized)
  764. {
  765. uart_puts(uart0, s);
  766. }
  767. }
  768. static int g_watchdog_timeout;
  769. static bool g_watchdog_initialized;
  770. static void watchdog_callback(unsigned alarm_num)
  771. {
  772. g_watchdog_timeout -= 1000;
  773. if (g_watchdog_timeout < WATCHDOG_CRASH_TIMEOUT - 1000)
  774. {
  775. // Been stuck for at least a second, start dumping USB log
  776. usb_log_poll();
  777. }
  778. if (g_watchdog_timeout <= WATCHDOG_CRASH_TIMEOUT - WATCHDOG_BUS_RESET_TIMEOUT)
  779. {
  780. if (!scsiDev.resetFlag || !g_scsiHostPhyReset)
  781. {
  782. logmsg("--------------");
  783. logmsg("WATCHDOG TIMEOUT, attempting bus reset");
  784. logmsg("Platform: ", g_platform_name);
  785. logmsg("FW Version: ", g_log_firmwareversion);
  786. logmsg("GPIO states: out ", sio_hw->gpio_out, " oe ", sio_hw->gpio_oe, " in ", sio_hw->gpio_in);
  787. logmsg("scsiDev.cdb: ", bytearray(scsiDev.cdb, 12));
  788. logmsg("scsiDev.phase: ", (int)scsiDev.phase);
  789. scsi_accel_log_state();
  790. uint32_t msp;
  791. asm volatile ("MRS %0, msp" : "=r" (msp) );
  792. uint32_t *p = (uint32_t*)msp;
  793. for (int i = 0; i < 8; i++)
  794. {
  795. if (p == &__StackTop) break; // End of stack
  796. logmsg("STACK ", (uint32_t)p, ": ", p[0], " ", p[1], " ", p[2], " ", p[3]);
  797. p += 4;
  798. }
  799. scsiDev.resetFlag = 1;
  800. g_scsiHostPhyReset = true;
  801. }
  802. if (g_watchdog_timeout <= 0)
  803. {
  804. logmsg("--------------");
  805. logmsg("WATCHDOG TIMEOUT, already attempted bus reset, rebooting");
  806. logmsg("Platform: ", g_platform_name);
  807. logmsg("FW Version: ", g_log_firmwareversion);
  808. logmsg("GPIO states: out ", sio_hw->gpio_out, " oe ", sio_hw->gpio_oe, " in ", sio_hw->gpio_in);
  809. logmsg("scsiDev.cdb: ", bytearray(scsiDev.cdb, 12));
  810. logmsg("scsiDev.phase: ", (int)scsiDev.phase);
  811. uint32_t msp;
  812. asm volatile ("MRS %0, msp" : "=r" (msp) );
  813. uint32_t *p = (uint32_t*)msp;
  814. for (int i = 0; i < 8; i++)
  815. {
  816. if (p == &__StackTop) break; // End of stack
  817. logmsg("STACK ", (uint32_t)p, ": ", p[0], " ", p[1], " ", p[2], " ", p[3]);
  818. p += 4;
  819. }
  820. usb_log_poll();
  821. platform_emergency_log_save();
  822. platform_boot_to_main_firmware();
  823. }
  824. }
  825. hardware_alarm_set_target(alarm_num, delayed_by_ms(get_absolute_time(), 1000));
  826. }
  827. // This function can be used to periodically reset watchdog timer for crash handling.
  828. // It can also be left empty if the platform does not use a watchdog timer.
  829. void platform_reset_watchdog()
  830. {
  831. g_watchdog_timeout = WATCHDOG_CRASH_TIMEOUT;
  832. if (!g_watchdog_initialized)
  833. {
  834. int alarm_num = -1;
  835. for (int i = 0; i < NUM_GENERIC_TIMERS; i++)
  836. {
  837. if (!hardware_alarm_is_claimed(i))
  838. {
  839. alarm_num = i;
  840. break;
  841. }
  842. }
  843. if (alarm_num == -1)
  844. {
  845. logmsg("No free watchdog hardware alarms to claim");
  846. return;
  847. }
  848. hardware_alarm_claim(alarm_num);
  849. hardware_alarm_set_callback(alarm_num, &watchdog_callback);
  850. hardware_alarm_set_target(alarm_num, delayed_by_ms(get_absolute_time(), 1000));
  851. g_watchdog_initialized = true;
  852. }
  853. // USB log is polled here also to make sure any log messages in fault states
  854. // get passed to USB.
  855. usb_log_poll();
  856. }
  857. // Poll function that is called every few milliseconds.
  858. // Can be left empty or used for platform-specific processing.
  859. void platform_poll()
  860. {
  861. usb_input_poll();
  862. usb_log_poll();
  863. adc_poll();
  864. #if defined(ENABLE_AUDIO_OUTPUT_SPDIF) || defined(ENABLE_AUDIO_OUTPUT_I2S)
  865. audio_poll();
  866. #endif // ENABLE_AUDIO_OUTPUT_SPDIF
  867. }
  868. void platform_reset_mcu()
  869. {
  870. watchdog_reboot(0, 0, 2000);
  871. }
  872. uint8_t platform_get_buttons()
  873. {
  874. uint8_t buttons = 0;
  875. #if defined(ENABLE_AUDIO_OUTPUT_SPDIF)
  876. // pulled to VCC via resistor, sinking when pressed
  877. if (!gpio_get(GPIO_EXP_SPARE)) buttons |= 1;
  878. #elif defined(GPIO_I2C_SDA)
  879. // SDA = button 1, SCL = button 2
  880. if (!gpio_get(GPIO_I2C_SDA)) buttons |= 1;
  881. if (!gpio_get(GPIO_I2C_SCL)) buttons |= 2;
  882. #endif // defined(ENABLE_AUDIO_OUTPUT_SPDIF)
  883. // Simple debouncing logic: handle button releases after 100 ms delay.
  884. static uint32_t debounce;
  885. static uint8_t buttons_debounced = 0;
  886. if (buttons != 0)
  887. {
  888. buttons_debounced = buttons;
  889. debounce = millis();
  890. }
  891. else if ((uint32_t)(millis() - debounce) > 100)
  892. {
  893. buttons_debounced = 0;
  894. }
  895. return buttons_debounced;
  896. }
  897. /************************************/
  898. /* ROM drive in extra flash space */
  899. /************************************/
  900. #ifdef PLATFORM_HAS_ROM_DRIVE
  901. # ifndef ROMDRIVE_OFFSET
  902. // Reserve up to 352 kB for firmware by default.
  903. #define ROMDRIVE_OFFSET (352 * 1024)
  904. # endif
  905. uint32_t platform_get_romdrive_maxsize()
  906. {
  907. if (g_flash_chip_size >= ROMDRIVE_OFFSET)
  908. {
  909. return g_flash_chip_size - ROMDRIVE_OFFSET;
  910. }
  911. else
  912. {
  913. // Failed to read flash chip size, default to 2 MB
  914. return 2048 * 1024 - ROMDRIVE_OFFSET;
  915. }
  916. }
  917. bool platform_read_romdrive(uint8_t *dest, uint32_t start, uint32_t count)
  918. {
  919. xip_ctrl_hw->stream_ctr = 0;
  920. while (!(xip_ctrl_hw->stat & XIP_STAT_FIFO_EMPTY))
  921. {
  922. (void) xip_ctrl_hw->stream_fifo;
  923. }
  924. xip_ctrl_hw->stream_addr = start + ROMDRIVE_OFFSET;
  925. xip_ctrl_hw->stream_ctr = count / 4;
  926. // Transfer happens in multiples of 4 bytes
  927. assert(start < platform_get_romdrive_maxsize());
  928. assert((count & 3) == 0);
  929. assert((((uint32_t)dest) & 3) == 0);
  930. uint32_t *dest32 = (uint32_t*)dest;
  931. uint32_t words_remain = count / 4;
  932. while (words_remain > 0)
  933. {
  934. if (!(xip_ctrl_hw->stat & XIP_STAT_FIFO_EMPTY))
  935. {
  936. *dest32++ = xip_ctrl_hw->stream_fifo;
  937. words_remain--;
  938. }
  939. }
  940. return true;
  941. }
  942. bool platform_write_romdrive(const uint8_t *data, uint32_t start, uint32_t count)
  943. {
  944. assert(start < platform_get_romdrive_maxsize());
  945. assert((count % PLATFORM_ROMDRIVE_PAGE_SIZE) == 0);
  946. uint32_t saved_irq = save_and_disable_interrupts();
  947. flash_range_erase(start + ROMDRIVE_OFFSET, count);
  948. flash_range_program(start + ROMDRIVE_OFFSET, data, count);
  949. restore_interrupts(saved_irq);
  950. return true;
  951. }
  952. #endif // PLATFORM_HAS_ROM_DRIVE
  953. /**********************************************/
  954. /* Mapping from data bytes to GPIO BOP values */
  955. /**********************************************/
  956. /* A lookup table is the fastest way to calculate parity and convert the IO pin mapping for data bus.
  957. * For RP2040 we expect that the bits are consecutive and in order.
  958. * The PIO-based parity scheme also requires that the lookup table is aligned to 512-byte increment.
  959. * The parity table is placed into SRAM4 area to reduce bus contention.
  960. */
  961. #define PARITY(n) ((1 ^ (n) ^ ((n)>>1) ^ ((n)>>2) ^ ((n)>>3) ^ ((n)>>4) ^ ((n)>>5) ^ ((n)>>6) ^ ((n)>>7)) & 1)
  962. #ifdef ZULUSCSI_BLASTER
  963. # define X(n) (\
  964. ((n & 0x01) ? 0 : (1 << 0)) | \
  965. ((n & 0x02) ? 0 : (1 << 1)) | \
  966. ((n & 0x04) ? 0 : (1 << 2)) | \
  967. ((n & 0x08) ? 0 : (1 << 3)) | \
  968. ((n & 0x10) ? 0 : (1 << 4)) | \
  969. ((n & 0x20) ? 0 : (1 << 5)) | \
  970. ((n & 0x40) ? 0 : (1 << 6)) | \
  971. ((n & 0x80) ? 0 : (1 << 7)) | \
  972. (PARITY(n) ? 0 : (1 << 8)) \
  973. )
  974. #else
  975. # define X(n) (\
  976. ((n & 0x01) ? 0 : (1 << SCSI_IO_DB0)) | \
  977. ((n & 0x02) ? 0 : (1 << SCSI_IO_DB1)) | \
  978. ((n & 0x04) ? 0 : (1 << SCSI_IO_DB2)) | \
  979. ((n & 0x08) ? 0 : (1 << SCSI_IO_DB3)) | \
  980. ((n & 0x10) ? 0 : (1 << SCSI_IO_DB4)) | \
  981. ((n & 0x20) ? 0 : (1 << SCSI_IO_DB5)) | \
  982. ((n & 0x40) ? 0 : (1 << SCSI_IO_DB6)) | \
  983. ((n & 0x80) ? 0 : (1 << SCSI_IO_DB7)) | \
  984. (PARITY(n) ? 0 : (1 << SCSI_IO_DBP)) \
  985. )
  986. #endif
  987. const uint16_t g_scsi_parity_lookup[256] __attribute__((aligned(512), section(".scratch_x.parity"))) =
  988. {
  989. 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),
  990. 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),
  991. 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),
  992. 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),
  993. 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),
  994. 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),
  995. 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),
  996. 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),
  997. 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),
  998. 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),
  999. 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),
  1000. 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),
  1001. 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),
  1002. 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),
  1003. 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),
  1004. 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)
  1005. };
  1006. #undef X
  1007. /* Similarly, another lookup table is used to verify parity of received data.
  1008. * This table is indexed by the 8 data bits + 1 parity bit from SCSI bus (active low)
  1009. * Each word contains the data byte (inverted to active-high) and a bit indicating whether parity is valid.
  1010. */
  1011. #define X(n) (\
  1012. ((n & 0xFF) ^ 0xFF) | \
  1013. (((PARITY(n & 0xFF) ^ (n >> 8)) & 1) << 8) \
  1014. )
  1015. const uint16_t g_scsi_parity_check_lookup[512] __attribute__((aligned(1024), section(".scratch_x.parity"))) =
  1016. {
  1017. X(0x000), X(0x001), X(0x002), X(0x003), X(0x004), X(0x005), X(0x006), X(0x007), X(0x008), X(0x009), X(0x00a), X(0x00b), X(0x00c), X(0x00d), X(0x00e), X(0x00f),
  1018. X(0x010), X(0x011), X(0x012), X(0x013), X(0x014), X(0x015), X(0x016), X(0x017), X(0x018), X(0x019), X(0x01a), X(0x01b), X(0x01c), X(0x01d), X(0x01e), X(0x01f),
  1019. X(0x020), X(0x021), X(0x022), X(0x023), X(0x024), X(0x025), X(0x026), X(0x027), X(0x028), X(0x029), X(0x02a), X(0x02b), X(0x02c), X(0x02d), X(0x02e), X(0x02f),
  1020. X(0x030), X(0x031), X(0x032), X(0x033), X(0x034), X(0x035), X(0x036), X(0x037), X(0x038), X(0x039), X(0x03a), X(0x03b), X(0x03c), X(0x03d), X(0x03e), X(0x03f),
  1021. X(0x040), X(0x041), X(0x042), X(0x043), X(0x044), X(0x045), X(0x046), X(0x047), X(0x048), X(0x049), X(0x04a), X(0x04b), X(0x04c), X(0x04d), X(0x04e), X(0x04f),
  1022. X(0x050), X(0x051), X(0x052), X(0x053), X(0x054), X(0x055), X(0x056), X(0x057), X(0x058), X(0x059), X(0x05a), X(0x05b), X(0x05c), X(0x05d), X(0x05e), X(0x05f),
  1023. X(0x060), X(0x061), X(0x062), X(0x063), X(0x064), X(0x065), X(0x066), X(0x067), X(0x068), X(0x069), X(0x06a), X(0x06b), X(0x06c), X(0x06d), X(0x06e), X(0x06f),
  1024. X(0x070), X(0x071), X(0x072), X(0x073), X(0x074), X(0x075), X(0x076), X(0x077), X(0x078), X(0x079), X(0x07a), X(0x07b), X(0x07c), X(0x07d), X(0x07e), X(0x07f),
  1025. X(0x080), X(0x081), X(0x082), X(0x083), X(0x084), X(0x085), X(0x086), X(0x087), X(0x088), X(0x089), X(0x08a), X(0x08b), X(0x08c), X(0x08d), X(0x08e), X(0x08f),
  1026. X(0x090), X(0x091), X(0x092), X(0x093), X(0x094), X(0x095), X(0x096), X(0x097), X(0x098), X(0x099), X(0x09a), X(0x09b), X(0x09c), X(0x09d), X(0x09e), X(0x09f),
  1027. X(0x0a0), X(0x0a1), X(0x0a2), X(0x0a3), X(0x0a4), X(0x0a5), X(0x0a6), X(0x0a7), X(0x0a8), X(0x0a9), X(0x0aa), X(0x0ab), X(0x0ac), X(0x0ad), X(0x0ae), X(0x0af),
  1028. X(0x0b0), X(0x0b1), X(0x0b2), X(0x0b3), X(0x0b4), X(0x0b5), X(0x0b6), X(0x0b7), X(0x0b8), X(0x0b9), X(0x0ba), X(0x0bb), X(0x0bc), X(0x0bd), X(0x0be), X(0x0bf),
  1029. X(0x0c0), X(0x0c1), X(0x0c2), X(0x0c3), X(0x0c4), X(0x0c5), X(0x0c6), X(0x0c7), X(0x0c8), X(0x0c9), X(0x0ca), X(0x0cb), X(0x0cc), X(0x0cd), X(0x0ce), X(0x0cf),
  1030. X(0x0d0), X(0x0d1), X(0x0d2), X(0x0d3), X(0x0d4), X(0x0d5), X(0x0d6), X(0x0d7), X(0x0d8), X(0x0d9), X(0x0da), X(0x0db), X(0x0dc), X(0x0dd), X(0x0de), X(0x0df),
  1031. X(0x0e0), X(0x0e1), X(0x0e2), X(0x0e3), X(0x0e4), X(0x0e5), X(0x0e6), X(0x0e7), X(0x0e8), X(0x0e9), X(0x0ea), X(0x0eb), X(0x0ec), X(0x0ed), X(0x0ee), X(0x0ef),
  1032. X(0x0f0), X(0x0f1), X(0x0f2), X(0x0f3), X(0x0f4), X(0x0f5), X(0x0f6), X(0x0f7), X(0x0f8), X(0x0f9), X(0x0fa), X(0x0fb), X(0x0fc), X(0x0fd), X(0x0fe), X(0x0ff),
  1033. X(0x100), X(0x101), X(0x102), X(0x103), X(0x104), X(0x105), X(0x106), X(0x107), X(0x108), X(0x109), X(0x10a), X(0x10b), X(0x10c), X(0x10d), X(0x10e), X(0x10f),
  1034. X(0x110), X(0x111), X(0x112), X(0x113), X(0x114), X(0x115), X(0x116), X(0x117), X(0x118), X(0x119), X(0x11a), X(0x11b), X(0x11c), X(0x11d), X(0x11e), X(0x11f),
  1035. X(0x120), X(0x121), X(0x122), X(0x123), X(0x124), X(0x125), X(0x126), X(0x127), X(0x128), X(0x129), X(0x12a), X(0x12b), X(0x12c), X(0x12d), X(0x12e), X(0x12f),
  1036. X(0x130), X(0x131), X(0x132), X(0x133), X(0x134), X(0x135), X(0x136), X(0x137), X(0x138), X(0x139), X(0x13a), X(0x13b), X(0x13c), X(0x13d), X(0x13e), X(0x13f),
  1037. X(0x140), X(0x141), X(0x142), X(0x143), X(0x144), X(0x145), X(0x146), X(0x147), X(0x148), X(0x149), X(0x14a), X(0x14b), X(0x14c), X(0x14d), X(0x14e), X(0x14f),
  1038. X(0x150), X(0x151), X(0x152), X(0x153), X(0x154), X(0x155), X(0x156), X(0x157), X(0x158), X(0x159), X(0x15a), X(0x15b), X(0x15c), X(0x15d), X(0x15e), X(0x15f),
  1039. X(0x160), X(0x161), X(0x162), X(0x163), X(0x164), X(0x165), X(0x166), X(0x167), X(0x168), X(0x169), X(0x16a), X(0x16b), X(0x16c), X(0x16d), X(0x16e), X(0x16f),
  1040. X(0x170), X(0x171), X(0x172), X(0x173), X(0x174), X(0x175), X(0x176), X(0x177), X(0x178), X(0x179), X(0x17a), X(0x17b), X(0x17c), X(0x17d), X(0x17e), X(0x17f),
  1041. X(0x180), X(0x181), X(0x182), X(0x183), X(0x184), X(0x185), X(0x186), X(0x187), X(0x188), X(0x189), X(0x18a), X(0x18b), X(0x18c), X(0x18d), X(0x18e), X(0x18f),
  1042. X(0x190), X(0x191), X(0x192), X(0x193), X(0x194), X(0x195), X(0x196), X(0x197), X(0x198), X(0x199), X(0x19a), X(0x19b), X(0x19c), X(0x19d), X(0x19e), X(0x19f),
  1043. X(0x1a0), X(0x1a1), X(0x1a2), X(0x1a3), X(0x1a4), X(0x1a5), X(0x1a6), X(0x1a7), X(0x1a8), X(0x1a9), X(0x1aa), X(0x1ab), X(0x1ac), X(0x1ad), X(0x1ae), X(0x1af),
  1044. X(0x1b0), X(0x1b1), X(0x1b2), X(0x1b3), X(0x1b4), X(0x1b5), X(0x1b6), X(0x1b7), X(0x1b8), X(0x1b9), X(0x1ba), X(0x1bb), X(0x1bc), X(0x1bd), X(0x1be), X(0x1bf),
  1045. X(0x1c0), X(0x1c1), X(0x1c2), X(0x1c3), X(0x1c4), X(0x1c5), X(0x1c6), X(0x1c7), X(0x1c8), X(0x1c9), X(0x1ca), X(0x1cb), X(0x1cc), X(0x1cd), X(0x1ce), X(0x1cf),
  1046. X(0x1d0), X(0x1d1), X(0x1d2), X(0x1d3), X(0x1d4), X(0x1d5), X(0x1d6), X(0x1d7), X(0x1d8), X(0x1d9), X(0x1da), X(0x1db), X(0x1dc), X(0x1dd), X(0x1de), X(0x1df),
  1047. X(0x1e0), X(0x1e1), X(0x1e2), X(0x1e3), X(0x1e4), X(0x1e5), X(0x1e6), X(0x1e7), X(0x1e8), X(0x1e9), X(0x1ea), X(0x1eb), X(0x1ec), X(0x1ed), X(0x1ee), X(0x1ef),
  1048. X(0x1f0), X(0x1f1), X(0x1f2), X(0x1f3), X(0x1f4), X(0x1f5), X(0x1f6), X(0x1f7), X(0x1f8), X(0x1f9), X(0x1fa), X(0x1fb), X(0x1fc), X(0x1fd), X(0x1fe), X(0x1ff),
  1049. };
  1050. #undef X
  1051. } /* extern "C" */
  1052. #ifdef SD_USE_SDIO
  1053. // These functions are not used for SDIO mode but are needed to avoid build error.
  1054. void sdCsInit(SdCsPin_t pin) {}
  1055. void sdCsWrite(SdCsPin_t pin, bool level) {}
  1056. // SDIO configuration for main program
  1057. SdioConfig g_sd_sdio_config(DMA_SDIO);
  1058. #ifdef SD_USE_RP2350_SDIO
  1059. void platform_set_sd_callback(sd_callback_t func, const uint8_t *buffer)
  1060. {
  1061. rp2350_sdio_sdfat_set_callback(func, buffer);
  1062. }
  1063. #endif
  1064. #endif