1*4882a593Smuzhiyun/* SPDX-License-Identifier: GPL-2.0-only */ 2*4882a593Smuzhiyun/* 3*4882a593Smuzhiyun * linux/arch/arm/lib/io-writesw-armv4.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 .macro outword, rd 11*4882a593Smuzhiyun#ifndef __ARMEB__ 12*4882a593Smuzhiyun strh \rd, [r0] 13*4882a593Smuzhiyun mov \rd, \rd, lsr #16 14*4882a593Smuzhiyun strh \rd, [r0] 15*4882a593Smuzhiyun#else 16*4882a593Smuzhiyun mov lr, \rd, lsr #16 17*4882a593Smuzhiyun strh lr, [r0] 18*4882a593Smuzhiyun strh \rd, [r0] 19*4882a593Smuzhiyun#endif 20*4882a593Smuzhiyun .endm 21*4882a593Smuzhiyun 22*4882a593Smuzhiyun.Loutsw_align: movs ip, r1, lsl #31 23*4882a593Smuzhiyun bne .Loutsw_noalign 24*4882a593Smuzhiyun 25*4882a593Smuzhiyun ldrh r3, [r1], #2 26*4882a593Smuzhiyun sub r2, r2, #1 27*4882a593Smuzhiyun strh r3, [r0] 28*4882a593Smuzhiyun 29*4882a593SmuzhiyunENTRY(__raw_writesw) 30*4882a593Smuzhiyun teq r2, #0 31*4882a593Smuzhiyun reteq lr 32*4882a593Smuzhiyun ands r3, r1, #3 33*4882a593Smuzhiyun bne .Loutsw_align 34*4882a593Smuzhiyun 35*4882a593Smuzhiyun stmfd sp!, {r4, r5, lr} 36*4882a593Smuzhiyun 37*4882a593Smuzhiyun subs r2, r2, #8 38*4882a593Smuzhiyun bmi .Lno_outsw_8 39*4882a593Smuzhiyun 40*4882a593Smuzhiyun.Loutsw_8_lp: ldmia r1!, {r3, r4, r5, ip} 41*4882a593Smuzhiyun subs r2, r2, #8 42*4882a593Smuzhiyun outword r3 43*4882a593Smuzhiyun outword r4 44*4882a593Smuzhiyun outword r5 45*4882a593Smuzhiyun outword ip 46*4882a593Smuzhiyun bpl .Loutsw_8_lp 47*4882a593Smuzhiyun 48*4882a593Smuzhiyun.Lno_outsw_8: tst r2, #4 49*4882a593Smuzhiyun beq .Lno_outsw_4 50*4882a593Smuzhiyun 51*4882a593Smuzhiyun ldmia r1!, {r3, ip} 52*4882a593Smuzhiyun outword r3 53*4882a593Smuzhiyun outword ip 54*4882a593Smuzhiyun 55*4882a593Smuzhiyun.Lno_outsw_4: movs r2, r2, lsl #31 56*4882a593Smuzhiyun bcc .Lno_outsw_2 57*4882a593Smuzhiyun 58*4882a593Smuzhiyun ldr r3, [r1], #4 59*4882a593Smuzhiyun outword r3 60*4882a593Smuzhiyun 61*4882a593Smuzhiyun.Lno_outsw_2: ldrhne r3, [r1] 62*4882a593Smuzhiyun strhne r3, [r0] 63*4882a593Smuzhiyun 64*4882a593Smuzhiyun ldmfd sp!, {r4, r5, pc} 65*4882a593Smuzhiyun 66*4882a593Smuzhiyun#ifdef __ARMEB__ 67*4882a593Smuzhiyun#define pull_hbyte0 lsl #8 68*4882a593Smuzhiyun#define push_hbyte1 lsr #24 69*4882a593Smuzhiyun#else 70*4882a593Smuzhiyun#define pull_hbyte0 lsr #24 71*4882a593Smuzhiyun#define push_hbyte1 lsl #8 72*4882a593Smuzhiyun#endif 73*4882a593Smuzhiyun 74*4882a593Smuzhiyun.Loutsw_noalign: 75*4882a593Smuzhiyun ARM( ldr r3, [r1, -r3]! ) 76*4882a593Smuzhiyun THUMB( rsb r3, r3, #0 ) 77*4882a593Smuzhiyun THUMB( ldr r3, [r1, r3] ) 78*4882a593Smuzhiyun THUMB( sub r1, r3 ) 79*4882a593Smuzhiyun subcs r2, r2, #1 80*4882a593Smuzhiyun bcs 2f 81*4882a593Smuzhiyun subs r2, r2, #2 82*4882a593Smuzhiyun bmi 3f 83*4882a593Smuzhiyun 84*4882a593Smuzhiyun1: mov ip, r3, lsr #8 85*4882a593Smuzhiyun strh ip, [r0] 86*4882a593Smuzhiyun2: mov ip, r3, pull_hbyte0 87*4882a593Smuzhiyun ldr r3, [r1, #4]! 88*4882a593Smuzhiyun subs r2, r2, #2 89*4882a593Smuzhiyun orr ip, ip, r3, push_hbyte1 90*4882a593Smuzhiyun strh ip, [r0] 91*4882a593Smuzhiyun bpl 1b 92*4882a593Smuzhiyun 93*4882a593Smuzhiyun tst r2, #1 94*4882a593Smuzhiyun3: movne ip, r3, lsr #8 95*4882a593Smuzhiyun strhne ip, [r0] 96*4882a593Smuzhiyun ret lr 97*4882a593SmuzhiyunENDPROC(__raw_writesw) 98