Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / arch / frv / lib / insl_sw.S

diff --git a/kernel/arch/frv/lib/insl_sw.S b/kernel/arch/frv/lib/insl_sw.S
new file mode 100644 (file)
index 0000000..9b5aa95
--- /dev/null
+++ b/kernel/arch/frv/lib/insl_sw.S
@@ -0,0 +1,40 @@
+/* insl_sw.S: input array of 4b words from device port with 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_sw(unsigned int port, void *buf, int n)
+#
+###############################################################################
+        .globl         __insl_sw
+        .type          __insl_sw,@function
+__insl_sw:
+       subi.p          gr9,#1,gr9
+       setlos          #1,gr4
+0:
+       ldi.p           @(gr8,#0),gr5           ; get 0xAABBCCDD
+       subicc          gr10,#1,gr10,icc0
+
+       stbu.p          gr5,@(gr9,gr4)          ; write 0xDD
+       srli            gr5,#8,gr5
+       stbu.p          gr5,@(gr9,gr4)          ; write 0xCC
+       srli            gr5,#8,gr5
+       stbu.p          gr5,@(gr9,gr4)          ; write 0xBB
+       srli            gr5,#8,gr5
+       stbu.p          gr5,@(gr9,gr4)          ; write 0xAA
+       bhi             icc0,#2,0b
+       bralr
+
+       .size           __insl_sw, .-__insl_sw