1/* NG2patch.S: Patch Ultra-I routines with Niagara-2 variant.
2 *
3 * Copyright (C) 2007 David S. Miller <davem@davemloft.net>
4 */
5
6#define BRANCH_ALWAYS	0x10680000
7#define NOP		0x01000000
8#define NG_DO_PATCH(OLD, NEW)	\
9	sethi	%hi(NEW), %g1; \
10	or	%g1, %lo(NEW), %g1; \
11	sethi	%hi(OLD), %g2; \
12	or	%g2, %lo(OLD), %g2; \
13	sub	%g1, %g2, %g1; \
14	sethi	%hi(BRANCH_ALWAYS), %g3; \
15	sll	%g1, 11, %g1; \
16	srl	%g1, 11 + 2, %g1; \
17	or	%g3, %lo(BRANCH_ALWAYS), %g3; \
18	or	%g3, %g1, %g3; \
19	stw	%g3, [%g2]; \
20	sethi	%hi(NOP), %g3; \
21	or	%g3, %lo(NOP), %g3; \
22	stw	%g3, [%g2 + 0x4]; \
23	flush	%g2;
24
25	.globl	niagara2_patch_copyops
26	.type	niagara2_patch_copyops,#function
27niagara2_patch_copyops:
28	NG_DO_PATCH(memcpy, NG2memcpy)
29	NG_DO_PATCH(___copy_from_user, NG2copy_from_user)
30	NG_DO_PATCH(___copy_to_user, NG2copy_to_user)
31	retl
32	 nop
33	.size	niagara2_patch_copyops,.-niagara2_patch_copyops
34