Kev Mann / mbed-dev-OS5_10_4

RTC auf true

hal/TARGET_FLASH_CMSIS_ALGO/flash_common_algo.c@2:7aab896b1a3b, 2019-03-13 (annotated)

Committer:
kevman
Date:
Wed Mar 13 11:03:24 2019 +0000
Revision:
2:7aab896b1a3b
Parent:
0:38ceb79fef03 
2019-03-13

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kevman 0:38ceb79fef03 1 /* mbed Microcontroller Library
kevman 0:38ceb79fef03 2 * Copyright (c) 2017 ARM Limited
kevman 0:38ceb79fef03 3 *
kevman 0:38ceb79fef03 4 * Licensed under the Apache License, Version 2.0 (the "License");
kevman 0:38ceb79fef03 5 * you may not use this file except in compliance with the License.
kevman 0:38ceb79fef03 6 * You may obtain a copy of the License at
kevman 0:38ceb79fef03 7 *
kevman 0:38ceb79fef03 8 * http://www.apache.org/licenses/LICENSE-2.0
kevman 0:38ceb79fef03 9 *
kevman 0:38ceb79fef03 10 * Unless required by applicable law or agreed to in writing, software
kevman 0:38ceb79fef03 11 * distributed under the License is distributed on an "AS IS" BASIS,
kevman 0:38ceb79fef03 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kevman 0:38ceb79fef03 13 * See the License for the specific language governing permissions and
kevman 0:38ceb79fef03 14 * limitations under the License.
kevman 0:38ceb79fef03 15 */
kevman 0:38ceb79fef03 16
kevman 0:38ceb79fef03 17 #include "flash_api.h"
kevman 0:38ceb79fef03 18 #include "flash_data.h"
kevman 0:38ceb79fef03 19 #include "mbed_critical.h"
kevman 0:38ceb79fef03 20 #include "mbed_toolchain.h"
kevman 0:38ceb79fef03 21
kevman 0:38ceb79fef03 22 #ifndef DOMAIN_NS
kevman 0:38ceb79fef03 23
kevman 0:38ceb79fef03 24 #if defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3U)
kevman 0:38ceb79fef03 25 #include <arm_cmse.h>
kevman 0:38ceb79fef03 26 #endif
kevman 0:38ceb79fef03 27
kevman 0:38ceb79fef03 28 #define MBED_FLASH_ALGO_ERASE 1UL
kevman 0:38ceb79fef03 29 #define MBED_FLASH_ALGO_PROGRAM 2UL
kevman 0:38ceb79fef03 30
kevman 0:38ceb79fef03 31 extern uint32_t SystemCoreClock;
kevman 0:38ceb79fef03 32
kevman 0:38ceb79fef03 33 /*
kevman 0:38ceb79fef03 34 This binary blob (thumb code) sets r9 (static base) as the code we are jumping to
kevman 0:38ceb79fef03 35 is PIC (position independent code).
kevman 0:38ceb79fef03 36
kevman 0:38ceb79fef03 37 These are the instructions (r0 is a pointer to arg_t):
kevman 0:38ceb79fef03 38 push {r5, lr, r4}
kevman 0:38ceb79fef03 39 mov r5, r9
kevman 0:38ceb79fef03 40 push {r5}
kevman 0:38ceb79fef03 41 ldr r5, [r0, #20]
kevman 0:38ceb79fef03 42 ldr r3, [r0, #16]
kevman 0:38ceb79fef03 43 mov r9, r3
kevman 0:38ceb79fef03 44 ldr r3, [r0, #12]
kevman 0:38ceb79fef03 45 ldr r2, [r0, #8]
kevman 0:38ceb79fef03 46 ldr r1, [r0, #4]
kevman 0:38ceb79fef03 47 ldr r0, [r0, #0]
kevman 0:38ceb79fef03 48 blx r5
kevman 0:38ceb79fef03 49 pop {r5}
kevman 0:38ceb79fef03 50 mov r9, r5
kevman 0:38ceb79fef03 51 pop {r4-r5, pc}
kevman 0:38ceb79fef03 52 bx r14
kevman 0:38ceb79fef03 53 */
kevman 0:38ceb79fef03 54 static uint32_t jump_to_flash_algo[] = {
kevman 0:38ceb79fef03 55 0x464DB530,
kevman 0:38ceb79fef03 56 0x6945B420,
kevman 0:38ceb79fef03 57 0x46996903,
kevman 0:38ceb79fef03 58 0x688268C3,
kevman 0:38ceb79fef03 59 0x68006841,
kevman 0:38ceb79fef03 60 0xBC2047A8,
kevman 0:38ceb79fef03 61 0xBD3046A9
kevman 0:38ceb79fef03 62 };
kevman 0:38ceb79fef03 63
kevman 0:38ceb79fef03 64 // should be called within critical section
kevman 0:38ceb79fef03 65 static int32_t flash_algo_init(flash_t *obj, uint32_t address, uint32_t function)
kevman 0:38ceb79fef03 66 {
kevman 0:38ceb79fef03 67 args_t arguments = {
kevman 0:38ceb79fef03 68 .r0 = address,
kevman 0:38ceb79fef03 69 .r1 = SystemCoreClock,
kevman 0:38ceb79fef03 70 .r2 = function,
kevman 0:38ceb79fef03 71 .r3 = 0,
kevman 0:38ceb79fef03 72 .r9 = (uint32_t)obj->flash_algo->algo_blob + obj->flash_algo->static_base,
kevman 0:38ceb79fef03 73 .pc = (uint32_t)obj->flash_algo->algo_blob + obj->flash_algo->init
kevman 0:38ceb79fef03 74 };
kevman 0:38ceb79fef03 75 return ((flash_algo_jump_t)(((uint32_t)&jump_to_flash_algo) | 1))(&arguments);
kevman 0:38ceb79fef03 76 }
kevman 0:38ceb79fef03 77
kevman 0:38ceb79fef03 78 // should be called within critical section
kevman 0:38ceb79fef03 79 static int32_t flash_algo_uninit(flash_t *obj, uint32_t address, uint32_t function)
kevman 0:38ceb79fef03 80 {
kevman 0:38ceb79fef03 81 args_t arguments = {
kevman 0:38ceb79fef03 82 .r0 = address,
kevman 0:38ceb79fef03 83 .r1 = SystemCoreClock,
kevman 0:38ceb79fef03 84 .r2 = function,
kevman 0:38ceb79fef03 85 .r3 = 0,
kevman 0:38ceb79fef03 86 .r9 = (uint32_t)obj->flash_algo->algo_blob + obj->flash_algo->static_base,
kevman 0:38ceb79fef03 87 .pc = (uint32_t)obj->flash_algo->algo_blob + obj->flash_algo->uninit
kevman 0:38ceb79fef03 88 };
kevman 0:38ceb79fef03 89 return ((flash_algo_jump_t)(((uint32_t)&jump_to_flash_algo) | 1))(&arguments);
kevman 0:38ceb79fef03 90 }
kevman 0:38ceb79fef03 91
kevman 0:38ceb79fef03 92 #if defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3U)
kevman 0:38ceb79fef03 93 /* Check if address range [start_addr, end_addr] is in non-secure flash
kevman 0:38ceb79fef03 94 *
kevman 0:38ceb79fef03 95 * @param obj The flash object
kevman 0:38ceb79fef03 96 * @param start_addr Start address to check
kevman 0:38ceb79fef03 97 * @param end_addr End address to check. Could be the same as start_addr to just check start_addr
kevman 0:38ceb79fef03 98 * for e.g. flash_erase_sector.
kevman 0:38ceb79fef03 99 * @return 0 for success, -1 for error
kevman 0:38ceb79fef03 100 */
kevman 0:38ceb79fef03 101 static int32_t flash_check_nonsecure(flash_t *obj, uint32_t start_addr, uint32_t end_addr)
kevman 0:38ceb79fef03 102 {
kevman 0:38ceb79fef03 103 /* Check if end address wraps around */
kevman 0:38ceb79fef03 104 if (end_addr < start_addr) {
kevman 0:38ceb79fef03 105 return -1;
kevman 0:38ceb79fef03 106 }
kevman 0:38ceb79fef03 107
kevman 0:38ceb79fef03 108 /* Check if start address is in non-secure flash */
kevman 0:38ceb79fef03 109 if ((start_addr < obj->target_config_ns->flash_start) ||
kevman 0:38ceb79fef03 110 (start_addr >= (obj->target_config_ns->flash_start + obj->target_config_ns->flash_size))) {
kevman 0:38ceb79fef03 111 return -1;
kevman 0:38ceb79fef03 112 }
kevman 0:38ceb79fef03 113
kevman 0:38ceb79fef03 114 /* Check if end address is in non-secure flash */
kevman 0:38ceb79fef03 115 if (end_addr != start_addr) {
kevman 0:38ceb79fef03 116 if ((end_addr < obj->target_config_ns->flash_start) ||
kevman 0:38ceb79fef03 117 (end_addr >= (obj->target_config_ns->flash_start + obj->target_config_ns->flash_size))) {
kevman 0:38ceb79fef03 118 return -1;
kevman 0:38ceb79fef03 119 }
kevman 0:38ceb79fef03 120 }
kevman 0:38ceb79fef03 121
kevman 0:38ceb79fef03 122 return 0;
kevman 0:38ceb79fef03 123 }
kevman 0:38ceb79fef03 124 #endif
kevman 0:38ceb79fef03 125
kevman 0:38ceb79fef03 126 MBED_NONSECURE_ENTRY int32_t flash_init(flash_t *obj)
kevman 0:38ceb79fef03 127 {
kevman 0:38ceb79fef03 128 flash_set_target_config(obj);
kevman 0:38ceb79fef03 129 return 0;
kevman 0:38ceb79fef03 130 }
kevman 0:38ceb79fef03 131
kevman 0:38ceb79fef03 132 MBED_NONSECURE_ENTRY int32_t flash_free(flash_t *obj)
kevman 0:38ceb79fef03 133 {
kevman 0:38ceb79fef03 134 return 0;
kevman 0:38ceb79fef03 135 }
kevman 0:38ceb79fef03 136
kevman 0:38ceb79fef03 137 MBED_NONSECURE_ENTRY int32_t flash_erase_sector(flash_t *obj, uint32_t address)
kevman 0:38ceb79fef03 138 {
kevman 0:38ceb79fef03 139 #if defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3U)
kevman 0:38ceb79fef03 140 if (cmse_nonsecure_caller()) {
kevman 0:38ceb79fef03 141 // Confine non-secure access to non-secure flash
kevman 0:38ceb79fef03 142 if (flash_check_nonsecure(obj, address, address)) {
kevman 0:38ceb79fef03 143 return -1;
kevman 0:38ceb79fef03 144 }
kevman 0:38ceb79fef03 145 }
kevman 0:38ceb79fef03 146 #endif
kevman 0:38ceb79fef03 147
kevman 0:38ceb79fef03 148 core_util_critical_section_enter();
kevman 0:38ceb79fef03 149 flash_algo_init(obj, address, MBED_FLASH_ALGO_ERASE);
kevman 0:38ceb79fef03 150
kevman 0:38ceb79fef03 151 args_t arguments = {
kevman 0:38ceb79fef03 152 .r0 = address,
kevman 0:38ceb79fef03 153 .r1 = 0,
kevman 0:38ceb79fef03 154 .r2 = 0,
kevman 0:38ceb79fef03 155 .r3 = 0,
kevman 0:38ceb79fef03 156 .r9 = (uint32_t)obj->flash_algo->algo_blob + obj->flash_algo->static_base,
kevman 0:38ceb79fef03 157 .pc = (uint32_t)obj->flash_algo->algo_blob + obj->flash_algo->erase_sector
kevman 0:38ceb79fef03 158 };
kevman 0:38ceb79fef03 159 int32_t ret = ((flash_algo_jump_t)(((uint32_t)&jump_to_flash_algo) | 1))(&arguments);
kevman 0:38ceb79fef03 160
kevman 0:38ceb79fef03 161 flash_algo_uninit(obj, address, MBED_FLASH_ALGO_ERASE);
kevman 0:38ceb79fef03 162 core_util_critical_section_exit();
kevman 0:38ceb79fef03 163 return ret ? -1 : 0;
kevman 0:38ceb79fef03 164 }
kevman 0:38ceb79fef03 165
kevman 0:38ceb79fef03 166 MBED_NONSECURE_ENTRY int32_t flash_program_page(flash_t *obj, uint32_t address, const uint8_t *data, uint32_t size)
kevman 0:38ceb79fef03 167 {
kevman 0:38ceb79fef03 168 #if defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3U)
kevman 0:38ceb79fef03 169 if (cmse_nonsecure_caller()) {
kevman 0:38ceb79fef03 170 // Confine non-secure access to non-secure flash
kevman 0:38ceb79fef03 171 if (flash_check_nonsecure(obj, address, address + size - 1)) {
kevman 0:38ceb79fef03 172 return -1;
kevman 0:38ceb79fef03 173 }
kevman 0:38ceb79fef03 174 }
kevman 0:38ceb79fef03 175 #endif
kevman 0:38ceb79fef03 176
kevman 0:38ceb79fef03 177 core_util_critical_section_enter();
kevman 0:38ceb79fef03 178 flash_algo_init(obj, address, MBED_FLASH_ALGO_PROGRAM);
kevman 0:38ceb79fef03 179
kevman 0:38ceb79fef03 180 args_t arguments = {
kevman 0:38ceb79fef03 181 .r0 = address,
kevman 0:38ceb79fef03 182 .r1 = size,
kevman 0:38ceb79fef03 183 .r2 = (uint32_t)data,
kevman 0:38ceb79fef03 184 .r3 = 0,
kevman 0:38ceb79fef03 185 .r9 = (uint32_t)obj->flash_algo->algo_blob + obj->flash_algo->static_base,
kevman 0:38ceb79fef03 186 .pc = (uint32_t)obj->flash_algo->algo_blob + obj->flash_algo->program_page
kevman 0:38ceb79fef03 187 };
kevman 0:38ceb79fef03 188 int32_t ret = ((flash_algo_jump_t)(((uint32_t)&jump_to_flash_algo) | 1))(&arguments);
kevman 0:38ceb79fef03 189
kevman 0:38ceb79fef03 190 flash_algo_uninit(obj, address, MBED_FLASH_ALGO_PROGRAM);
kevman 0:38ceb79fef03 191 core_util_critical_section_exit();
kevman 0:38ceb79fef03 192 return ret ? -1 : 0;
kevman 0:38ceb79fef03 193 }
kevman 0:38ceb79fef03 194
kevman 0:38ceb79fef03 195 MBED_NONSECURE_ENTRY uint32_t flash_get_sector_size(const flash_t *obj, uint32_t address)
kevman 0:38ceb79fef03 196 {
kevman 0:38ceb79fef03 197 #if defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3U)
kevman 0:38ceb79fef03 198 if (cmse_nonsecure_caller()) {
kevman 0:38ceb79fef03 199 const sector_info_t *sectors = obj->target_config_ns->sectors;
kevman 0:38ceb79fef03 200
kevman 0:38ceb79fef03 201 if (address >= obj->target_config_ns->flash_start + obj->target_config_ns->flash_size) {
kevman 0:38ceb79fef03 202 return MBED_FLASH_INVALID_SIZE;
kevman 0:38ceb79fef03 203 }
kevman 0:38ceb79fef03 204
kevman 0:38ceb79fef03 205 int sector_index = obj->target_config_ns->sector_info_count - 1;
kevman 0:38ceb79fef03 206 for (; sector_index >= 0; sector_index--) {
kevman 0:38ceb79fef03 207 if (address >= sectors[sector_index].start) {
kevman 0:38ceb79fef03 208 return sectors[sector_index].size;
kevman 0:38ceb79fef03 209 }
kevman 0:38ceb79fef03 210 }
kevman 0:38ceb79fef03 211 return MBED_FLASH_INVALID_SIZE;
kevman 0:38ceb79fef03 212 }
kevman 0:38ceb79fef03 213 #endif
kevman 0:38ceb79fef03 214
kevman 0:38ceb79fef03 215 const sector_info_t *sectors = obj->target_config->sectors;
kevman 0:38ceb79fef03 216
kevman 0:38ceb79fef03 217 if (address >= obj->target_config->flash_start + obj->target_config->flash_size) {
kevman 0:38ceb79fef03 218 return MBED_FLASH_INVALID_SIZE;
kevman 0:38ceb79fef03 219 }
kevman 0:38ceb79fef03 220
kevman 0:38ceb79fef03 221 int sector_index = obj->target_config->sector_info_count - 1;
kevman 0:38ceb79fef03 222 for (; sector_index >= 0; sector_index--) {
kevman 0:38ceb79fef03 223 if (address >= sectors[sector_index].start) {
kevman 0:38ceb79fef03 224 return sectors[sector_index].size;
kevman 0:38ceb79fef03 225 }
kevman 0:38ceb79fef03 226 }
kevman 0:38ceb79fef03 227 return MBED_FLASH_INVALID_SIZE;
kevman 0:38ceb79fef03 228 }
kevman 0:38ceb79fef03 229
kevman 0:38ceb79fef03 230 MBED_NONSECURE_ENTRY uint32_t flash_get_page_size(const flash_t *obj)
kevman 0:38ceb79fef03 231 {
kevman 0:38ceb79fef03 232 #if defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3U)
kevman 0:38ceb79fef03 233 if (cmse_nonsecure_caller()) {
kevman 0:38ceb79fef03 234 return obj->target_config_ns->page_size;
kevman 0:38ceb79fef03 235 }
kevman 0:38ceb79fef03 236 #endif
kevman 0:38ceb79fef03 237
kevman 0:38ceb79fef03 238 return obj->target_config->page_size;
kevman 0:38ceb79fef03 239 }
kevman 0:38ceb79fef03 240
kevman 0:38ceb79fef03 241 MBED_NONSECURE_ENTRY uint32_t flash_get_start_address(const flash_t *obj)
kevman 0:38ceb79fef03 242 {
kevman 0:38ceb79fef03 243 #if defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3U)
kevman 0:38ceb79fef03 244 if (cmse_nonsecure_caller()) {
kevman 0:38ceb79fef03 245 return obj->target_config_ns->flash_start;
kevman 0:38ceb79fef03 246 }
kevman 0:38ceb79fef03 247 #endif
kevman 0:38ceb79fef03 248
kevman 0:38ceb79fef03 249 return obj->target_config->flash_start;
kevman 0:38ceb79fef03 250 }
kevman 0:38ceb79fef03 251
kevman 0:38ceb79fef03 252 MBED_NONSECURE_ENTRY uint32_t flash_get_size(const flash_t *obj)
kevman 0:38ceb79fef03 253 {
kevman 0:38ceb79fef03 254 #if defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3U)
kevman 0:38ceb79fef03 255 if (cmse_nonsecure_caller()) {
kevman 0:38ceb79fef03 256 return obj->target_config_ns->flash_size;
kevman 0:38ceb79fef03 257 }
kevman 0:38ceb79fef03 258 #endif
kevman 0:38ceb79fef03 259
kevman 0:38ceb79fef03 260 return obj->target_config->flash_size;
kevman 0:38ceb79fef03 261 }
kevman 0:38ceb79fef03 262
kevman 0:38ceb79fef03 263 #endif // #ifndef DOMAIN_NS