543 lines
14 KiB
C
543 lines
14 KiB
C
|
#include "sys_config.h"
|
|||
|
|
#include "typesdef.h"
|
|||
|
|
#include "errno.h"
|
|||
|
|
#include "list.h"
|
|||
|
|
#include "dev.h"
|
|||
|
|
#include "devid.h"
|
|||
|
|
#include "osal/task.h"
|
|||
|
|
#include "osal/sleep.h"
|
|||
|
|
#include "osal/string.h"
|
|||
|
|
#include "osal/irq.h"
|
|||
|
|
#include "hal/dma.h"
|
|||
|
|
#include "hal/crc.h"
|
|||
|
|
#include "lib/common/common.h"
|
|||
|
|
#include "lib/heap/sysheap.h"
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
const uint32 sdk_version = SDK_VERSION;
|
|||
|
|
const uint32 svn_version = SVN_VERSION;
|
|||
|
|
const uint32 app_version = APP_VERSION;
|
|||
|
|
|
|||
|
|
__bobj uint64 cpu_loading_tick;
|
|||
|
|
uint32 m2mdam_time = 0;
|
|||
|
|
__bobj struct dma_device *m2mdma;
|
|||
|
|
|
|||
|
|
extern void cpu_loading_api_time(char *api, uint32 time, uint32 diff_tick);
|
|||
|
|
|
|||
|
|
#define CPU_TIME_API(api) extern uint32 api##_time(void); \
|
|||
|
|
_time_ = api##_time(); \
|
|||
|
|
cpu_loading_api_time(#api, _time_, diff_tick);
|
|||
|
|
|
|||
|
|
void cpu_loading_api_time(char *api, uint32 time, uint32 diff_tick)
|
|||
|
|
{
|
|||
|
|
if (time > 0) {
|
|||
|
|
uint32 count = 100 * os_msecs_to_jiffies(time / 1000);
|
|||
|
|
os_printf(KERN_ALERT"[%s time: %dms, %d%%]\r\n", api, (time / 1000), (count / diff_tick));
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void module_version_show(void)
|
|||
|
|
{
|
|||
|
|
extern uint32 __modver_start;
|
|||
|
|
extern uint32 __modver_end;
|
|||
|
|
uint32 *start = (uint32 *)&__modver_start;
|
|||
|
|
uint32 *end = (uint32 *)&__modver_end;
|
|||
|
|
while (start < end) {
|
|||
|
|
_os_printf("** lib%s\r\n", (char *)*start++);
|
|||
|
|
}
|
|||
|
|
_os_printf("------------------------------------------------------------------\r\n");
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
typedef void (*__ctor_func_)(void);
|
|||
|
|
extern __ctor_func_ __CTOR_LIST__[];
|
|||
|
|
extern __ctor_func_ __DTOR_LIST__[];
|
|||
|
|
void do_global_ctors(void)
|
|||
|
|
{
|
|||
|
|
ulong i;
|
|||
|
|
ulong nptrs = (ulong)__CTOR_LIST__[0];
|
|||
|
|
if (nptrs == (ulong) - 1) {
|
|||
|
|
for (nptrs = 0; __CTOR_LIST__[nptrs + 1] != 0; nptrs++) ;
|
|||
|
|
}
|
|||
|
|
for (i = nptrs; i >= 1; i--) {
|
|||
|
|
__CTOR_LIST__[i]();
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
void do_global_dtors(void)
|
|||
|
|
{
|
|||
|
|
ulong i;
|
|||
|
|
ulong nptrs = (ulong)__DTOR_LIST__[0];
|
|||
|
|
|
|||
|
|
if (nptrs == (ulong) - 1) {
|
|||
|
|
for (nptrs = 0; __DTOR_LIST__[nptrs + 1] != 0; nptrs++) ;
|
|||
|
|
}
|
|||
|
|
for (i = 1; i <= nptrs; i++) {
|
|||
|
|
__DTOR_LIST__[i]();
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void cpu_loading_print(uint8 all, struct os_task_info *tsk_info, uint32 size)
|
|||
|
|
{
|
|||
|
|
uint32 i = 0;
|
|||
|
|
uint32 diff_tick = 0;
|
|||
|
|
uint32 _time_ = 0;
|
|||
|
|
uint32 count;
|
|||
|
|
uint64 jiff = os_jiffies();
|
|||
|
|
uint32 total_time = 0;
|
|||
|
|
|
|||
|
|
if(tsk_info == NULL) return;
|
|||
|
|
diff_tick = DIFF_JIFFIES(cpu_loading_tick, jiff);
|
|||
|
|
cpu_loading_tick = jiff;
|
|||
|
|
|
|||
|
|
os_printf(KERN_ALERT"----------------------------------------------------------------------------------\r\n");
|
|||
|
|
os_printf(KERN_ALERT"Task Runtime Statistic, interval:%dms\r\n", (uint32)os_jiffies_to_msecs(diff_tick));
|
|||
|
|
os_printf(KERN_ALERT"PID Name %%CPU(Time) Stack Prio Status\r\n");
|
|||
|
|
os_printf(KERN_ALERT"----------------------------------------------------------------------------------\r\n");
|
|||
|
|
|
|||
|
|
cpu_loading_api_time("sram_heap", sysheap_time(&sram_heap), diff_tick);
|
|||
|
|
#ifdef PSRAM_HEAP
|
|||
|
|
cpu_loading_api_time("sram_heap", sysheap_time(&psram_heap), diff_tick);
|
|||
|
|
#endif
|
|||
|
|
|
|||
|
|
CPU_TIME_API(sysirq);
|
|||
|
|
#ifdef SKB_POOL_ENABLE
|
|||
|
|
CPU_TIME_API(skbpool);
|
|||
|
|
#endif
|
|||
|
|
//CPU_TIME_API(hw_memcpy);
|
|||
|
|
|
|||
|
|
os_printf(KERN_ALERT"----------------------------------------------------------------------------------\r\n");
|
|||
|
|
|
|||
|
|
count = os_task_runtime(tsk_info, size);
|
|||
|
|
for (i = 0; i < count; i++) {
|
|||
|
|
if (tsk_info[i].time > 0 || all) {
|
|||
|
|
total_time += tsk_info[i].time;
|
|||
|
|
os_printf(KERN_ALERT"%2d %-28s\t%2d%%(%6d) %4d %2d (%08x) %s\r\n",
|
|||
|
|
tsk_info[i].id,
|
|||
|
|
tsk_info[i].name ? tsk_info[i].name : "----",
|
|||
|
|
#ifdef CSKY_OS
|
|||
|
|
(tsk_info[i].time * 100) / diff_tick,
|
|||
|
|
#elif defined(OHOS)
|
|||
|
|
tsk_info[i].time,
|
|||
|
|
#endif
|
|||
|
|
|
|||
|
|
tsk_info[i].time,
|
|||
|
|
tsk_info[i].stack * 4,
|
|||
|
|
tsk_info[i].prio,
|
|||
|
|
tsk_info[i].arg,
|
|||
|
|
tsk_info[i].status);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
#ifdef CSKY_OS
|
|||
|
|
os_printf(KERN_ALERT"--------------------------- CPU Loading: %d%% [%dms] -------------------------\r\n",
|
|||
|
|
(total_time*100)/diff_tick, (uint32)os_jiffies_to_msecs(total_time));
|
|||
|
|
#elif defined(OHOS)
|
|||
|
|
os_printf(KERN_ALERT"--------------------------- CPU Loading: %d%% -------------------------------\r\n", total_time);
|
|||
|
|
#endif
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
int strncasecmp(const char *s1, const char *s2, size_t n)
|
|||
|
|
{
|
|||
|
|
size_t i = 0;
|
|||
|
|
|
|||
|
|
for (i = 0; i < n && s1[i] && s2[i]; i++) {
|
|||
|
|
if (s1[i] == s2[i] || s1[i] + 32 == s2[i] || s1[i] - 32 == s2[i]) {
|
|||
|
|
} else {
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
return (i != n);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
int strcasecmp(const char *s1, const char *s2)
|
|||
|
|
{
|
|||
|
|
while (*s1 || *s2) {
|
|||
|
|
if (*s1 == *s2 || *s1 + 32 == *s2 || *s1 - 32 == *s2) {
|
|||
|
|
s1++; s2++;
|
|||
|
|
} else {
|
|||
|
|
return -1;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void hw_memcpy(void *dest, const void *src, uint32 size)
|
|||
|
|
{
|
|||
|
|
if (dest && src) {
|
|||
|
|
if (m2mdma && size > 45) {
|
|||
|
|
#ifdef MEM_TRACE
|
|||
|
|
#ifdef PSRAM_HEAP
|
|||
|
|
void *heap = (IS_PSRAM_ADDR(dest)) ? ((void *)&psram_heap) : ((void *)&sram_heap);
|
|||
|
|
#else
|
|||
|
|
void *heap = (void *)&sram_heap;
|
|||
|
|
#endif
|
|||
|
|
int32 ret = sysheap_of_check(heap, dest, size);
|
|||
|
|
if (ret == 0) {
|
|||
|
|
os_printf(KERN_WARNING"check addr fail: %x, size:%d \r\n", dest, size);
|
|||
|
|
}
|
|||
|
|
#endif
|
|||
|
|
uint64 __t__ = os_useconds();
|
|||
|
|
dma_memcpy(m2mdma, dest, src, size);
|
|||
|
|
m2mdam_time += os_useconds() - __t__;
|
|||
|
|
} else {
|
|||
|
|
os_memcpy(dest, src, size);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void hw_memcpy0(void *dest, const void *src, uint32 size)
|
|||
|
|
{
|
|||
|
|
if (m2mdma && size > 45) {
|
|||
|
|
#ifdef MEM_TRACE
|
|||
|
|
#ifdef PSRAM_HEAP
|
|||
|
|
void *heap = (IS_PSRAM_ADDR(dest)) ? ((void *)&psram_heap) : ((void *)&sram_heap);
|
|||
|
|
#else
|
|||
|
|
void *heap = (void *)&sram_heap;
|
|||
|
|
#endif
|
|||
|
|
int32 ret = sysheap_of_check(heap, dest, size);
|
|||
|
|
if (ret == 0) {
|
|||
|
|
os_printf(KERN_WARNING"check addr fail: %x, size:%d \r\n", dest, size);
|
|||
|
|
}
|
|||
|
|
#endif
|
|||
|
|
uint64 __t__ = os_useconds();
|
|||
|
|
dma_memcpy(m2mdma, dest, src, size);
|
|||
|
|
m2mdam_time += os_useconds() - __t__;
|
|||
|
|
} else {
|
|||
|
|
os_memcpy(dest, src, size);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void hw_memcpy_no_cache(void *dest, const void *src, uint32 size)
|
|||
|
|
{
|
|||
|
|
if (dest && src) {
|
|||
|
|
|
|||
|
|
#ifdef MEM_TRACE
|
|||
|
|
#ifdef PSRAM_HEAP
|
|||
|
|
void *heap = (IS_PSRAM_ADDR(dest)) ? ((void *)&psram_heap) : ((void *)&sram_heap);
|
|||
|
|
#else
|
|||
|
|
void *heap = (void *)&sram_heap;
|
|||
|
|
#endif
|
|||
|
|
int32 ret = sysheap_of_check(heap, dest, size);
|
|||
|
|
if (ret == 0) {
|
|||
|
|
os_printf(KERN_WARNING"check addr fail: %x, size:%d \r\n", dest, size);
|
|||
|
|
}
|
|||
|
|
#endif
|
|||
|
|
uint64 __t__ = os_useconds();
|
|||
|
|
dma_memcpy_no_cache(m2mdma, dest, src, size);
|
|||
|
|
m2mdam_time += os_useconds() - __t__;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void hw_memset(void *dest, uint8 val, uint32 n)
|
|||
|
|
{
|
|||
|
|
if (dest) {
|
|||
|
|
if (m2mdma && n > 12) {
|
|||
|
|
#ifdef MEM_TRACE
|
|||
|
|
#ifdef PSRAM_HEAP
|
|||
|
|
void *heap = (IS_PSRAM_ADDR(dest)) ? ((void *)&psram_heap) : ((void *)&sram_heap);
|
|||
|
|
#else
|
|||
|
|
void *heap = (void *)&sram_heap;
|
|||
|
|
#endif
|
|||
|
|
int32 ret = sysheap_of_check(heap, dest, n);
|
|||
|
|
if (ret == 0) {
|
|||
|
|
os_printf(KERN_WARNING"check addr fail: %x, size:%d \r\n", dest, n);
|
|||
|
|
}
|
|||
|
|
#endif
|
|||
|
|
uint64 __t__ = os_useconds();
|
|||
|
|
dma_memset(m2mdma, dest, val, n);
|
|||
|
|
m2mdam_time += os_useconds() - __t__;
|
|||
|
|
} else {
|
|||
|
|
os_memset(dest, val, n);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
uint32 hw_memcpy_time(void)
|
|||
|
|
{
|
|||
|
|
uint32 v = m2mdam_time;
|
|||
|
|
m2mdam_time = 0;
|
|||
|
|
return v / 1000;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void *os_memdup(const void *ptr, uint32 len)
|
|||
|
|
{
|
|||
|
|
void *p;
|
|||
|
|
if (!ptr || len == 0) {
|
|||
|
|
return NULL;
|
|||
|
|
}
|
|||
|
|
p = os_malloc(len);
|
|||
|
|
if (p) {
|
|||
|
|
hw_memcpy(p, ptr, len);
|
|||
|
|
}
|
|||
|
|
return p;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
int32 os_random_bytes(uint8 *data, int32 len)
|
|||
|
|
{
|
|||
|
|
int32 i = 0;
|
|||
|
|
int32 seed, seed_uuid, rand_val = 0;
|
|||
|
|
uint8 uuid[6];
|
|||
|
|
|
|||
|
|
sysctrl_get_chip_uuid((uint8 *)&uuid[0], 6);
|
|||
|
|
memcpy((void *)&seed_uuid, &uuid[2], 4);
|
|||
|
|
|
|||
|
|
#ifdef TXW4002ACK803
|
|||
|
|
seed = CPU_CYCLE_VALUE() ^ (CPU_CYCLE_VALUE() << 8) ^ (CPU_CYCLE_VALUE() >> 8);
|
|||
|
|
#else
|
|||
|
|
seed = CPU_CYCLE_VALUE() ^ sysctrl_get_trng() ^ (seed_uuid);
|
|||
|
|
#endif
|
|||
|
|
for (i = 0; i < len; i++) {
|
|||
|
|
if (i & 1) {
|
|||
|
|
rand_val = rand_val >> 8;
|
|||
|
|
} else {
|
|||
|
|
seed = (seed * 214013L + 2531011L) >> 16;
|
|||
|
|
rand_val = seed;
|
|||
|
|
}
|
|||
|
|
data[i] = (uint8)(rand_val & 0xFF);
|
|||
|
|
}
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
uint32 hw_crc(enum CRC_DEV_TYPE type, uint8 *data, uint32 len)
|
|||
|
|
{
|
|||
|
|
uint32 crc = 0xffff;
|
|||
|
|
struct crc_dev_req req;
|
|||
|
|
struct crc_dev *crcdev = (struct crc_dev *)dev_get(HG_CRC_DEVID);
|
|||
|
|
|
|||
|
|
if (!crcdev) {
|
|||
|
|
os_printf("no crc dev\r\n");
|
|||
|
|
return RET_ERR;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
req.flag = 0;
|
|||
|
|
req.type = type;
|
|||
|
|
req.data = data;
|
|||
|
|
req.len = 0x40000;
|
|||
|
|
|
|||
|
|
if (len <= 0x40000) {
|
|||
|
|
req.len = len;
|
|||
|
|
crc_dev_calc(crcdev, &req, &crc, 0);
|
|||
|
|
return crc;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
crc_dev_calc(crcdev, &req, &crc, 0);
|
|||
|
|
req.data += req.len;
|
|||
|
|
len -= req.len;
|
|||
|
|
while(len >= 0x40000) {
|
|||
|
|
req.crc_last = crc;
|
|||
|
|
crc_dev_calc(crcdev, &req, &crc, CRC_DEV_FLAGS_CONTINUE_CALC);
|
|||
|
|
req.data += req.len;
|
|||
|
|
len -= req.len;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (len) {
|
|||
|
|
req.crc_last = crc;
|
|||
|
|
req.len = len;
|
|||
|
|
crc_dev_calc(crcdev, &req, &crc, CRC_DEV_FLAGS_CONTINUE_CALC);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return crc;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
uint32 hw_crc_no_cache(enum CRC_DEV_TYPE type, uint8 *data, uint32 len)
|
|||
|
|
{
|
|||
|
|
uint32 crc = 0xffff;
|
|||
|
|
struct crc_dev_req req;
|
|||
|
|
struct crc_dev *crcdev = (struct crc_dev *)dev_get(HG_CRC_DEVID);
|
|||
|
|
|
|||
|
|
if (!crcdev) {
|
|||
|
|
os_printf("no crc dev\r\n");
|
|||
|
|
return RET_ERR;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
req.flag = 1;
|
|||
|
|
req.type = type;
|
|||
|
|
req.data = data;
|
|||
|
|
req.len = 0x40000;
|
|||
|
|
|
|||
|
|
if (len <= 0x40000) {
|
|||
|
|
req.len = len;
|
|||
|
|
crc_dev_calc(crcdev, &req, &crc, 0);
|
|||
|
|
return crc;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
crc_dev_calc(crcdev, &req, &crc, 0);
|
|||
|
|
req.data += req.len;
|
|||
|
|
len -= req.len;
|
|||
|
|
while(len >= 0x40000) {
|
|||
|
|
req.crc_last = crc;
|
|||
|
|
crc_dev_calc(crcdev, &req, &crc, CRC_DEV_FLAGS_CONTINUE_CALC);
|
|||
|
|
req.data += req.len;
|
|||
|
|
len -= req.len;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (len) {
|
|||
|
|
req.crc_last = crc;
|
|||
|
|
req.len = len;
|
|||
|
|
crc_dev_calc(crcdev, &req, &crc, CRC_DEV_FLAGS_CONTINUE_CALC);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return crc;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
int ffs(int x)
|
|||
|
|
{
|
|||
|
|
int r = 1;
|
|||
|
|
|
|||
|
|
if (!x) {
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (!(x & 0xffff)) {
|
|||
|
|
x >>= 16;
|
|||
|
|
r += 16;
|
|||
|
|
}
|
|||
|
|
if (!(x & 0xff)) {
|
|||
|
|
x >>= 8;
|
|||
|
|
r += 8;
|
|||
|
|
}
|
|||
|
|
if (!(x & 0xf)) {
|
|||
|
|
x >>= 4;
|
|||
|
|
r += 4;
|
|||
|
|
}
|
|||
|
|
if (!(x & 3)) {
|
|||
|
|
x >>= 2;
|
|||
|
|
r += 2;
|
|||
|
|
}
|
|||
|
|
if (!(x & 1)) {
|
|||
|
|
x >>= 1;
|
|||
|
|
r += 1;
|
|||
|
|
}
|
|||
|
|
return r;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
int fls(int x)
|
|||
|
|
{
|
|||
|
|
int r = 32;
|
|||
|
|
|
|||
|
|
if (!x) {
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
if (!(x & 0xffff0000u)) {
|
|||
|
|
x <<= 16;
|
|||
|
|
r -= 16;
|
|||
|
|
}
|
|||
|
|
if (!(x & 0xff000000u)) {
|
|||
|
|
x <<= 8;
|
|||
|
|
r -= 8;
|
|||
|
|
}
|
|||
|
|
if (!(x & 0xf0000000u)) {
|
|||
|
|
x <<= 4;
|
|||
|
|
r -= 4;
|
|||
|
|
}
|
|||
|
|
if (!(x & 0xc0000000u)) {
|
|||
|
|
x <<= 2;
|
|||
|
|
r -= 2;
|
|||
|
|
}
|
|||
|
|
if (!(x & 0x80000000u)) {
|
|||
|
|
x <<= 1;
|
|||
|
|
r -= 1;
|
|||
|
|
}
|
|||
|
|
return r;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
uint32 scatter_size(scatter_data *data, uint32 count)
|
|||
|
|
{
|
|||
|
|
uint32 size = 0;
|
|||
|
|
uint32 i = 0;
|
|||
|
|
for (i = 0; i < count; i++) {
|
|||
|
|
size += data[i].size;
|
|||
|
|
}
|
|||
|
|
return size;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
uint8 *scatter_offset(scatter_data *data, uint32 count, uint32 off)
|
|||
|
|
{
|
|||
|
|
uint8 i;
|
|||
|
|
for (i = 0; i < count; i++) {
|
|||
|
|
if (off < data[i].size) {
|
|||
|
|
return data[i].addr + off;
|
|||
|
|
}
|
|||
|
|
off -= data[i].size;
|
|||
|
|
}
|
|||
|
|
return NULL;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/////////////////////////////////////////////////////////////////////////////////////////
|
|||
|
|
//系统崩溃产生异常时会执行 trap_data_dump 和 trap_hdl_run
|
|||
|
|
// trap_data_dump: 崩溃时dump指定的数据，可以通过 trap_data_set 添加多个观察数据
|
|||
|
|
// trap_hdl_run : 崩溃时执行指定的函数，通过 trap_hdl_set API设置系统崩溃时需要执行的函数。注意：添加的函数不能再次崩溃
|
|||
|
|
/////////////////////////////////////////////////////////////////////////////////////////
|
|||
|
|
enum TRAP_DATA {
|
|||
|
|
//TRAP_DATA_ID_1,
|
|||
|
|
TRAP_DATA_MAX,
|
|||
|
|
};
|
|||
|
|
enum TRAP_HDL {
|
|||
|
|
//TRAP_HDL_ID_1,
|
|||
|
|
TRAP_HDL_MAX,
|
|||
|
|
};
|
|||
|
|
struct {
|
|||
|
|
void *addr;
|
|||
|
|
uint32 len;
|
|||
|
|
} trap_c_data[TRAP_DATA_MAX];
|
|||
|
|
struct {
|
|||
|
|
void (*hdl)(void *arg);
|
|||
|
|
void *arg;
|
|||
|
|
} trap_c_hdl[TRAP_HDL_MAX];
|
|||
|
|
void trap_data_set(int8 id, void *addr, uint32 len)
|
|||
|
|
{
|
|||
|
|
if (id < TRAP_DATA_MAX) {
|
|||
|
|
trap_c_data[id].addr = addr;
|
|||
|
|
trap_c_data[id].len = len;
|
|||
|
|
} else {
|
|||
|
|
os_printf(KERN_ERR"trap_data_set: invalid id %d, max %d\r\n", id, TRAP_DATA_MAX);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
void trap_hdl_set(int8 id, void (*hdl)(void *), void *arg)
|
|||
|
|
{
|
|||
|
|
if (id < TRAP_HDL_MAX) {
|
|||
|
|
trap_c_hdl[id].hdl = hdl;
|
|||
|
|
trap_c_hdl[id].arg = arg;
|
|||
|
|
} else {
|
|||
|
|
os_printf(KERN_ERR"trap_hdl_set: invalid id %d, max %d\r\n", id, TRAP_HDL_MAX);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
void trap_data_dump(void)
|
|||
|
|
{
|
|||
|
|
int8 i;
|
|||
|
|
char name[32];
|
|||
|
|
for (i = 0; i < TRAP_DATA_MAX; i++) {
|
|||
|
|
if (trap_c_data[i].addr && trap_c_data[i].len) {
|
|||
|
|
os_printf(KERN_ERR"---------------------------------------------------------------\r\n");
|
|||
|
|
os_snprintf(name, 31, "dump data %d:\r\n", i);
|
|||
|
|
dump_hex(name, trap_c_data[i].addr, trap_c_data[i].len, 1);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
void trap_hdl_run(void)
|
|||
|
|
{
|
|||
|
|
int8 i;
|
|||
|
|
for (i = 0; i < TRAP_HDL_MAX; i++) {
|
|||
|
|
if (trap_c_hdl[i].hdl) {
|
|||
|
|
os_printf(KERN_ERR"---------------------------------------------------------------\r\n");
|
|||
|
|
os_printf(KERN_ERR"trap hdl: %p, arg:%p\r\n", trap_c_hdl[i].hdl, trap_c_hdl[i].arg);
|
|||
|
|
trap_c_hdl[i].hdl(trap_c_hdl[i].arg);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
/////////////////////////////////////////////////////////////////////////////////////////
|
|||
|
|
|
|||
|
|
extern int *__errno_location(void);
|
|||
|
|
|
|||
|
|
void set_errno(int32 err)
|
|||
|
|
{
|
|||
|
|
*__errno_location() = err;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
int32 get_errno(void)
|
|||
|
|
{
|
|||
|
|
return *__errno_location();
|
|||
|
|
}
|
|||
|
|
|