Merge branch 'intelfb-patches' of master.kernel.org:/pub/scm/linux/kernel/git/airlied...
[linux-2.6] / arch / ppc / kernel / misc.S
1 /*
2  * This file contains miscellaneous low-level functions.
3  *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
4  *
5  * Largely rewritten by Cort Dougan (cort@cs.nmt.edu)
6  * and Paul Mackerras.
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License
10  * as published by the Free Software Foundation; either version
11  * 2 of the License, or (at your option) any later version.
12  *
13  */
14
15 #include <linux/sys.h>
16 #include <asm/unistd.h>
17 #include <asm/errno.h>
18 #include <asm/processor.h>
19 #include <asm/page.h>
20 #include <asm/cache.h>
21 #include <asm/cputable.h>
22 #include <asm/mmu.h>
23 #include <asm/ppc_asm.h>
24 #include <asm/thread_info.h>
25 #include <asm/asm-offsets.h>
26
27 #ifdef CONFIG_8xx
28 #define ISYNC_8xx isync
29 #else
30 #define ISYNC_8xx
31 #endif
32         .text
33
34         .align  5
35 _GLOBAL(__delay)
36         cmpwi   0,r3,0
37         mtctr   r3
38         beqlr
39 1:      bdnz    1b
40         blr
41
42 /*
43  * Returns (address we're running at) - (address we were linked at)
44  * for use before the text and data are mapped to KERNELBASE.
45  */
46 _GLOBAL(reloc_offset)
47         mflr    r0
48         bl      1f
49 1:      mflr    r3
50         lis     r4,1b@ha
51         addi    r4,r4,1b@l
52         subf    r3,r4,r3
53         mtlr    r0
54         blr
55
56 /*
57  * add_reloc_offset(x) returns x + reloc_offset().
58  */
59 _GLOBAL(add_reloc_offset)
60         mflr    r0
61         bl      1f
62 1:      mflr    r5
63         lis     r4,1b@ha
64         addi    r4,r4,1b@l
65         subf    r5,r4,r5
66         add     r3,r3,r5
67         mtlr    r0
68         blr
69
70 /*
71  * sub_reloc_offset(x) returns x - reloc_offset().
72  */
73 _GLOBAL(sub_reloc_offset)
74         mflr    r0
75         bl      1f
76 1:      mflr    r5
77         lis     r4,1b@ha
78         addi    r4,r4,1b@l
79         subf    r5,r4,r5
80         subf    r3,r5,r3
81         mtlr    r0
82         blr
83
84 /*
85  * reloc_got2 runs through the .got2 section adding an offset
86  * to each entry.
87  */
88 _GLOBAL(reloc_got2)
89         mflr    r11
90         lis     r7,__got2_start@ha
91         addi    r7,r7,__got2_start@l
92         lis     r8,__got2_end@ha
93         addi    r8,r8,__got2_end@l
94         subf    r8,r7,r8
95         srwi.   r8,r8,2
96         beqlr
97         mtctr   r8
98         bl      1f
99 1:      mflr    r0
100         lis     r4,1b@ha
101         addi    r4,r4,1b@l
102         subf    r0,r4,r0
103         add     r7,r0,r7
104 2:      lwz     r0,0(r7)
105         add     r0,r0,r3
106         stw     r0,0(r7)
107         addi    r7,r7,4
108         bdnz    2b
109         mtlr    r11
110         blr
111
112 /*
113  * identify_cpu,
114  * called with r3 = data offset and r4 = CPU number
115  * doesn't change r3
116  */
117 _GLOBAL(identify_cpu)
118         addis   r8,r3,cpu_specs@ha
119         addi    r8,r8,cpu_specs@l
120         mfpvr   r7
121 1:
122         lwz     r5,CPU_SPEC_PVR_MASK(r8)
123         and     r5,r5,r7
124         lwz     r6,CPU_SPEC_PVR_VALUE(r8)
125         cmplw   0,r6,r5
126         beq     1f
127         addi    r8,r8,CPU_SPEC_ENTRY_SIZE
128         b       1b
129 1:
130         addis   r6,r3,cur_cpu_spec@ha
131         addi    r6,r6,cur_cpu_spec@l
132         sub     r8,r8,r3
133         stw     r8,0(r6)
134         blr
135
136 /*
137  * do_cpu_ftr_fixups - goes through the list of CPU feature fixups
138  * and writes nop's over sections of code that don't apply for this cpu.
139  * r3 = data offset (not changed)
140  */
141 _GLOBAL(do_cpu_ftr_fixups)
142         /* Get CPU 0 features */
143         addis   r6,r3,cur_cpu_spec@ha
144         addi    r6,r6,cur_cpu_spec@l
145         lwz     r4,0(r6)
146         add     r4,r4,r3
147         lwz     r4,CPU_SPEC_FEATURES(r4)
148
149         /* Get the fixup table */
150         addis   r6,r3,__start___ftr_fixup@ha
151         addi    r6,r6,__start___ftr_fixup@l
152         addis   r7,r3,__stop___ftr_fixup@ha
153         addi    r7,r7,__stop___ftr_fixup@l
154
155         /* Do the fixup */
156 1:      cmplw   0,r6,r7
157         bgelr
158         addi    r6,r6,16
159         lwz     r8,-16(r6)      /* mask */
160         and     r8,r8,r4
161         lwz     r9,-12(r6)      /* value */
162         cmplw   0,r8,r9
163         beq     1b
164         lwz     r8,-8(r6)       /* section begin */
165         lwz     r9,-4(r6)       /* section end */
166         subf.   r9,r8,r9
167         beq     1b
168         /* write nops over the section of code */
169         /* todo: if large section, add a branch at the start of it */
170         srwi    r9,r9,2
171         mtctr   r9
172         add     r8,r8,r3
173         lis     r0,0x60000000@h /* nop */
174 3:      stw     r0,0(r8)
175         andi.   r10,r4,CPU_FTR_SPLIT_ID_CACHE@l
176         beq     2f
177         dcbst   0,r8            /* suboptimal, but simpler */
178         sync
179         icbi    0,r8
180 2:      addi    r8,r8,4
181         bdnz    3b
182         sync                    /* additional sync needed on g4 */
183         isync
184         b       1b
185
186 /*
187  * call_setup_cpu - call the setup_cpu function for this cpu
188  * r3 = data offset, r24 = cpu number
189  *
190  * Setup function is called with:
191  *   r3 = data offset
192  *   r4 = ptr to CPU spec (relocated)
193  */
194 _GLOBAL(call_setup_cpu)
195         addis   r4,r3,cur_cpu_spec@ha
196         addi    r4,r4,cur_cpu_spec@l
197         lwz     r4,0(r4)
198         add     r4,r4,r3
199         lwz     r5,CPU_SPEC_SETUP(r4)
200         cmpi    0,r5,0
201         add     r5,r5,r3
202         beqlr
203         mtctr   r5
204         bctr
205
206 /*
207  * complement mask on the msr then "or" some values on.
208  *     _nmask_and_or_msr(nmask, value_to_or)
209  */
210 _GLOBAL(_nmask_and_or_msr)
211         mfmsr   r0              /* Get current msr */
212         andc    r0,r0,r3        /* And off the bits set in r3 (first parm) */
213         or      r0,r0,r4        /* Or on the bits in r4 (second parm) */
214         SYNC                    /* Some chip revs have problems here... */
215         mtmsr   r0              /* Update machine state */
216         isync
217         blr                     /* Done */
218
219
220 /*
221  * Flush MMU TLB
222  */
223 _GLOBAL(_tlbia)
224 #if defined(CONFIG_40x)
225         sync                    /* Flush to memory before changing mapping */
226         tlbia
227         isync                   /* Flush shadow TLB */
228 #elif defined(CONFIG_44x)
229         li      r3,0
230         sync
231
232         /* Load high watermark */
233         lis     r4,tlb_44x_hwater@ha
234         lwz     r5,tlb_44x_hwater@l(r4)
235
236 1:      tlbwe   r3,r3,PPC44x_TLB_PAGEID
237         addi    r3,r3,1
238         cmpw    0,r3,r5
239         ble     1b
240
241         isync
242 #elif defined(CONFIG_FSL_BOOKE)
243         /* Invalidate all entries in TLB0 */
244         li      r3, 0x04
245         tlbivax 0,3
246         /* Invalidate all entries in TLB1 */
247         li      r3, 0x0c
248         tlbivax 0,3
249         /* Invalidate all entries in TLB2 */
250         li      r3, 0x14
251         tlbivax 0,3
252         /* Invalidate all entries in TLB3 */
253         li      r3, 0x1c
254         tlbivax 0,3
255         msync
256 #ifdef CONFIG_SMP
257         tlbsync
258 #endif /* CONFIG_SMP */
259 #else /* !(CONFIG_40x || CONFIG_44x || CONFIG_FSL_BOOKE) */
260 #if defined(CONFIG_SMP)
261         rlwinm  r8,r1,0,0,18
262         lwz     r8,TI_CPU(r8)
263         oris    r8,r8,10
264         mfmsr   r10
265         SYNC
266         rlwinm  r0,r10,0,17,15          /* clear bit 16 (MSR_EE) */
267         rlwinm  r0,r0,0,28,26           /* clear DR */
268         mtmsr   r0
269         SYNC_601
270         isync
271         lis     r9,mmu_hash_lock@h
272         ori     r9,r9,mmu_hash_lock@l
273         tophys(r9,r9)
274 10:     lwarx   r7,0,r9
275         cmpwi   0,r7,0
276         bne-    10b
277         stwcx.  r8,0,r9
278         bne-    10b
279         sync
280         tlbia
281         sync
282         TLBSYNC
283         li      r0,0
284         stw     r0,0(r9)                /* clear mmu_hash_lock */
285         mtmsr   r10
286         SYNC_601
287         isync
288 #else /* CONFIG_SMP */
289         sync
290         tlbia
291         sync
292 #endif /* CONFIG_SMP */
293 #endif /* ! defined(CONFIG_40x) */
294         blr
295
296 /*
297  * Flush MMU TLB for a particular address
298  */
299 _GLOBAL(_tlbie)
300 #if defined(CONFIG_40x)
301         tlbsx.  r3, 0, r3
302         bne     10f
303         sync
304         /* There are only 64 TLB entries, so r3 < 64, which means bit 25 is clear.
305          * Since 25 is the V bit in the TLB_TAG, loading this value will invalidate
306          * the TLB entry. */
307         tlbwe   r3, r3, TLB_TAG
308         isync
309 10:
310 #elif defined(CONFIG_44x)
311         mfspr   r4,SPRN_MMUCR
312         mfspr   r5,SPRN_PID                     /* Get PID */
313         rlwimi  r4,r5,0,24,31                   /* Set TID */
314         mtspr   SPRN_MMUCR,r4
315
316         tlbsx.  r3, 0, r3
317         bne     10f
318         sync
319         /* There are only 64 TLB entries, so r3 < 64,
320          * which means bit 22, is clear.  Since 22 is
321          * the V bit in the TLB_PAGEID, loading this
322          * value will invalidate the TLB entry.
323          */
324         tlbwe   r3, r3, PPC44x_TLB_PAGEID
325         isync
326 10:
327 #elif defined(CONFIG_FSL_BOOKE)
328         rlwinm  r4, r3, 0, 0, 19
329         ori     r5, r4, 0x08    /* TLBSEL = 1 */
330         ori     r6, r4, 0x10    /* TLBSEL = 2 */
331         ori     r7, r4, 0x18    /* TLBSEL = 3 */
332         tlbivax 0, r4
333         tlbivax 0, r5
334         tlbivax 0, r6
335         tlbivax 0, r7
336         msync
337 #if defined(CONFIG_SMP)
338         tlbsync
339 #endif /* CONFIG_SMP */
340 #else /* !(CONFIG_40x || CONFIG_44x || CONFIG_FSL_BOOKE) */
341 #if defined(CONFIG_SMP)
342         rlwinm  r8,r1,0,0,18
343         lwz     r8,TI_CPU(r8)
344         oris    r8,r8,11
345         mfmsr   r10
346         SYNC
347         rlwinm  r0,r10,0,17,15          /* clear bit 16 (MSR_EE) */
348         rlwinm  r0,r0,0,28,26           /* clear DR */
349         mtmsr   r0
350         SYNC_601
351         isync
352         lis     r9,mmu_hash_lock@h
353         ori     r9,r9,mmu_hash_lock@l
354         tophys(r9,r9)
355 10:     lwarx   r7,0,r9
356         cmpwi   0,r7,0
357         bne-    10b
358         stwcx.  r8,0,r9
359         bne-    10b
360         eieio
361         tlbie   r3
362         sync
363         TLBSYNC
364         li      r0,0
365         stw     r0,0(r9)                /* clear mmu_hash_lock */
366         mtmsr   r10
367         SYNC_601
368         isync
369 #else /* CONFIG_SMP */
370         tlbie   r3
371         sync
372 #endif /* CONFIG_SMP */
373 #endif /* ! CONFIG_40x */
374         blr
375
376 /*
377  * Flush instruction cache.
378  * This is a no-op on the 601.
379  */
380 _GLOBAL(flush_instruction_cache)
381 #if defined(CONFIG_8xx)
382         isync
383         lis     r5, IDC_INVALL@h
384         mtspr   SPRN_IC_CST, r5
385 #elif defined(CONFIG_4xx)
386 #ifdef CONFIG_403GCX
387         li      r3, 512
388         mtctr   r3
389         lis     r4, KERNELBASE@h
390 1:      iccci   0, r4
391         addi    r4, r4, 16
392         bdnz    1b
393 #else
394         lis     r3, KERNELBASE@h
395         iccci   0,r3
396 #endif
397 #elif CONFIG_FSL_BOOKE
398 BEGIN_FTR_SECTION
399         mfspr   r3,SPRN_L1CSR0
400         ori     r3,r3,L1CSR0_CFI|L1CSR0_CLFC
401         /* msync; isync recommended here */
402         mtspr   SPRN_L1CSR0,r3
403         isync
404         blr
405 END_FTR_SECTION_IFCLR(CPU_FTR_SPLIT_ID_CACHE)
406         mfspr   r3,SPRN_L1CSR1
407         ori     r3,r3,L1CSR1_ICFI|L1CSR1_ICLFR
408         mtspr   SPRN_L1CSR1,r3
409 #else
410         mfspr   r3,SPRN_PVR
411         rlwinm  r3,r3,16,16,31
412         cmpwi   0,r3,1
413         beqlr                   /* for 601, do nothing */
414         /* 603/604 processor - use invalidate-all bit in HID0 */
415         mfspr   r3,SPRN_HID0
416         ori     r3,r3,HID0_ICFI
417         mtspr   SPRN_HID0,r3
418 #endif /* CONFIG_8xx/4xx */
419         isync
420         blr
421
422 /*
423  * Write any modified data cache blocks out to memory
424  * and invalidate the corresponding instruction cache blocks.
425  * This is a no-op on the 601.
426  *
427  * __flush_icache_range(unsigned long start, unsigned long stop)
428  */
429 _GLOBAL(__flush_icache_range)
430 BEGIN_FTR_SECTION
431         blr                             /* for 601, do nothing */
432 END_FTR_SECTION_IFCLR(CPU_FTR_SPLIT_ID_CACHE)
433         li      r5,L1_CACHE_BYTES-1
434         andc    r3,r3,r5
435         subf    r4,r3,r4
436         add     r4,r4,r5
437         srwi.   r4,r4,L1_CACHE_SHIFT
438         beqlr
439         mtctr   r4
440         mr      r6,r3
441 1:      dcbst   0,r3
442         addi    r3,r3,L1_CACHE_BYTES
443         bdnz    1b
444         sync                            /* wait for dcbst's to get to ram */
445         mtctr   r4
446 2:      icbi    0,r6
447         addi    r6,r6,L1_CACHE_BYTES
448         bdnz    2b
449         sync                            /* additional sync needed on g4 */
450         isync
451         blr
452 /*
453  * Write any modified data cache blocks out to memory.
454  * Does not invalidate the corresponding cache lines (especially for
455  * any corresponding instruction cache).
456  *
457  * clean_dcache_range(unsigned long start, unsigned long stop)
458  */
459 _GLOBAL(clean_dcache_range)
460         li      r5,L1_CACHE_BYTES-1
461         andc    r3,r3,r5
462         subf    r4,r3,r4
463         add     r4,r4,r5
464         srwi.   r4,r4,L1_CACHE_SHIFT
465         beqlr
466         mtctr   r4
467
468 1:      dcbst   0,r3
469         addi    r3,r3,L1_CACHE_BYTES
470         bdnz    1b
471         sync                            /* wait for dcbst's to get to ram */
472         blr
473
474 /*
475  * Write any modified data cache blocks out to memory and invalidate them.
476  * Does not invalidate the corresponding instruction cache blocks.
477  *
478  * flush_dcache_range(unsigned long start, unsigned long stop)
479  */
480 _GLOBAL(flush_dcache_range)
481         li      r5,L1_CACHE_BYTES-1
482         andc    r3,r3,r5
483         subf    r4,r3,r4
484         add     r4,r4,r5
485         srwi.   r4,r4,L1_CACHE_SHIFT
486         beqlr
487         mtctr   r4
488
489 1:      dcbf    0,r3
490         addi    r3,r3,L1_CACHE_BYTES
491         bdnz    1b
492         sync                            /* wait for dcbst's to get to ram */
493         blr
494
495 /*
496  * Like above, but invalidate the D-cache.  This is used by the 8xx
497  * to invalidate the cache so the PPC core doesn't get stale data
498  * from the CPM (no cache snooping here :-).
499  *
500  * invalidate_dcache_range(unsigned long start, unsigned long stop)
501  */
502 _GLOBAL(invalidate_dcache_range)
503         li      r5,L1_CACHE_BYTES-1
504         andc    r3,r3,r5
505         subf    r4,r3,r4
506         add     r4,r4,r5
507         srwi.   r4,r4,L1_CACHE_SHIFT
508         beqlr
509         mtctr   r4
510
511 1:      dcbi    0,r3
512         addi    r3,r3,L1_CACHE_BYTES
513         bdnz    1b
514         sync                            /* wait for dcbi's to get to ram */
515         blr
516
517 #ifdef CONFIG_NOT_COHERENT_CACHE
518 /*
519  * 40x cores have 8K or 16K dcache and 32 byte line size.
520  * 44x has a 32K dcache and 32 byte line size.
521  * 8xx has 1, 2, 4, 8K variants.
522  * For now, cover the worst case of the 44x.
523  * Must be called with external interrupts disabled.
524  */
525 #define CACHE_NWAYS     64
526 #define CACHE_NLINES    16
527
528 _GLOBAL(flush_dcache_all)
529         li      r4, (2 * CACHE_NWAYS * CACHE_NLINES)
530         mtctr   r4
531         lis     r5, KERNELBASE@h
532 1:      lwz     r3, 0(r5)               /* Load one word from every line */
533         addi    r5, r5, L1_CACHE_BYTES
534         bdnz    1b
535         blr
536 #endif /* CONFIG_NOT_COHERENT_CACHE */
537
538 /*
539  * Flush a particular page from the data cache to RAM.
540  * Note: this is necessary because the instruction cache does *not*
541  * snoop from the data cache.
542  * This is a no-op on the 601 which has a unified cache.
543  *
544  *      void __flush_dcache_icache(void *page)
545  */
546 _GLOBAL(__flush_dcache_icache)
547 BEGIN_FTR_SECTION
548         blr                                     /* for 601, do nothing */
549 END_FTR_SECTION_IFCLR(CPU_FTR_SPLIT_ID_CACHE)
550         rlwinm  r3,r3,0,0,19                    /* Get page base address */
551         li      r4,4096/L1_CACHE_BYTES  /* Number of lines in a page */
552         mtctr   r4
553         mr      r6,r3
554 0:      dcbst   0,r3                            /* Write line to ram */
555         addi    r3,r3,L1_CACHE_BYTES
556         bdnz    0b
557         sync
558         mtctr   r4
559 1:      icbi    0,r6
560         addi    r6,r6,L1_CACHE_BYTES
561         bdnz    1b
562         sync
563         isync
564         blr
565
566 /*
567  * Flush a particular page from the data cache to RAM, identified
568  * by its physical address.  We turn off the MMU so we can just use
569  * the physical address (this may be a highmem page without a kernel
570  * mapping).
571  *
572  *      void __flush_dcache_icache_phys(unsigned long physaddr)
573  */
574 _GLOBAL(__flush_dcache_icache_phys)
575 BEGIN_FTR_SECTION
576         blr                                     /* for 601, do nothing */
577 END_FTR_SECTION_IFCLR(CPU_FTR_SPLIT_ID_CACHE)
578         mfmsr   r10
579         rlwinm  r0,r10,0,28,26                  /* clear DR */
580         mtmsr   r0
581         isync
582         rlwinm  r3,r3,0,0,19                    /* Get page base address */
583         li      r4,4096/L1_CACHE_BYTES  /* Number of lines in a page */
584         mtctr   r4
585         mr      r6,r3
586 0:      dcbst   0,r3                            /* Write line to ram */
587         addi    r3,r3,L1_CACHE_BYTES
588         bdnz    0b
589         sync
590         mtctr   r4
591 1:      icbi    0,r6
592         addi    r6,r6,L1_CACHE_BYTES
593         bdnz    1b
594         sync
595         mtmsr   r10                             /* restore DR */
596         isync
597         blr
598
599 /*
600  * Clear pages using the dcbz instruction, which doesn't cause any
601  * memory traffic (except to write out any cache lines which get
602  * displaced).  This only works on cacheable memory.
603  *
604  * void clear_pages(void *page, int order) ;
605  */
606 _GLOBAL(clear_pages)
607         li      r0,4096/L1_CACHE_BYTES
608         slw     r0,r0,r4
609         mtctr   r0
610 #ifdef CONFIG_8xx
611         li      r4, 0
612 1:      stw     r4, 0(r3)
613         stw     r4, 4(r3)
614         stw     r4, 8(r3)
615         stw     r4, 12(r3)
616 #else
617 1:      dcbz    0,r3
618 #endif
619         addi    r3,r3,L1_CACHE_BYTES
620         bdnz    1b
621         blr
622
623 /*
624  * Copy a whole page.  We use the dcbz instruction on the destination
625  * to reduce memory traffic (it eliminates the unnecessary reads of
626  * the destination into cache).  This requires that the destination
627  * is cacheable.
628  */
629 #define COPY_16_BYTES           \
630         lwz     r6,4(r4);       \
631         lwz     r7,8(r4);       \
632         lwz     r8,12(r4);      \
633         lwzu    r9,16(r4);      \
634         stw     r6,4(r3);       \
635         stw     r7,8(r3);       \
636         stw     r8,12(r3);      \
637         stwu    r9,16(r3)
638
639 _GLOBAL(copy_page)
640         addi    r3,r3,-4
641         addi    r4,r4,-4
642
643 #ifdef CONFIG_8xx
644         /* don't use prefetch on 8xx */
645         li      r0,4096/L1_CACHE_BYTES
646         mtctr   r0
647 1:      COPY_16_BYTES
648         bdnz    1b
649         blr
650
651 #else   /* not 8xx, we can prefetch */
652         li      r5,4
653
654 #if MAX_COPY_PREFETCH > 1
655         li      r0,MAX_COPY_PREFETCH
656         li      r11,4
657         mtctr   r0
658 11:     dcbt    r11,r4
659         addi    r11,r11,L1_CACHE_BYTES
660         bdnz    11b
661 #else /* MAX_COPY_PREFETCH == 1 */
662         dcbt    r5,r4
663         li      r11,L1_CACHE_BYTES+4
664 #endif /* MAX_COPY_PREFETCH */
665         li      r0,4096/L1_CACHE_BYTES - MAX_COPY_PREFETCH
666         crclr   4*cr0+eq
667 2:
668         mtctr   r0
669 1:
670         dcbt    r11,r4
671         dcbz    r5,r3
672         COPY_16_BYTES
673 #if L1_CACHE_BYTES >= 32
674         COPY_16_BYTES
675 #if L1_CACHE_BYTES >= 64
676         COPY_16_BYTES
677         COPY_16_BYTES
678 #if L1_CACHE_BYTES >= 128
679         COPY_16_BYTES
680         COPY_16_BYTES
681         COPY_16_BYTES
682         COPY_16_BYTES
683 #endif
684 #endif
685 #endif
686         bdnz    1b
687         beqlr
688         crnot   4*cr0+eq,4*cr0+eq
689         li      r0,MAX_COPY_PREFETCH
690         li      r11,4
691         b       2b
692 #endif  /* CONFIG_8xx */
693
694 /*
695  * void atomic_clear_mask(atomic_t mask, atomic_t *addr)
696  * void atomic_set_mask(atomic_t mask, atomic_t *addr);
697  */
698 _GLOBAL(atomic_clear_mask)
699 10:     lwarx   r5,0,r4
700         andc    r5,r5,r3
701         PPC405_ERR77(0,r4)
702         stwcx.  r5,0,r4
703         bne-    10b
704         blr
705 _GLOBAL(atomic_set_mask)
706 10:     lwarx   r5,0,r4
707         or      r5,r5,r3
708         PPC405_ERR77(0,r4)
709         stwcx.  r5,0,r4
710         bne-    10b
711         blr
712
713 /*
714  * I/O string operations
715  *
716  * insb(port, buf, len)
717  * outsb(port, buf, len)
718  * insw(port, buf, len)
719  * outsw(port, buf, len)
720  * insl(port, buf, len)
721  * outsl(port, buf, len)
722  * insw_ns(port, buf, len)
723  * outsw_ns(port, buf, len)
724  * insl_ns(port, buf, len)
725  * outsl_ns(port, buf, len)
726  *
727  * The *_ns versions don't do byte-swapping.
728  */
729 _GLOBAL(_insb)
730         cmpwi   0,r5,0
731         mtctr   r5
732         subi    r4,r4,1
733         blelr-
734 00:     lbz     r5,0(r3)
735 01:     eieio
736 02:     stbu    r5,1(r4)
737         ISYNC_8xx
738         .section .fixup,"ax"
739 03:     blr
740         .text
741         .section __ex_table, "a"
742                 .align 2
743                 .long 00b, 03b
744                 .long 01b, 03b
745                 .long 02b, 03b
746         .text
747         bdnz    00b
748         blr
749
750 _GLOBAL(_outsb)
751         cmpwi   0,r5,0
752         mtctr   r5
753         subi    r4,r4,1
754         blelr-
755 00:     lbzu    r5,1(r4)
756 01:     stb     r5,0(r3)
757 02:     eieio
758         ISYNC_8xx
759         .section .fixup,"ax"
760 03:     blr
761         .text
762         .section __ex_table, "a"
763                 .align 2
764                 .long 00b, 03b
765                 .long 01b, 03b
766                 .long 02b, 03b
767         .text
768         bdnz    00b
769         blr
770
771 _GLOBAL(_insw_ns)
772         cmpwi   0,r5,0
773         mtctr   r5
774         subi    r4,r4,2
775         blelr-
776 00:     lhz     r5,0(r3)
777 01:     eieio
778 02:     sthu    r5,2(r4)
779         ISYNC_8xx
780         .section .fixup,"ax"
781 03:     blr
782         .text
783         .section __ex_table, "a"
784                 .align 2
785                 .long 00b, 03b
786                 .long 01b, 03b
787                 .long 02b, 03b
788         .text
789         bdnz    00b
790         blr
791
792 _GLOBAL(_outsw_ns)
793         cmpwi   0,r5,0
794         mtctr   r5
795         subi    r4,r4,2
796         blelr-
797 00:     lhzu    r5,2(r4)
798 01:     sth     r5,0(r3)
799 02:     eieio
800         ISYNC_8xx
801         .section .fixup,"ax"
802 03:     blr
803         .text
804         .section __ex_table, "a"
805                 .align 2
806                 .long 00b, 03b
807                 .long 01b, 03b
808                 .long 02b, 03b
809         .text
810         bdnz    00b
811         blr
812
813 _GLOBAL(_insl_ns)
814         cmpwi   0,r5,0
815         mtctr   r5
816         subi    r4,r4,4
817         blelr-
818 00:     lwz     r5,0(r3)
819 01:     eieio
820 02:     stwu    r5,4(r4)
821         ISYNC_8xx
822         .section .fixup,"ax"
823 03:     blr
824         .text
825         .section __ex_table, "a"
826                 .align 2
827                 .long 00b, 03b
828                 .long 01b, 03b
829                 .long 02b, 03b
830         .text
831         bdnz    00b
832         blr
833
834 _GLOBAL(_outsl_ns)
835         cmpwi   0,r5,0
836         mtctr   r5
837         subi    r4,r4,4
838         blelr-
839 00:     lwzu    r5,4(r4)
840 01:     stw     r5,0(r3)
841 02:     eieio
842         ISYNC_8xx
843         .section .fixup,"ax"
844 03:     blr
845         .text
846         .section __ex_table, "a"
847                 .align 2
848                 .long 00b, 03b
849                 .long 01b, 03b
850                 .long 02b, 03b
851         .text
852         bdnz    00b
853         blr
854
855 /*
856  * Extended precision shifts.
857  *
858  * Updated to be valid for shift counts from 0 to 63 inclusive.
859  * -- Gabriel
860  *
861  * R3/R4 has 64 bit value
862  * R5    has shift count
863  * result in R3/R4
864  *
865  *  ashrdi3: arithmetic right shift (sign propagation)  
866  *  lshrdi3: logical right shift
867  *  ashldi3: left shift
868  */
869 _GLOBAL(__ashrdi3)
870         subfic  r6,r5,32
871         srw     r4,r4,r5        # LSW = count > 31 ? 0 : LSW >> count
872         addi    r7,r5,32        # could be xori, or addi with -32
873         slw     r6,r3,r6        # t1 = count > 31 ? 0 : MSW << (32-count)
874         rlwinm  r8,r7,0,32      # t3 = (count < 32) ? 32 : 0
875         sraw    r7,r3,r7        # t2 = MSW >> (count-32)
876         or      r4,r4,r6        # LSW |= t1
877         slw     r7,r7,r8        # t2 = (count < 32) ? 0 : t2
878         sraw    r3,r3,r5        # MSW = MSW >> count
879         or      r4,r4,r7        # LSW |= t2
880         blr
881
882 _GLOBAL(__ashldi3)
883         subfic  r6,r5,32
884         slw     r3,r3,r5        # MSW = count > 31 ? 0 : MSW << count
885         addi    r7,r5,32        # could be xori, or addi with -32
886         srw     r6,r4,r6        # t1 = count > 31 ? 0 : LSW >> (32-count)
887         slw     r7,r4,r7        # t2 = count < 32 ? 0 : LSW << (count-32)
888         or      r3,r3,r6        # MSW |= t1
889         slw     r4,r4,r5        # LSW = LSW << count
890         or      r3,r3,r7        # MSW |= t2
891         blr
892
893 _GLOBAL(__lshrdi3)
894         subfic  r6,r5,32
895         srw     r4,r4,r5        # LSW = count > 31 ? 0 : LSW >> count
896         addi    r7,r5,32        # could be xori, or addi with -32
897         slw     r6,r3,r6        # t1 = count > 31 ? 0 : MSW << (32-count)
898         srw     r7,r3,r7        # t2 = count < 32 ? 0 : MSW >> (count-32)
899         or      r4,r4,r6        # LSW |= t1
900         srw     r3,r3,r5        # MSW = MSW >> count
901         or      r4,r4,r7        # LSW |= t2
902         blr
903
904 _GLOBAL(abs)
905         srawi   r4,r3,31
906         xor     r3,r3,r4
907         sub     r3,r3,r4
908         blr
909
910 _GLOBAL(_get_SP)
911         mr      r3,r1           /* Close enough */
912         blr
913
914 /*
915  * Create a kernel thread
916  *   kernel_thread(fn, arg, flags)
917  */
918 _GLOBAL(kernel_thread)
919         stwu    r1,-16(r1)
920         stw     r30,8(r1)
921         stw     r31,12(r1)
922         mr      r30,r3          /* function */
923         mr      r31,r4          /* argument */
924         ori     r3,r5,CLONE_VM  /* flags */
925         oris    r3,r3,CLONE_UNTRACED>>16
926         li      r4,0            /* new sp (unused) */
927         li      r0,__NR_clone
928         sc
929         cmpwi   0,r3,0          /* parent or child? */
930         bne     1f              /* return if parent */
931         li      r0,0            /* make top-level stack frame */
932         stwu    r0,-16(r1)
933         mtlr    r30             /* fn addr in lr */
934         mr      r3,r31          /* load arg and call fn */
935         PPC440EP_ERR42
936         blrl
937         li      r0,__NR_exit    /* exit if function returns */
938         li      r3,0
939         sc
940 1:      lwz     r30,8(r1)
941         lwz     r31,12(r1)
942         addi    r1,r1,16
943         blr
944
945 /*
946  * This routine is just here to keep GCC happy - sigh...
947  */
948 _GLOBAL(__main)
949         blr
950
951 #define SYSCALL(name) \
952 _GLOBAL(name) \
953         li      r0,__NR_##name; \
954         sc; \
955         bnslr; \
956         lis     r4,errno@ha; \
957         stw     r3,errno@l(r4); \
958         li      r3,-1; \
959         blr
960
961 SYSCALL(execve)