/* SPDX-License-Identifier: GPL-2.0-only */ #include #include #include #include static struct spi_flash sfg; static bool sfg_init_done; static ssize_t spi_readat(const struct region_device *rd, void *b, size_t offset, size_t size) { if (spi_flash_read(&sfg, offset, size, b)) return -1; return size; } static ssize_t spi_writeat(const struct region_device *rd, const void *b, size_t offset, size_t size) { if (spi_flash_write(&sfg, offset, size, b)) return -1; return size; } static ssize_t spi_eraseat(const struct region_device *rd, size_t offset, size_t size) { if (spi_flash_erase(&sfg, offset, size)) return -1; return size; } static const struct region_device_ops spi_ops = { .readat = spi_readat, .writeat = spi_writeat, .eraseat = spi_eraseat, }; static const struct region_device spi_rw = REGION_DEV_INIT(&spi_ops, 0, CONFIG_ROM_SIZE); static void boot_device_rw_init(void) { const int bus = CONFIG_BOOT_DEVICE_SPI_FLASH_BUS; const int cs = 0; if (sfg_init_done == true) return; /* Ensure any necessary setup is performed by the drivers. */ spi_init(); if (!spi_flash_probe(bus, cs, &sfg)) sfg_init_done = true; } const struct region_device *boot_device_rw(void) { /* Probe for the SPI flash device if not already done. */ boot_device_rw_init(); if (sfg_init_done != true) return NULL; return &spi_rw; } const struct spi_flash *boot_device_spi_flash(void) { boot_device_rw_init(); if (sfg_init_done != true) return NULL; return &sfg; } int boot_device_wp_region(const struct region_device *rd, const enum bootdev_prot_type type) { uint32_t ctrlr_pr; /* Ensure boot device has been initialized at least once. */ boot_device_init(); const struct spi_flash *boot_dev = boot_device_spi_flash(); if (boot_dev == NULL) return -1; if (type == MEDIA_WP) { if (spi_flash_is_write_protected(boot_dev, region_device_region(rd)) != 1) { return spi_flash_set_write_protected(boot_dev, region_device_region(rd), true, SPI_WRITE_PROTECTION_REBOOT); } /* Already write protected */ return 0; } switch (type) { case CTRLR_WP: ctrlr_pr = WRITE_PROTECT; break; case CTRLR_RP: ctrlr_pr = READ_PROTECT; break; case CTRLR_RWP: ctrlr_pr = READ_WRITE_PROTECT; break; default: return -1; } return spi_flash_ctrlr_protect_region(boot_dev, region_device_region(rd), ctrlr_pr); }