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

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