mirror of
https://github.com/trezor/trezor-firmware.git
synced 2024-12-30 01:58:11 +00:00
137 lines
3.1 KiB
C
137 lines
3.1 KiB
C
/*
|
|
* This file is part of the Trezor project, https://trezor.io/
|
|
*
|
|
* Copyright (C) 2017 Saleem Rashid <trezor@saleemrashid.com>
|
|
*
|
|
* This library is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU Lesser General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public License
|
|
* along with this library. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <assert.h>
|
|
#include <stdbool.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
|
|
#include "memory.h"
|
|
|
|
void flash_lock(void) { sync(); }
|
|
|
|
void flash_unlock(void) {}
|
|
|
|
void flash_clear_status_flags(void) {}
|
|
|
|
void flash_lock_option_bytes(void) {}
|
|
void flash_unlock_option_bytes(void) {}
|
|
|
|
void flash_program_option_bytes(uint32_t data) { (void)data; }
|
|
|
|
static ssize_t sector_to_offset(uint8_t sector) {
|
|
switch (sector) {
|
|
case 0:
|
|
return 0x0;
|
|
case 1:
|
|
return 0x4000;
|
|
case 2:
|
|
return 0x8000;
|
|
case 3:
|
|
return 0xC000;
|
|
case 4:
|
|
return 0x10000;
|
|
case 5:
|
|
return 0x20000;
|
|
case 6:
|
|
return 0x40000;
|
|
case 7:
|
|
return 0x60000;
|
|
case 8:
|
|
return 0x80000;
|
|
default:
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
static void *sector_to_address(uint8_t sector) {
|
|
ssize_t offset = sector_to_offset(sector);
|
|
if (offset < 0) {
|
|
return NULL;
|
|
}
|
|
|
|
return (void *)FLASH_PTR(FLASH_ORIGIN + offset);
|
|
}
|
|
|
|
static ssize_t sector_to_size(uint8_t sector) {
|
|
ssize_t start = sector_to_offset(sector);
|
|
if (start < 0) {
|
|
return -1;
|
|
}
|
|
|
|
ssize_t end = sector_to_offset(sector + 1);
|
|
if (end < 0) {
|
|
return -1;
|
|
}
|
|
|
|
return end - start;
|
|
}
|
|
|
|
void flash_erase_sector(uint8_t sector, uint32_t program_size) {
|
|
(void)program_size;
|
|
|
|
void *address = sector_to_address(sector);
|
|
if (address == NULL) {
|
|
return;
|
|
}
|
|
|
|
ssize_t size = sector_to_size(sector);
|
|
if (size < 0) {
|
|
return;
|
|
}
|
|
|
|
memset(address, 0xFF, size);
|
|
}
|
|
|
|
void flash_erase_all_sectors(uint32_t program_size) {
|
|
(void)program_size;
|
|
|
|
memset(emulator_flash_base, 0xFF, FLASH_TOTAL_SIZE);
|
|
}
|
|
|
|
void flash_program_word(uint32_t address, uint32_t data) {
|
|
*(volatile uint32_t *)FLASH_PTR(address) = data;
|
|
}
|
|
|
|
void flash_program_byte(uint32_t address, uint8_t data) {
|
|
*(volatile uint8_t *)FLASH_PTR(address) = data;
|
|
}
|
|
|
|
static bool flash_locked = true;
|
|
void svc_flash_unlock(void) {
|
|
assert(flash_locked);
|
|
flash_locked = false;
|
|
}
|
|
void svc_flash_program(uint32_t size) {
|
|
(void)size;
|
|
assert(!flash_locked);
|
|
}
|
|
void svc_flash_erase_sector(uint16_t sector) {
|
|
assert(!flash_locked);
|
|
assert(sector >= FLASH_STORAGE_SECTOR_FIRST &&
|
|
sector <= FLASH_STORAGE_SECTOR_LAST);
|
|
flash_erase_sector(sector, 3);
|
|
}
|
|
uint32_t svc_flash_lock(void) {
|
|
assert(!flash_locked);
|
|
flash_locked = true;
|
|
sync();
|
|
return 0;
|
|
}
|