Merge branch 'master' into upstream-fixes
[linux-2.6] / arch / frv / kernel / break.S
1 /* break.S: Break interrupt handling (kept separate from entry.S)
2  *
3  * Copyright (C) 2003 Red Hat, Inc. All Rights Reserved.
4  * Written by David Howells (dhowells@redhat.com)
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License
8  * as published by the Free Software Foundation; either version
9  * 2 of the License, or (at your option) any later version.
10  */
11
12 #include <linux/linkage.h>
13 #include <asm/setup.h>
14 #include <asm/segment.h>
15 #include <asm/ptrace.h>
16 #include <asm/thread_info.h>
17 #include <asm/spr-regs.h>
18
19 #include <asm/errno.h>
20
21 #
22 # the break handler has its own stack
23 #
24         .section        .bss.stack
25         .globl          __break_user_context
26         .balign         THREAD_SIZE
27 __break_stack:
28         .space          THREAD_SIZE - FRV_FRAME0_SIZE
29 __break_frame_0:
30         .space          FRV_FRAME0_SIZE
31
32 #
33 # miscellaneous variables
34 #
35         .section        .bss
36 #ifdef CONFIG_MMU
37         .globl          __break_tlb_miss_real_return_info
38 __break_tlb_miss_real_return_info:
39         .balign         8
40         .space          2*4                     /* saved PCSR, PSR for TLB-miss handler fixup */
41 #endif
42
43 __break_trace_through_exceptions:
44         .space          4
45
46 #define CS2_ECS1        0xe1200000
47 #define CS2_USERLED     0x4
48
49 .macro LEDS val,reg
50 #       sethi.p         %hi(CS2_ECS1+CS2_USERLED),gr30
51 #       setlo           %lo(CS2_ECS1+CS2_USERLED),gr30
52 #       setlos          #~\val,\reg
53 #       st              \reg,@(gr30,gr0)
54 #       setlos          #0x5555,\reg
55 #       sethi.p         %hi(0xffc00100),gr30
56 #       setlo           %lo(0xffc00100),gr30
57 #       sth             \reg,@(gr30,gr0)
58 #       membar
59 .endm
60
61 ###############################################################################
62 #
63 # entry point for Break Exceptions/Interrupts
64 #
65 ###############################################################################
66         .section        .text.break
67         .balign         4
68         .globl          __entry_break
69 __entry_break:
70 #ifdef CONFIG_MMU
71         movgs           gr31,scr3
72 #endif
73         LEDS            0x1001,gr31
74
75         sethi.p         %hi(__break_frame_0),gr31
76         setlo           %lo(__break_frame_0),gr31
77
78         stdi            gr2,@(gr31,#REG_GR(2))
79         movsg           ccr,gr3
80         sti             gr3,@(gr31,#REG_CCR)
81
82         # catch the return from a TLB-miss handler that had single-step disabled
83         # traps will be enabled, so we have to do this now
84 #ifdef CONFIG_MMU
85         movsg           bpcsr,gr3
86         sethi.p         %hi(__break_tlb_miss_return_breaks_here),gr2
87         setlo           %lo(__break_tlb_miss_return_breaks_here),gr2
88         subcc           gr2,gr3,gr0,icc0
89         beq             icc0,#2,__break_return_singlestep_tlbmiss
90 #endif
91
92         # determine whether we have stepped through into an exception
93         # - we need to take special action to suspend h/w single stepping if we've done
94         #   that, so that the gdbstub doesn't get bogged down endlessly stepping through
95         #   external interrupt handling
96         movsg           bpsr,gr3
97         andicc          gr3,#BPSR_BET,gr0,icc0
98         bne             icc0,#2,__break_maybe_userspace /* jump if PSR.ET was 1 */
99
100         LEDS            0x1003,gr2
101
102         movsg           brr,gr3
103         andicc          gr3,#BRR_ST,gr0,icc0
104         andicc.p        gr3,#BRR_SB,gr0,icc1
105         bne             icc0,#2,__break_step            /* jump if single-step caused break */
106         beq             icc1,#2,__break_continue        /* jump if BREAK didn't cause break */
107
108         LEDS            0x1007,gr2
109
110         # handle special breaks
111         movsg           bpcsr,gr3
112
113         sethi.p         %hi(__entry_return_singlestep_breaks_here),gr2
114         setlo           %lo(__entry_return_singlestep_breaks_here),gr2
115         subcc           gr2,gr3,gr0,icc0
116         beq             icc0,#2,__break_return_singlestep
117
118         bra             __break_continue
119
120
121 ###############################################################################
122 #
123 # handle BREAK instruction in kernel-mode exception epilogue
124 #
125 ###############################################################################
126 __break_return_singlestep:
127         LEDS            0x100f,gr2
128
129         # special break insn requests single-stepping to be turned back on
130         #               HERE            RETT
131         # PSR.ET        0               0
132         # PSR.PS        old PSR.S       ?
133         # PSR.S         1               1
134         # BPSR.ET       0               1 (can't have caused orig excep otherwise)
135         # BPSR.BS       1               old PSR.S
136         movsg           dcr,gr2
137         sethi.p         %hi(DCR_SE),gr3
138         setlo           %lo(DCR_SE),gr3
139         or              gr2,gr3,gr2
140         movgs           gr2,dcr
141
142         movsg           psr,gr2
143         andi            gr2,#PSR_PS,gr2
144         slli            gr2,#11,gr2                     /* PSR.PS -> BPSR.BS */
145         ori             gr2,#BPSR_BET,gr2               /* 1 -> BPSR.BET */
146         movgs           gr2,bpsr
147
148         # return to the invoker of the original kernel exception
149         movsg           pcsr,gr2
150         movgs           gr2,bpcsr
151
152         LEDS            0x101f,gr2
153
154         ldi             @(gr31,#REG_CCR),gr3
155         movgs           gr3,ccr
156         lddi.p          @(gr31,#REG_GR(2)),gr2
157         xor             gr31,gr31,gr31
158         movgs           gr0,brr
159 #ifdef CONFIG_MMU
160         movsg           scr3,gr31
161 #endif
162         rett            #1
163
164 ###############################################################################
165 #
166 # handle BREAK instruction in TLB-miss handler return path
167 #
168 ###############################################################################
169 #ifdef CONFIG_MMU
170 __break_return_singlestep_tlbmiss:
171         LEDS            0x1100,gr2
172
173         sethi.p         %hi(__break_tlb_miss_real_return_info),gr3
174         setlo           %lo(__break_tlb_miss_real_return_info),gr3
175         lddi            @(gr3,#0),gr2
176         movgs           gr2,pcsr
177         movgs           gr3,psr
178
179         bra             __break_return_singlestep
180 #endif
181
182
183 ###############################################################################
184 #
185 # handle single stepping into an exception prologue from kernel mode
186 # - we try and catch it whilst it is still in the main vector table
187 # - if we catch it there, we have to jump to the fixup handler
188 #   - there is a fixup table that has a pointer for every 16b slot in the trap
189 #     table
190 #
191 ###############################################################################
192 __break_step:
193         LEDS            0x2003,gr2
194
195         # external interrupts seem to escape from the trap table before single
196         # step catches up with them
197         movsg           bpcsr,gr2
198         sethi.p         %hi(__entry_kernel_external_interrupt),gr3
199         setlo           %lo(__entry_kernel_external_interrupt),gr3
200         subcc.p         gr2,gr3,gr0,icc0
201         sethi           %hi(__entry_uspace_external_interrupt),gr3
202         setlo.p         %lo(__entry_uspace_external_interrupt),gr3
203         beq             icc0,#2,__break_step_kernel_external_interrupt
204         subcc.p         gr2,gr3,gr0,icc0
205         sethi           %hi(__entry_kernel_external_interrupt_virtually_disabled),gr3
206         setlo.p         %lo(__entry_kernel_external_interrupt_virtually_disabled),gr3
207         beq             icc0,#2,__break_step_uspace_external_interrupt
208         subcc.p         gr2,gr3,gr0,icc0
209         sethi           %hi(__entry_kernel_external_interrupt_virtual_reenable),gr3
210         setlo.p         %lo(__entry_kernel_external_interrupt_virtual_reenable),gr3
211         beq             icc0,#2,__break_step_kernel_external_interrupt_virtually_disabled
212         subcc           gr2,gr3,gr0,icc0
213         beq             icc0,#2,__break_step_kernel_external_interrupt_virtual_reenable
214
215         LEDS            0x2007,gr2
216
217         # the two main vector tables are adjacent on one 8Kb slab
218         movsg           bpcsr,gr2
219         setlos          #0xffffe000,gr3
220         and             gr2,gr3,gr2
221         sethi.p         %hi(__trap_tables),gr3
222         setlo           %lo(__trap_tables),gr3
223         subcc           gr2,gr3,gr0,icc0
224         bne             icc0,#2,__break_continue
225
226         LEDS            0x200f,gr2
227
228         # skip workaround if so requested by GDB
229         sethi.p         %hi(__break_trace_through_exceptions),gr3
230         setlo           %lo(__break_trace_through_exceptions),gr3
231         ld              @(gr3,gr0),gr3
232         subcc           gr3,gr0,gr0,icc0
233         bne             icc0,#0,__break_continue
234
235         LEDS            0x201f,gr2
236
237         # access the fixup table - there's a 1:1 mapping between the slots in the trap tables and
238         # the slots in the trap fixup tables allowing us to simply divide the offset into the
239         # former by 4 to access the latter
240         sethi.p         %hi(__trap_tables),gr3
241         setlo           %lo(__trap_tables),gr3
242         movsg           bpcsr,gr2
243         sub             gr2,gr3,gr2
244         srli.p          gr2,#2,gr2
245
246         sethi           %hi(__trap_fixup_tables),gr3
247         setlo.p         %lo(__trap_fixup_tables),gr3
248         andi            gr2,#~3,gr2
249         ld              @(gr2,gr3),gr2
250         jmpil           @(gr2,#0)
251
252 # step through an internal exception from kernel mode
253         .globl          __break_step_kernel_softprog_interrupt
254 __break_step_kernel_softprog_interrupt:
255         sethi.p         %hi(__entry_kernel_softprog_interrupt_reentry),gr3
256         setlo           %lo(__entry_kernel_softprog_interrupt_reentry),gr3
257         bra             __break_return_as_kernel_prologue
258
259 # step through an external interrupt from kernel mode
260         .globl          __break_step_kernel_external_interrupt
261 __break_step_kernel_external_interrupt:
262         # deal with virtual interrupt disablement
263         beq             icc2,#0,__break_step_kernel_external_interrupt_virtually_disabled
264
265         sethi.p         %hi(__entry_kernel_external_interrupt_reentry),gr3
266         setlo           %lo(__entry_kernel_external_interrupt_reentry),gr3
267
268 __break_return_as_kernel_prologue:
269         LEDS            0x203f,gr2
270
271         movgs           gr3,bpcsr
272
273         # do the bit we had to skip
274 #ifdef CONFIG_MMU
275         movsg           ear0,gr2                /* EAR0 can get clobbered by gdb-stub (ICI/ICEI) */
276         movgs           gr2,scr2
277 #endif
278
279         or.p            sp,gr0,gr2              /* set up the stack pointer */
280         subi            sp,#REG__END,sp
281         sti.p           gr2,@(sp,#REG_SP)
282
283         setlos          #REG__STATUS_STEP,gr2
284         sti             gr2,@(sp,#REG__STATUS)          /* record single step status */
285
286         # cancel single-stepping mode
287         movsg           dcr,gr2
288         sethi.p         %hi(~DCR_SE),gr3
289         setlo           %lo(~DCR_SE),gr3
290         and             gr2,gr3,gr2
291         movgs           gr2,dcr
292
293         LEDS            0x207f,gr2
294
295         ldi             @(gr31,#REG_CCR),gr3
296         movgs           gr3,ccr
297         lddi.p          @(gr31,#REG_GR(2)),gr2
298         xor             gr31,gr31,gr31
299         movgs           gr0,brr
300 #ifdef CONFIG_MMU
301         movsg           scr3,gr31
302 #endif
303         rett            #1
304
305 # we single-stepped into an interrupt handler whilst interrupts were merely virtually disabled
306 # need to really disable interrupts, set flag, fix up and return
307 __break_step_kernel_external_interrupt_virtually_disabled:
308         movsg           psr,gr2
309         andi            gr2,#~PSR_PIL,gr2
310         ori             gr2,#PSR_PIL_14,gr2     /* debugging interrupts only */
311         movgs           gr2,psr
312
313         ldi             @(gr31,#REG_CCR),gr3
314         movgs           gr3,ccr
315         subcc.p         gr0,gr0,gr0,icc2        /* leave Z set, clear C */
316
317         # exceptions must've been enabled and we must've been in supervisor mode
318         setlos          BPSR_BET|BPSR_BS,gr3
319         movgs           gr3,bpsr
320
321         # return to where the interrupt happened
322         movsg           pcsr,gr2
323         movgs           gr2,bpcsr
324
325         lddi.p          @(gr31,#REG_GR(2)),gr2
326
327         xor             gr31,gr31,gr31
328         movgs           gr0,brr
329 #ifdef CONFIG_MMU
330         movsg           scr3,gr31
331 #endif
332         rett            #1
333
334 # we stepped through into the virtual interrupt reenablement trap
335 #
336 # we also want to single step anyway, but after fixing up so that we get an event on the
337 # instruction after the broken-into exception returns
338         .globl          __break_step_kernel_external_interrupt_virtual_reenable
339 __break_step_kernel_external_interrupt_virtual_reenable:
340         movsg           psr,gr2
341         andi            gr2,#~PSR_PIL,gr2
342         movgs           gr2,psr
343
344         ldi             @(gr31,#REG_CCR),gr3
345         movgs           gr3,ccr
346         subicc          gr0,#1,gr0,icc2         /* clear Z, set C */
347
348         # save the adjusted ICC2
349         movsg           ccr,gr3
350         sti             gr3,@(gr31,#REG_CCR)
351
352         # exceptions must've been enabled and we must've been in supervisor mode
353         setlos          BPSR_BET|BPSR_BS,gr3
354         movgs           gr3,bpsr
355
356         # return to where the trap happened
357         movsg           pcsr,gr2
358         movgs           gr2,bpcsr
359
360         # and then process the single step
361         bra             __break_continue
362
363 # step through an internal exception from uspace mode
364         .globl          __break_step_uspace_softprog_interrupt
365 __break_step_uspace_softprog_interrupt:
366         sethi.p         %hi(__entry_uspace_softprog_interrupt_reentry),gr3
367         setlo           %lo(__entry_uspace_softprog_interrupt_reentry),gr3
368         bra             __break_return_as_uspace_prologue
369
370 # step through an external interrupt from kernel mode
371         .globl          __break_step_uspace_external_interrupt
372 __break_step_uspace_external_interrupt:
373         sethi.p         %hi(__entry_uspace_external_interrupt_reentry),gr3
374         setlo           %lo(__entry_uspace_external_interrupt_reentry),gr3
375
376 __break_return_as_uspace_prologue:
377         LEDS            0x20ff,gr2
378
379         movgs           gr3,bpcsr
380
381         # do the bit we had to skip
382         sethi.p         %hi(__kernel_frame0_ptr),gr28
383         setlo           %lo(__kernel_frame0_ptr),gr28
384         ldi.p           @(gr28,#0),gr28
385
386         setlos          #REG__STATUS_STEP,gr2
387         sti             gr2,@(gr28,#REG__STATUS)        /* record single step status */
388
389         # cancel single-stepping mode
390         movsg           dcr,gr2
391         sethi.p         %hi(~DCR_SE),gr3
392         setlo           %lo(~DCR_SE),gr3
393         and             gr2,gr3,gr2
394         movgs           gr2,dcr
395
396         LEDS            0x20fe,gr2
397
398         ldi             @(gr31,#REG_CCR),gr3
399         movgs           gr3,ccr
400         lddi.p          @(gr31,#REG_GR(2)),gr2
401         xor             gr31,gr31,gr31
402         movgs           gr0,brr
403 #ifdef CONFIG_MMU
404         movsg           scr3,gr31
405 #endif
406         rett            #1
407
408 #ifdef CONFIG_MMU
409 # step through an ITLB-miss handler from user mode
410         .globl          __break_user_insn_tlb_miss
411 __break_user_insn_tlb_miss:
412         # we'll want to try the trap stub again
413         sethi.p         %hi(__trap_user_insn_tlb_miss),gr2
414         setlo           %lo(__trap_user_insn_tlb_miss),gr2
415         movgs           gr2,bpcsr
416
417 __break_tlb_miss_common:
418         LEDS            0x2101,gr2
419
420         # cancel single-stepping mode
421         movsg           dcr,gr2
422         sethi.p         %hi(~DCR_SE),gr3
423         setlo           %lo(~DCR_SE),gr3
424         and             gr2,gr3,gr2
425         movgs           gr2,dcr
426
427         # we'll swap the real return address for one with a BREAK insn so that we can re-enable
428         # single stepping on return
429         movsg           pcsr,gr2
430         sethi.p         %hi(__break_tlb_miss_real_return_info),gr3
431         setlo           %lo(__break_tlb_miss_real_return_info),gr3
432         sti             gr2,@(gr3,#0)
433
434         sethi.p         %hi(__break_tlb_miss_return_break),gr2
435         setlo           %lo(__break_tlb_miss_return_break),gr2
436         movgs           gr2,pcsr
437
438         # we also have to fudge PSR because the return BREAK is in kernel space and we want
439         # to get a BREAK fault not an access violation should the return be to userspace
440         movsg           psr,gr2
441         sti.p           gr2,@(gr3,#4)
442         ori             gr2,#PSR_PS,gr2
443         movgs           gr2,psr
444
445         LEDS            0x2102,gr2
446
447         ldi             @(gr31,#REG_CCR),gr3
448         movgs           gr3,ccr
449         lddi            @(gr31,#REG_GR(2)),gr2
450         movsg           scr3,gr31
451         movgs           gr0,brr
452         rett            #1
453
454 # step through a DTLB-miss handler from user mode
455         .globl          __break_user_data_tlb_miss
456 __break_user_data_tlb_miss:
457         # we'll want to try the trap stub again
458         sethi.p         %hi(__trap_user_data_tlb_miss),gr2
459         setlo           %lo(__trap_user_data_tlb_miss),gr2
460         movgs           gr2,bpcsr
461         bra             __break_tlb_miss_common
462
463 # step through an ITLB-miss handler from kernel mode
464         .globl          __break_kernel_insn_tlb_miss
465 __break_kernel_insn_tlb_miss:
466         # we'll want to try the trap stub again
467         sethi.p         %hi(__trap_kernel_insn_tlb_miss),gr2
468         setlo           %lo(__trap_kernel_insn_tlb_miss),gr2
469         movgs           gr2,bpcsr
470         bra             __break_tlb_miss_common
471
472 # step through a DTLB-miss handler from kernel mode
473         .globl          __break_kernel_data_tlb_miss
474 __break_kernel_data_tlb_miss:
475         # we'll want to try the trap stub again
476         sethi.p         %hi(__trap_kernel_data_tlb_miss),gr2
477         setlo           %lo(__trap_kernel_data_tlb_miss),gr2
478         movgs           gr2,bpcsr
479         bra             __break_tlb_miss_common
480 #endif
481
482 ###############################################################################
483 #
484 # handle debug events originating with userspace
485 #
486 ###############################################################################
487 __break_maybe_userspace:
488         LEDS            0x3003,gr2
489
490         setlos          #BPSR_BS,gr2
491         andcc           gr3,gr2,gr0,icc0
492         bne             icc0,#0,__break_continue        /* skip if PSR.S was 1 */
493
494         movsg           brr,gr2
495         andicc          gr2,#BRR_ST|BRR_SB,gr0,icc0
496         beq             icc0,#0,__break_continue        /* jump if not BREAK or single-step */
497
498         LEDS            0x3007,gr2
499
500         # do the first part of the exception prologue here
501         sethi.p         %hi(__kernel_frame0_ptr),gr28
502         setlo           %lo(__kernel_frame0_ptr),gr28
503         ldi             @(gr28,#0),gr28
504         andi            gr28,#~7,gr28
505
506         # set up the kernel stack pointer
507         sti             sp  ,@(gr28,#REG_SP)
508         ori             gr28,0,sp
509         sti             gr0 ,@(gr28,#REG_GR(28))
510
511         stdi            gr20,@(gr28,#REG_GR(20))
512         stdi            gr22,@(gr28,#REG_GR(22))
513
514         movsg           tbr,gr20
515         movsg           bpcsr,gr21
516         movsg           psr,gr22
517
518         # determine the exception type and cancel single-stepping mode
519         or              gr0,gr0,gr23
520
521         movsg           dcr,gr2
522         sethi.p         %hi(DCR_SE),gr3
523         setlo           %lo(DCR_SE),gr3
524         andcc           gr2,gr3,gr0,icc0
525         beq             icc0,#0,__break_no_user_sstep   /* must have been a BREAK insn */
526
527         not             gr3,gr3
528         and             gr2,gr3,gr2
529         movgs           gr2,dcr
530         ori             gr23,#REG__STATUS_STEP,gr23
531
532 __break_no_user_sstep:
533         LEDS            0x300f,gr2
534
535         movsg           brr,gr2
536         andi            gr2,#BRR_ST|BRR_SB,gr2
537         slli            gr2,#1,gr2
538         or              gr23,gr2,gr23
539         sti.p           gr23,@(gr28,#REG__STATUS)       /* record single step status */
540
541         # adjust the value acquired from TBR - this indicates the exception
542         setlos          #~TBR_TT,gr2
543         and.p           gr20,gr2,gr20
544         setlos          #TBR_TT_BREAK,gr2
545         or.p            gr20,gr2,gr20
546
547         # fudge PSR.PS and BPSR.BS to return to kernel mode through the trap
548         # table as trap 126
549         andi            gr22,#~PSR_PS,gr22              /* PSR.PS should be 0 */
550         movgs           gr22,psr
551
552         setlos          #BPSR_BS,gr2                    /* BPSR.BS should be 1 and BPSR.BET 0 */
553         movgs           gr2,bpsr
554
555         # return through remainder of the exception prologue
556         # - need to load gr23 with return handler address
557         sethi.p         %hi(__entry_return_from_user_exception),gr23
558         setlo           %lo(__entry_return_from_user_exception),gr23
559         sethi.p         %hi(__entry_common),gr3
560         setlo           %lo(__entry_common),gr3
561         movgs           gr3,bpcsr
562
563         LEDS            0x301f,gr2
564
565         ldi             @(gr31,#REG_CCR),gr3
566         movgs           gr3,ccr
567         lddi.p          @(gr31,#REG_GR(2)),gr2
568         xor             gr31,gr31,gr31
569         movgs           gr0,brr
570 #ifdef CONFIG_MMU
571         movsg           scr3,gr31
572 #endif
573         rett            #1
574
575 ###############################################################################
576 #
577 # resume normal debug-mode entry
578 #
579 ###############################################################################
580 __break_continue:
581         LEDS            0x4003,gr2
582
583         # set up the kernel stack pointer
584         sti             sp,@(gr31,#REG_SP)
585
586         sethi.p         %hi(__break_frame_0),sp
587         setlo           %lo(__break_frame_0),sp
588
589         # finish building the exception frame
590         stdi            gr4 ,@(gr31,#REG_GR(4))
591         stdi            gr6 ,@(gr31,#REG_GR(6))
592         stdi            gr8 ,@(gr31,#REG_GR(8))
593         stdi            gr10,@(gr31,#REG_GR(10))
594         stdi            gr12,@(gr31,#REG_GR(12))
595         stdi            gr14,@(gr31,#REG_GR(14))
596         stdi            gr16,@(gr31,#REG_GR(16))
597         stdi            gr18,@(gr31,#REG_GR(18))
598         stdi            gr20,@(gr31,#REG_GR(20))
599         stdi            gr22,@(gr31,#REG_GR(22))
600         stdi            gr24,@(gr31,#REG_GR(24))
601         stdi            gr26,@(gr31,#REG_GR(26))
602         sti             gr0 ,@(gr31,#REG_GR(28))        /* NULL frame pointer */
603         sti             gr29,@(gr31,#REG_GR(29))
604         sti             gr30,@(gr31,#REG_GR(30))
605         sti             gr8 ,@(gr31,#REG_ORIG_GR8)
606
607 #ifdef CONFIG_MMU
608         movsg           scr3,gr19
609         sti             gr19,@(gr31,#REG_GR(31))
610 #endif
611
612         movsg           bpsr ,gr19
613         movsg           tbr  ,gr20
614         movsg           bpcsr,gr21
615         movsg           psr  ,gr22
616         movsg           isr  ,gr23
617         movsg           cccr ,gr25
618         movsg           lr   ,gr26
619         movsg           lcr  ,gr27
620
621         andi.p          gr22,#~(PSR_S|PSR_ET),gr5       /* rebuild PSR */
622         andi            gr19,#PSR_ET,gr4
623         or.p            gr4,gr5,gr5
624         srli            gr19,#10,gr4
625         andi            gr4,#PSR_S,gr4
626         or.p            gr4,gr5,gr5
627
628         setlos          #-1,gr6
629         sti             gr20,@(gr31,#REG_TBR)
630         sti             gr21,@(gr31,#REG_PC)
631         sti             gr5 ,@(gr31,#REG_PSR)
632         sti             gr23,@(gr31,#REG_ISR)
633         sti             gr25,@(gr31,#REG_CCCR)
634         stdi            gr26,@(gr31,#REG_LR)
635         sti             gr6 ,@(gr31,#REG_SYSCALLNO)
636
637         # store CPU-specific regs
638         movsg           iacc0h,gr4
639         movsg           iacc0l,gr5
640         stdi            gr4,@(gr31,#REG_IACC0)
641
642         movsg           gner0,gr4
643         movsg           gner1,gr5
644         stdi            gr4,@(gr31,#REG_GNER0)
645
646         # build the debug register frame
647         movsg           brr,gr4
648         movgs           gr0,brr
649         movsg           nmar,gr5
650         movsg           dcr,gr6
651
652         sethi.p         %hi(__debug_status),gr7
653         setlo           %lo(__debug_status),gr7
654
655         stdi            gr4 ,@(gr7,#DEBUG_BRR)
656         sti             gr19,@(gr7,#DEBUG_BPSR)
657         sti.p           gr6 ,@(gr7,#DEBUG_DCR)
658
659         # trap exceptions during break handling and disable h/w breakpoints/watchpoints
660         sethi           %hi(DCR_EBE),gr5
661         setlo.p         %lo(DCR_EBE),gr5
662         sethi           %hi(__entry_breaktrap_table),gr4
663         setlo           %lo(__entry_breaktrap_table),gr4
664         movgs           gr5,dcr
665         movgs           gr4,tbr
666
667         # set up kernel global registers
668         sethi.p         %hi(__kernel_current_task),gr5
669         setlo           %lo(__kernel_current_task),gr5
670         ld              @(gr5,gr0),gr29
671         ldi.p           @(gr29,#4),gr15         ; __current_thread_info = current->thread_info
672
673         sethi           %hi(_gp),gr16
674         setlo.p         %lo(_gp),gr16
675
676         # make sure we (the kernel) get div-zero and misalignment exceptions
677         setlos          #ISR_EDE|ISR_DTT_DIVBYZERO|ISR_EMAM_EXCEPTION,gr5
678         movgs           gr5,isr
679
680         # enter the GDB stub
681         LEDS            0x4007,gr2
682
683         or.p            gr0,gr0,fp
684         call            debug_stub
685
686         LEDS            0x403f,gr2
687
688         # return from break
689         lddi            @(gr31,#REG_IACC0),gr4
690         movgs           gr4,iacc0h
691         movgs           gr5,iacc0l
692
693         lddi            @(gr31,#REG_GNER0),gr4
694         movgs           gr4,gner0
695         movgs           gr5,gner1
696
697         lddi            @(gr31,#REG_LR)  ,gr26
698         lddi            @(gr31,#REG_CCR) ,gr24
699         lddi            @(gr31,#REG_PSR) ,gr22
700         ldi             @(gr31,#REG_PC)  ,gr21
701         ldi             @(gr31,#REG_TBR) ,gr20
702
703         sethi.p         %hi(__debug_status),gr6
704         setlo           %lo(__debug_status),gr6
705         ldi.p           @(gr6,#DEBUG_DCR) ,gr6
706
707         andi            gr22,#PSR_S,gr19                /* rebuild BPSR */
708         andi.p          gr22,#PSR_ET,gr5
709         slli            gr19,#10,gr19
710         or              gr5,gr19,gr19
711
712         movgs           gr6 ,dcr
713         movgs           gr19,bpsr
714         movgs           gr20,tbr
715         movgs           gr21,bpcsr
716         movgs           gr23,isr
717         movgs           gr24,ccr
718         movgs           gr25,cccr
719         movgs           gr26,lr
720         movgs           gr27,lcr
721
722         LEDS            0x407f,gr2
723
724 #ifdef CONFIG_MMU
725         ldi             @(gr31,#REG_GR(31)),gr2
726         movgs           gr2,scr3
727 #endif
728
729         ldi             @(gr31,#REG_GR(30)),gr30
730         ldi             @(gr31,#REG_GR(29)),gr29
731         lddi            @(gr31,#REG_GR(26)),gr26
732         lddi            @(gr31,#REG_GR(24)),gr24
733         lddi            @(gr31,#REG_GR(22)),gr22
734         lddi            @(gr31,#REG_GR(20)),gr20
735         lddi            @(gr31,#REG_GR(18)),gr18
736         lddi            @(gr31,#REG_GR(16)),gr16
737         lddi            @(gr31,#REG_GR(14)),gr14
738         lddi            @(gr31,#REG_GR(12)),gr12
739         lddi            @(gr31,#REG_GR(10)),gr10
740         lddi            @(gr31,#REG_GR(8)) ,gr8
741         lddi            @(gr31,#REG_GR(6)) ,gr6
742         lddi            @(gr31,#REG_GR(4)) ,gr4
743         lddi            @(gr31,#REG_GR(2)) ,gr2
744         ldi.p           @(gr31,#REG_SP)    ,sp
745
746         xor             gr31,gr31,gr31
747         movgs           gr0,brr
748 #ifdef CONFIG_MMU
749         movsg           scr3,gr31
750 #endif
751         rett            #1
752
753 ###################################################################################################
754 #
755 # GDB stub "system calls"
756 #
757 ###################################################################################################
758
759 #ifdef CONFIG_GDBSTUB
760         # void gdbstub_console_write(struct console *con, const char *p, unsigned n)
761         .globl          gdbstub_console_write
762 gdbstub_console_write:
763         break
764         bralr
765 #endif
766
767         # GDB stub BUG() trap
768         # GR8 is the proposed signal number
769         .globl          __debug_bug_trap
770 __debug_bug_trap:
771         break
772         bralr
773
774         # transfer kernel exeception to GDB for handling
775         .globl          __break_hijack_kernel_event
776 __break_hijack_kernel_event:
777         break
778         .globl          __break_hijack_kernel_event_breaks_here
779 __break_hijack_kernel_event_breaks_here:
780         nop
781
782 #ifdef CONFIG_MMU
783         # handle a return from TLB-miss that requires single-step reactivation
784         .globl          __break_tlb_miss_return_break
785 __break_tlb_miss_return_break:
786         break
787 __break_tlb_miss_return_breaks_here:
788         nop
789 #endif
790
791         # guard the first .text label in the next file from confusion
792         nop