satip-axe/kernel/arch/frv/lib/insl_ns.S
2015-03-26 17:24:57 +01:00

53 lines
1.3 KiB
ArmAsm

/* insl_ns.S: input array of 4b words from device port without byte swapping
*
* Copyright (C) 2003 Red Hat, Inc. All Rights Reserved.
* Written by David Howells (dhowells@redhat.com)
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version
* 2 of the License, or (at your option) any later version.
*/
.text
.p2align 4
###############################################################################
#
# void __insl_ns(unsigned int port, void *buf, int n)
#
###############################################################################
.globl __insl_ns
.type __insl_ns,@function
__insl_ns:
andicc.p gr9,#3,gr0,icc0
setlos #4,gr4
bne icc0,#0,__insl_ns_misaligned
subi gr9,#4,gr9
0:
ldi.p @(gr8,#0),gr5
subicc gr10,#1,gr10,icc0
stu.p gr5,@(gr9,gr4)
bhi icc0,#2,0b
bralr
__insl_ns_misaligned:
subi.p gr9,#1,gr9
setlos #1,gr4
0:
ldi @(gr8,#0),gr5
srli gr5,#24,gr6
stbu.p gr6,@(gr9,gr4)
srli gr5,#16,gr6
stbu.p gr6,@(gr9,gr4)
srli gr5,#8,gr6
stbu.p gr6,@(gr9,gr4)
subicc gr10,#1,gr10,icc0
stbu.p gr5,@(gr9,gr4)
bhi icc0,#2,0b
bralr
.size __insl_ns, .-__insl_ns