[linux-2.6-block.git] / arch / powerpc / kernel / cpu_setup_power.S

/*
 * This file contains low level CPU setup functions.
 *    Copyright (C) 2003 Benjamin Herrenschmidt (benh@kernel.crashing.org)
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version
 * 2 of the License, or (at your option) any later version.
 *
 */

#include <asm/processor.h>
#include <asm/page.h>
#include <asm/cputable.h>
#include <asm/ppc_asm.h>
#include <asm/asm-offsets.h>
#include <asm/cache.h>
#include <asm/book3s/64/mmu-hash.h>

/* Entry: r3 = crap, r4 = ptr to cputable entry
 *
 * Note that we can be called twice for pseudo-PVRs
 */
_GLOBAL(__setup_cpu_power7)
	mflr	r11
	bl	__init_hvmode_206
	mtlr	r11
	beqlr
	li	r0,0
	mtspr	SPRN_LPID,r0
	mfspr	r3,SPRN_LPCR
	bl	__init_LPCR
	bl	__init_tlb_power7
	mtlr	r11
	blr

_GLOBAL(__restore_cpu_power7)
	mflr	r11
	mfmsr	r3
	rldicl.	r0,r3,4,63
	beqlr
	li	r0,0
	mtspr	SPRN_LPID,r0
	mfspr	r3,SPRN_LPCR
	bl	__init_LPCR
	bl	__init_tlb_power7
	mtlr	r11
	blr

_GLOBAL(__setup_cpu_power8)
	mflr	r11
	bl	__init_FSCR
	bl	__init_PMU
	bl	__init_PMU_ISA207
	bl	__init_hvmode_206
	mtlr	r11
	beqlr
	li	r0,0
	mtspr	SPRN_LPID,r0
	mfspr	r3,SPRN_LPCR
	ori	r3, r3, LPCR_PECEDH
	bl	__init_LPCR
	bl	__init_HFSCR
	bl	__init_tlb_power8
	bl	__init_PMU_HV
	bl	__init_PMU_HV_ISA207
	mtlr	r11
	blr

_GLOBAL(__restore_cpu_power8)
	mflr	r11
	bl	__init_FSCR
	bl	__init_PMU
	bl	__init_PMU_ISA207
	mfmsr	r3
	rldicl.	r0,r3,4,63
	mtlr	r11
	beqlr
	li	r0,0
	mtspr	SPRN_LPID,r0
	mfspr   r3,SPRN_LPCR
	ori	r3, r3, LPCR_PECEDH
	bl	__init_LPCR
	bl	__init_HFSCR
	bl	__init_tlb_power8
	bl	__init_PMU_HV
	bl	__init_PMU_HV_ISA207
	mtlr	r11
	blr

_GLOBAL(__setup_cpu_power9)
	mflr	r11
	bl	__init_FSCR
	bl	__init_PMU
	bl	__init_hvmode_206
	mtlr	r11
	beqlr
	li	r0,0
	mtspr	SPRN_LPID,r0
	mfspr	r3,SPRN_LPCR
	ori	r3, r3, LPCR_PECEDH
	ori	r3, r3, LPCR_HVICE
	bl	__init_LPCR
	bl	__init_HFSCR
	bl	__init_tlb_power9
	bl	__init_PMU_HV
	mtlr	r11
	blr

_GLOBAL(__restore_cpu_power9)
	mflr	r11
	bl	__init_FSCR
	bl	__init_PMU
	mfmsr	r3
	rldicl.	r0,r3,4,63
	mtlr	r11
	beqlr
	li	r0,0
	mtspr	SPRN_LPID,r0
	mfspr   r3,SPRN_LPCR
	ori	r3, r3, LPCR_PECEDH
	ori	r3, r3, LPCR_HVICE
	bl	__init_LPCR
	bl	__init_HFSCR
	bl	__init_tlb_power9
	bl	__init_PMU_HV
	mtlr	r11
	blr

__init_hvmode_206:
	/* Disable CPU_FTR_HVMODE and exit if MSR:HV is not set */
	mfmsr	r3
	rldicl.	r0,r3,4,63
	bnelr
	ld	r5,CPU_SPEC_FEATURES(r4)
	LOAD_REG_IMMEDIATE(r6,CPU_FTR_HVMODE)
	xor	r5,r5,r6
	std	r5,CPU_SPEC_FEATURES(r4)
	blr

