pinebuds/platform/hal/hal_overlay.c
Ben V. Brown 75381150fd Formatting
Formatting Pass 1

Lots of fixups to adding stdint and stdbool all over the place

Formatting Pass 2
Formatting Pass 3
Formatting Pass 4

Update app_bt_stream.cpp
2023-02-02 07:56:49 +11:00

327 lines
9.6 KiB
C

/***************************************************************************
*
* Copyright 2015-2019 BES.
* All rights reserved. All unpublished rights reserved.
*
* No part of this work may be used or reproduced in any form or by any
* means, or stored in a database or retrieval system, without prior written
* permission of BES.
*
* Use of this work is governed by a license granted by BES.
* This work contains confidential and proprietary information of
* BES. which is protected by copyright, trade secret,
* trademark and other intellectual property rights.
*
****************************************************************************/
#include "hal_overlay.h"
#include "cmsis.h"
#include "hal_cache.h"
#include "hal_sysfreq.h"
#include "hal_trace.h"
#include "plat_types.h"
#ifdef __ARMCC_VERSION
#include "link_sym_armclang.h"
#endif
extern uint32_t __overlay_text_start__[];
extern uint32_t __overlay_text_exec_start__[];
extern uint32_t __load_start_overlay_text0[];
extern uint32_t __load_stop_overlay_text0[];
extern uint32_t __load_start_overlay_text1[];
extern uint32_t __load_stop_overlay_text1[];
extern uint32_t __load_start_overlay_text2[];
extern uint32_t __load_stop_overlay_text2[];
extern uint32_t __load_start_overlay_text3[];
extern uint32_t __load_stop_overlay_text3[];
extern uint32_t __load_start_overlay_text4[];
extern uint32_t __load_stop_overlay_text4[];
extern uint32_t __load_start_overlay_text5[];
extern uint32_t __load_stop_overlay_text5[];
extern uint32_t __load_start_overlay_text6[];
extern uint32_t __load_stop_overlay_text6[];
extern uint32_t __load_start_overlay_text7[];
extern uint32_t __load_stop_overlay_text7[];
extern uint32_t __overlay_text_exec_end__[];
extern uint32_t __overlay_data_start__[];
extern uint32_t __load_start_overlay_data0[];
extern uint32_t __load_stop_overlay_data0[];
extern uint32_t __load_start_overlay_data1[];
extern uint32_t __load_stop_overlay_data1[];
extern uint32_t __load_start_overlay_data2[];
extern uint32_t __load_stop_overlay_data2[];
extern uint32_t __load_start_overlay_data3[];
extern uint32_t __load_stop_overlay_data3[];
extern uint32_t __load_start_overlay_data4[];
extern uint32_t __load_stop_overlay_data4[];
extern uint32_t __load_start_overlay_data5[];
extern uint32_t __load_stop_overlay_data5[];
extern uint32_t __load_start_overlay_data6[];
extern uint32_t __load_stop_overlay_data6[];
extern uint32_t __load_start_overlay_data7[];
extern uint32_t __load_stop_overlay_data7[];
#ifndef NO_OVERLAY
#define OVERLAY_IS_FREE 0
#define OVERLAY_IS_USED 1
#define CHECK_OVERLAY_ID(id) \
do { \
if ((id < 0) || (id >= HAL_OVERLAY_ID_QTY)) { \
ASSERT(0, "overlay id error %d", id); \
} \
} while (0)
static bool segment_state[HAL_OVERLAY_ID_QTY];
static enum HAL_OVERLAY_ID_T cur_overlay_id = HAL_OVERLAY_ID_QTY;
static uint32_t *const text_load_start[HAL_OVERLAY_ID_QTY] = {
__load_start_overlay_text0, __load_start_overlay_text1,
__load_start_overlay_text2, __load_start_overlay_text3,
__load_start_overlay_text4, __load_start_overlay_text5,
__load_start_overlay_text6, __load_start_overlay_text7,
};
static uint32_t *const text_load_stop[HAL_OVERLAY_ID_QTY] = {
__load_stop_overlay_text0, __load_stop_overlay_text1,
__load_stop_overlay_text2, __load_stop_overlay_text3,
__load_stop_overlay_text4, __load_stop_overlay_text5,
__load_stop_overlay_text6, __load_stop_overlay_text7,
};
static uint32_t *const data_load_start[HAL_OVERLAY_ID_QTY] = {
__load_start_overlay_data0, __load_start_overlay_data1,
__load_start_overlay_data2, __load_start_overlay_data3,
__load_start_overlay_data4, __load_start_overlay_data5,
__load_start_overlay_data6, __load_start_overlay_data7,
};
static uint32_t *const data_load_stop[HAL_OVERLAY_ID_QTY] = {
__load_stop_overlay_data0, __load_stop_overlay_data1,
__load_stop_overlay_data2, __load_stop_overlay_data3,
__load_stop_overlay_data4, __load_stop_overlay_data5,
__load_stop_overlay_data6, __load_stop_overlay_data7,
};
/*must called by lock get */
static void invalid_overlay_cache(enum HAL_OVERLAY_ID_T id) {
// TODO: PSRAM is large enough and no need to overlay
return;
#if defined(CHIP_HAS_PSRAM) && defined(PSRAM_ENABLE)
if (((uint32_t)__overlay_text_exec_start__ >= PSRAM_BASE &&
(uint32_t)__overlay_text_exec_start__ < PSRAM_BASE + PSRAM_SIZE) ||
((uint32_t)__overlay_text_exec_start__ >= PSRAMX_BASE &&
(uint32_t)__overlay_text_exec_start__ < PSRAMX_BASE + PSRAM_SIZE)) {
hal_cache_invalidate(
HAL_CACHE_ID_I_CACHE, (uint32_t)__overlay_text_exec_start__,
(uint32_t)text_load_stop[id] - (uint32_t)text_load_start[id]);
}
if (((uint32_t)__overlay_data_start__ >= PSRAM_BASE &&
(uint32_t)__overlay_data_start__ < PSRAM_BASE + PSRAM_SIZE) ||
((uint32_t)__overlay_data_start__ >= PSRAMX_BASE &&
(uint32_t)__overlay_data_start__ < PSRAMX_BASE + PSRAM_SIZE)) {
hal_cache_invalidate(HAL_CACHE_ID_D_CACHE, (uint32_t)__overlay_data_start__,
(uint32_t)data_load_stop[id] -
(uint32_t)data_load_start[id]);
}
#endif
}
enum HAL_OVERLAY_RET_T hal_overlay_load(enum HAL_OVERLAY_ID_T id) {
enum HAL_OVERLAY_RET_T ret;
CHECK_OVERLAY_ID(id);
ret = HAL_OVERLAY_RET_OK;
uint32_t lock;
uint32_t *dst, *src;
if (hal_overlay_is_used()) {
ASSERT(0, "overlay %d is in use", id);
return HAL_OVERLAY_RET_IN_USE;
}
hal_sysfreq_req(HAL_SYSFREQ_USER_OVERLAY, HAL_CMU_FREQ_52M);
lock = int_lock();
if (cur_overlay_id == HAL_OVERLAY_ID_QTY) {
cur_overlay_id = HAL_OVERLAY_ID_IN_CFG;
} else if (cur_overlay_id == HAL_OVERLAY_ID_IN_CFG) {
ret = HAL_OVERLAY_RET_IN_CFG;
} else {
ret = HAL_OVERLAY_RET_IN_USE;
}
if (ret != HAL_OVERLAY_RET_OK) {
goto _exit;
}
hal_overlay_acquire(id);
for (dst = __overlay_text_start__, src = text_load_start[id];
src < text_load_stop[id]; dst++, src++) {
*dst = *src;
}
for (dst = __overlay_data_start__, src = data_load_start[id];
src < data_load_stop[id]; dst++, src++) {
*dst = *src;
}
cur_overlay_id = id;
segment_state[id] = OVERLAY_IS_USED;
_exit:
int_unlock(lock);
hal_sysfreq_req(HAL_SYSFREQ_USER_OVERLAY, HAL_CMU_FREQ_32K);
return ret;
}
enum HAL_OVERLAY_RET_T hal_overlay_unload(enum HAL_OVERLAY_ID_T id) {
enum HAL_OVERLAY_RET_T ret;
CHECK_OVERLAY_ID(id);
ret = HAL_OVERLAY_RET_OK;
uint32_t lock;
lock = int_lock();
if (cur_overlay_id == id) {
cur_overlay_id = HAL_OVERLAY_ID_QTY;
} else if (cur_overlay_id == HAL_OVERLAY_ID_IN_CFG) {
ret = HAL_OVERLAY_RET_IN_CFG;
} else {
ret = HAL_OVERLAY_RET_IN_USE;
}
hal_overlay_release(id);
int_unlock(lock);
return ret;
}
/*
* get the overlay's text start address
*/
uint32_t hal_overlay_get_text_address(void) {
return (uint32_t)__overlay_text_start__;
}
/*
* get the whole size of the overlay text
*/
uint32_t hal_overlay_get_text_all_size(void) {
uint32_t text_start, text_end;
text_start = (uint32_t)__overlay_text_exec_start__;
text_end = (uint32_t)__overlay_text_exec_end__;
return text_end - text_start;
}
/*
* get the segment size of one overlay text
*/
uint32_t hal_overlay_get_text_size(enum HAL_OVERLAY_ID_T id) {
CHECK_OVERLAY_ID(id);
return (uint32_t)text_load_stop[id] - (uint32_t)text_load_start[id];
}
/*
____________ overlay's text end
| |
| |
| free |
| |
|__________|free_addr ______________________segment text end
| | | |
| | | |
| | | |
| | | |
| | | |
|__________| text's start_addr |__________|segment text start_addr
*
*/
/*
* Use the free space of one segement, this function
* return the free address of space
*/
uint32_t hal_overlay_get_text_free_addr(enum HAL_OVERLAY_ID_T id) {
uint32_t segment_text_sz;
uint32_t start_addr;
uint32_t free_addr;
CHECK_OVERLAY_ID(id);
segment_text_sz = hal_overlay_get_text_size(id);
start_addr = hal_overlay_get_text_address();
free_addr = start_addr + segment_text_sz;
if (free_addr & 0x3) {
ASSERT(0, "free addr %p is not aligned to 4", (void *)free_addr);
}
return free_addr;
}
/*
* get the free size for one overlay text
*/
uint32_t hal_overlay_get_text_free_size(enum HAL_OVERLAY_ID_T id) {
uint32_t all_text_sz;
uint32_t segment_text_sz;
CHECK_OVERLAY_ID(id);
all_text_sz = hal_overlay_get_text_all_size();
segment_text_sz = hal_overlay_get_text_size(id);
return all_text_sz - segment_text_sz;
}
/*
* acquire one overlay segment
*/
void hal_overlay_acquire(enum HAL_OVERLAY_ID_T id) {
uint32_t lock;
CHECK_OVERLAY_ID(id);
segment_state[id] = OVERLAY_IS_USED;
lock = int_lock();
invalid_overlay_cache(id);
int_unlock(lock);
return;
}
/*
* release one overlay segment
*/
void hal_overlay_release(enum HAL_OVERLAY_ID_T id) {
CHECK_OVERLAY_ID(id);
segment_state[id] = OVERLAY_IS_FREE;
return;
}
/*
* check if any overlay segment is used
*/
bool hal_overlay_is_used(void) {
int i;
uint32_t lock;
lock = int_lock();
for (i = 0; i < HAL_OVERLAY_ID_QTY; i++) {
// if any segment is in use, the overlay is used;
if (segment_state[i] == OVERLAY_IS_USED) {
int_unlock(lock);
return true;
}
}
int_unlock(lock);
return false;
}
#endif