Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 99739611 authored by Kevin Hao's avatar Kevin Hao Committed by Scott Wood
Browse files

powerpc/fsl_booke: introduce get_phys_addr function 



Move the codes which translate a effective address to physical address
to a separate function. So it can be reused by other code.

Signed-off-by: default avatarKevin Hao <haokexin@gmail.com>
Signed-off-by: default avatarScott Wood <scottwood@freescale.com>
parent 7c732cba

arch/powerpc/kernel/head_fsl_booke.S

+30 −20
Original line number Diff line number Diff line
@@ -65,26 +65,9 @@ _ENTRY(_start); 
	nop



	/* Translate device tree address to physical, save in r30/r31 */

	mfmsr	r16

	mfspr	r17,SPRN_PID

	rlwinm	r17,r17,16,0x3fff0000	/* turn PID into MAS6[SPID] */

	rlwimi	r17,r16,28,0x00000001	/* turn MSR[DS] into MAS6[SAS] */

	mtspr	SPRN_MAS6,r17



	tlbsx	0,r3			/* must succeed */



	mfspr	r16,SPRN_MAS1

	mfspr	r20,SPRN_MAS3

	rlwinm	r17,r16,25,0x1f		/* r17 = log2(page size) */

	li	r18,1024

	slw	r18,r18,r17		/* r18 = page size */

	addi	r18,r18,-1

	and	r19,r3,r18		/* r19 = page offset */

	andc	r31,r20,r18		/* r31 = page base */

	or	r31,r31,r19		/* r31 = devtree phys addr */

#ifdef CONFIG_PHYS_64BIT

	mfspr	r30,SPRN_MAS7

#endif

	bl	get_phys_addr

	mr	r30,r3

	mr	r31,r4



	li	r25,0			/* phys kernel start (low) */

	li	r24,0			/* CPU number */
@@ -857,6 +840,33 @@ KernelSPE: 


#endif /* CONFIG_SPE */



/*

 * Translate the effec addr in r3 to phys addr. The phys addr will be put

 * into r3(higher 32bit) and r4(lower 32bit)

 */

get_phys_addr:

	mfmsr	r8

	mfspr	r9,SPRN_PID

	rlwinm	r9,r9,16,0x3fff0000	/* turn PID into MAS6[SPID] */

	rlwimi	r9,r8,28,0x00000001	/* turn MSR[DS] into MAS6[SAS] */

	mtspr	SPRN_MAS6,r9



	tlbsx	0,r3			/* must succeed */



	mfspr	r8,SPRN_MAS1

	mfspr	r12,SPRN_MAS3

	rlwinm	r9,r8,25,0x1f		/* r9 = log2(page size) */

	li	r10,1024

	slw	r10,r10,r9		/* r10 = page size */

	addi	r10,r10,-1

	and	r11,r3,r10		/* r11 = page offset */

	andc	r4,r12,r10		/* r4 = page base */

	or	r4,r4,r11		/* r4 = devtree phys addr */

#ifdef CONFIG_PHYS_64BIT

	mfspr	r3,SPRN_MAS7

#endif

	blr



/*

 * Global functions

 */