__init_LPCR:
	/* Setup a sane LPCR:
	 *   Called with initial LPCR in R3
	 *
	 *   LPES = 0b01 (HSRR0/1 used for 0x500)
	 *   PECE = 0b111
	 *   DPFD = 4
	 *   HDICE = 0
	 *   VC = 0b100 (VPM0=1, VPM1=0, ISL=0)
	 *   VRMASD = 0b10000 (L=1, LP=00)
	 *
	 * Other bits untouched for now
	 */
	li	r5,1
	rldimi	r3,r5, LPCR_LPES_SH, 64-LPCR_LPES_SH-2
	ori	r3,r3,(LPCR_PECE0|LPCR_PECE1|LPCR_PECE2)
	li	r5,4
	rldimi	r3,r5, LPCR_DPFD_SH, 64-LPCR_DPFD_SH-3
	clrrdi	r3,r3,1		/* clear HDICE */
	li	r5,4
	rldimi	r3,r5, LPCR_VC_SH, 0
	li	r5,0x10
	rldimi	r3,r5, LPCR_VRMASD_SH, 64-LPCR_VRMASD_SH-5
	mtspr	SPRN_LPCR,r3
	isync
	blr

__init_FSCR:
	mfspr	r3,SPRN_FSCR
	ori	r3,r3,FSCR_TAR|FSCR_DSCR|FSCR_EBB
	mtspr	SPRN_FSCR,r3
	blr

__init_HFSCR:
	mfspr	r3,SPRN_HFSCR
	ori	r3,r3,HFSCR_TAR|HFSCR_TM|HFSCR_BHRB|HFSCR_PM|\
		      HFSCR_DSCR|HFSCR_VECVSX|HFSCR_FP|HFSCR_EBB
	mtspr	SPRN_HFSCR,r3
	blr

/*
 * Clear the TLB using the specified IS form of tlbiel instruction
 * (invalidate by congruence class). P7 has 128 CCs., P8 has 512.
 */
__init_tlb_power7:
	li	r6,POWER7_TLB_SETS
	mtctr	r6
	li	r7,0xc00	/* IS field = 0b11 */
	ptesync
2:	tlbiel	r7
	addi	r7,r7,0x1000
	bdnz	2b
	ptesync
1:	blr

__init_tlb_power8:
	li	r6,POWER8_TLB_SETS
	mtctr	r6
	li	r7,0xc00	/* IS field = 0b11 */
	ptesync
2:	tlbiel	r7
	addi	r7,r7,0x1000
	bdnz	2b
	ptesync
1:	blr

__init_tlb_power9:
	li	r6,POWER9_TLB_SETS_HASH
	mtctr	r6
	li	r7,0xc00	/* IS field = 0b11 */
	ptesync
2:	tlbiel	r7
	addi	r7,r7,0x1000
	bdnz	2b
	ptesync
1:	blr

__init_PMU_HV:
	li	r5,0
	mtspr	SPRN_MMCRC,r5
	blr

__init_PMU_HV_ISA207:
	li	r5,0
	mtspr	SPRN_MMCRH,r5
	blr

__init_PMU:
	li	r5,0
	mtspr	SPRN_MMCRA,r5
	mtspr	SPRN_MMCR0,r5
	mtspr	SPRN_MMCR1,r5
	mtspr	SPRN_MMCR2,r5
	blr

__init_PMU_ISA207:
	li	r5,0
	mtspr	SPRN_MMCRS,r5
	blr
Commit	Line	Data
24cc67de BH	1	/*
	2	* This file contains low level CPU setup functions.
	3	* Copyright (C) 2003 Benjamin Herrenschmidt (benh@kernel.crashing.org)
	4	*
	5	* This program is free software; you can redistribute it and/or
	6	* modify it under the terms of the GNU General Public License
	7	* as published by the Free Software Foundation; either version
	8	* 2 of the License, or (at your option) any later version.
	9	*
	10	*/
	11
	12	#include <asm/processor.h>
	13	#include <asm/page.h>
	14	#include <asm/cputable.h>
	15	#include <asm/ppc_asm.h>
	16	#include <asm/asm-offsets.h>
	17	#include <asm/cache.h>
f64e8084	18	#include <asm/book3s/64/mmu-hash.h>
24cc67de BH	19
	20	/* Entry: r3 = crap, r4 = ptr to cputable entry
	21	*
	22	* Note that we can be called twice for pseudo-PVRs
	23	*/
	24	_GLOBAL(__setup_cpu_power7)
	25	mflr r11
	26	bl __init_hvmode_206
	27	mtlr r11
	28	beqlr
