release/src-rt-6.x/linux/linux-2.6/arch/mips/kernel/gdb-low.S

   1 /*
   2  * gdb-low.S contains the low-level trap handler for the GDB stub.
   3  *
   4  * Copyright (C) 1995 Andreas Busse
   5  */
   6 #include <linux/sys.h>
   7
   8 #include <asm/asm.h>
   9 #include <asm/errno.h>
  10 #include <asm/irqflags.h>
  11 #include <asm/mipsregs.h>
  12 #include <asm/asm-offsets.h>
  13 #include <asm/regdef.h>
  14 #include <asm/stackframe.h>
  15
  16 #ifdef CONFIG_32BIT
  17 #define DMFC0   mfc0
  18 #define DMTC0   mtc0
  19 #define LDC1    lwc1
  20 #define SDC1    swc1
  21 #endif
  22 #ifdef CONFIG_64BIT
  23 #define DMFC0   dmfc0
  24 #define DMTC0   dmtc0
  25 #define LDC1    ldc1
  26 #define SDC1    sdc1
  27 #endif
  28
  29 /*
  30  * [jsun] We reserves about 2x GDB_FR_SIZE in stack.  The lower (addressed)
  31  * part is used to store registers and passed to exception handler.
  32  * The upper part is reserved for "call func" feature where gdb client
  33  * saves some of the regs, setups call frame and passes args.
  34  *
  35  * A trace shows about 200 bytes are used to store about half of all regs.
  36  * The rest should be big enough for frame setup and passing args.
  37  */
  38
  39 /*
  40  * The low level trap handler
  41  */
  42                 .align  5
  43                 NESTED(trap_low, GDB_FR_SIZE, sp)
  44                 .set    noat
  45                 .set    noreorder
  46
  47                 mfc0    k0, CP0_STATUS
  48                 sll     k0, 3                   /* extract cu0 bit */
  49                 bltz    k0, 1f
  50                 move    k1, sp
  51
  52                 /*
  53                  * Called from user mode, go somewhere else.
  54                  */
  55                 mfc0    k0, CP0_CAUSE
  56                 andi    k0, k0, 0x7c
  57 #ifdef CONFIG_64BIT
  58                 dsll    k0, k0, 1
  59 #endif
  60                 PTR_L   k1, saved_vectors(k0)
  61                 jr      k1
  62                 nop
  63 1:
  64                 move    k0, sp
  65                 PTR_SUBU sp, k1, GDB_FR_SIZE*2  # see comment above
  66                 LONG_S  k0, GDB_FR_REG29(sp)
  67                 LONG_S  $2, GDB_FR_REG2(sp)
  68
  69 /*
  70  * First save the CP0 and special registers
  71  */
  72
  73                 mfc0    v0, CP0_STATUS
  74                 LONG_S  v0, GDB_FR_STATUS(sp)
  75                 mfc0    v0, CP0_CAUSE
  76                 LONG_S  v0, GDB_FR_CAUSE(sp)
  77                 DMFC0   v0, CP0_EPC
  78                 LONG_S  v0, GDB_FR_EPC(sp)
  79                 DMFC0   v0, CP0_BADVADDR
  80                 LONG_S  v0, GDB_FR_BADVADDR(sp)
  81 #ifdef CONFIG_CPU_HAS_SMARTMIPS
  82                 mflhxu  v0
  83                 LONG_S  v0, GDB_FR_LO(sp)
  84                 mflhxu  v0
  85                 LONG_S  v0, GDB_FR_HI(sp)
  86                 mflhxu  v0
  87                 LONG_S  v0, GDB_FR_ACX(sp)
  88 #else
  89                 mfhi    v0
  90                 LONG_S  v0, GDB_FR_HI(sp)
  91                 mflo    v0
  92                 LONG_S  v0, GDB_FR_LO(sp)
  93 #endif
  94
  95 /*
  96  * Now the integer registers
  97  */
  98
  99                 LONG_S  zero, GDB_FR_REG0(sp)           /* I know... */
 100                 LONG_S  $1, GDB_FR_REG1(sp)
 101                 /* v0 already saved */
 102                 LONG_S  $3, GDB_FR_REG3(sp)
 103                 LONG_S  $4, GDB_FR_REG4(sp)
 104                 LONG_S  $5, GDB_FR_REG5(sp)
 105                 LONG_S  $6, GDB_FR_REG6(sp)
 106                 LONG_S  $7, GDB_FR_REG7(sp)
 107                 LONG_S  $8, GDB_FR_REG8(sp)
 108                 LONG_S  $9, GDB_FR_REG9(sp)
 109                 LONG_S  $10, GDB_FR_REG10(sp)
 110                 LONG_S  $11, GDB_FR_REG11(sp)
 111                 LONG_S  $12, GDB_FR_REG12(sp)
 112                 LONG_S  $13, GDB_FR_REG13(sp)
 113                 LONG_S  $14, GDB_FR_REG14(sp)
 114                 LONG_S  $15, GDB_FR_REG15(sp)
 115                 LONG_S  $16, GDB_FR_REG16(sp)
 116                 LONG_S  $17, GDB_FR_REG17(sp)
 117                 LONG_S  $18, GDB_FR_REG18(sp)
 118                 LONG_S  $19, GDB_FR_REG19(sp)
 119                 LONG_S  $20, GDB_FR_REG20(sp)
 120                 LONG_S  $21, GDB_FR_REG21(sp)
 121                 LONG_S  $22, GDB_FR_REG22(sp)
 122                 LONG_S  $23, GDB_FR_REG23(sp)
 123                 LONG_S  $24, GDB_FR_REG24(sp)
 124                 LONG_S  $25, GDB_FR_REG25(sp)
 125                 LONG_S  $26, GDB_FR_REG26(sp)
 126                 LONG_S  $27, GDB_FR_REG27(sp)
 127                 LONG_S  $28, GDB_FR_REG28(sp)
 128                 /* sp already saved */
 129                 LONG_S  $30, GDB_FR_REG30(sp)
 130                 LONG_S  $31, GDB_FR_REG31(sp)
 131
 132                 CLI                             /* disable interrupts */
 133                 TRACE_IRQS_OFF
 134
 135 /*
 136  * Followed by the floating point registers
 137  */
 138                 mfc0    v0, CP0_STATUS          /* FPU enabled? */
 139                 srl     v0, v0, 16
 140                 andi    v0, v0, (ST0_CU1 >> 16)
 141
 142                 beqz    v0,2f                   /* disabled, skip */
 143                  nop
 144
 145                 SDC1    $0, GDB_FR_FPR0(sp)
 146                 SDC1    $1, GDB_FR_FPR1(sp)
 147                 SDC1    $2, GDB_FR_FPR2(sp)
 148                 SDC1    $3, GDB_FR_FPR3(sp)
 149                 SDC1    $4, GDB_FR_FPR4(sp)
 150                 SDC1    $5, GDB_FR_FPR5(sp)
 151                 SDC1    $6, GDB_FR_FPR6(sp)
 152                 SDC1    $7, GDB_FR_FPR7(sp)
 153                 SDC1    $8, GDB_FR_FPR8(sp)
 154                 SDC1    $9, GDB_FR_FPR9(sp)
 155                 SDC1    $10, GDB_FR_FPR10(sp)
 156                 SDC1    $11, GDB_FR_FPR11(sp)
 157                 SDC1    $12, GDB_FR_FPR12(sp)
 158                 SDC1    $13, GDB_FR_FPR13(sp)
 159                 SDC1    $14, GDB_FR_FPR14(sp)
 160                 SDC1    $15, GDB_FR_FPR15(sp)
 161                 SDC1    $16, GDB_FR_FPR16(sp)
 162                 SDC1    $17, GDB_FR_FPR17(sp)
 163                 SDC1    $18, GDB_FR_FPR18(sp)
 164                 SDC1    $19, GDB_FR_FPR19(sp)
 165                 SDC1    $20, GDB_FR_FPR20(sp)
 166                 SDC1    $21, GDB_FR_FPR21(sp)
 167                 SDC1    $22, GDB_FR_FPR22(sp)
 168                 SDC1    $23, GDB_FR_FPR23(sp)
 169                 SDC1    $24, GDB_FR_FPR24(sp)
 170                 SDC1    $25, GDB_FR_FPR25(sp)
 171                 SDC1    $26, GDB_FR_FPR26(sp)
 172                 SDC1    $27, GDB_FR_FPR27(sp)
 173                 SDC1    $28, GDB_FR_FPR28(sp)
 174                 SDC1    $29, GDB_FR_FPR29(sp)
 175                 SDC1    $30, GDB_FR_FPR30(sp)
 176                 SDC1    $31, GDB_FR_FPR31(sp)
 177
 178 /*
 179  * FPU control registers
 180  */
 181
 182                 cfc1    v0, CP1_STATUS
 183                 LONG_S  v0, GDB_FR_FSR(sp)
 184                 cfc1    v0, CP1_REVISION
 185                 LONG_S  v0, GDB_FR_FIR(sp)
 186
 187 /*
 188  * Current stack frame ptr
 189  */
 190
 191 2:
 192                 LONG_S  sp, GDB_FR_FRP(sp)
 193
 194 /*
 195  * CP0 registers (R4000/R4400 unused registers skipped)
 196  */
 197
 198                 mfc0    v0, CP0_INDEX
 199                 LONG_S  v0, GDB_FR_CP0_INDEX(sp)
 200                 mfc0    v0, CP0_RANDOM
 201                 LONG_S  v0, GDB_FR_CP0_RANDOM(sp)
 202                 DMFC0   v0, CP0_ENTRYLO0
 203                 LONG_S  v0, GDB_FR_CP0_ENTRYLO0(sp)
 204                 DMFC0   v0, CP0_ENTRYLO1
 205                 LONG_S  v0, GDB_FR_CP0_ENTRYLO1(sp)
 206                 DMFC0   v0, CP0_CONTEXT
 207                 LONG_S  v0, GDB_FR_CP0_CONTEXT(sp)
 208                 mfc0    v0, CP0_PAGEMASK
 209                 LONG_S  v0, GDB_FR_CP0_PAGEMASK(sp)
 210                 mfc0    v0, CP0_WIRED
 211                 LONG_S  v0, GDB_FR_CP0_WIRED(sp)
 212                 DMFC0   v0, CP0_ENTRYHI
 213                 LONG_S  v0, GDB_FR_CP0_ENTRYHI(sp)
 214                 mfc0    v0, CP0_PRID
 215                 LONG_S  v0, GDB_FR_CP0_PRID(sp)
 216
 217                 .set    at
 218
 219 /*
 220  * Continue with the higher level handler
 221  */
 222
 223                 move    a0,sp
 224
 225                 jal     handle_exception
 226                  nop
 227
 228 /*
 229  * Restore all writable registers, in reverse order
 230  */
 231
 232                 .set    noat
 233
 234                 LONG_L  v0, GDB_FR_CP0_ENTRYHI(sp)
 235                 LONG_L  v1, GDB_FR_CP0_WIRED(sp)
 236                 DMTC0   v0, CP0_ENTRYHI
 237                 mtc0    v1, CP0_WIRED
 238                 LONG_L  v0, GDB_FR_CP0_PAGEMASK(sp)
 239                 LONG_L  v1, GDB_FR_CP0_ENTRYLO1(sp)
 240                 mtc0    v0, CP0_PAGEMASK
 241                 DMTC0   v1, CP0_ENTRYLO1
 242                 LONG_L  v0, GDB_FR_CP0_ENTRYLO0(sp)
 243                 LONG_L  v1, GDB_FR_CP0_INDEX(sp)
 244                 DMTC0   v0, CP0_ENTRYLO0
 245                 LONG_L  v0, GDB_FR_CP0_CONTEXT(sp)
 246                 mtc0    v1, CP0_INDEX
 247                 DMTC0   v0, CP0_CONTEXT
 248
 249
 250 /*
 251  * Next, the floating point registers
 252  */
 253                 mfc0    v0, CP0_STATUS          /* check if the FPU is enabled */
 254                 srl     v0, v0, 16
 255                 andi    v0, v0, (ST0_CU1 >> 16)
 256
 257                 beqz    v0, 3f                  /* disabled, skip */
 258                  nop
 259
 260                 LDC1    $31, GDB_FR_FPR31(sp)
 261                 LDC1    $30, GDB_FR_FPR30(sp)
 262                 LDC1    $29, GDB_FR_FPR29(sp)
 263                 LDC1    $28, GDB_FR_FPR28(sp)
 264                 LDC1    $27, GDB_FR_FPR27(sp)
 265                 LDC1    $26, GDB_FR_FPR26(sp)
 266                 LDC1    $25, GDB_FR_FPR25(sp)
 267                 LDC1    $24, GDB_FR_FPR24(sp)
 268                 LDC1    $23, GDB_FR_FPR23(sp)
 269                 LDC1    $22, GDB_FR_FPR22(sp)
 270                 LDC1    $21, GDB_FR_FPR21(sp)
 271                 LDC1    $20, GDB_FR_FPR20(sp)
 272                 LDC1    $19, GDB_FR_FPR19(sp)
 273                 LDC1    $18, GDB_FR_FPR18(sp)
 274                 LDC1    $17, GDB_FR_FPR17(sp)
 275                 LDC1    $16, GDB_FR_FPR16(sp)
 276                 LDC1    $15, GDB_FR_FPR15(sp)
 277                 LDC1    $14, GDB_FR_FPR14(sp)
 278                 LDC1    $13, GDB_FR_FPR13(sp)
 279                 LDC1    $12, GDB_FR_FPR12(sp)
 280                 LDC1    $11, GDB_FR_FPR11(sp)
 281                 LDC1    $10, GDB_FR_FPR10(sp)
 282                 LDC1    $9, GDB_FR_FPR9(sp)
 283                 LDC1    $8, GDB_FR_FPR8(sp)
 284                 LDC1    $7, GDB_FR_FPR7(sp)
 285                 LDC1    $6, GDB_FR_FPR6(sp)
 286                 LDC1    $5, GDB_FR_FPR5(sp)
 287                 LDC1    $4, GDB_FR_FPR4(sp)
 288                 LDC1    $3, GDB_FR_FPR3(sp)
 289                 LDC1    $2, GDB_FR_FPR2(sp)
 290                 LDC1    $1, GDB_FR_FPR1(sp)
 291                 LDC1    $0, GDB_FR_FPR0(sp)
 292
 293 /*
 294  * Now the CP0 and integer registers
 295  */
 296
 297 3:
 298 #ifdef CONFIG_MIPS_MT_SMTC
 299                 /* Read-modify write of Status must be atomic */
 300                 mfc0    t2, CP0_TCSTATUS
 301                 ori     t1, t2, TCSTATUS_IXMT
 302                 mtc0    t1, CP0_TCSTATUS
 303                 andi    t2, t2, TCSTATUS_IXMT
 304                 _ehb
 305                 DMT     9                               # dmt   t1
 306                 jal     mips_ihb
 307                 nop
 308 #endif /* CONFIG_MIPS_MT_SMTC */
 309                 mfc0    t0, CP0_STATUS
 310                 ori     t0, 0x1f
 311                 xori    t0, 0x1f
 312                 mtc0    t0, CP0_STATUS
 313 #ifdef CONFIG_MIPS_MT_SMTC
 314                 andi    t1, t1, VPECONTROL_TE
 315                 beqz    t1, 9f
 316                 nop
 317                 EMT                                     # emt
 318 9:
 319                 mfc0    t1, CP0_TCSTATUS
 320                 xori    t1, t1, TCSTATUS_IXMT
 321                 or      t1, t1, t2
 322                 mtc0    t1, CP0_TCSTATUS
 323                 _ehb
 324 #endif /* CONFIG_MIPS_MT_SMTC */
 325                 LONG_L  v0, GDB_FR_STATUS(sp)
 326                 LONG_L  v1, GDB_FR_EPC(sp)
 327                 mtc0    v0, CP0_STATUS
 328                 DMTC0   v1, CP0_EPC
 329 #ifdef CONFIG_CPU_HAS_SMARTMIPS
 330                 LONG_L  v0, GDB_FR_ACX(sp)
 331                 mtlhx   v0
 332                 LONG_L  v0, GDB_FR_HI(sp)
 333                 mtlhx   v0
 334                 LONG_L  v0, GDB_FR_LO(sp)
 335                 mtlhx   v0
 336 #else
 337                 LONG_L  v0, GDB_FR_HI(sp)
 338                 LONG_L  v1, GDB_FR_LO(sp)
 339                 mthi    v0
 340                 mtlo    v1
 341 #endif
 342                 LONG_L  $31, GDB_FR_REG31(sp)
 343                 LONG_L  $30, GDB_FR_REG30(sp)
 344                 LONG_L  $28, GDB_FR_REG28(sp)
 345                 LONG_L  $27, GDB_FR_REG27(sp)
 346                 LONG_L  $26, GDB_FR_REG26(sp)
 347                 LONG_L  $25, GDB_FR_REG25(sp)
 348                 LONG_L  $24, GDB_FR_REG24(sp)
 349                 LONG_L  $23, GDB_FR_REG23(sp)
 350                 LONG_L  $22, GDB_FR_REG22(sp)
 351                 LONG_L  $21, GDB_FR_REG21(sp)
 352                 LONG_L  $20, GDB_FR_REG20(sp)
 353                 LONG_L  $19, GDB_FR_REG19(sp)
 354                 LONG_L  $18, GDB_FR_REG18(sp)
 355                 LONG_L  $17, GDB_FR_REG17(sp)
 356                 LONG_L  $16, GDB_FR_REG16(sp)
 357                 LONG_L  $15, GDB_FR_REG15(sp)
 358                 LONG_L  $14, GDB_FR_REG14(sp)
 359                 LONG_L  $13, GDB_FR_REG13(sp)
 360                 LONG_L  $12, GDB_FR_REG12(sp)
 361                 LONG_L  $11, GDB_FR_REG11(sp)
 362                 LONG_L  $10, GDB_FR_REG10(sp)
 363                 LONG_L  $9, GDB_FR_REG9(sp)
 364                 LONG_L  $8, GDB_FR_REG8(sp)
 365                 LONG_L  $7, GDB_FR_REG7(sp)
 366                 LONG_L  $6, GDB_FR_REG6(sp)
 367                 LONG_L  $5, GDB_FR_REG5(sp)
 368                 LONG_L  $4, GDB_FR_REG4(sp)
 369                 LONG_L  $3, GDB_FR_REG3(sp)
 370                 LONG_L  $2, GDB_FR_REG2(sp)
 371                 LONG_L  $1, GDB_FR_REG1(sp)
 372 #if defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
 373                 LONG_L  k0, GDB_FR_EPC(sp)
 374                 LONG_L  $29, GDB_FR_REG29(sp)           /* Deallocate stack */
 375                 jr      k0
 376                 rfe
 377 #else
 378                 LONG_L  sp, GDB_FR_REG29(sp)            /* Deallocate stack */
 379
 380                 .set    mips3
 381                 eret
 382                 .set    mips0
 383 #endif
 384                 .set    at
 385                 .set    reorder
 386                 END(trap_low)
 387
 388 LEAF(kgdb_read_byte)
 389 4:              lb      t0, (a0)
 390                 sb      t0, (a1)
 391                 li      v0, 0
 392                 jr      ra
 393                 .section __ex_table,"a"
 394                 PTR     4b, kgdbfault
 395                 .previous
 396                 END(kgdb_read_byte)
 397
 398 LEAF(kgdb_write_byte)
 399 5:              sb      a0, (a1)
 400                 li      v0, 0
 401                 jr      ra
 402                 .section __ex_table,"a"
 403                 PTR     5b, kgdbfault
 404                 .previous
 405                 END(kgdb_write_byte)
 406
 407                 .type   kgdbfault@function
 408                 .ent    kgdbfault
 409
 410 kgdbfault:      li      v0, -EFAULT
 411                 jr      ra
 412                 .end    kgdbfault