// 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) { }