OpenCloudOS-Kernel/arch/frv/lib/outsl_ns.S

60 lines
1.3 KiB
ArmAsm
Raw Normal View History

/* outsl_ns.S: output array of 4b words to device 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 __outsl_ns(unsigned int port, const void *buf, int n)
#
###############################################################################
.globl __outsl_ns
.type __outsl_ns,@function
__outsl_ns:
andicc.p gr9,#3,gr0,icc0
setlos #4,gr4
bne icc0,#0,__outsl_ns_misaligned
subi gr9,#4,gr9
0:
ldu.p @(gr9,gr4),gr5
subicc gr10,#1,gr10,icc0
sti.p gr5,@(gr8,#0)
bhi icc0,#2,0b
membar
bralr
__outsl_ns_misaligned:
subi.p gr9,#1,gr9
setlos #1,gr4
0:
ldubu @(gr9,gr4),gr5
ldubu.p @(gr9,gr4),gr6
slli gr5,#8,gr5
ldubu.p @(gr9,gr4),gr7
or gr5,gr6,gr5
ldubu.p @(gr9,gr4),gr6
slli gr5,#16,gr5
slli.p gr7,#8,gr7
or gr5,gr6,gr5
subicc.p gr10,#1,gr10,icc0
or gr5,gr7,gr5
sti.p gr5,@(gr8,#0)
bhi icc0,#2,0b
membar
bralr
.size __outsl_ns, .-__outsl_ns