b144871c BH	29	li r0,0
b144871c BH	30	mtspr SPRN_LPID,r0
f7c32c24	31	mfspr r3,SPRN_LPCR
24cc67de	32	bl __init_LPCR
04407050	33	bl __init_tlb_power7
24cc67de BH	34	mtlr r11
	35	blr
	36
	37	_GLOBAL(__restore_cpu_power7)
	38	mflr r11
	39	mfmsr r3
	40	rldicl. r0,r3,4,63
	41	beqlr
b144871c BH	42	li r0,0
b144871c BH	43	mtspr SPRN_LPID,r0
f7c32c24	44	mfspr r3,SPRN_LPCR
24cc67de	45	bl __init_LPCR
04407050	46	bl __init_tlb_power7
aec937b1 MN	47	mtlr r11
	48	blr
	49
	50	_GLOBAL(__setup_cpu_power8)
	51	mflr r11
57d23167	52	bl __init_FSCR
240686c1	53	bl __init_PMU
393eb79a	54	bl __init_PMU_ISA207
aec937b1 MN	55	bl __init_hvmode_206
	56	mtlr r11
	57	beqlr
	58	li r0,0
	59	mtspr SPRN_LPID,r0
f7c32c24	60	mfspr r3,SPRN_LPCR
d4e58e59	61	ori r3, r3, LPCR_PECEDH
aec937b1	62	bl __init_LPCR
2a3563b0	63	bl __init_HFSCR
04407050	64	bl __init_tlb_power8
240686c1	65	bl __init_PMU_HV
393eb79a	66	bl __init_PMU_HV_ISA207
aec937b1 MN	67	mtlr r11
	68	blr
	69
	70	_GLOBAL(__restore_cpu_power8)
	71	mflr r11
57d23167	72	bl __init_FSCR
240686c1	73	bl __init_PMU
393eb79a	74	bl __init_PMU_ISA207
aec937b1 MN	75	mfmsr r3
aec937b1 MN	76	rldicl. r0,r3,4,63
8c2a3817	77	mtlr r11
aec937b1 MN	78	beqlr
	79	li r0,0
	80	mtspr SPRN_LPID,r0
f7c32c24	81	mfspr r3,SPRN_LPCR
d4e58e59	82	ori r3, r3, LPCR_PECEDH
aec937b1	83	bl __init_LPCR
2a3563b0	84	bl __init_HFSCR
04407050	85	bl __init_tlb_power8
240686c1	86	bl __init_PMU_HV
393eb79a	87	bl __init_PMU_HV_ISA207
24cc67de BH	88	mtlr r11
	89	blr
	90
c3ab300e MN	91	_GLOBAL(__setup_cpu_power9)
	92	mflr r11
	93	bl __init_FSCR
393eb79a	94	bl __init_PMU
c3ab300e MN	95	bl __init_hvmode_206
	96	mtlr r11
	97	beqlr
	98	li r0,0
	99	mtspr SPRN_LPID,r0
	100	mfspr r3,SPRN_LPCR
	101	ori r3, r3, LPCR_PECEDH
9baaef0a	102	ori r3, r3, LPCR_HVICE
c3ab300e MN	103	bl __init_LPCR
	104	bl __init_HFSCR
	105	bl __init_tlb_power9
393eb79a	106	bl __init_PMU_HV
c3ab300e MN	107	mtlr r11
	108	blr
	109
	110	_GLOBAL(__restore_cpu_power9)
	111	mflr r11
	112	bl __init_FSCR
393eb79a	113	bl __init_PMU
c3ab300e MN	114	mfmsr r3
	115	rldicl. r0,r3,4,63
	116	mtlr r11
	117	beqlr
	118	li r0,0
	119	mtspr SPRN_LPID,r0
	120	mfspr r3,SPRN_LPCR
	121	ori r3, r3, LPCR_PECEDH
9baaef0a	122	ori r3, r3, LPCR_HVICE
c3ab300e MN	123	bl __init_LPCR
	124	bl __init_HFSCR
	125	bl __init_tlb_power9
393eb79a	126	bl __init_PMU_HV
c3ab300e MN	127	mtlr r11
	128	blr
	129
24cc67de	130	__init_hvmode_206:
969391c5	131	/* Disable CPU_FTR_HVMODE and exit if MSR:HV is not set */
24cc67de BH	132	mfmsr r3
	133	rldicl. r0,r3,4,63
	134	bnelr
	135	ld r5,CPU_SPEC_FEATURES(r4)
