1386561f8SAndrew Jones // SPDX-License-Identifier: GPL-2.0-only 2386561f8SAndrew Jones /* 3386561f8SAndrew Jones * Copyright (C) 2023, Ventana Micro Systems Inc., Andrew Jones <ajones@ventanamicro.com> 4386561f8SAndrew Jones */ 5386561f8SAndrew Jones #include <libcflat.h> 6386561f8SAndrew Jones #include <asm/csr.h> 7*db0ae91cSAndrew Jones #include <asm/isa.h> 8386561f8SAndrew Jones #include <asm/processor.h> 9386561f8SAndrew Jones #include <asm/setup.h> 10386561f8SAndrew Jones 11386561f8SAndrew Jones extern unsigned long _text; 12386561f8SAndrew Jones 13386561f8SAndrew Jones void show_regs(struct pt_regs *regs) 14386561f8SAndrew Jones { 159c92b28eSAndrew Jones struct thread_info *info = current_thread_info(); 16386561f8SAndrew Jones uintptr_t text = (uintptr_t)&_text; 17386561f8SAndrew Jones unsigned int w = __riscv_xlen / 4; 18386561f8SAndrew Jones 19386561f8SAndrew Jones printf("Load address: %" PRIxPTR "\n", text); 209c92b28eSAndrew Jones printf("CPU%3d : hartid=%lx\n", info->cpu, info->hartid); 21386561f8SAndrew Jones printf("status : %.*lx\n", w, regs->status); 22386561f8SAndrew Jones printf("cause : %.*lx\n", w, regs->cause); 23386561f8SAndrew Jones printf("badaddr: %.*lx\n", w, regs->badaddr); 24386561f8SAndrew Jones printf("pc: %.*lx ra: %.*lx\n", w, regs->epc, w, regs->ra); 25386561f8SAndrew Jones printf("sp: %.*lx gp: %.*lx tp : %.*lx\n", w, regs->sp, w, regs->gp, w, regs->tp); 26386561f8SAndrew Jones printf("a0: %.*lx a1: %.*lx a2 : %.*lx a3 : %.*lx\n", w, regs->a0, w, regs->a1, w, regs->a2, w, regs->a3); 27386561f8SAndrew Jones printf("a4: %.*lx a5: %.*lx a6 : %.*lx a7 : %.*lx\n", w, regs->a4, w, regs->a5, w, regs->a6, w, regs->a7); 28386561f8SAndrew Jones printf("t0: %.*lx t1: %.*lx t2 : %.*lx t3 : %.*lx\n", w, regs->t0, w, regs->t1, w, regs->t2, w, regs->t3); 29386561f8SAndrew Jones printf("t4: %.*lx t5: %.*lx t6 : %.*lx\n", w, regs->t4, w, regs->t5, w, regs->t6); 30386561f8SAndrew Jones printf("s0: %.*lx s1: %.*lx s2 : %.*lx s3 : %.*lx\n", w, regs->s0, w, regs->s1, w, regs->s2, w, regs->s3); 31386561f8SAndrew Jones printf("s4: %.*lx s5: %.*lx s6 : %.*lx s7 : %.*lx\n", w, regs->s4, w, regs->s5, w, regs->s6, w, regs->s7); 32386561f8SAndrew Jones printf("s8: %.*lx s9: %.*lx s10: %.*lx s11: %.*lx\n", w, regs->s8, w, regs->s9, w, regs->s10, w, regs->s11); 33386561f8SAndrew Jones } 34386561f8SAndrew Jones 35386561f8SAndrew Jones void do_handle_exception(struct pt_regs *regs) 36386561f8SAndrew Jones { 37386561f8SAndrew Jones struct thread_info *info = current_thread_info(); 38386561f8SAndrew Jones 39386561f8SAndrew Jones assert(regs->cause < EXCEPTION_CAUSE_MAX); 40386561f8SAndrew Jones if (info->exception_handlers[regs->cause]) { 41386561f8SAndrew Jones info->exception_handlers[regs->cause](regs); 42386561f8SAndrew Jones return; 43386561f8SAndrew Jones } 44386561f8SAndrew Jones 45386561f8SAndrew Jones show_regs(regs); 46386561f8SAndrew Jones assert(0); 47386561f8SAndrew Jones } 48386561f8SAndrew Jones 49386561f8SAndrew Jones void install_exception_handler(unsigned long cause, void (*handler)(struct pt_regs *)) 50386561f8SAndrew Jones { 51386561f8SAndrew Jones struct thread_info *info = current_thread_info(); 52386561f8SAndrew Jones 53386561f8SAndrew Jones assert(cause < EXCEPTION_CAUSE_MAX); 54386561f8SAndrew Jones info->exception_handlers[cause] = handler; 55386561f8SAndrew Jones } 56386561f8SAndrew Jones 57386561f8SAndrew Jones void thread_info_init(void) 58386561f8SAndrew Jones { 59386561f8SAndrew Jones unsigned long hartid = csr_read(CSR_SSCRATCH); 60386561f8SAndrew Jones int cpu = hartid_to_cpu(hartid); 61386561f8SAndrew Jones 62*db0ae91cSAndrew Jones isa_init(&cpus[cpu]); 63386561f8SAndrew Jones csr_write(CSR_SSCRATCH, &cpus[cpu]); 64386561f8SAndrew Jones } 65