modules/debug/ps2link/excepHandler.c

   1 /*********************************************************************
   2  * Copyright (C) 2004 Lukasz Bruun (mail@lukasz.dk)
   3  * This file is subject to the terms and conditions of the PS2Link License.
   4  * See the file LICENSE in the main directory of this distribution for more
   5  * details.
   6  */
   7
   8 #include <tamtypes.h>
   9 #include "irx_imports.h"
  10 #include "hostlink.h"
  11
  12 #define BUFFER_SIZE             sizeof(exception_frame_t)+4+4+128
  13
  14 u32 excep_buffer[BUFFER_SIZE/4] __attribute__ ((aligned(16)));
  15
  16 extern unsigned int pkoSendSifCmd(unsigned int cmd, void *src, unsigned int len); // lazy fix :)
  17 extern int excepscrdump;
  18
  19 // taken from smod by mrbrown, only use one function, didn't wanna include another irx.
  20
  21 /* Module info entry.  */
  22 typedef struct _smod_mod_info {
  23         struct _smod_mod_info *next;
  24         u8      *name;
  25         u16     version;
  26         u16     newflags;       /* For modload shipped with games.  */
  27         u16     id;
  28         u16     flags;          /* I believe this is where flags are kept for BIOS versions.  */
  29         u32     entry;          /* _start */
  30         u32     gp;
  31         u32     text_start;
  32         u32     text_size;
  33         u32     data_size;
  34         u32     bss_size;
  35         u32     unused1;
  36         u32     unused2;
  37 } smod_mod_info_t;
  38
  39
  40 smod_mod_info_t *smod_get_next_mod(smod_mod_info_t *cur_mod)
  41 {
  42   /* If cur_mod is 0, return the head of the list (IOP address 0x800).  */
  43   if (!cur_mod) {
  44     return (smod_mod_info_t *)0x800;
  45   } else {
  46     if (!cur_mod->next)
  47       return 0;
  48     else
  49       return cur_mod->next;
  50   }
  51   return 0;
  52 }
  53
  54 char* ExceptionGetModuleName(u32 epc, u32* r_epc)
  55 {
  56         smod_mod_info_t *mod_info = 0;
  57
  58         while((mod_info = smod_get_next_mod(mod_info)) != 0)
  59         {
  60                 if((epc >= mod_info->text_start) && (epc <= (mod_info->text_start+mod_info->text_size)))
  61                 {
  62                         if(r_epc)
  63                                 *r_epc = epc -  mod_info->text_start;
  64
  65                         return mod_info->name;
  66                 }
  67         }
  68
  69         return 0;
  70 }
  71
  72 static void excep_handler2(exception_frame_t *frame)
  73 {
  74         u32 r_epc; // relative epc
  75         char *module_name;
  76         u32 len;
  77         u32* buffer = excep_buffer;
  78
  79         module_name = ExceptionGetModuleName(frame->epc, &r_epc);
  80
  81         len = strlen(module_name);
  82
  83
  84         buffer[0] = 0x0d02beba; // reverse engineering..
  85         buffer++;
  86
  87         memcpy(buffer, frame, BUFFER_SIZE);
  88         buffer+= (sizeof(exception_frame_t)/4);
  89
  90         buffer[0] = r_epc;
  91         buffer[1] = len;
  92         buffer+=2;
  93         memcpy(buffer, module_name, len+1);
  94
  95         pkoSendSifCmd(PKO_RPC_IOPEXCEP, excep_buffer, BUFFER_SIZE);
  96 }
  97
  98
  99 static void excep_handler(exception_type_t type, exception_frame_t *frame)
 100 {
 101         excep_handler2(frame); // Don't know why this works, but keeps iop alive.
 102 }
 103
 104
 105 ////////////////////////////////////////////////////////////////////////
 106 // Installs iop exception handlers for the 'usual' exceptions..
 107 void installExceptionHandlers(void)
 108 {
 109         s32 i;
 110
 111         for(i=1; i < 8; i++)
 112                 set_exception_handler(i, excep_handler);
 113
 114         for(i=10; i < 13; i++)
 115                 set_exception_handler(i, excep_handler);
 116
 117 }