LXR linux/arch/arm/lib/io-writesw-armv3.S

   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