|
|
@@ -1,78 +0,0 @@
|
|
|
-// As of 2022-11-16, the raspberrypi platformio package ships with old version
|
|
|
-// of pico-sdk. This version lacks the flash_do_cmd() function in flash.h header.
|
|
|
-// This file backports the function from new versions.
|
|
|
-
|
|
|
-#pragma once
|
|
|
-
|
|
|
-#ifndef RP2040_HAS_FLASH_DO_CMD
|
|
|
-
|
|
|
-#include <hardware/flash.h>
|
|
|
-#include "pico/bootrom.h"
|
|
|
-#include "hardware/structs/ssi.h"
|
|
|
-#include "hardware/structs/ioqspi.h"
|
|
|
-
|
|
|
-#define BOOT2_SIZE_WORDS 64
|
|
|
-
|
|
|
-static uint32_t boot2_copyout[BOOT2_SIZE_WORDS];
|
|
|
-static bool boot2_copyout_valid = false;
|
|
|
-
|
|
|
-static void __no_inline_not_in_flash_func(flash_init_boot2_copyout)(void) {
|
|
|
- if (boot2_copyout_valid)
|
|
|
- return;
|
|
|
- for (int i = 0; i < BOOT2_SIZE_WORDS; ++i)
|
|
|
- boot2_copyout[i] = ((uint32_t *)XIP_BASE)[i];
|
|
|
- __asm__ volatile ("" : : : "memory");
|
|
|
- boot2_copyout_valid = true;
|
|
|
-}
|
|
|
-
|
|
|
-static void __no_inline_not_in_flash_func(flash_enable_xip_via_boot2)(void) {
|
|
|
- ((void (*)(void))((char*)boot2_copyout+1))();
|
|
|
-}
|
|
|
-
|
|
|
-// Bitbanging the chip select using IO overrides, in case RAM-resident IRQs
|
|
|
-// are still running, and the FIFO bottoms out. (the bootrom does the same)
|
|
|
-static void __no_inline_not_in_flash_func(flash_cs_force)(bool high) {
|
|
|
- uint32_t field_val = high ?
|
|
|
- IO_QSPI_GPIO_QSPI_SS_CTRL_OUTOVER_VALUE_HIGH :
|
|
|
- IO_QSPI_GPIO_QSPI_SS_CTRL_OUTOVER_VALUE_LOW;
|
|
|
- hw_write_masked(&ioqspi_hw->io[1].ctrl,
|
|
|
- field_val << IO_QSPI_GPIO_QSPI_SS_CTRL_OUTOVER_LSB,
|
|
|
- IO_QSPI_GPIO_QSPI_SS_CTRL_OUTOVER_BITS
|
|
|
- );
|
|
|
-}
|
|
|
-
|
|
|
-static void __no_inline_not_in_flash_func(flash_do_cmd)(const uint8_t *txbuf, uint8_t *rxbuf, size_t count) {
|
|
|
- void (*connect_internal_flash)(void) = (void(*)(void))rom_func_lookup(rom_table_code('I', 'F'));
|
|
|
- void (*flash_exit_xip)(void) = (void(*)(void))rom_func_lookup(rom_table_code('E', 'X'));
|
|
|
- void (*flash_flush_cache)(void) = (void(*)(void))rom_func_lookup(rom_table_code('F', 'C'));
|
|
|
- assert(connect_internal_flash && flash_exit_xip && flash_flush_cache);
|
|
|
- flash_init_boot2_copyout();
|
|
|
- __asm__ volatile ("" : : : "memory");
|
|
|
- connect_internal_flash();
|
|
|
- flash_exit_xip();
|
|
|
-
|
|
|
- flash_cs_force(0);
|
|
|
- size_t tx_remaining = count;
|
|
|
- size_t rx_remaining = count;
|
|
|
- // We may be interrupted -- don't want FIFO to overflow if we're distracted.
|
|
|
- const size_t max_in_flight = 16 - 2;
|
|
|
- while (tx_remaining || rx_remaining) {
|
|
|
- uint32_t flags = ssi_hw->sr;
|
|
|
- bool can_put = !!(flags & SSI_SR_TFNF_BITS);
|
|
|
- bool can_get = !!(flags & SSI_SR_RFNE_BITS);
|
|
|
- if (can_put && tx_remaining && rx_remaining - tx_remaining < max_in_flight) {
|
|
|
- ssi_hw->dr0 = *txbuf++;
|
|
|
- --tx_remaining;
|
|
|
- }
|
|
|
- if (can_get && rx_remaining) {
|
|
|
- *rxbuf++ = (uint8_t)ssi_hw->dr0;
|
|
|
- --rx_remaining;
|
|
|
- }
|
|
|
- }
|
|
|
- flash_cs_force(1);
|
|
|
-
|
|
|
- flash_flush_cache();
|
|
|
- flash_enable_xip_via_boot2();
|
|
|
-}
|
|
|
-
|
|
|
-#endif
|