1 files changed, 46 insertions, 0 deletions

diff --git a/arch/arm64/lib/copy_page.S b/arch/arm64/lib/copy_page.S
new file mode 100644
index 00000000000..512b9a7b980
--- /dev/null
+++ b/arch/arm64/lib/copy_page.S
@@ -0,0 +1,46 @@
+/*
+ * Copyright (C) 2012 ARM Ltd.
+ *
+ * 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.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <linux/linkage.h>
+#include <linux/const.h>
+#include <asm/assembler.h>
+#include <asm/page.h>
+
+/*
+ * Copy a page from src to dest (both are page aligned)
+ *
+ * Parameters:
+ *      x0 - dest
+ *      x1 - src
+ */
+ENTRY(copy_page)
+        /* Assume cache line size is 64 bytes. */
+        prfm    pldl1strm, [x1, #64]
+1:      ldp     x2, x3, [x1]
+        ldp     x4, x5, [x1, #16]
+        ldp     x6, x7, [x1, #32]
+        ldp     x8, x9, [x1, #48]
+        add     x1, x1, #64
+        prfm    pldl1strm, [x1, #64]
+        stnp    x2, x3, [x0]
+        stnp    x4, x5, [x0, #16]
+        stnp    x6, x7, [x0, #32]
+        stnp    x8, x9, [x0, #48]
+        add     x0, x0, #64
+        tst     x1, #(PAGE_SIZE - 1)
+        b.ne    1b
+        ret
+ENDPROC(copy_page)