1/* 2 * linux/arch/arm/lib/io-writesw-armv3.S 3 * 4 * Copyright (C) 1995-2000 Russell King 5 * 6 * This program is free software; you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License version 2 as 8 * published by the Free Software Foundation. 9 */ 10#include <linux/linkage.h> 11#include <asm/assembler.h> 12 13.Loutsw_bad_alignment: 14 adr r0, .Loutsw_bad_align_msg 15 mov r2, lr 16 b panic 17.Loutsw_bad_align_msg: 18 .asciz "outsw: bad buffer alignment (0x%p, lr=0x%08lX)\n" 19 .align 20 21.Loutsw_align: tst r1, #1 22 bne .Loutsw_bad_alignment 23 24 add r1, r1, #2 25 26 ldr r3, [r1, #-4] 27 mov r3, r3, lsr #16 28 orr r3, r3, r3, lsl #16 29 str r3, [r0] 30 subs r2, r2, #1 31 reteq lr 32 33ENTRY(__raw_writesw) 34 teq r2, #0 @ do we have to check for the zero len? 35 reteq lr 36 tst r1, #3 37 bne .Loutsw_align 38 39 stmfd sp!, {r4, r5, r6, lr} 40 41 subs r2, r2, #8 42 bmi .Lno_outsw_8 43 44.Loutsw_8_lp: ldmia r1!, {r3, r4, r5, r6} 45 46 mov ip, r3, lsl #16 47 orr ip, ip, ip, lsr #16 48 str ip, [r0] 49 50 mov ip, r3, lsr #16 51 orr ip, ip, ip, lsl #16 52 str ip, [r0] 53 54 mov ip, r4, lsl #16 55 orr ip, ip, ip, lsr #16 56 str ip, [r0] 57 58 mov ip, r4, lsr #16 59 orr ip, ip, ip, lsl #16 60 str ip, [r0] 61 62 mov ip, r5, lsl #16 63 orr ip, ip, ip, lsr #16 64 str ip, [r0] 65 66 mov ip, r5, lsr #16 67 orr ip, ip, ip, lsl #16 68 str ip, [r0] 69 70 mov ip, r6, lsl #16 71 orr ip, ip, ip, lsr #16 72 str ip, [r0] 73 74 mov ip, r6, lsr #16 75 orr ip, ip, ip, lsl #16 76 str ip, [r0] 77 78 subs r2, r2, #8 79 bpl .Loutsw_8_lp 80 81 tst r2, #7 82 ldmeqfd sp!, {r4, r5, r6, pc} 83 84.Lno_outsw_8: tst r2, #4 85 beq .Lno_outsw_4 86 87 ldmia r1!, {r3, r4} 88 89 mov ip, r3, lsl #16 90 orr ip, ip, ip, lsr #16 91 str ip, [r0] 92 93 mov ip, r3, lsr #16 94 orr ip, ip, ip, lsl #16 95 str ip, [r0] 96 97 mov ip, r4, lsl #16 98 orr ip, ip, ip, lsr #16 99 str ip, [r0] 100 101 mov ip, r4, lsr #16 102 orr ip, ip, ip, lsl #16 103 str ip, [r0] 104 105.Lno_outsw_4: tst r2, #2 106 beq .Lno_outsw_2 107 108 ldr r3, [r1], #4 109 110 mov ip, r3, lsl #16 111 orr ip, ip, ip, lsr #16 112 str ip, [r0] 113 114 mov ip, r3, lsr #16 115 orr ip, ip, ip, lsl #16 116 str ip, [r0] 117 118.Lno_outsw_2: tst r2, #1 119 120 ldrne r3, [r1] 121 122 movne ip, r3, lsl #16 123 orrne ip, ip, ip, lsr #16 124 strne ip, [r0] 125 126 ldmfd sp!, {r4, r5, r6, pc} 127