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