kopia lustrzana https://github.com/espressif/esp-idf
98 wiersze
2.7 KiB
C
98 wiersze
2.7 KiB
C
|
// Copyright 2021 Espressif Systems (Shanghai) PTE LTD
|
||
|
|
//
|
||
|
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
||
|
|
// you may not use this file except in compliance with the License.
|
||
|
|
// You may obtain a copy of the License at
|
||
|
|
//
|
||
|
|
// http://www.apache.org/licenses/LICENSE-2.0
|
||
|
|
//
|
||
|
|
// Unless required by applicable law or agreed to in writing, software
|
||
|
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
||
|
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||
|
|
// See the License for the specific language governing permissions and
|
||
|
|
// limitations under the License.
|
||
|
|
|
||
|
|
#include <string.h>
|
||
|
|
#include <sys/param.h>
|
||
|
|
#include "esp_system.h"
|
||
|
|
#include "esp_spi_flash.h"
|
||
|
|
#include "soc/soc_memory_layout.h"
|
||
|
|
|
||
|
|
#define ASSERT_STR "assert failed: "
|
||
|
|
#define CACHE_DISABLED_STR "<cached disabled>"
|
||
|
|
|
||
|
|
#if __XTENSA__
|
||
|
|
#define INST_LEN 3
|
||
|
|
#elif __riscv
|
||
|
|
#define INST_LEN 4
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static inline void ra_to_str(char *addr)
|
||
|
|
{
|
||
|
|
addr[0] = '0';
|
||
|
|
addr[1] = 'x';
|
||
|
|
itoa((uint32_t)(__builtin_return_address(0) - INST_LEN), addr + 2, 16);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Overriding assert function so that whenever assert is called from critical section,
|
||
|
|
* it does not lead to a crash of its own.
|
||
|
|
*/
|
||
|
|
void __attribute__((noreturn)) __assert_func(const char *file, int line, const char *func, const char *expr)
|
||
|
|
{
|
||
|
|
#if CONFIG_COMPILER_OPTIMIZATION_ASSERTIONS_SILENT
|
||
|
|
char buff[sizeof(ASSERT_STR) + 11 + 1] = ASSERT_STR;
|
||
|
|
|
||
|
|
ra_to_str(&buff[sizeof(ASSERT_STR) - 1]);
|
||
|
|
|
||
|
|
esp_system_abort(buff);
|
||
|
|
#else
|
||
|
|
char addr[11] = { 0 };
|
||
|
|
char buff[200];
|
||
|
|
char lbuf[5];
|
||
|
|
uint32_t rem_len = sizeof(buff) - 1;
|
||
|
|
uint32_t off = 0;
|
||
|
|
|
||
|
|
itoa(line, lbuf, 10);
|
||
|
|
|
||
|
|
if (!spi_flash_cache_enabled()) {
|
||
|
|
if (esp_ptr_in_drom(file)) {
|
||
|
|
file = CACHE_DISABLED_STR;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (esp_ptr_in_drom(func)) {
|
||
|
|
ra_to_str(addr);
|
||
|
|
func = addr;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (esp_ptr_in_drom(expr)) {
|
||
|
|
expr = CACHE_DISABLED_STR;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
const char *str[] = {ASSERT_STR, func ? func : "\b", " ", file, ":", lbuf, " (", expr, ")"};
|
||
|
|
|
||
|
|
for (int i = 0; i < sizeof(str) / sizeof(str[0]); i++) {
|
||
|
|
uint32_t len = strlen(str[i]);
|
||
|
|
uint32_t cpy_len = MIN(len, rem_len);
|
||
|
|
memcpy(buff + off, str[i], cpy_len);
|
||
|
|
rem_len -= cpy_len;
|
||
|
|
off += cpy_len;
|
||
|
|
if (rem_len == 0) {
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
buff[off] = '\0';
|
||
|
|
esp_system_abort(buff);
|
||
|
|
#endif /* CONFIG_COMPILER_OPTIMIZATION_ASSERTIONS_SILENT */
|
||
|
|
}
|
||
|
|
|
||
|
|
void __attribute__((noreturn)) __assert(const char *file, int line, const char *failedexpr)
|
||
|
|
{
|
||
|
|
__assert_func(file, line, NULL, failedexpr);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* No-op function, used to force linker to include these changes */
|
||
|
|
void newlib_include_assert_impl(void)
|
||
|
|
{
|
||
|
|
}
|