1/*
2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License as published by
4 * the Free Software Foundation; either version 2 of the License, or
5 * (at your option) any later version.
6 *
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
10 * GNU General Public License for more details.
11 *
12 * You should have received a copy of the GNU General Public License
13 * along with this program; if not, write to the Free Software
14 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
15 *
16 * Copyright (C) IBM Corporation, 2012
17 *
18 * Author: Anton Blanchard <anton@au.ibm.com>
19 */
20#include <asm/page.h>
21#include <asm/ppc_asm.h>
22
23_GLOBAL(copypage_power7)
24	/*
25	 * We prefetch both the source and destination using enhanced touch
26	 * instructions. We use a stream ID of 0 for the load side and
27	 * 1 for the store side. Since source and destination are page
28	 * aligned we don't need to clear the bottom 7 bits of either
29	 * address.
30	 */
31	ori	r9,r3,1		/* stream=1 => to */
32
33#ifdef CONFIG_PPC_64K_PAGES
34	lis	r7,0x0E01	/* depth=7
35				 * units/cachelines=512 */
36#else
37	lis	r7,0x0E00	/* depth=7 */
38	ori	r7,r7,0x1000	/* units/cachelines=32 */
39#endif
40	ori	r10,r7,1	/* stream=1 */
41
42	lis	r8,0x8000	/* GO=1 */
43	clrldi	r8,r8,32
44
45.machine push
46.machine "power4"
47	/* setup read stream 0  */
48	dcbt	r0,r4,0b01000  	/* addr from */
49	dcbt	r0,r7,0b01010   /* length and depth from */
50	/* setup write stream 1 */
51	dcbtst	r0,r9,0b01000   /* addr to */
52	dcbtst	r0,r10,0b01010  /* length and depth to */
53	eieio
54	dcbt	r0,r8,0b01010	/* all streams GO */
55.machine pop
56
57#ifdef CONFIG_ALTIVEC
58	mflr	r0
59	std	r3,48(r1)
60	std	r4,56(r1)
61	std	r0,16(r1)
62	stdu	r1,-STACKFRAMESIZE(r1)
63	bl	.enter_vmx_copy
64	cmpwi	r3,0
65	ld	r0,STACKFRAMESIZE+16(r1)
66	ld	r3,STACKFRAMESIZE+48(r1)
67	ld	r4,STACKFRAMESIZE+56(r1)
68	mtlr	r0
69
70	li	r0,(PAGE_SIZE/128)
71	mtctr	r0
72
73	beq	.Lnonvmx_copy
74
75	addi	r1,r1,STACKFRAMESIZE
76
77	li	r6,16
78	li	r7,32
79	li	r8,48
80	li	r9,64
81	li	r10,80
82	li	r11,96
83	li	r12,112
84
85	.align	5
861:	lvx	vr7,r0,r4
87	lvx	vr6,r4,r6
88	lvx	vr5,r4,r7
89	lvx	vr4,r4,r8
90	lvx	vr3,r4,r9
91	lvx	vr2,r4,r10
92	lvx	vr1,r4,r11
93	lvx	vr0,r4,r12
94	addi	r4,r4,128
95	stvx	vr7,r0,r3
96	stvx	vr6,r3,r6
97	stvx	vr5,r3,r7
98	stvx	vr4,r3,r8
99	stvx	vr3,r3,r9
100	stvx	vr2,r3,r10
101	stvx	vr1,r3,r11
102	stvx	vr0,r3,r12
103	addi	r3,r3,128
104	bdnz	1b
105
106	b	.exit_vmx_copy		/* tail call optimise */
107
108#else
109	li	r0,(PAGE_SIZE/128)
110	mtctr	r0
111
112	stdu	r1,-STACKFRAMESIZE(r1)
113#endif
114
115.Lnonvmx_copy:
116	std	r14,STK_REG(R14)(r1)
117	std	r15,STK_REG(R15)(r1)
118	std	r16,STK_REG(R16)(r1)
119	std	r17,STK_REG(R17)(r1)
120	std	r18,STK_REG(R18)(r1)
121	std	r19,STK_REG(R19)(r1)
122	std	r20,STK_REG(R20)(r1)
123
1241:	ld	r0,0(r4)
125	ld	r5,8(r4)
126	ld	r6,16(r4)
127	ld	r7,24(r4)
128	ld	r8,32(r4)
129	ld	r9,40(r4)
130	ld	r10,48(r4)
131	ld	r11,56(r4)
132	ld	r12,64(r4)
133	ld	r14,72(r4)
134	ld	r15,80(r4)
135	ld	r16,88(r4)
136	ld	r17,96(r4)
137	ld	r18,104(r4)
138	ld	r19,112(r4)
139	ld	r20,120(r4)
140	addi	r4,r4,128
141	std	r0,0(r3)
142	std	r5,8(r3)
143	std	r6,16(r3)
144	std	r7,24(r3)
145	std	r8,32(r3)
146	std	r9,40(r3)
147	std	r10,48(r3)
148	std	r11,56(r3)
149	std	r12,64(r3)
150	std	r14,72(r3)
151	std	r15,80(r3)
152	std	r16,88(r3)
153	std	r17,96(r3)
154	std	r18,104(r3)
155	std	r19,112(r3)
156	std	r20,120(r3)
157	addi	r3,r3,128
158	bdnz	1b
159
160	ld	r14,STK_REG(R14)(r1)
161	ld	r15,STK_REG(R15)(r1)
162	ld	r16,STK_REG(R16)(r1)
163	ld	r17,STK_REG(R17)(r1)
164	ld	r18,STK_REG(R18)(r1)
165	ld	r19,STK_REG(R19)(r1)
166	ld	r20,STK_REG(R20)(r1)
167	addi	r1,r1,STACKFRAMESIZE
168	blr
169