969391c5	136	LOAD_REG_IMMEDIATE(r6,CPU_FTR_HVMODE)
24cc67de BH	137	xor r5,r5,r6
	138	std r5,CPU_SPEC_FEATURES(r4)
	139	blr
	140
	141	__init_LPCR:
	142	/* Setup a sane LPCR:
f7c32c24	143	* Called with initial LPCR in R3
24cc67de	144	*
a5d4f3ad	145	* LPES = 0b01 (HSRR0/1 used for 0x500)
24cc67de	146	* PECE = 0b111
895796a8	147	* DPFD = 4
923c53ca PM	148	* HDICE = 0
	149	* VC = 0b100 (VPM0=1, VPM1=0, ISL=0)
	150	* VRMASD = 0b10000 (L=1, LP=00)
24cc67de BH	151	*
	152	* Other bits untouched for now
	153	*/
923c53ca PM	154	li r5,1
923c53ca PM	155	rldimi r3,r5, LPCR_LPES_SH, 64-LPCR_LPES_SH-2
24cc67de	156	ori r3,r3,(LPCR_PECE0\|LPCR_PECE1\|LPCR_PECE2)
895796a8	157	li r5,4
923c53ca PM	158	rldimi r3,r5, LPCR_DPFD_SH, 64-LPCR_DPFD_SH-3
	159	clrrdi r3,r3,1 /* clear HDICE */
	160	li r5,4
	161	rldimi r3,r5, LPCR_VC_SH, 0
	162	li r5,0x10
	163	rldimi r3,r5, LPCR_VRMASD_SH, 64-LPCR_VRMASD_SH-5
24cc67de BH	164	mtspr SPRN_LPCR,r3
	165	isync
	166	blr
b144871c	167
2468dcf6 IM	168	__init_FSCR:
2468dcf6 IM	169	mfspr r3,SPRN_FSCR
1ddf499e	170	ori r3,r3,FSCR_TAR\|FSCR_DSCR\|FSCR_EBB
2468dcf6 IM	171	mtspr SPRN_FSCR,r3
	172	blr
	173
2a3563b0 MN	174	__init_HFSCR:
2a3563b0 MN	175	mfspr r3,SPRN_HFSCR
53b56ca0	176	ori r3,r3,HFSCR_TAR\|HFSCR_TM\|HFSCR_BHRB\|HFSCR_PM\|\
1ddf499e	177	HFSCR_DSCR\|HFSCR_VECVSX\|HFSCR_FP\|HFSCR_EBB
2a3563b0 MN	178	mtspr SPRN_HFSCR,r3
	179	blr
	180
04407050 MS	181	/*
	182	* Clear the TLB using the specified IS form of tlbiel instruction
	183	* (invalidate by congruence class). P7 has 128 CCs., P8 has 512.
04407050 MS	184	*/
04407050 MS	185	__init_tlb_power7:
15b1624b	186	li r6,POWER7_TLB_SETS
04407050	187	mtctr r6
45706bb5	188	li r7,0xc00 /* IS field = 0b11 */
04407050 MS	189	ptesync
	190	2: tlbiel r7
	191	addi r7,r7,0x1000
	192	bdnz 2b
	193	ptesync
	194	1: blr
	195
	196	__init_tlb_power8:
15b1624b	197	li r6,POWER8_TLB_SETS
b144871c	198	mtctr r6
45706bb5	199	li r7,0xc00 /* IS field = 0b11 */
b144871c BH	200	ptesync
	201	2: tlbiel r7
	202	addi r7,r7,0x1000
	203	bdnz 2b
	204	ptesync
	205	1: blr
240686c1	206
c3ab300e MN	207	__init_tlb_power9:
	208	li r6,POWER9_TLB_SETS_HASH
	209	mtctr r6
	210	li r7,0xc00 /* IS field = 0b11 */
	211	ptesync
	212	2: tlbiel r7
	213	addi r7,r7,0x1000
	214	bdnz 2b
	215	ptesync
	216	1: blr
	217
240686c1 ME	218	__init_PMU_HV:
	219	li r5,0
	220	mtspr SPRN_MMCRC,r5
393eb79a MS	221	blr
	222
	223	__init_PMU_HV_ISA207:
	224	li r5,0
240686c1 ME	225	mtspr SPRN_MMCRH,r5
	226	blr
	227
	228	__init_PMU:
	229	li r5,0
240686c1 ME	230	mtspr SPRN_MMCRA,r5
	231	mtspr SPRN_MMCR0,r5
	232	mtspr SPRN_MMCR1,r5
	233	mtspr SPRN_MMCR2,r5
	234	blr
393eb79a MS	235
	236	__init_PMU_ISA207:
	237	li r5,0
	238	mtspr SPRN_MMCRS,r5
	239	blr