src/target/xscale/debug_handler.S

   1 /***************************************************************************
   2  *   Copyright (C) 2006 by Dominic Rath                                    *
   3  *   Dominic.Rath@gmx.de                                                   *
   4  *                                                                         *
   5  *   This program is free software; you can redistribute it and/or modify  *
   6  *   it under the terms of the GNU General Public License as published by  *
   7  *   the Free Software Foundation; either version 2 of the License, or     *
   8  *   (at your option) any later version.                                   *
   9  *                                                                         *
  10  *   This program is distributed in the hope that it will be useful,       *
  11  *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
  12  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
  13  *   GNU General Public License for more details.                          *
  14  *                                                                         *
  15  *   You should have received a copy of the GNU General Public License     *
  16  *   along with this program; if not, write to the                         *
  17  *   Free Software Foundation, Inc.,                                       *
  18  *   51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.           *
  19  ***************************************************************************/
  20 #include "protocol.h"
  21
  22     .text
  23     .align  4
  24
  25 @ Disable thumb mode
  26     .code 32
  27
  28 @ send word to debugger
  29 .macro m_send_to_debugger reg
  30 1:
  31         mrc p14, 0, r15, c14, c0, 0
  32         bvs 1b
  33         mcr p14, 0, \reg, c8, c0, 0
  34 .endm
  35
  36 @ receive word from debugger
  37 .macro m_receive_from_debugger reg
  38 1:
  39         mrc p14, 0, r15, c14, c0, 0
  40         bpl 1b
  41         mrc p14, 0, \reg, c9, c0, 0
  42 .endm
  43
  44 @ save register on debugger, small
  45 .macro m_small_save_reg reg
  46         mov r0, \reg
  47         bl send_to_debugger
  48 .endm
  49
  50 @ save status register on debugger, small
  51 .macro m_small_save_psr
  52         mrs r0, spsr
  53         bl send_to_debugger
  54 .endm
  55
  56 @ wait for all outstanding coprocessor accesses to complete
  57 .macro m_cpwait
  58         mrc p15, 0, r0, c2, c0, 0
  59         mov r0, r0
  60         sub pc, pc, #4
  61 .endm
  62
  63 .global reset_handler
  64 .global undef_handler
  65 .global swi_handler
  66 .global prefetch_abort_handler
  67 .global data_abort_handler
  68 .global irq_handler
  69 .global fiq_handler
  70
  71 .section .part1 , "ax"
  72
  73 reset_handler:
  74         @ read DCSR
  75         mrc p14, 0, r13, c10, c0
  76         @ check if global enable bit (GE) is set
  77         ands r13, r13, #0x80000000
  78
  79         bne debug_handler
  80
  81         @ set global enable bit (GE)
  82         mov r13, #0xc0000000
  83         mcr p14, 0, r13, c10, c0
  84
  85 debug_handler:
  86
  87         @ save r0 without modifying other registers
  88         m_send_to_debugger r0
  89
  90         @ save lr (program PC) without branching (use macro)
  91         m_send_to_debugger r14
  92
  93         @ save non-banked registers and spsr (program CPSR)
  94         m_small_save_reg r1
  95         m_small_save_reg r2
  96         m_small_save_reg r3
  97         m_small_save_reg r4
  98         m_small_save_reg r5
  99         m_small_save_reg r6
 100         m_small_save_reg r7
 101         m_small_save_psr
 102
 103         mrs r0, spsr
 104
 105         @ prepare program PSR for debug use (clear Thumb, set I/F to disable interrupts)
 106         bic r0, r0, #PSR_T
 107         orr r0, r0, #(PSR_I | PSR_F)
 108
 109         @ examine mode bits
 110         and r1, r0, #MODE_MASK
 111         cmp r1, #MODE_USR
 112
 113         bne not_user_mode
 114
 115         @ replace USR mode with SYS
 116         bic r0, r0, #MODE_MASK
 117         orr r0, r0, #MODE_SYS
 118
 119 not_user_mode:
 120
 121         b save_banked_registers
 122
 123 @ command loop
 124 @ wait for command from debugger, than execute desired function
 125 get_command:
 126         bl receive_from_debugger
 127
 128         @ 0x0n - register access
 129         cmp r0, #0x0
 130         beq get_banked_registers
 131
 132         cmp r0, #0x1
 133         beq set_banked_registers
 134
 135         @ 0x1n - read memory
 136         cmp r0, #0x11
 137         beq read_byte
 138
 139         cmp r0, #0x12
 140         beq read_half_word
 141
 142         cmp r0, #0x14
 143         beq read_word
 144
 145         @ 0x2n - write memory
 146         cmp r0, #0x21
 147         beq write_byte
 148
 149         cmp r0, #0x22
 150         beq write_half_word
 151
 152         cmp r0, #0x24
 153         beq write_word
 154
 155         @ 0x3n - program execution
 156         cmp r0, #0x30
 157         beq resume
 158
 159         cmp r0, #0x31
 160         beq resume_w_trace
 161
 162         @ 0x4n - coprocessor access
 163         cmp r0, #0x40
 164         beq read_cp_reg
 165
 166         cmp r0, #0x41
 167         beq write_cp_reg
 168
 169         @ 0x5n - cache and mmu functions
 170         cmp r0, #0x50
 171         beq clean_d_cache
 172
 173         cmp r0, #0x51
 174         beq invalidate_d_cache
 175
 176         cmp r0, #0x52
 177         beq invalidate_i_cache
 178
 179         cmp r0, #0x53
 180         beq cpwait
 181
 182         @ 0x6n - misc functions
 183         cmp r0, #0x60
 184         beq clear_sa
 185
 186         cmp r0, #0x61
 187         beq read_trace_buffer
 188
 189         cmp r0, #0x62
 190         beq clean_trace_buffer
 191
 192         @ return (back to get_command)
 193         b get_command
 194
 195 @ ----
 196
 197 @ resume program execution
 198 resume:
 199         @ restore CPSR (SPSR_dbg)
 200         bl receive_from_debugger
 201         msr spsr, r0
 202
 203         @ restore registers (r7 - r0)
 204         bl receive_from_debugger @ r7
 205         mov r7, r0
 206         bl receive_from_debugger @ r6
 207         mov r6, r0
 208         bl receive_from_debugger @ r5
 209         mov r5, r0
 210         bl receive_from_debugger @ r4
 211         mov r4, r0
 212         bl receive_from_debugger @ r3
 213         mov r3, r0
 214         bl receive_from_debugger @ r2
 215         mov r2, r0
 216         bl receive_from_debugger @ r1
 217         mov r1, r0
 218         bl receive_from_debugger @ r0
 219
 220         @ resume addresss
 221         m_receive_from_debugger lr
 222
 223         @ branch back to application code, restoring CPSR
 224         subs pc, lr, #0
 225
 226 @ get banked registers
 227 @ receive mode bits from host, then run into save_banked_registers to
 228
 229 get_banked_registers:
 230         bl receive_from_debugger
 231
 232 @ save banked registers
 233 @ r0[4:0]: desired mode bits
 234 save_banked_registers:
 235         @ backup CPSR
 236         mrs r7, cpsr
 237         msr cpsr_c, r0
 238         nop
 239
 240         @ keep current mode bits in r1 for later use
 241         and r1, r0, #MODE_MASK
 242
 243         @ backup banked registers
 244         m_send_to_debugger r8
 245         m_send_to_debugger r9
 246         m_send_to_debugger r10
 247         m_send_to_debugger r11
 248         m_send_to_debugger r12
 249         m_send_to_debugger r13
 250         m_send_to_debugger r14
 251
 252         @ if not in SYS mode (or USR, which we replaced with SYS before)
 253         cmp r1, #MODE_SYS
 254
 255         beq no_spsr_to_save
 256
 257         @ backup SPSR
 258         mrs r0, spsr
 259         m_send_to_debugger r0
 260
 261 no_spsr_to_save:
 262
 263         @ restore CPSR for SDS
 264         msr cpsr_c, r7
 265         nop
 266
 267         @ return
 268         b get_command
 269
 270 @ ----
 271
 272
 273 @ set banked registers
 274 @ receive mode bits from host, then run into save_banked_registers to
 275
 276 set_banked_registers:
 277         bl receive_from_debugger
 278
 279 @ restore banked registers
 280 @ r0[4:0]: desired mode bits
 281 restore_banked_registers:
 282         @ backup CPSR
 283         mrs r7, cpsr
 284         msr cpsr_c, r0
 285         nop
 286
 287         @ keep current mode bits in r1 for later use
 288         and r1, r0, #MODE_MASK
 289
 290         @ set banked registers
 291         m_receive_from_debugger r8
 292         m_receive_from_debugger r9
 293         m_receive_from_debugger r10
 294         m_receive_from_debugger r11
 295         m_receive_from_debugger r12
 296         m_receive_from_debugger r13
 297         m_receive_from_debugger r14
 298
 299         @ if not in SYS mode (or USR, which we replaced with SYS before)
 300         cmp r1, #MODE_SYS
 301
 302         beq no_spsr_to_restore
 303
 304         @ set SPSR
 305         m_receive_from_debugger r0
 306         msr spsr, r0
 307
 308 no_spsr_to_restore:
 309
 310         @ restore CPSR for SDS
 311         msr cpsr_c, r7
 312         nop
 313
 314         @ return
 315         b get_command
 316
 317 @ ----
 318
 319 read_byte:
 320         @ r2: address
 321         bl receive_from_debugger
 322         mov r2, r0
 323
 324         @ r1: count
 325         bl receive_from_debugger
 326         mov r1, r0
 327
 328 rb_loop:
 329         ldrb r0, [r2], #1
 330
 331         @ drain write- (and fill-) buffer to work around XScale errata
 332         mcr p15, 0, r8, c7, c10, 4
 333
 334         bl send_to_debugger
 335
 336         subs r1, r1, #1
 337         bne rb_loop
 338
 339         @ return
 340         b get_command
 341
 342 @ ----
 343
 344 read_half_word:
 345         @ r2: address
 346         bl receive_from_debugger
 347         mov r2, r0
 348
 349         @ r1: count
 350         bl receive_from_debugger
 351         mov r1, r0
 352
 353 rh_loop:
 354         ldrh r0, [r2], #2
 355
 356         @ drain write- (and fill-) buffer to work around XScale errata
 357         mcr p15, 0, r8, c7, c10, 4
 358
 359         bl send_to_debugger
 360
 361         subs r1, r1, #1
 362         bne rh_loop
 363
 364         @ return
 365         b get_command
 366
 367 @ ----
 368
 369 read_word:
 370         @ r2: address
 371         bl receive_from_debugger
 372         mov r2, r0
 373
 374         @ r1: count
 375         bl receive_from_debugger
 376         mov r1, r0
 377
 378 rw_loop:
 379         ldr r0, [r2], #4
 380
 381         @ drain write- (and fill-) buffer to work around XScale errata
 382         mcr p15, 0, r8, c7, c10, 4
 383
 384         bl send_to_debugger
 385
 386         subs r1, r1, #1
 387         bne rw_loop
 388
 389         @ return
 390         b get_command
 391
 392 @ ----
 393
 394 write_byte:
 395         @ r2: address
 396         bl receive_from_debugger
 397         mov r2, r0
 398
 399         @ r1: count
 400         bl receive_from_debugger
 401         mov r1, r0
 402
 403 wb_loop:
 404         bl receive_from_debugger
 405         strb r0, [r2], #1
 406
 407         @ drain write- (and fill-) buffer to work around XScale errata
 408         mcr p15, 0, r8, c7, c10, 4
 409
 410         subs r1, r1, #1
 411         bne wb_loop
 412
 413         @ return
 414         b get_command
 415
 416 @ ----
 417
 418 write_half_word:
 419         @ r2: address
 420         bl receive_from_debugger
 421         mov r2, r0
 422
 423         @ r1: count
 424         bl receive_from_debugger
 425         mov r1, r0
 426
 427 wh_loop:
 428         bl receive_from_debugger
 429         strh r0, [r2], #2
 430
 431         @ drain write- (and fill-) buffer to work around XScale errata
 432         mcr p15, 0, r8, c7, c10, 4
 433
 434         subs r1, r1, #1
 435         bne wh_loop
 436
 437         @ return
 438         b get_command
 439
 440 @ ----
 441
 442 write_word:
 443         @ r2: address
 444         bl receive_from_debugger
 445         mov r2, r0
 446
 447         @ r1: count
 448         bl receive_from_debugger
 449         mov r1, r0
 450
 451 ww_loop:
 452         bl receive_from_debugger
 453         str r0, [r2], #4
 454
 455         @ drain write- (and fill-) buffer to work around XScale errata
 456         mcr p15, 0, r8, c7, c10, 4
 457
 458         subs r1, r1, #1
 459         bne ww_loop
 460
 461         @ return
 462         b get_command
 463
 464 @ ----
 465
 466 clear_sa:
 467         @ read DCSR
 468         mrc p14, 0, r0, c10, c0
 469
 470         @ clear SA bit
 471         bic r0, r0, #0x20
 472
 473         @ write DCSR
 474         mcr p14, 0, r0, c10, c0
 475
 476         @ return
 477         b get_command
 478
 479 @ ----
 480
 481 clean_d_cache:
 482         @ r0: cache clean area
 483         bl receive_from_debugger
 484
 485         mov r1, #1024
 486 clean_loop:
 487         mcr p15, 0, r0, c7, c2, 5
 488         add r0, r0, #32
 489         subs r1, r1, #1
 490         bne clean_loop
 491
 492         @ return
 493         b get_command
 494
 495 @ ----
 496
 497 invalidate_d_cache:
 498         mcr p15, 0, r0, c7, c6, 0
 499
 500         @ return
 501         b get_command
 502
 503 @ ----
 504
 505 invalidate_i_cache:
 506         mcr p15, 0, r0, c7, c5, 0
 507
 508         @ return
 509         b get_command
 510
 511 @ ----
 512
 513 cpwait:
 514         m_cpwait
 515
 516         @return
 517         b get_command
 518
 519 @ ----
 520
 521 .section .part2 , "ax"
 522
 523 read_cp_reg:
 524         @ requested cp register
 525         bl receive_from_debugger
 526
 527         adr r1, read_cp_table
 528         add pc, r1, r0, lsl #3
 529
 530 read_cp_table:
 531         mrc p15, 0, r0, c0, c0, 0  @ XSCALE_MAINID
 532         b read_cp_reg_reply
 533         mrc p15, 0, r0, c0, c0, 1  @ XSCALE_CACHETYPE
 534         b read_cp_reg_reply
 535         mrc p15, 0, r0, c1, c0, 0  @ XSCALE_CTRL
 536         b read_cp_reg_reply
 537         mrc p15, 0, r0, c1, c0, 1  @ XSCALE_AUXCTRL
 538         b read_cp_reg_reply
 539         mrc p15, 0, r0, c2, c0, 0  @ XSCALE_TTB
 540         b read_cp_reg_reply
 541         mrc p15, 0, r0, c3, c0, 0  @ XSCALE_DAC
 542         b read_cp_reg_reply
 543         mrc p15, 0, r0, c5, c0, 0  @ XSCALE_FSR
 544         b read_cp_reg_reply
 545         mrc p15, 0, r0, c6, c0, 0  @ XSCALE_FAR
 546         b read_cp_reg_reply
 547         mrc p15, 0, r0, c13, c0, 0  @ XSCALE_PID
 548         b read_cp_reg_reply
 549         mrc p15, 0, r0, c15, c0, 0  @ XSCALE_CP_ACCESS
 550         b read_cp_reg_reply
 551         mrc p15, 0, r0, c14, c8, 0  @ XSCALE_IBCR0
 552         b read_cp_reg_reply
 553         mrc p15, 0, r0, c14, c9, 0  @ XSCALE_IBCR1
 554         b read_cp_reg_reply
 555         mrc p15, 0, r0, c14, c0, 0  @ XSCALE_DBR0
 556         b read_cp_reg_reply
 557         mrc p15, 0, r0, c14, c3, 0  @ XSCALE_DBR1
 558         b read_cp_reg_reply
 559         mrc p15, 0, r0, c14, c4, 0  @ XSCALE_DBCON
 560         b read_cp_reg_reply
 561         mrc p14, 0, r0, c11, c0, 0 @ XSCALE_TBREG
 562         b read_cp_reg_reply
 563         mrc p14, 0, r0, c12, c0, 0 @ XSCALE_CHKPT0
 564         b read_cp_reg_reply
 565         mrc p14, 0, r0, c13, c0, 0 @ XSCALE_CHKPT1
 566         b read_cp_reg_reply
 567         mrc p14, 0, r0, c10, c0, 0 @ XSCALE_DCSR
 568         b read_cp_reg_reply
 569
 570 read_cp_reg_reply:
 571         bl send_to_debugger
 572
 573         @ return
 574         b get_command
 575
 576 @ ----
 577
 578 write_cp_reg:
 579         @ requested cp register
 580         bl receive_from_debugger
 581         mov r1, r0
 582
 583         @ value to be written
 584         bl receive_from_debugger
 585
 586         adr r2, write_cp_table
 587         add pc, r2, r1, lsl #3
 588
 589 write_cp_table:
 590         mcr p15, 0, r0, c0, c0, 0  @ XSCALE_MAINID (0x0)
 591         b get_command
 592         mcr p15, 0, r0, c0, c0, 1  @ XSCALE_CACHETYPE (0x1)
 593         b get_command
 594         mcr p15, 0, r0, c1, c0, 0  @ XSCALE_CTRL (0x2)
 595         b get_command
 596         mcr p15, 0, r0, c1, c0, 1  @ XSCALE_AUXCTRL (0x3)
 597         b get_command
 598         mcr p15, 0, r0, c2, c0, 0  @ XSCALE_TTB (0x4)
 599         b get_command
 600         mcr p15, 0, r0, c3, c0, 0  @ XSCALE_DAC (0x5)
 601         b get_command
 602         mcr p15, 0, r0, c5, c0, 0  @ XSCALE_FSR (0x6)
 603         b get_command
 604         mcr p15, 0, r0, c6, c0, 0  @ XSCALE_FAR (0x7)
 605         b get_command
 606         mcr p15, 0, r0, c13, c0, 0  @ XSCALE_PID (0x8)
 607         b get_command
 608         mcr p15, 0, r0, c15, c0, 0  @ XSCALE_CP_ACCESS (0x9)
 609         b get_command
 610         mcr p15, 0, r0, c14, c8, 0  @ XSCALE_IBCR0 (0xa)
 611         b get_command
 612         mcr p15, 0, r0, c14, c9, 0  @ XSCALE_IBCR1 (0xb)
 613         b get_command
 614         mcr p15, 0, r0, c14, c0, 0  @ XSCALE_DBR0 (0xc)
 615         b get_command
 616         mcr p15, 0, r0, c14, c3, 0  @ XSCALE_DBR1 (0xd)
 617         b get_command
 618         mcr p15, 0, r0, c14, c4, 0  @ XSCALE_DBCON (0xe)
 619         b get_command
 620         mcr p14, 0, r0, c11, c0, 0 @ XSCALE_TBREG (0xf)
 621         b get_command
 622         mcr p14, 0, r0, c12, c0, 0 @ XSCALE_CHKPT0 (0x10)
 623         b get_command
 624         mcr p14, 0, r0, c13, c0, 0 @ XSCALE_CHKPT1 (0x11)
 625         b get_command
 626         mcr p14, 0, r0, c10, c0, 0 @ XSCALE_DCSR (0x12)
 627         b get_command
 628
 629 @ ----
 630
 631 read_trace_buffer:
 632
 633         @ dump 256 entries from trace buffer
 634         mov     r1, #256
 635 read_tb_loop:
 636         mrc p14, 0, r0, c11, c0, 0 @ XSCALE_TBREG
 637         bl send_to_debugger
 638         subs r1, r1, #1
 639         bne read_tb_loop
 640
 641         @ dump checkpoint register 0
 642         mrc p14, 0, r0, c12, c0, 0 @ XSCALE_CHKPT0 (0x10)
 643         bl send_to_debugger
 644
 645         @ dump checkpoint register 1
 646         mrc p14, 0, r0, c13, c0, 0 @ XSCALE_CHKPT1 (0x11)
 647         bl send_to_debugger
 648
 649         @ return
 650         b get_command
 651
 652 @ ----
 653
 654 clean_trace_buffer:
 655
 656         @ clean 256 entries from trace buffer
 657         mov     r1, #256
 658 clean_tb_loop:
 659         mrc p14, 0, r0, c11, c0, 0 @ XSCALE_TBREG
 660         subs r1, r1, #1
 661         bne clean_tb_loop
 662
 663         @ return
 664         b get_command
 665
 666 @ ----
 667
 668
 669 @ resume program execution with trace buffer enabled
 670 resume_w_trace:
 671         @ restore CPSR (SPSR_dbg)
 672         bl receive_from_debugger
 673         msr spsr, r0
 674
 675         @ restore registers (r7 - r0)
 676         bl receive_from_debugger @ r7
 677         mov r7, r0
 678         bl receive_from_debugger @ r6
 679         mov r6, r0
 680         bl receive_from_debugger @ r5
 681         mov r5, r0
 682         bl receive_from_debugger @ r4
 683         mov r4, r0
 684         bl receive_from_debugger @ r3
 685         mov r3, r0
 686         bl receive_from_debugger @ r2
 687         mov r2, r0
 688         bl receive_from_debugger @ r1
 689         mov r1, r0
 690         bl receive_from_debugger @ r0
 691
 692         @ resume addresss
 693         m_receive_from_debugger lr
 694
 695         mrc p14, 0, r13, c10, c0, 0 @ XSCALE_DCSR
 696         orr r13, r13, #1
 697         mcr p14, 0, r13, c10, c0, 0 @ XSCALE_DCSR
 698
 699         @ branch back to application code, restoring CPSR
 700         subs pc, lr, #0
 701
 702 undef_handler:
 703 swi_handler:
 704 prefetch_abort_handler:
 705 data_abort_handler:
 706 irq_handler:
 707 fiq_handler:
 708 1:
 709         b 1b
 710
 711 send_to_debugger:
 712         m_send_to_debugger r0
 713         mov pc, lr
 714
 715 receive_from_debugger:
 716         m_receive_from_debugger r0
 717         mov pc, lr
 718