Merge branch 'topic/ali5451-cleanup' into for-linus
[pandora-kernel.git] / arch / mips / kernel / genex.S
1 /*
2  * This file is subject to the terms and conditions of the GNU General Public
3  * License.  See the file "COPYING" in the main directory of this archive
4  * for more details.
5  *
6  * Copyright (C) 1994 - 2000, 2001, 2003 Ralf Baechle
7  * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
8  * Copyright (C) 2001 MIPS Technologies, Inc.
9  * Copyright (C) 2002, 2007  Maciej W. Rozycki
10  */
11 #include <linux/init.h>
12
13 #include <asm/asm.h>
14 #include <asm/asmmacro.h>
15 #include <asm/cacheops.h>
16 #include <asm/irqflags.h>
17 #include <asm/regdef.h>
18 #include <asm/fpregdef.h>
19 #include <asm/mipsregs.h>
20 #include <asm/stackframe.h>
21 #include <asm/war.h>
22 #include <asm/page.h>
23 #include <asm/thread_info.h>
24
25 #define PANIC_PIC(msg)                                  \
26                 .set push;                              \
27                 .set    reorder;                        \
28                 PTR_LA  a0,8f;                          \
29                 .set    noat;                           \
30                 PTR_LA  AT, panic;                      \
31                 jr      AT;                             \
32 9:              b       9b;                             \
33                 .set    pop;                            \
34                 TEXT(msg)
35
36         __INIT
37
38 NESTED(except_vec0_generic, 0, sp)
39         PANIC_PIC("Exception vector 0 called")
40         END(except_vec0_generic)
41
42 NESTED(except_vec1_generic, 0, sp)
43         PANIC_PIC("Exception vector 1 called")
44         END(except_vec1_generic)
45
46 /*
47  * General exception vector for all other CPUs.
48  *
49  * Be careful when changing this, it has to be at most 128 bytes
50  * to fit into space reserved for the exception handler.
51  */
52 NESTED(except_vec3_generic, 0, sp)
53         .set    push
54         .set    noat
55 #if R5432_CP0_INTERRUPT_WAR
56         mfc0    k0, CP0_INDEX
57 #endif
58         mfc0    k1, CP0_CAUSE
59         andi    k1, k1, 0x7c
60 #ifdef CONFIG_64BIT
61         dsll    k1, k1, 1
62 #endif
63         PTR_L   k0, exception_handlers(k1)
64         jr      k0
65         .set    pop
66         END(except_vec3_generic)
67
68 /*
69  * General exception handler for CPUs with virtual coherency exception.
70  *
71  * Be careful when changing this, it has to be at most 256 (as a special
72  * exception) bytes to fit into space reserved for the exception handler.
73  */
74 NESTED(except_vec3_r4000, 0, sp)
75         .set    push
76         .set    mips3
77         .set    noat
78         mfc0    k1, CP0_CAUSE
79         li      k0, 31<<2
80         andi    k1, k1, 0x7c
81         .set    push
82         .set    noreorder
83         .set    nomacro
84         beq     k1, k0, handle_vced
85          li     k0, 14<<2
86         beq     k1, k0, handle_vcei
87 #ifdef CONFIG_64BIT
88          dsll   k1, k1, 1
89 #endif
90         .set    pop
91         PTR_L   k0, exception_handlers(k1)
92         jr      k0
93
94         /*
95          * Big shit, we now may have two dirty primary cache lines for the same
96          * physical address.  We can safely invalidate the line pointed to by
97          * c0_badvaddr because after return from this exception handler the
98          * load / store will be re-executed.
99          */
100 handle_vced:
101         MFC0    k0, CP0_BADVADDR
102         li      k1, -4                                  # Is this ...
103         and     k0, k1                                  # ... really needed?
104         mtc0    zero, CP0_TAGLO
105         cache   Index_Store_Tag_D, (k0)
106         cache   Hit_Writeback_Inv_SD, (k0)
107 #ifdef CONFIG_PROC_FS
108         PTR_LA  k0, vced_count
109         lw      k1, (k0)
110         addiu   k1, 1
111         sw      k1, (k0)
112 #endif
113         eret
114
115 handle_vcei:
116         MFC0    k0, CP0_BADVADDR
117         cache   Hit_Writeback_Inv_SD, (k0)              # also cleans pi
118 #ifdef CONFIG_PROC_FS
119         PTR_LA  k0, vcei_count
120         lw      k1, (k0)
121         addiu   k1, 1
122         sw      k1, (k0)
123 #endif
124         eret
125         .set    pop
126         END(except_vec3_r4000)
127
128         __FINIT
129
130         .align  5       /* 32 byte rollback region */
131 LEAF(r4k_wait)
132         .set    push
133         .set    noreorder
134         /* start of rollback region */
135         LONG_L  t0, TI_FLAGS($28)
136         nop
137         andi    t0, _TIF_NEED_RESCHED
138         bnez    t0, 1f
139          nop
140         nop
141         nop
142         .set    mips3
143         wait
144         /* end of rollback region (the region size must be power of two) */
145         .set    pop
146 1:
147         jr      ra
148         END(r4k_wait)
149
150         .macro  BUILD_ROLLBACK_PROLOGUE handler
151         FEXPORT(rollback_\handler)
152         .set    push
153         .set    noat
154         MFC0    k0, CP0_EPC
155         PTR_LA  k1, r4k_wait
156         ori     k0, 0x1f        /* 32 byte rollback region */
157         xori    k0, 0x1f
158         bne     k0, k1, 9f
159         MTC0    k0, CP0_EPC
160 9:
161         .set pop
162         .endm
163
164         .align  5
165 BUILD_ROLLBACK_PROLOGUE handle_int
166 NESTED(handle_int, PT_SIZE, sp)
167 #ifdef CONFIG_TRACE_IRQFLAGS
168         /*
169          * Check to see if the interrupted code has just disabled
170          * interrupts and ignore this interrupt for now if so.
171          *
172          * local_irq_disable() disables interrupts and then calls
173          * trace_hardirqs_off() to track the state. If an interrupt is taken
174          * after interrupts are disabled but before the state is updated
175          * it will appear to restore_all that it is incorrectly returning with
176          * interrupts disabled
177          */
178         .set    push
179         .set    noat
180         mfc0    k0, CP0_STATUS
181 #if defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
182         and     k0, ST0_IEP
183         bnez    k0, 1f
184
185         mfc0    k0, CP0_EPC
186         .set    noreorder
187         j       k0
188         rfe
189 #else
190         and     k0, ST0_IE
191         bnez    k0, 1f
192
193         eret
194 #endif
195 1:
196         .set pop
197 #endif
198         SAVE_ALL
199         CLI
200         TRACE_IRQS_OFF
201
202         LONG_L  s0, TI_REGS($28)
203         LONG_S  sp, TI_REGS($28)
204         PTR_LA  ra, ret_from_irq
205         j       plat_irq_dispatch
206         END(handle_int)
207
208         __INIT
209
210 /*
211  * Special interrupt vector for MIPS64 ISA & embedded MIPS processors.
212  * This is a dedicated interrupt exception vector which reduces the
213  * interrupt processing overhead.  The jump instruction will be replaced
214  * at the initialization time.
215  *
216  * Be careful when changing this, it has to be at most 128 bytes
217  * to fit into space reserved for the exception handler.
218  */
219 NESTED(except_vec4, 0, sp)
220 1:      j       1b                      /* Dummy, will be replaced */
221         END(except_vec4)
222
223 /*
224  * EJTAG debug exception handler.
225  * The EJTAG debug exception entry point is 0xbfc00480, which
226  * normally is in the boot PROM, so the boot PROM must do a
227  * unconditional jump to this vector.
228  */
229 NESTED(except_vec_ejtag_debug, 0, sp)
230         j       ejtag_debug_handler
231         END(except_vec_ejtag_debug)
232
233         __FINIT
234
235 /*
236  * Vectored interrupt handler.
237  * This prototype is copied to ebase + n*IntCtl.VS and patched
238  * to invoke the handler
239  */
240 BUILD_ROLLBACK_PROLOGUE except_vec_vi
241 NESTED(except_vec_vi, 0, sp)
242         SAVE_SOME
243         SAVE_AT
244         .set    push
245         .set    noreorder
246 #ifdef CONFIG_MIPS_MT_SMTC
247         /*
248          * To keep from blindly blocking *all* interrupts
249          * during service by SMTC kernel, we also want to
250          * pass the IM value to be cleared.
251          */
252 FEXPORT(except_vec_vi_mori)
253         ori     a0, $0, 0
254 #endif /* CONFIG_MIPS_MT_SMTC */
255 FEXPORT(except_vec_vi_lui)
256         lui     v0, 0           /* Patched */
257         j       except_vec_vi_handler
258 FEXPORT(except_vec_vi_ori)
259          ori    v0, 0           /* Patched */
260         .set    pop
261         END(except_vec_vi)
262 EXPORT(except_vec_vi_end)
263
264 /*
265  * Common Vectored Interrupt code
266  * Complete the register saves and invoke the handler which is passed in $v0
267  */
268 NESTED(except_vec_vi_handler, 0, sp)
269         SAVE_TEMP
270         SAVE_STATIC
271 #ifdef CONFIG_MIPS_MT_SMTC
272         /*
273          * SMTC has an interesting problem that interrupts are level-triggered,
274          * and the CLI macro will clear EXL, potentially causing a duplicate
275          * interrupt service invocation. So we need to clear the associated
276          * IM bit of Status prior to doing CLI, and restore it after the
277          * service routine has been invoked - we must assume that the
278          * service routine will have cleared the state, and any active
279          * level represents a new or otherwised unserviced event...
280          */
281         mfc0    t1, CP0_STATUS
282         and     t0, a0, t1
283 #ifdef CONFIG_MIPS_MT_SMTC_IM_BACKSTOP
284         mfc0    t2, CP0_TCCONTEXT
285         or      t2, t0, t2
286         mtc0    t2, CP0_TCCONTEXT
287 #endif /* CONFIG_MIPS_MT_SMTC_IM_BACKSTOP */
288         xor     t1, t1, t0
289         mtc0    t1, CP0_STATUS
290         _ehb
291 #endif /* CONFIG_MIPS_MT_SMTC */
292         CLI
293 #ifdef CONFIG_TRACE_IRQFLAGS
294         move    s0, v0
295 #ifdef CONFIG_MIPS_MT_SMTC
296         move    s1, a0
297 #endif
298         TRACE_IRQS_OFF
299 #ifdef CONFIG_MIPS_MT_SMTC
300         move    a0, s1
301 #endif
302         move    v0, s0
303 #endif
304
305         LONG_L  s0, TI_REGS($28)
306         LONG_S  sp, TI_REGS($28)
307         PTR_LA  ra, ret_from_irq
308         jr      v0
309         END(except_vec_vi_handler)
310
311 /*
312  * EJTAG debug exception handler.
313  */
314 NESTED(ejtag_debug_handler, PT_SIZE, sp)
315         .set    push
316         .set    noat
317         MTC0    k0, CP0_DESAVE
318         mfc0    k0, CP0_DEBUG
319
320         sll     k0, k0, 30      # Check for SDBBP.
321         bgez    k0, ejtag_return
322
323         PTR_LA  k0, ejtag_debug_buffer
324         LONG_S  k1, 0(k0)
325         SAVE_ALL
326         move    a0, sp
327         jal     ejtag_exception_handler
328         RESTORE_ALL
329         PTR_LA  k0, ejtag_debug_buffer
330         LONG_L  k1, 0(k0)
331
332 ejtag_return:
333         MFC0    k0, CP0_DESAVE
334         .set    mips32
335         deret
336         .set pop
337         END(ejtag_debug_handler)
338
339 /*
340  * This buffer is reserved for the use of the EJTAG debug
341  * handler.
342  */
343         .data
344 EXPORT(ejtag_debug_buffer)
345         .fill   LONGSIZE
346         .previous
347
348         __INIT
349
350 /*
351  * NMI debug exception handler for MIPS reference boards.
352  * The NMI debug exception entry point is 0xbfc00000, which
353  * normally is in the boot PROM, so the boot PROM must do a
354  * unconditional jump to this vector.
355  */
356 NESTED(except_vec_nmi, 0, sp)
357         j       nmi_handler
358         END(except_vec_nmi)
359
360         __FINIT
361
362 NESTED(nmi_handler, PT_SIZE, sp)
363         .set    push
364         .set    noat
365         SAVE_ALL
366         move    a0, sp
367         jal     nmi_exception_handler
368         RESTORE_ALL
369         .set    mips3
370         eret
371         .set    pop
372         END(nmi_handler)
373
374         .macro  __build_clear_none
375         .endm
376
377         .macro  __build_clear_sti
378         TRACE_IRQS_ON
379         STI
380         .endm
381
382         .macro  __build_clear_cli
383         CLI
384         TRACE_IRQS_OFF
385         .endm
386
387         .macro  __build_clear_fpe
388         .set    push
389         /* gas fails to assemble cfc1 for some archs (octeon).*/ \
390         .set    mips1
391         cfc1    a1, fcr31
392         li      a2, ~(0x3f << 12)
393         and     a2, a1
394         ctc1    a2, fcr31
395         .set    pop
396         TRACE_IRQS_ON
397         STI
398         .endm
399
400         .macro  __build_clear_ade
401         MFC0    t0, CP0_BADVADDR
402         PTR_S   t0, PT_BVADDR(sp)
403         KMODE
404         .endm
405
406         .macro  __BUILD_silent exception
407         .endm
408
409         /* Gas tries to parse the PRINT argument as a string containing
410            string escapes and emits bogus warnings if it believes to
411            recognize an unknown escape code.  So make the arguments
412            start with an n and gas will believe \n is ok ...  */
413         .macro  __BUILD_verbose nexception
414         LONG_L  a1, PT_EPC(sp)
415 #ifdef CONFIG_32BIT
416         PRINT("Got \nexception at %08lx\012")
417 #endif
418 #ifdef CONFIG_64BIT
419         PRINT("Got \nexception at %016lx\012")
420 #endif
421         .endm
422
423         .macro  __BUILD_count exception
424         LONG_L  t0,exception_count_\exception
425         LONG_ADDIU t0, 1
426         LONG_S  t0,exception_count_\exception
427         .comm   exception_count\exception, 8, 8
428         .endm
429
430         .macro  __BUILD_HANDLER exception handler clear verbose ext
431         .align  5
432         NESTED(handle_\exception, PT_SIZE, sp)
433         .set    noat
434         SAVE_ALL
435         FEXPORT(handle_\exception\ext)
436         __BUILD_clear_\clear
437         .set    at
438         __BUILD_\verbose \exception
439         move    a0, sp
440         PTR_LA  ra, ret_from_exception
441         j       do_\handler
442         END(handle_\exception)
443         .endm
444
445         .macro  BUILD_HANDLER exception handler clear verbose
446         __BUILD_HANDLER \exception \handler \clear \verbose _int
447         .endm
448
449         BUILD_HANDLER adel ade ade silent               /* #4  */
450         BUILD_HANDLER ades ade ade silent               /* #5  */
451         BUILD_HANDLER ibe be cli silent                 /* #6  */
452         BUILD_HANDLER dbe be cli silent                 /* #7  */
453         BUILD_HANDLER bp bp sti silent                  /* #9  */
454         BUILD_HANDLER ri ri sti silent                  /* #10 */
455         BUILD_HANDLER cpu cpu sti silent                /* #11 */
456         BUILD_HANDLER ov ov sti silent                  /* #12 */
457         BUILD_HANDLER tr tr sti silent                  /* #13 */
458         BUILD_HANDLER fpe fpe fpe silent                /* #15 */
459         BUILD_HANDLER mdmx mdmx sti silent              /* #22 */
460 #ifdef  CONFIG_HARDWARE_WATCHPOINTS
461         /*
462          * For watch, interrupts will be enabled after the watch
463          * registers are read.
464          */
465         BUILD_HANDLER watch watch cli silent            /* #23 */
466 #else
467         BUILD_HANDLER watch watch sti verbose           /* #23 */
468 #endif
469         BUILD_HANDLER mcheck mcheck cli verbose         /* #24 */
470         BUILD_HANDLER mt mt sti silent                  /* #25 */
471         BUILD_HANDLER dsp dsp sti silent                /* #26 */
472         BUILD_HANDLER reserved reserved sti verbose     /* others */
473
474         .align  5
475         LEAF(handle_ri_rdhwr_vivt)
476 #ifdef CONFIG_MIPS_MT_SMTC
477         PANIC_PIC("handle_ri_rdhwr_vivt called")
478 #else
479         .set    push
480         .set    noat
481         .set    noreorder
482         /* check if TLB contains a entry for EPC */
483         MFC0    k1, CP0_ENTRYHI
484         andi    k1, 0xff        /* ASID_MASK */
485         MFC0    k0, CP0_EPC
486         PTR_SRL k0, PAGE_SHIFT + 1
487         PTR_SLL k0, PAGE_SHIFT + 1
488         or      k1, k0
489         MTC0    k1, CP0_ENTRYHI
490         mtc0_tlbw_hazard
491         tlbp
492         tlb_probe_hazard
493         mfc0    k1, CP0_INDEX
494         .set    pop
495         bltz    k1, handle_ri   /* slow path */
496         /* fall thru */
497 #endif
498         END(handle_ri_rdhwr_vivt)
499
500         LEAF(handle_ri_rdhwr)
501         .set    push
502         .set    noat
503         .set    noreorder
504         /* 0x7c03e83b: rdhwr v1,$29 */
505         MFC0    k1, CP0_EPC
506         lui     k0, 0x7c03
507         lw      k1, (k1)
508         ori     k0, 0xe83b
509         .set    reorder
510         bne     k0, k1, handle_ri       /* if not ours */
511         /* The insn is rdhwr.  No need to check CAUSE.BD here. */
512         get_saved_sp    /* k1 := current_thread_info */
513         .set    noreorder
514         MFC0    k0, CP0_EPC
515 #if defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
516         ori     k1, _THREAD_MASK
517         xori    k1, _THREAD_MASK
518         LONG_L  v1, TI_TP_VALUE(k1)
519         LONG_ADDIU      k0, 4
520         jr      k0
521          rfe
522 #else
523 #ifndef CONFIG_CPU_DADDI_WORKAROUNDS
524         LONG_ADDIU      k0, 4           /* stall on $k0 */
525 #else
526         .set    at=v1
527         LONG_ADDIU      k0, 4
528         .set    noat
529 #endif
530         MTC0    k0, CP0_EPC
531         /* I hope three instructions between MTC0 and ERET are enough... */
532         ori     k1, _THREAD_MASK
533         xori    k1, _THREAD_MASK
534         LONG_L  v1, TI_TP_VALUE(k1)
535         .set    mips3
536         eret
537         .set    mips0
538 #endif
539         .set    pop
540         END(handle_ri_rdhwr)
541
542 #ifdef CONFIG_64BIT
543 /* A temporary overflow handler used by check_daddi(). */
544
545         __INIT
546
547         BUILD_HANDLER  daddi_ov daddi_ov none silent    /* #12 */
548 #endif