arch/cris/arch-v32/kernel/kgdb_asm.S

   1 /*
   2  *  Copyright (C) 2004 Axis Communications AB
   3  *
   4  * Code for handling break 8, hardware breakpoint, single step, and serial
   5  * port exceptions for kernel debugging purposes.
   6  */
   7
   8 #include <asm/arch/hwregs/intr_vect.h>
   9
  10         ;; Exported functions.
  11         .globl kgdb_handle_exception
  12
  13 kgdb_handle_exception:
  14
  15 ;; Create a register image of the caller.
  16 ;;
  17 ;; First of all, save the ACR on the stack since we need it for address calculations.
  18 ;; We put it into the register struct later.
  19
  20   subq     4, $sp
  21   move.d   $acr, [$sp]
  22
  23 ;; Now we are free to use ACR all we want.
  24 ;; If we were running this handler with interrupts on, we would have to be careful
  25 ;; to save and restore CCS manually, but since we aren't we treat it like every other
  26 ;; register.
  27
  28   move.d   reg,  $acr
  29   move.d   $r0,  [$acr]        ; Save R0 (start of register struct)
  30   addq     4,    $acr
  31   move.d   $r1,  [$acr]        ; Save R1
  32   addq     4,    $acr
  33   move.d   $r2,  [$acr]        ; Save R2
  34   addq     4,    $acr
  35   move.d   $r3,  [$acr]        ; Save R3
  36   addq     4,    $acr
  37   move.d   $r4,  [$acr]        ; Save R4
  38   addq     4,    $acr
  39   move.d   $r5,  [$acr]        ; Save R5
  40   addq     4,    $acr
  41   move.d   $r6,  [$acr]        ; Save R6
  42   addq     4,    $acr
  43   move.d   $r7,  [$acr]        ; Save R7
  44   addq     4,    $acr
  45   move.d   $r8,  [$acr]        ; Save R8
  46   addq     4,    $acr
  47   move.d   $r9,  [$acr]        ; Save R9
  48   addq     4,    $acr
  49   move.d   $r10, [$acr]        ; Save R10
  50   addq     4,    $acr
  51   move.d   $r11, [$acr]        ; Save R11
  52   addq     4,    $acr
  53   move.d   $r12, [$acr]        ; Save R12
  54   addq     4,    $acr
  55   move.d   $r13, [$acr]        ; Save R13
  56   addq     4,    $acr
  57   move.d   $sp,  [$acr]        ; Save SP (R14)
  58   addq     4,    $acr
  59
  60   ;; The ACR register is already saved on the stack, so pop it from there.
  61   move.d   [$sp],$r0
  62   move.d   $r0,  [$acr]
  63   addq     4,    $acr
  64
  65   move     $bz,  [$acr]
  66   addq     1,    $acr
  67   move     $vr,  [$acr]
  68   addq     1,    $acr
  69   move     $pid, [$acr]
  70   addq     4,    $acr
  71   move     $srs, [$acr]
  72   addq     1,    $acr
  73   move     $wz,  [$acr]
  74   addq     2,    $acr
  75   move     $exs, [$acr]
  76   addq     4,    $acr
  77   move     $eda, [$acr]
  78   addq     4,    $acr
  79   move     $mof, [$acr]
  80   addq     4,    $acr
  81   move     $dz,  [$acr]
  82   addq     4,    $acr
  83   move     $ebp, [$acr]
  84   addq     4,    $acr
  85   move     $erp, [$acr]
  86   addq     4,    $acr
  87   move     $srp, [$acr]
  88   addq     4,    $acr
  89   move     $nrp, [$acr]
  90   addq     4,    $acr
  91   move     $ccs, [$acr]
  92   addq     4,    $acr
  93   move     $usp, [$acr]
  94   addq     4,    $acr
  95   move     $spc, [$acr]
  96   addq     4,     $acr
  97
  98 ;; Skip the pseudo-PC.
  99   addq     4,     $acr
 100
 101 ;; Save the support registers in bank 0 - 3.
 102   clear.d $r1 ; Bank counter
 103   move.d  sreg, $acr
 104
 105 ;; Bank 0
 106   move    $r1,  $srs
 107   nop
 108   nop
 109   nop
 110   move    $s0,   $r0
 111   move.d  $r0,   [$acr]
 112   addq    4,     $acr
 113   move    $s1,   $r0
 114   move.d  $r0,   [$acr]
 115   addq    4,     $acr
 116   move    $s2,   $r0
 117   move.d  $r0,   [$acr]
 118   addq    4,     $acr
 119   move    $s3,   $r0
 120   move.d  $r0,   [$acr]
 121   addq    4,     $acr
 122   move    $s4,   $r0
 123   move.d  $r0,   [$acr]
 124   addq    4,     $acr
 125   move    $s5,   $r0
 126   move.d  $r0,   [$acr]
 127   addq    4,     $acr
 128   move    $s6,   $r0
 129   move.d  $r0,   [$acr]
 130   addq    4,     $acr
 131   move    $s7,   $r0
 132   move.d  $r0,   [$acr]
 133   addq    4,     $acr
 134   move    $s8,   $r0
 135   move.d  $r0,   [$acr]
 136   addq    4,     $acr
 137   move    $s9,   $r0
 138   move.d  $r0,   [$acr]
 139   addq    4,     $acr
 140   move    $s10,  $r0
 141   move.d  $r0,   [$acr]
 142   addq    4,     $acr
 143   move    $s11,  $r0
 144   move.d  $r0,   [$acr]
 145   addq    4,     $acr
 146   move    $s12,  $r0
 147   move.d  $r0,   [$acr]
 148   addq    4,     $acr
 149
 150   ;; Nothing in S13 - S15, bank 0
 151   clear.d [$acr]
 152   addq    4,     $acr
 153   clear.d [$acr]
 154   addq    4,     $acr
 155   clear.d [$acr]
 156   addq    4,     $acr
 157
 158 ;; Bank 1 and bank 2 have the same layout, hence the loop.
 159   addq    1, $r1
 160 1:
 161   move    $r1,  $srs
 162   nop
 163   nop
 164   nop
 165   move    $s0,   $r0
 166   move.d  $r0,   [$acr]
 167   addq    4,     $acr
 168   move    $s1,   $r0
 169   move.d  $r0,   [$acr]
 170   addq    4,     $acr
 171   move    $s2,   $r0
 172   move.d  $r0,   [$acr]
 173   addq    4,     $acr
 174   move    $s3,   $r0
 175   move.d  $r0,   [$acr]
 176   addq    4,     $acr
 177   move    $s4,   $r0
 178   move.d  $r0,   [$acr]
 179   addq    4,     $acr
 180   move    $s5,   $r0
 181   move.d  $r0,   [$acr]
 182   addq    4,     $acr
 183   move    $s6,   $r0
 184   move.d  $r0,   [$acr]
 185   addq    4,     $acr
 186
 187   ;; Nothing in S7 - S15, bank 1 and 2
 188   clear.d [$acr]
 189   addq    4,     $acr
 190   clear.d [$acr]
 191   addq    4,     $acr
 192   clear.d [$acr]
 193   addq    4,     $acr
 194   clear.d [$acr]
 195   addq    4,     $acr
 196   clear.d [$acr]
 197   addq    4,     $acr
 198   clear.d [$acr]
 199   addq    4,     $acr
 200   clear.d [$acr]
 201   addq    4,     $acr
 202   clear.d [$acr]
 203   addq    4,     $acr
 204   clear.d [$acr]
 205   addq    4,     $acr
 206
 207   addq 1, $r1
 208   cmpq 3, $r1
 209   bne 1b
 210   nop
 211
 212 ;; Bank 3
 213   move    $r1,  $srs
 214   nop
 215   nop
 216   nop
 217   move    $s0,   $r0
 218   move.d  $r0,   [$acr]
 219   addq    4,     $acr
 220   move    $s1,   $r0
 221   move.d  $r0,   [$acr]
 222   addq    4,     $acr
 223   move    $s2,   $r0
 224   move.d  $r0,   [$acr]
 225   addq    4,     $acr
 226   move    $s3,   $r0
 227   move.d  $r0,   [$acr]
 228   addq    4,     $acr
 229   move    $s4,   $r0
 230   move.d  $r0,   [$acr]
 231   addq    4,     $acr
 232   move    $s5,   $r0
 233   move.d  $r0,   [$acr]
 234   addq    4,     $acr
 235   move    $s6,   $r0
 236   move.d  $r0,   [$acr]
 237   addq    4,     $acr
 238   move    $s7,   $r0
 239   move.d  $r0,   [$acr]
 240   addq    4,     $acr
 241   move    $s8,   $r0
 242   move.d  $r0,   [$acr]
 243   addq    4,     $acr
 244   move    $s9,   $r0
 245   move.d  $r0,   [$acr]
 246   addq    4,     $acr
 247   move    $s10,  $r0
 248   move.d  $r0,   [$acr]
 249   addq    4,     $acr
 250   move    $s11,  $r0
 251   move.d  $r0,   [$acr]
 252   addq    4,     $acr
 253   move    $s12,  $r0
 254   move.d  $r0,   [$acr]
 255   addq    4,     $acr
 256   move    $s13,  $r0
 257   move.d  $r0,   [$acr]
 258   addq    4,     $acr
 259   move    $s14,  $r0
 260   move.d  $r0,   [$acr]
 261   addq    4,     $acr
 262 ;; Nothing in S15, bank 3
 263   clear.d [$acr]
 264   addq    4,     $acr
 265
 266 ;; Check what got us here: get IDX field of EXS.
 267   move $exs,    $r10
 268   and.d 0xff00, $r10
 269   lsrq 8,       $r10
 270 #if defined(CONFIG_ETRAX_KGDB_PORT0)
 271   cmp.d SER0_INTR_VECT,   $r10 ; IRQ for serial port 0
 272   beq sigint
 273   nop
 274 #elif defined(CONFIG_ETRAX_KGDB_PORT1)
 275   cmp.d SER1_INTR_VECT,   $r10 ; IRQ for serial port 1
 276   beq sigint
 277   nop
 278 #elif defined(CONFIG_ETRAX_KGDB_PORT2)
 279   cmp.d SER2_INTR_VECT,   $r10 ; IRQ for serial port 2
 280   beq sigint
 281   nop
 282 #elif defined(CONFIG_ETRAX_KGDB_PORT3)
 283   cmp.d SER3_INTR_VECT,   $r10 ; IRQ for serial port 3
 284   beq sigint
 285   nop
 286 #endif
 287 ;; Multiple interrupt must be due to serial break.
 288   cmp.d 0x30,   $r10 ; Multiple interrupt
 289   beq sigint
 290   nop
 291 ;; Neither of those? Then it's a sigtrap.
 292   ba handle_comm
 293   moveq 5, $r10      ; Set SIGTRAP (delay slot)
 294
 295 sigint:
 296   ;; Serial interrupt; get character
 297   jsr getDebugChar
 298   nop                ; Delay slot
 299   cmp.b 3, $r10      ; \003 (Ctrl-C)?
 300   bne return         ; No, get out of here
 301   nop
 302   moveq 2, $r10      ; Set SIGINT
 303
 304 ;;
 305 ;; Handle the communication
 306 ;;
 307 handle_comm:
 308   move.d   internal_stack+1020, $sp ; Use the internal stack which grows upwards
 309   jsr      handle_exception         ; Interactive routine
 310   nop
 311
 312 ;;
 313 ;; Return to the caller
 314 ;;
 315 return:
 316
 317 ;; First of all, write the support registers.
 318   clear.d $r1 ; Bank counter
 319   move.d  sreg, $acr
 320
 321 ;; Bank 0
 322   move    $r1,  $srs
 323   nop
 324   nop
 325   nop
 326   move.d  [$acr], $r0
 327   move    $r0,    $s0
 328   addq    4,      $acr
 329   move.d  [$acr], $r0
 330   move    $r0,    $s1
 331   addq    4,      $acr
 332   move.d  [$acr], $r0
 333   move    $r0,    $s2
 334   addq    4,      $acr
 335   move.d  [$acr], $r0
 336   move    $r0,    $s3
 337   addq    4,      $acr
 338   move.d  [$acr], $r0
 339   move    $r0,    $s4
 340   addq    4,      $acr
 341   move.d  [$acr], $r0
 342   move    $r0,    $s5
 343   addq    4,      $acr
 344
 345 ;; Nothing in S6 - S7, bank 0.
 346   addq    4,      $acr
 347   addq    4,      $acr
 348
 349   move.d  [$acr], $r0
 350   move    $r0,    $s8
 351   addq    4,      $acr
 352   move.d  [$acr], $r0
 353   move    $r0,    $s9
 354   addq    4,      $acr
 355   move.d  [$acr], $r0
 356   move    $r0,    $s10
 357   addq    4,      $acr
 358   move.d  [$acr], $r0
 359   move    $r0,    $s11
 360   addq    4,      $acr
 361   move.d  [$acr], $r0
 362   move    $r0,    $s12
 363   addq    4,      $acr
 364
 365 ;; Nothing in S13 - S15, bank 0
 366   addq    4,      $acr
 367   addq    4,      $acr
 368   addq    4,      $acr
 369
 370 ;; Bank 1 and bank 2 have the same layout, hence the loop.
 371   addq    1, $r1
 372 2:
 373   move    $r1,  $srs
 374   nop
 375   nop
 376   nop
 377   move.d  [$acr], $r0
 378   move    $r0,    $s0
 379   addq    4,      $acr
 380   move.d  [$acr], $r0
 381   move    $r0,    $s1
 382   addq    4,      $acr
 383   move.d  [$acr], $r0
 384   move    $r0,    $s2
 385   addq    4,      $acr
 386
 387 ;; S3 (MM_CAUSE) is read-only.
 388   addq    4,      $acr
 389
 390   move.d  [$acr], $r0
 391   move    $r0,    $s4
 392   addq    4,      $acr
 393
 394 ;; FIXME: Actually write S5/S6? (Affects MM_CAUSE.)
 395   addq    4,      $acr
 396   addq    4,      $acr
 397
 398 ;; Nothing in S7 - S15, bank 1 and 2
 399   addq    4,      $acr
 400   addq    4,      $acr
 401   addq    4,      $acr
 402   addq    4,      $acr
 403   addq    4,      $acr
 404   addq    4,      $acr
 405   addq    4,      $acr
 406   addq    4,      $acr
 407   addq    4,      $acr
 408
 409   addq 1, $r1
 410   cmpq 3, $r1
 411   bne 2b
 412   nop
 413
 414 ;; Bank 3
 415   move    $r1,  $srs
 416   nop
 417   nop
 418   nop
 419   move.d  [$acr], $r0
 420   move    $r0,    $s0
 421   addq    4,      $acr
 422   move.d  [$acr], $r0
 423   move    $r0,    $s1
 424   addq    4,      $acr
 425   move.d  [$acr], $r0
 426   move    $r0,    $s2
 427   addq    4,      $acr
 428   move.d  [$acr], $r0
 429   move    $r0,    $s3
 430   addq    4,      $acr
 431   move.d  [$acr], $r0
 432   move    $r0,    $s4
 433   addq    4,      $acr
 434   move.d  [$acr], $r0
 435   move    $r0,    $s5
 436   addq    4,      $acr
 437   move.d  [$acr], $r0
 438   move    $r0,    $s6
 439   addq    4,      $acr
 440   move.d  [$acr], $r0
 441   move    $r0,    $s7
 442   addq    4,      $acr
 443   move.d  [$acr], $r0
 444   move    $r0,    $s8
 445   addq    4,      $acr
 446   move.d  [$acr], $r0
 447   move    $r0,    $s9
 448   addq    4,      $acr
 449   move.d  [$acr], $r0
 450   move    $r0,    $s10
 451   addq    4,      $acr
 452   move.d  [$acr], $r0
 453   move    $r0,    $s11
 454   addq    4,      $acr
 455   move.d  [$acr], $r0
 456   move    $r0,    $s12
 457   addq    4,      $acr
 458   move.d  [$acr], $r0
 459   move    $r0,    $s13
 460   addq    4,      $acr
 461   move.d  [$acr], $r0
 462   move    $r0,    $s14
 463   addq    4,      $acr
 464
 465 ;; Nothing in S15, bank 3
 466   addq    4,      $acr
 467
 468 ;; Now, move on to the regular register restoration process.
 469
 470    move.d  reg,    $acr   ; Reset ACR to point at the beginning of the register image
 471    move.d  [$acr], $r0    ; Restore R0
 472    addq    4,      $acr
 473    move.d  [$acr], $r1    ; Restore R1
 474    addq    4,      $acr
 475    move.d  [$acr], $r2    ; Restore R2
 476    addq    4,      $acr
 477    move.d  [$acr], $r3    ; Restore R3
 478    addq    4,      $acr
 479    move.d  [$acr], $r4    ; Restore R4
 480    addq    4,      $acr
 481    move.d  [$acr], $r5    ; Restore R5
 482    addq    4,      $acr
 483    move.d  [$acr], $r6    ; Restore R6
 484    addq    4,      $acr
 485    move.d  [$acr], $r7    ; Restore R7
 486    addq    4,      $acr
 487    move.d  [$acr], $r8    ; Restore R8
 488    addq    4,      $acr
 489    move.d  [$acr], $r9    ; Restore R9
 490    addq    4,      $acr
 491    move.d  [$acr], $r10   ; Restore R10
 492    addq    4,      $acr
 493    move.d  [$acr], $r11   ; Restore R11
 494    addq    4,      $acr
 495    move.d  [$acr], $r12   ; Restore R12
 496    addq    4,      $acr
 497    move.d  [$acr], $r13   ; Restore R13
 498
 499 ;;
 500 ;; We restore all registers, even though some of them probably haven't changed.
 501 ;;
 502
 503    addq    4,      $acr
 504    move.d  [$acr], $sp    ; Restore SP (R14)
 505
 506    ;; ACR cannot be restored just yet.
 507    addq    8,      $acr
 508
 509    ;; Skip BZ, VR.
 510    addq    2,      $acr
 511
 512    move    [$acr], $pid   ; Restore PID
 513    addq    4,      $acr
 514    move    [$acr], $srs   ; Restore SRS
 515    nop
 516    nop
 517    nop
 518    addq    1,      $acr
 519
 520    ;; Skip WZ.
 521    addq    2,      $acr
 522
 523    move    [$acr], $exs    ; Restore EXS.
 524    addq    4,      $acr
 525    move    [$acr], $eda    ; Restore EDA.
 526    addq    4,      $acr
 527    move    [$acr], $mof    ; Restore MOF.
 528
 529    ;; Skip DZ.
 530    addq    8,      $acr
 531
 532    move    [$acr], $ebp    ; Restore EBP.
 533    addq    4,      $acr
 534    move    [$acr], $erp    ; Restore ERP.
 535    addq    4,      $acr
 536    move    [$acr], $srp    ; Restore SRP.
 537    addq    4,      $acr
 538    move    [$acr], $nrp    ; Restore NRP.
 539    addq    4,      $acr
 540    move    [$acr], $ccs    ; Restore CCS like an ordinary register.
 541    addq    4,      $acr
 542    move    [$acr], $usp    ; Restore USP
 543    addq    4,      $acr
 544    move    [$acr], $spc    ; Restore SPC
 545                            ; No restoration of pseudo-PC of course.
 546
 547    move.d  reg,    $acr    ; Reset ACR to point at the beginning of the register image
 548    add.d   15*4,   $acr
 549    move.d  [$acr], $acr    ; Finally, restore ACR.
 550    rete                    ; Same as jump ERP
 551    rfe                     ; Shifts CCS