/*
 * Copyright (C) 2017 C-SKY Microsystems Co., Ltd. All rights reserved.
 *
 * 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.
 */

/******************************************************************************
 * @file     trap_c.c
 * @brief    source file for the trap process
 * @version  V1.0
 * @date     12. December 2017
 ******************************************************************************/
#include "typesdef.h"
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <csi_config.h>
#include <csi_core.h>
#include "osal/string.h"
#include "osal/task.h"
#include <k_api.h>
#include <csi_kernel.h>

extern void csi_kernel_task_dump(k_task_handle_t task_handle, void* stack);
extern void hgprintf(const char *fmt, ...);
extern void trap_data_dump(void);
extern void trap_hdl_run(void);

#define trap_err(fmt,...) hgprintf(KERN_ERR fmt, ##__VA_ARGS__)

#if defined(__E804DF__)  /* CPU0 */
void trap_c(uint32_t *regs)
{
    int i;
    uint32_t vec = (__get_PSR() & PSR_VEC_Msk) >> PSR_VEC_Pos;

    disable_print(0);
    print_level(8);
    trap_err("---------------------------------------------------------------\r\n");
    trap_err("CPU Exception: NO.%u\r\n", vec);

    for (i = 0; i < 32; i++) {
        trap_err("r%d: %08x\t", i, regs[i]);
        if ((i % 4) == 3) {
            trap_err("\n");
        }
    }
	
    for (i = 0; i < 16; i++) {
        trap_err("vr%d: %08x\t", i, regs[i + 32]);
        if ((i % 4) == 3) {
            trap_err("\n");
        }
    }

    trap_err("epsr: %8x\n", regs[48]);
    trap_err("epc : %8x\n", regs[49]);
    os_task_dump(os_task_current(), (void* )regs[14]);
    trap_data_dump();
    trap_hdl_run();
    mcu_reset();
}

#else   /* CPU0 */
void trap_c(uint32_t *regs)
{
    int i;
    uint32_t vec = (__get_PSR() & PSR_VEC_Msk) >> PSR_VEC_Pos;

    mcu_watchdog_feed();
    mcu_watchdog_timeout(20);
    disable_print(0);
    trap_err("---------------------------------------------------------------\r\n");
    trap_err("CPU Exception: NO.%u\r\n", vec);
    for (i = 0; i < 16; i++) {
        trap_err("r%d: %08x\t", i, regs[i]);
        if ((i % 4) == 3) {
            trap_err("\r\n");
        }
    }
	
    trap_err("r28 : %08x\r\n", regs[16]);
    trap_err("epsr: %08x\r\n", regs[17]);
    trap_err("epc : %08x\r\n", regs[18]);
    csi_kernel_task_dump((k_task_handle_t)g_active_task[0], (void* )regs[14]);
    trap_data_dump();
    trap_hdl_run();
    mcu_reset();
}

#endif