1 files changed, 38 insertions, 0 deletions

diff --git a/arch/avr32/lib/io-writesw.S b/arch/avr32/lib/io-writesw.S
new file mode 100644
index 000000000000..8c4a53f1c52a
--- /dev/null
+++ b/arch/avr32/lib/io-writesw.S
@@ -0,0 +1,38 @@
+/*
+ * Copyright (C) 2004-2006 Atmel Corporation
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+.Lnot_word_aligned:
+        ld.uh   r8, r11++
+        sub     r10, 1
+        st.h    r12[0], r8
+
+        .global __raw_writesw
+        .type   __raw_writesw,@function
+__raw_writesw:
+        cp.w    r10, 0
+        mov     r9, 3
+        reteq   r12
+        tst     r11, r9
+        brne    .Lnot_word_aligned
+
+        sub     r10, 2
+        brlt    2f
+
+1:      ld.w    r8, r11++
+        bfextu  r9, r8, 16, 16
+        st.h    r12[0], r9
+        st.h    r12[0], r8
+        sub     r10, 2
+        brge    1b
+
+2:      sub     r10, -2
+        reteq   r12
+
+        ld.uh   r8, r11++
+        st.h    r12[0], r8
+        retal   r12