xref: /freebsd/sys/powerpc/aim/mmu_oea.c (revision 1f1b2286fd5ae4cd7f8e6412723201e92d28771a)
160727d8bSWarner Losh /*-
24d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause AND BSD-4-Clause
371e3c308SPedro F. Giffuni  *
45244eac9SBenno Rice  * Copyright (c) 2001 The NetBSD Foundation, Inc.
55244eac9SBenno Rice  * All rights reserved.
65244eac9SBenno Rice  *
75244eac9SBenno Rice  * This code is derived from software contributed to The NetBSD Foundation
85244eac9SBenno Rice  * by Matt Thomas <matt@3am-software.com> of Allegro Networks, Inc.
95244eac9SBenno Rice  *
105244eac9SBenno Rice  * Redistribution and use in source and binary forms, with or without
115244eac9SBenno Rice  * modification, are permitted provided that the following conditions
125244eac9SBenno Rice  * are met:
135244eac9SBenno Rice  * 1. Redistributions of source code must retain the above copyright
145244eac9SBenno Rice  *    notice, this list of conditions and the following disclaimer.
155244eac9SBenno Rice  * 2. Redistributions in binary form must reproduce the above copyright
165244eac9SBenno Rice  *    notice, this list of conditions and the following disclaimer in the
175244eac9SBenno Rice  *    documentation and/or other materials provided with the distribution.
185244eac9SBenno Rice  *
195244eac9SBenno Rice  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
205244eac9SBenno Rice  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
215244eac9SBenno Rice  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
225244eac9SBenno Rice  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
235244eac9SBenno Rice  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
245244eac9SBenno Rice  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
255244eac9SBenno Rice  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
265244eac9SBenno Rice  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
275244eac9SBenno Rice  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
285244eac9SBenno Rice  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
295244eac9SBenno Rice  * POSSIBILITY OF SUCH DAMAGE.
305244eac9SBenno Rice  */
3160727d8bSWarner Losh /*-
32f9bac91bSBenno Rice  * Copyright (C) 1995, 1996 Wolfgang Solfrank.
33f9bac91bSBenno Rice  * Copyright (C) 1995, 1996 TooLs GmbH.
34f9bac91bSBenno Rice  * All rights reserved.
35f9bac91bSBenno Rice  *
36f9bac91bSBenno Rice  * Redistribution and use in source and binary forms, with or without
37f9bac91bSBenno Rice  * modification, are permitted provided that the following conditions
38f9bac91bSBenno Rice  * are met:
39f9bac91bSBenno Rice  * 1. Redistributions of source code must retain the above copyright
40f9bac91bSBenno Rice  *    notice, this list of conditions and the following disclaimer.
41f9bac91bSBenno Rice  * 2. Redistributions in binary form must reproduce the above copyright
42f9bac91bSBenno Rice  *    notice, this list of conditions and the following disclaimer in the
43f9bac91bSBenno Rice  *    documentation and/or other materials provided with the distribution.
44f9bac91bSBenno Rice  * 3. All advertising materials mentioning features or use of this software
45f9bac91bSBenno Rice  *    must display the following acknowledgement:
46f9bac91bSBenno Rice  *	This product includes software developed by TooLs GmbH.
47f9bac91bSBenno Rice  * 4. The name of TooLs GmbH may not be used to endorse or promote products
48f9bac91bSBenno Rice  *    derived from this software without specific prior written permission.
49f9bac91bSBenno Rice  *
50f9bac91bSBenno Rice  * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
51f9bac91bSBenno Rice  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
52f9bac91bSBenno Rice  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
53f9bac91bSBenno Rice  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
54f9bac91bSBenno Rice  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
55f9bac91bSBenno Rice  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
56f9bac91bSBenno Rice  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
57f9bac91bSBenno Rice  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
58f9bac91bSBenno Rice  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
59f9bac91bSBenno Rice  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
60f9bac91bSBenno Rice  *
61111c77dcSBenno Rice  * $NetBSD: pmap.c,v 1.28 2000/03/26 20:42:36 kleink Exp $
62f9bac91bSBenno Rice  */
6360727d8bSWarner Losh /*-
64f9bac91bSBenno Rice  * Copyright (C) 2001 Benno Rice.
65f9bac91bSBenno Rice  * All rights reserved.
66f9bac91bSBenno Rice  *
67f9bac91bSBenno Rice  * Redistribution and use in source and binary forms, with or without
68f9bac91bSBenno Rice  * modification, are permitted provided that the following conditions
69f9bac91bSBenno Rice  * are met:
70f9bac91bSBenno Rice  * 1. Redistributions of source code must retain the above copyright
71f9bac91bSBenno Rice  *    notice, this list of conditions and the following disclaimer.
72f9bac91bSBenno Rice  * 2. Redistributions in binary form must reproduce the above copyright
73f9bac91bSBenno Rice  *    notice, this list of conditions and the following disclaimer in the
74f9bac91bSBenno Rice  *    documentation and/or other materials provided with the distribution.
75f9bac91bSBenno Rice  *
76f9bac91bSBenno Rice  * THIS SOFTWARE IS PROVIDED BY Benno Rice ``AS IS'' AND ANY EXPRESS OR
77f9bac91bSBenno Rice  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
78f9bac91bSBenno Rice  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
79f9bac91bSBenno Rice  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
80f9bac91bSBenno Rice  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
81f9bac91bSBenno Rice  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
82f9bac91bSBenno Rice  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
83f9bac91bSBenno Rice  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
84f9bac91bSBenno Rice  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
85f9bac91bSBenno Rice  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
86f9bac91bSBenno Rice  */
87f9bac91bSBenno Rice 
888368cf8fSDavid E. O'Brien #include <sys/cdefs.h>
895244eac9SBenno Rice /*
905244eac9SBenno Rice  * Manages physical address maps.
915244eac9SBenno Rice  *
925244eac9SBenno Rice  * Since the information managed by this module is also stored by the
935244eac9SBenno Rice  * logical address mapping module, this module may throw away valid virtual
945244eac9SBenno Rice  * to physical mappings at almost any time.  However, invalidations of
955244eac9SBenno Rice  * mappings must be done as requested.
965244eac9SBenno Rice  *
975244eac9SBenno Rice  * In order to cope with hardware architectures which make virtual to
985244eac9SBenno Rice  * physical map invalidates expensive, this module may delay invalidate
995244eac9SBenno Rice  * reduced protection operations until such time as they are actually
1005244eac9SBenno Rice  * necessary.  This module is given full information as to which processors
1015244eac9SBenno Rice  * are currently using which maps, and to when physical maps must be made
1025244eac9SBenno Rice  * correct.
1035244eac9SBenno Rice  */
1045244eac9SBenno Rice 
105ad7a226fSPeter Wemm #include "opt_kstack_pages.h"
106ad7a226fSPeter Wemm 
107f9bac91bSBenno Rice #include <sys/param.h>
1080b27d710SPeter Wemm #include <sys/kernel.h>
109bdb9ab0dSMark Johnston #include <sys/conf.h>
110c47dd3dbSAttilio Rao #include <sys/queue.h>
111c47dd3dbSAttilio Rao #include <sys/cpuset.h>
112bdb9ab0dSMark Johnston #include <sys/kerneldump.h>
1135244eac9SBenno Rice #include <sys/ktr.h>
11494e0b85eSMark Peek #include <sys/lock.h>
11543d3fc80SBrandon Bergren #include <sys/mman.h>
1165244eac9SBenno Rice #include <sys/msgbuf.h>
117f9bac91bSBenno Rice #include <sys/mutex.h>
1185244eac9SBenno Rice #include <sys/proc.h>
1193653f5cbSAlan Cox #include <sys/rwlock.h>
120c47dd3dbSAttilio Rao #include <sys/sched.h>
1215244eac9SBenno Rice #include <sys/sysctl.h>
1225244eac9SBenno Rice #include <sys/systm.h>
1235244eac9SBenno Rice #include <sys/vmmeter.h>
1245244eac9SBenno Rice 
1255244eac9SBenno Rice #include <dev/ofw/openfirm.h>
126f9bac91bSBenno Rice 
127f9bac91bSBenno Rice #include <vm/vm.h>
12843d3fc80SBrandon Bergren #include <vm/pmap.h>
129f9bac91bSBenno Rice #include <vm/vm_param.h>
130f9bac91bSBenno Rice #include <vm/vm_kern.h>
131f9bac91bSBenno Rice #include <vm/vm_page.h>
132f9bac91bSBenno Rice #include <vm/vm_map.h>
133f9bac91bSBenno Rice #include <vm/vm_object.h>
134f9bac91bSBenno Rice #include <vm/vm_extern.h>
13521943937SJeff Roberson #include <vm/vm_page.h>
13621943937SJeff Roberson #include <vm/vm_phys.h>
137f9bac91bSBenno Rice #include <vm/vm_pageout.h>
138378862a7SJeff Roberson #include <vm/uma.h>
139f9bac91bSBenno Rice 
1407c277971SPeter Grehan #include <machine/cpu.h>
141b40ce02aSNathan Whitehorn #include <machine/platform.h>
142d699b539SMark Peek #include <machine/bat.h>
1435244eac9SBenno Rice #include <machine/frame.h>
1445244eac9SBenno Rice #include <machine/md_var.h>
1455244eac9SBenno Rice #include <machine/psl.h>
146f9bac91bSBenno Rice #include <machine/pte.h>
14712640815SMarcel Moolenaar #include <machine/smp.h>
1485244eac9SBenno Rice #include <machine/sr.h>
14959276937SPeter Grehan #include <machine/mmuvar.h>
150258dbffeSNathan Whitehorn #include <machine/trap.h>
151f9bac91bSBenno Rice 
15259276937SPeter Grehan #define	MOEA_DEBUG
153f9bac91bSBenno Rice 
1545244eac9SBenno Rice #define TODO	panic("%s: not implemented", __func__);
155f9bac91bSBenno Rice 
1565244eac9SBenno Rice #define	VSID_MAKE(sr, hash)	((sr) | (((hash) & 0xfffff) << 4))
1575244eac9SBenno Rice #define	VSID_TO_SR(vsid)	((vsid) & 0xf)
1585244eac9SBenno Rice #define	VSID_TO_HASH(vsid)	(((vsid) >> 4) & 0xfffff)
1595244eac9SBenno Rice 
1607be655c2SBrandon Bergren /* Get physical address from PVO. */
1617be655c2SBrandon Bergren #define PVO_PADDR(pvo)		((pvo)->pvo_pte.pte.pte_lo & PTE_RPGN)
1627be655c2SBrandon Bergren 
1635244eac9SBenno Rice struct ofw_map {
1645244eac9SBenno Rice 	vm_offset_t	om_va;
1655244eac9SBenno Rice 	vm_size_t	om_len;
1665244eac9SBenno Rice 	vm_offset_t	om_pa;
1675244eac9SBenno Rice 	u_int		om_mode;
1685244eac9SBenno Rice };
169f9bac91bSBenno Rice 
170afd9cb6cSJustin Hibbits extern unsigned char _etext[];
171afd9cb6cSJustin Hibbits extern unsigned char _end[];
172afd9cb6cSJustin Hibbits 
1735244eac9SBenno Rice /*
1745244eac9SBenno Rice  * Map of physical memory regions.
1755244eac9SBenno Rice  */
17631c82d03SBenno Rice static struct	mem_region *regions;
17731c82d03SBenno Rice static struct	mem_region *pregions;
178c3e289e1SNathan Whitehorn static u_int    phys_avail_count;
179c3e289e1SNathan Whitehorn static int	regions_sz, pregions_sz;
180aa39961eSBenno Rice static struct	ofw_map *translations;
1815244eac9SBenno Rice 
182f9bac91bSBenno Rice /*
183f489bf21SAlan Cox  * Lock for the pteg and pvo tables.
184f489bf21SAlan Cox  */
18559276937SPeter Grehan struct mtx	moea_table_mutex;
186e9b5f218SNathan Whitehorn struct mtx	moea_vsid_mutex;
187f489bf21SAlan Cox 
188e4f72b32SMarcel Moolenaar /* tlbie instruction synchronization */
189e4f72b32SMarcel Moolenaar static struct mtx tlbie_mtx;
190e4f72b32SMarcel Moolenaar 
191f489bf21SAlan Cox /*
1925244eac9SBenno Rice  * PTEG data.
193f9bac91bSBenno Rice  */
19459276937SPeter Grehan static struct	pteg *moea_pteg_table;
19559276937SPeter Grehan u_int		moea_pteg_count;
19659276937SPeter Grehan u_int		moea_pteg_mask;
1975244eac9SBenno Rice 
1985244eac9SBenno Rice /*
1995244eac9SBenno Rice  * PVO data.
2005244eac9SBenno Rice  */
20159276937SPeter Grehan struct	pvo_head *moea_pvo_table;		/* pvo entries by pteg index */
20259276937SPeter Grehan struct	pvo_head moea_pvo_kunmanaged =
20359276937SPeter Grehan     LIST_HEAD_INITIALIZER(moea_pvo_kunmanaged);	/* list of unmanaged pages */
2045244eac9SBenno Rice 
205cfedf924SAttilio Rao static struct rwlock_padalign pvh_global_lock;
2063653f5cbSAlan Cox 
20759276937SPeter Grehan uma_zone_t	moea_upvo_zone;	/* zone for pvo entries for unmanaged pages */
20859276937SPeter Grehan uma_zone_t	moea_mpvo_zone;	/* zone for pvo entries for managed pages */
2095244eac9SBenno Rice 
2100d290675SBenno Rice #define	BPVO_POOL_SIZE	32768
21159276937SPeter Grehan static struct	pvo_entry *moea_bpvo_pool;
21259276937SPeter Grehan static int	moea_bpvo_pool_index = 0;
2135244eac9SBenno Rice 
2145244eac9SBenno Rice #define	VSID_NBPW	(sizeof(u_int32_t) * 8)
21559276937SPeter Grehan static u_int	moea_vsid_bitmap[NPMAPS / VSID_NBPW];
2165244eac9SBenno Rice 
217*1f1b2286SJohn Baldwin static bool	moea_initialized = false;
2185244eac9SBenno Rice 
2195244eac9SBenno Rice /*
2205244eac9SBenno Rice  * Statistics.
2215244eac9SBenno Rice  */
22259276937SPeter Grehan u_int	moea_pte_valid = 0;
22359276937SPeter Grehan u_int	moea_pte_overflow = 0;
22459276937SPeter Grehan u_int	moea_pte_replacements = 0;
22559276937SPeter Grehan u_int	moea_pvo_entries = 0;
22659276937SPeter Grehan u_int	moea_pvo_enter_calls = 0;
22759276937SPeter Grehan u_int	moea_pvo_remove_calls = 0;
22859276937SPeter Grehan u_int	moea_pte_spills = 0;
22959276937SPeter Grehan SYSCTL_INT(_machdep, OID_AUTO, moea_pte_valid, CTLFLAG_RD, &moea_pte_valid,
2305244eac9SBenno Rice     0, "");
23159276937SPeter Grehan SYSCTL_INT(_machdep, OID_AUTO, moea_pte_overflow, CTLFLAG_RD,
23259276937SPeter Grehan     &moea_pte_overflow, 0, "");
23359276937SPeter Grehan SYSCTL_INT(_machdep, OID_AUTO, moea_pte_replacements, CTLFLAG_RD,
23459276937SPeter Grehan     &moea_pte_replacements, 0, "");
23559276937SPeter Grehan SYSCTL_INT(_machdep, OID_AUTO, moea_pvo_entries, CTLFLAG_RD, &moea_pvo_entries,
2365244eac9SBenno Rice     0, "");
23759276937SPeter Grehan SYSCTL_INT(_machdep, OID_AUTO, moea_pvo_enter_calls, CTLFLAG_RD,
23859276937SPeter Grehan     &moea_pvo_enter_calls, 0, "");
23959276937SPeter Grehan SYSCTL_INT(_machdep, OID_AUTO, moea_pvo_remove_calls, CTLFLAG_RD,
24059276937SPeter Grehan     &moea_pvo_remove_calls, 0, "");
24159276937SPeter Grehan SYSCTL_INT(_machdep, OID_AUTO, moea_pte_spills, CTLFLAG_RD,
24259276937SPeter Grehan     &moea_pte_spills, 0, "");
2435244eac9SBenno Rice 
2445244eac9SBenno Rice /*
24559276937SPeter Grehan  * Allocate physical memory for use in moea_bootstrap.
2465244eac9SBenno Rice  */
24759276937SPeter Grehan static vm_offset_t	moea_bootstrap_alloc(vm_size_t, u_int);
2485244eac9SBenno Rice 
2495244eac9SBenno Rice /*
2505244eac9SBenno Rice  * PTE calls.
2515244eac9SBenno Rice  */
25259276937SPeter Grehan static int		moea_pte_insert(u_int, struct pte *);
2535244eac9SBenno Rice 
2545244eac9SBenno Rice /*
2555244eac9SBenno Rice  * PVO calls.
2565244eac9SBenno Rice  */
25759276937SPeter Grehan static int	moea_pvo_enter(pmap_t, uma_zone_t, struct pvo_head *,
2580936003eSJustin Hibbits 		    vm_offset_t, vm_paddr_t, u_int, int);
25959276937SPeter Grehan static void	moea_pvo_remove(struct pvo_entry *, int);
26059276937SPeter Grehan static struct	pvo_entry *moea_pvo_find_va(pmap_t, vm_offset_t, int *);
26159276937SPeter Grehan static struct	pte *moea_pvo_to_pte(const struct pvo_entry *, int);
2625244eac9SBenno Rice 
2635244eac9SBenno Rice /*
2645244eac9SBenno Rice  * Utility routines.
2655244eac9SBenno Rice  */
26639ffa8c1SKonstantin Belousov static int		moea_enter_locked(pmap_t, vm_offset_t, vm_page_t,
26739ffa8c1SKonstantin Belousov 			    vm_prot_t, u_int, int8_t);
2680936003eSJustin Hibbits static void		moea_syncicache(vm_paddr_t, vm_size_t);
269*1f1b2286SJohn Baldwin static bool		moea_query_bit(vm_page_t, int);
270ce186587SAlan Cox static u_int		moea_clear_bit(vm_page_t, int);
27145b69dd6SJustin Hibbits static void		moea_kremove(vm_offset_t);
27259276937SPeter Grehan int		moea_pte_spill(vm_offset_t);
27359276937SPeter Grehan 
27459276937SPeter Grehan /*
27559276937SPeter Grehan  * Kernel MMU interface
27659276937SPeter Grehan  */
27745b69dd6SJustin Hibbits void moea_clear_modify(vm_page_t);
27845b69dd6SJustin Hibbits void moea_copy_page(vm_page_t, vm_page_t);
27945b69dd6SJustin Hibbits void moea_copy_pages(vm_page_t *ma, vm_offset_t a_offset,
280e8a4a618SKonstantin Belousov     vm_page_t *mb, vm_offset_t b_offset, int xfersize);
28145b69dd6SJustin Hibbits int moea_enter(pmap_t, vm_offset_t, vm_page_t, vm_prot_t, u_int,
28239ffa8c1SKonstantin Belousov     int8_t);
28345b69dd6SJustin Hibbits void moea_enter_object(pmap_t, vm_offset_t, vm_offset_t, vm_page_t,
284ce142d9eSAlan Cox     vm_prot_t);
28545b69dd6SJustin Hibbits void moea_enter_quick(pmap_t, vm_offset_t, vm_page_t, vm_prot_t);
28645b69dd6SJustin Hibbits vm_paddr_t moea_extract(pmap_t, vm_offset_t);
28745b69dd6SJustin Hibbits vm_page_t moea_extract_and_hold(pmap_t, vm_offset_t, vm_prot_t);
28845b69dd6SJustin Hibbits void moea_init(void);
289*1f1b2286SJohn Baldwin bool moea_is_modified(vm_page_t);
290*1f1b2286SJohn Baldwin bool moea_is_prefaultable(pmap_t, vm_offset_t);
291*1f1b2286SJohn Baldwin bool moea_is_referenced(vm_page_t);
29245b69dd6SJustin Hibbits int moea_ts_referenced(vm_page_t);
29345b69dd6SJustin Hibbits vm_offset_t moea_map(vm_offset_t *, vm_paddr_t, vm_paddr_t, int);
29443d3fc80SBrandon Bergren static int moea_mincore(pmap_t, vm_offset_t, vm_paddr_t *);
295*1f1b2286SJohn Baldwin bool moea_page_exists_quick(pmap_t, vm_page_t);
29645b69dd6SJustin Hibbits void moea_page_init(vm_page_t);
29745b69dd6SJustin Hibbits int moea_page_wired_mappings(vm_page_t);
29845b69dd6SJustin Hibbits int moea_pinit(pmap_t);
29945b69dd6SJustin Hibbits void moea_pinit0(pmap_t);
30045b69dd6SJustin Hibbits void moea_protect(pmap_t, vm_offset_t, vm_offset_t, vm_prot_t);
30145b69dd6SJustin Hibbits void moea_qenter(vm_offset_t, vm_page_t *, int);
30245b69dd6SJustin Hibbits void moea_qremove(vm_offset_t, int);
30345b69dd6SJustin Hibbits void moea_release(pmap_t);
30445b69dd6SJustin Hibbits void moea_remove(pmap_t, vm_offset_t, vm_offset_t);
30545b69dd6SJustin Hibbits void moea_remove_all(vm_page_t);
30645b69dd6SJustin Hibbits void moea_remove_write(vm_page_t);
30745b69dd6SJustin Hibbits void moea_unwire(pmap_t, vm_offset_t, vm_offset_t);
30845b69dd6SJustin Hibbits void moea_zero_page(vm_page_t);
30945b69dd6SJustin Hibbits void moea_zero_page_area(vm_page_t, int, int);
31045b69dd6SJustin Hibbits void moea_activate(struct thread *);
31145b69dd6SJustin Hibbits void moea_deactivate(struct thread *);
31245b69dd6SJustin Hibbits void moea_cpu_bootstrap(int);
31345b69dd6SJustin Hibbits void moea_bootstrap(vm_offset_t, vm_offset_t);
31445b69dd6SJustin Hibbits void *moea_mapdev(vm_paddr_t, vm_size_t);
31545b69dd6SJustin Hibbits void *moea_mapdev_attr(vm_paddr_t, vm_size_t, vm_memattr_t);
3167ae99f80SJohn Baldwin void moea_unmapdev(void *, vm_size_t);
31745b69dd6SJustin Hibbits vm_paddr_t moea_kextract(vm_offset_t);
31845b69dd6SJustin Hibbits void moea_kenter_attr(vm_offset_t, vm_paddr_t, vm_memattr_t);
31945b69dd6SJustin Hibbits void moea_kenter(vm_offset_t, vm_paddr_t);
32045b69dd6SJustin Hibbits void moea_page_set_memattr(vm_page_t m, vm_memattr_t ma);
321d1426018SDimitry Andric int moea_dev_direct_mapped(vm_paddr_t, vm_size_t);
32245b69dd6SJustin Hibbits static void moea_sync_icache(pmap_t, vm_offset_t, vm_size_t);
32345b69dd6SJustin Hibbits void moea_dumpsys_map(vm_paddr_t pa, size_t sz, void **va);
32445b69dd6SJustin Hibbits void moea_scan_init(void);
32545b69dd6SJustin Hibbits vm_offset_t moea_quick_enter_page(vm_page_t m);
32645b69dd6SJustin Hibbits void moea_quick_remove_page(vm_offset_t addr);
327*1f1b2286SJohn Baldwin bool moea_page_is_mapped(vm_page_t m);
3288dc8feb5SJason A. Harmening bool moea_ps_enabled(pmap_t pmap);
32945b69dd6SJustin Hibbits static int moea_map_user_ptr(pmap_t pm,
33004329fa7SNathan Whitehorn     volatile const void *uaddr, void **kaddr, size_t ulen, size_t *klen);
33145b69dd6SJustin Hibbits static int moea_decode_kernel_ptr(vm_offset_t addr,
332eb1baf72SNathan Whitehorn     int *is_user, vm_offset_t *decoded_addr);
33304329fa7SNathan Whitehorn 
33445b69dd6SJustin Hibbits static struct pmap_funcs moea_methods = {
33545b69dd6SJustin Hibbits 	.clear_modify = moea_clear_modify,
33645b69dd6SJustin Hibbits 	.copy_page = moea_copy_page,
33745b69dd6SJustin Hibbits 	.copy_pages = moea_copy_pages,
33845b69dd6SJustin Hibbits 	.enter = moea_enter,
33945b69dd6SJustin Hibbits 	.enter_object = moea_enter_object,
34045b69dd6SJustin Hibbits 	.enter_quick = moea_enter_quick,
34145b69dd6SJustin Hibbits 	.extract = moea_extract,
34245b69dd6SJustin Hibbits 	.extract_and_hold = moea_extract_and_hold,
34345b69dd6SJustin Hibbits 	.init = moea_init,
34445b69dd6SJustin Hibbits 	.is_modified = moea_is_modified,
34545b69dd6SJustin Hibbits 	.is_prefaultable = moea_is_prefaultable,
34645b69dd6SJustin Hibbits 	.is_referenced = moea_is_referenced,
34745b69dd6SJustin Hibbits 	.ts_referenced = moea_ts_referenced,
34845b69dd6SJustin Hibbits 	.map =      		moea_map,
34945b69dd6SJustin Hibbits 	.page_exists_quick = moea_page_exists_quick,
35045b69dd6SJustin Hibbits 	.page_init = moea_page_init,
35145b69dd6SJustin Hibbits 	.page_wired_mappings = moea_page_wired_mappings,
35245b69dd6SJustin Hibbits 	.pinit = moea_pinit,
35345b69dd6SJustin Hibbits 	.pinit0 = moea_pinit0,
35445b69dd6SJustin Hibbits 	.protect = moea_protect,
35545b69dd6SJustin Hibbits 	.qenter = moea_qenter,
35645b69dd6SJustin Hibbits 	.qremove = moea_qremove,
35745b69dd6SJustin Hibbits 	.release = moea_release,
35845b69dd6SJustin Hibbits 	.remove = moea_remove,
35945b69dd6SJustin Hibbits 	.remove_all = moea_remove_all,
36043d3fc80SBrandon Bergren 	.mincore = moea_mincore,
36145b69dd6SJustin Hibbits 	.remove_write = moea_remove_write,
36245b69dd6SJustin Hibbits 	.sync_icache = moea_sync_icache,
36345b69dd6SJustin Hibbits 	.unwire = moea_unwire,
36445b69dd6SJustin Hibbits 	.zero_page =        	moea_zero_page,
36545b69dd6SJustin Hibbits 	.zero_page_area = moea_zero_page_area,
36645b69dd6SJustin Hibbits 	.activate = moea_activate,
36745b69dd6SJustin Hibbits 	.deactivate =       	moea_deactivate,
36845b69dd6SJustin Hibbits 	.page_set_memattr = moea_page_set_memattr,
36945b69dd6SJustin Hibbits 	.quick_enter_page =  moea_quick_enter_page,
37045b69dd6SJustin Hibbits 	.quick_remove_page =  moea_quick_remove_page,
37145b69dd6SJustin Hibbits 	.page_is_mapped = moea_page_is_mapped,
3728dc8feb5SJason A. Harmening 	.ps_enabled = moea_ps_enabled,
37359276937SPeter Grehan 
37459276937SPeter Grehan 	/* Internal interfaces */
37545b69dd6SJustin Hibbits 	.bootstrap =        	moea_bootstrap,
37645b69dd6SJustin Hibbits 	.cpu_bootstrap =    	moea_cpu_bootstrap,
37745b69dd6SJustin Hibbits 	.mapdev_attr = moea_mapdev_attr,
37845b69dd6SJustin Hibbits 	.mapdev = moea_mapdev,
37945b69dd6SJustin Hibbits 	.unmapdev = moea_unmapdev,
38045b69dd6SJustin Hibbits 	.kextract = moea_kextract,
38145b69dd6SJustin Hibbits 	.kenter = moea_kenter,
38245b69dd6SJustin Hibbits 	.kenter_attr = moea_kenter_attr,
38345b69dd6SJustin Hibbits 	.dev_direct_mapped = moea_dev_direct_mapped,
38445b69dd6SJustin Hibbits 	.dumpsys_pa_init = moea_scan_init,
38545b69dd6SJustin Hibbits 	.dumpsys_map_chunk = moea_dumpsys_map,
38645b69dd6SJustin Hibbits 	.map_user_ptr = moea_map_user_ptr,
38745b69dd6SJustin Hibbits 	.decode_kernel_ptr =  moea_decode_kernel_ptr,
38859276937SPeter Grehan };
38959276937SPeter Grehan 
39045b69dd6SJustin Hibbits MMU_DEF(oea_mmu, MMU_TYPE_OEA, moea_methods);
39133529b98SPeter Grehan 
392c1f4123bSNathan Whitehorn static __inline uint32_t
moea_calc_wimg(vm_paddr_t pa,vm_memattr_t ma)3930936003eSJustin Hibbits moea_calc_wimg(vm_paddr_t pa, vm_memattr_t ma)
394c1f4123bSNathan Whitehorn {
395c1f4123bSNathan Whitehorn 	uint32_t pte_lo;
396c1f4123bSNathan Whitehorn 	int i;
397c1f4123bSNathan Whitehorn 
398c1f4123bSNathan Whitehorn 	if (ma != VM_MEMATTR_DEFAULT) {
399c1f4123bSNathan Whitehorn 		switch (ma) {
400c1f4123bSNathan Whitehorn 		case VM_MEMATTR_UNCACHEABLE:
401c1f4123bSNathan Whitehorn 			return (PTE_I | PTE_G);
40254ac2713SJustin Hibbits 		case VM_MEMATTR_CACHEABLE:
40354ac2713SJustin Hibbits 			return (PTE_M);
404c1f4123bSNathan Whitehorn 		case VM_MEMATTR_WRITE_COMBINING:
405c1f4123bSNathan Whitehorn 		case VM_MEMATTR_WRITE_BACK:
406c1f4123bSNathan Whitehorn 		case VM_MEMATTR_PREFETCHABLE:
407c1f4123bSNathan Whitehorn 			return (PTE_I);
408c1f4123bSNathan Whitehorn 		case VM_MEMATTR_WRITE_THROUGH:
409c1f4123bSNathan Whitehorn 			return (PTE_W | PTE_M);
410c1f4123bSNathan Whitehorn 		}
411c1f4123bSNathan Whitehorn 	}
412c1f4123bSNathan Whitehorn 
413c1f4123bSNathan Whitehorn 	/*
414c1f4123bSNathan Whitehorn 	 * Assume the page is cache inhibited and access is guarded unless
415c1f4123bSNathan Whitehorn 	 * it's in our available memory array.
416c1f4123bSNathan Whitehorn 	 */
417c1f4123bSNathan Whitehorn 	pte_lo = PTE_I | PTE_G;
418c1f4123bSNathan Whitehorn 	for (i = 0; i < pregions_sz; i++) {
419c1f4123bSNathan Whitehorn 		if ((pa >= pregions[i].mr_start) &&
420c1f4123bSNathan Whitehorn 		    (pa < (pregions[i].mr_start + pregions[i].mr_size))) {
421c1f4123bSNathan Whitehorn 			pte_lo = PTE_M;
422c1f4123bSNathan Whitehorn 			break;
423c1f4123bSNathan Whitehorn 		}
424c1f4123bSNathan Whitehorn 	}
425c1f4123bSNathan Whitehorn 
426c1f4123bSNathan Whitehorn 	return pte_lo;
427c1f4123bSNathan Whitehorn }
42859276937SPeter Grehan 
429f10baa40SBrandon Bergren /*
430f10baa40SBrandon Bergren  * Translate OFW translations into VM attributes.
431f10baa40SBrandon Bergren  */
432f10baa40SBrandon Bergren static __inline vm_memattr_t
moea_bootstrap_convert_wimg(uint32_t mode)433f10baa40SBrandon Bergren moea_bootstrap_convert_wimg(uint32_t mode)
434f10baa40SBrandon Bergren {
435f10baa40SBrandon Bergren 
436f10baa40SBrandon Bergren 	switch (mode) {
437f10baa40SBrandon Bergren 	case (PTE_I | PTE_G):
438f10baa40SBrandon Bergren 		/* PCI device memory */
439f10baa40SBrandon Bergren 		return VM_MEMATTR_UNCACHEABLE;
440f10baa40SBrandon Bergren 	case (PTE_M):
441f10baa40SBrandon Bergren 		/* Explicitly coherent */
442f10baa40SBrandon Bergren 		return VM_MEMATTR_CACHEABLE;
443f10baa40SBrandon Bergren 	case 0: /* Default claim */
444f10baa40SBrandon Bergren 	case 2: /* Alternate PP bits set by OF for the original payload */
445f10baa40SBrandon Bergren 		/* "Normal" memory. */
446f10baa40SBrandon Bergren 		return VM_MEMATTR_DEFAULT;
447f10baa40SBrandon Bergren 
448f10baa40SBrandon Bergren 	default:
449f10baa40SBrandon Bergren 		/* Err on the side of caution for unknowns */
450f10baa40SBrandon Bergren 		/* XXX should we panic instead? */
451f10baa40SBrandon Bergren 		return VM_MEMATTR_UNCACHEABLE;
452f10baa40SBrandon Bergren 	}
453f10baa40SBrandon Bergren }
454f10baa40SBrandon Bergren 
455e4f72b32SMarcel Moolenaar static void
tlbie(vm_offset_t va)456e4f72b32SMarcel Moolenaar tlbie(vm_offset_t va)
457e4f72b32SMarcel Moolenaar {
458e4f72b32SMarcel Moolenaar 
459e4f72b32SMarcel Moolenaar 	mtx_lock_spin(&tlbie_mtx);
46094363f53SNathan Whitehorn 	__asm __volatile("ptesync");
461e4f72b32SMarcel Moolenaar 	__asm __volatile("tlbie %0" :: "r"(va));
46294363f53SNathan Whitehorn 	__asm __volatile("eieio; tlbsync; ptesync");
463e4f72b32SMarcel Moolenaar 	mtx_unlock_spin(&tlbie_mtx);
464e4f72b32SMarcel Moolenaar }
465e4f72b32SMarcel Moolenaar 
466e4f72b32SMarcel Moolenaar static void
tlbia(void)467e4f72b32SMarcel Moolenaar tlbia(void)
468e4f72b32SMarcel Moolenaar {
469e4f72b32SMarcel Moolenaar 	vm_offset_t va;
470e4f72b32SMarcel Moolenaar 
471e4f72b32SMarcel Moolenaar 	for (va = 0; va < 0x00040000; va += 0x00001000) {
472e4f72b32SMarcel Moolenaar 		__asm __volatile("tlbie %0" :: "r"(va));
473e4f72b32SMarcel Moolenaar 		powerpc_sync();
474e4f72b32SMarcel Moolenaar 	}
475e4f72b32SMarcel Moolenaar 	__asm __volatile("tlbsync");
476e4f72b32SMarcel Moolenaar 	powerpc_sync();
477e4f72b32SMarcel Moolenaar }
4785244eac9SBenno Rice 
4795244eac9SBenno Rice static __inline int
va_to_sr(u_int * sr,vm_offset_t va)4805244eac9SBenno Rice va_to_sr(u_int *sr, vm_offset_t va)
4815244eac9SBenno Rice {
4825244eac9SBenno Rice 	return (sr[(uintptr_t)va >> ADDR_SR_SHFT]);
4835244eac9SBenno Rice }
4845244eac9SBenno Rice 
4855244eac9SBenno Rice static __inline u_int
va_to_pteg(u_int sr,vm_offset_t addr)4865244eac9SBenno Rice va_to_pteg(u_int sr, vm_offset_t addr)
4875244eac9SBenno Rice {
4885244eac9SBenno Rice 	u_int hash;
4895244eac9SBenno Rice 
4905244eac9SBenno Rice 	hash = (sr & SR_VSID_MASK) ^ (((u_int)addr & ADDR_PIDX) >>
4915244eac9SBenno Rice 	    ADDR_PIDX_SHFT);
49259276937SPeter Grehan 	return (hash & moea_pteg_mask);
4935244eac9SBenno Rice }
4945244eac9SBenno Rice 
4955244eac9SBenno Rice static __inline struct pvo_head *
vm_page_to_pvoh(vm_page_t m)4965244eac9SBenno Rice vm_page_to_pvoh(vm_page_t m)
497f9bac91bSBenno Rice {
498f9bac91bSBenno Rice 
4995244eac9SBenno Rice 	return (&m->md.mdpg_pvoh);
500f9bac91bSBenno Rice }
501f9bac91bSBenno Rice 
502f9bac91bSBenno Rice static __inline void
moea_attr_clear(vm_page_t m,int ptebit)50359276937SPeter Grehan moea_attr_clear(vm_page_t m, int ptebit)
504f9bac91bSBenno Rice {
505f9bac91bSBenno Rice 
5063653f5cbSAlan Cox 	rw_assert(&pvh_global_lock, RA_WLOCKED);
5075244eac9SBenno Rice 	m->md.mdpg_attrs &= ~ptebit;
5085244eac9SBenno Rice }
5095244eac9SBenno Rice 
5105244eac9SBenno Rice static __inline int
moea_attr_fetch(vm_page_t m)51159276937SPeter Grehan moea_attr_fetch(vm_page_t m)
5125244eac9SBenno Rice {
5135244eac9SBenno Rice 
5145244eac9SBenno Rice 	return (m->md.mdpg_attrs);
515f9bac91bSBenno Rice }
516f9bac91bSBenno Rice 
517f9bac91bSBenno Rice static __inline void
moea_attr_save(vm_page_t m,int ptebit)51859276937SPeter Grehan moea_attr_save(vm_page_t m, int ptebit)
519f9bac91bSBenno Rice {
520f9bac91bSBenno Rice 
5213653f5cbSAlan Cox 	rw_assert(&pvh_global_lock, RA_WLOCKED);
5225244eac9SBenno Rice 	m->md.mdpg_attrs |= ptebit;
523f9bac91bSBenno Rice }
524f9bac91bSBenno Rice 
525f9bac91bSBenno Rice static __inline int
moea_pte_compare(const struct pte * pt,const struct pte * pvo_pt)52659276937SPeter Grehan moea_pte_compare(const struct pte *pt, const struct pte *pvo_pt)
527f9bac91bSBenno Rice {
5285244eac9SBenno Rice 	if (pt->pte_hi == pvo_pt->pte_hi)
5295244eac9SBenno Rice 		return (1);
530f9bac91bSBenno Rice 
5315244eac9SBenno Rice 	return (0);
532f9bac91bSBenno Rice }
533f9bac91bSBenno Rice 
534f9bac91bSBenno Rice static __inline int
moea_pte_match(struct pte * pt,u_int sr,vm_offset_t va,int which)53559276937SPeter Grehan moea_pte_match(struct pte *pt, u_int sr, vm_offset_t va, int which)
536f9bac91bSBenno Rice {
5375244eac9SBenno Rice 	return (pt->pte_hi & ~PTE_VALID) ==
5385244eac9SBenno Rice 	    (((sr & SR_VSID_MASK) << PTE_VSID_SHFT) |
5395244eac9SBenno Rice 	    ((va >> ADDR_API_SHFT) & PTE_API) | which);
540f9bac91bSBenno Rice }
541f9bac91bSBenno Rice 
5425244eac9SBenno Rice static __inline void
moea_pte_create(struct pte * pt,u_int sr,vm_offset_t va,u_int pte_lo)54359276937SPeter Grehan moea_pte_create(struct pte *pt, u_int sr, vm_offset_t va, u_int pte_lo)
544f9bac91bSBenno Rice {
545d644a0b7SAlan Cox 
546d644a0b7SAlan Cox 	mtx_assert(&moea_table_mutex, MA_OWNED);
547d644a0b7SAlan Cox 
548f9bac91bSBenno Rice 	/*
5495244eac9SBenno Rice 	 * Construct a PTE.  Default to IMB initially.  Valid bit only gets
5505244eac9SBenno Rice 	 * set when the real pte is set in memory.
551f9bac91bSBenno Rice 	 *
552f9bac91bSBenno Rice 	 * Note: Don't set the valid bit for correct operation of tlb update.
553f9bac91bSBenno Rice 	 */
5545244eac9SBenno Rice 	pt->pte_hi = ((sr & SR_VSID_MASK) << PTE_VSID_SHFT) |
5555244eac9SBenno Rice 	    (((va & ADDR_PIDX) >> ADDR_API_SHFT) & PTE_API);
5565244eac9SBenno Rice 	pt->pte_lo = pte_lo;
557f9bac91bSBenno Rice }
558f9bac91bSBenno Rice 
5595244eac9SBenno Rice static __inline void
moea_pte_synch(struct pte * pt,struct pte * pvo_pt)56059276937SPeter Grehan moea_pte_synch(struct pte *pt, struct pte *pvo_pt)
561f9bac91bSBenno Rice {
562f9bac91bSBenno Rice 
563d644a0b7SAlan Cox 	mtx_assert(&moea_table_mutex, MA_OWNED);
5645244eac9SBenno Rice 	pvo_pt->pte_lo |= pt->pte_lo & (PTE_REF | PTE_CHG);
565f9bac91bSBenno Rice }
566f9bac91bSBenno Rice 
5675244eac9SBenno Rice static __inline void
moea_pte_clear(struct pte * pt,vm_offset_t va,int ptebit)56859276937SPeter Grehan moea_pte_clear(struct pte *pt, vm_offset_t va, int ptebit)
569f9bac91bSBenno Rice {
5705244eac9SBenno Rice 
571d644a0b7SAlan Cox 	mtx_assert(&moea_table_mutex, MA_OWNED);
572d644a0b7SAlan Cox 
5735244eac9SBenno Rice 	/*
5745244eac9SBenno Rice 	 * As shown in Section 7.6.3.2.3
5755244eac9SBenno Rice 	 */
5765244eac9SBenno Rice 	pt->pte_lo &= ~ptebit;
577e4f72b32SMarcel Moolenaar 	tlbie(va);
5785244eac9SBenno Rice }
5795244eac9SBenno Rice 
5805244eac9SBenno Rice static __inline void
moea_pte_set(struct pte * pt,struct pte * pvo_pt)58159276937SPeter Grehan moea_pte_set(struct pte *pt, struct pte *pvo_pt)
5825244eac9SBenno Rice {
5835244eac9SBenno Rice 
584d644a0b7SAlan Cox 	mtx_assert(&moea_table_mutex, MA_OWNED);
5855244eac9SBenno Rice 	pvo_pt->pte_hi |= PTE_VALID;
5865244eac9SBenno Rice 
5875244eac9SBenno Rice 	/*
5885244eac9SBenno Rice 	 * Update the PTE as defined in section 7.6.3.1.
589804d1cc1SJustin Hibbits 	 * Note that the REF/CHG bits are from pvo_pt and thus should have
5905244eac9SBenno Rice 	 * been saved so this routine can restore them (if desired).
5915244eac9SBenno Rice 	 */
5925244eac9SBenno Rice 	pt->pte_lo = pvo_pt->pte_lo;
593e4f72b32SMarcel Moolenaar 	powerpc_sync();
5945244eac9SBenno Rice 	pt->pte_hi = pvo_pt->pte_hi;
595e4f72b32SMarcel Moolenaar 	powerpc_sync();
59659276937SPeter Grehan 	moea_pte_valid++;
5975244eac9SBenno Rice }
5985244eac9SBenno Rice 
5995244eac9SBenno Rice static __inline void
moea_pte_unset(struct pte * pt,struct pte * pvo_pt,vm_offset_t va)60059276937SPeter Grehan moea_pte_unset(struct pte *pt, struct pte *pvo_pt, vm_offset_t va)
6015244eac9SBenno Rice {
6025244eac9SBenno Rice 
603d644a0b7SAlan Cox 	mtx_assert(&moea_table_mutex, MA_OWNED);
6045244eac9SBenno Rice 	pvo_pt->pte_hi &= ~PTE_VALID;
6055244eac9SBenno Rice 
6065244eac9SBenno Rice 	/*
6075244eac9SBenno Rice 	 * Force the reg & chg bits back into the PTEs.
6085244eac9SBenno Rice 	 */
609e4f72b32SMarcel Moolenaar 	powerpc_sync();
6105244eac9SBenno Rice 
6115244eac9SBenno Rice 	/*
6125244eac9SBenno Rice 	 * Invalidate the pte.
6135244eac9SBenno Rice 	 */
6145244eac9SBenno Rice 	pt->pte_hi &= ~PTE_VALID;
6155244eac9SBenno Rice 
616e4f72b32SMarcel Moolenaar 	tlbie(va);
6175244eac9SBenno Rice 
6185244eac9SBenno Rice 	/*
6195244eac9SBenno Rice 	 * Save the reg & chg bits.
6205244eac9SBenno Rice 	 */
62159276937SPeter Grehan 	moea_pte_synch(pt, pvo_pt);
62259276937SPeter Grehan 	moea_pte_valid--;
6235244eac9SBenno Rice }
6245244eac9SBenno Rice 
6255244eac9SBenno Rice static __inline void
moea_pte_change(struct pte * pt,struct pte * pvo_pt,vm_offset_t va)62659276937SPeter Grehan moea_pte_change(struct pte *pt, struct pte *pvo_pt, vm_offset_t va)
6275244eac9SBenno Rice {
6285244eac9SBenno Rice 
6295244eac9SBenno Rice 	/*
6305244eac9SBenno Rice 	 * Invalidate the PTE
6315244eac9SBenno Rice 	 */
63259276937SPeter Grehan 	moea_pte_unset(pt, pvo_pt, va);
63359276937SPeter Grehan 	moea_pte_set(pt, pvo_pt);
634f9bac91bSBenno Rice }
635f9bac91bSBenno Rice 
636f9bac91bSBenno Rice /*
6375244eac9SBenno Rice  * Quick sort callout for comparing memory regions.
638f9bac91bSBenno Rice  */
6395244eac9SBenno Rice static int	om_cmp(const void *a, const void *b);
6405244eac9SBenno Rice 
6415244eac9SBenno Rice static int
om_cmp(const void * a,const void * b)6425244eac9SBenno Rice om_cmp(const void *a, const void *b)
6435244eac9SBenno Rice {
6445244eac9SBenno Rice 	const struct	ofw_map *mapa;
6455244eac9SBenno Rice 	const struct	ofw_map *mapb;
6465244eac9SBenno Rice 
6475244eac9SBenno Rice 	mapa = a;
6485244eac9SBenno Rice 	mapb = b;
6495244eac9SBenno Rice 	if (mapa->om_pa < mapb->om_pa)
6505244eac9SBenno Rice 		return (-1);
6515244eac9SBenno Rice 	else if (mapa->om_pa > mapb->om_pa)
6525244eac9SBenno Rice 		return (1);
6535244eac9SBenno Rice 	else
6545244eac9SBenno Rice 		return (0);
655f9bac91bSBenno Rice }
656f9bac91bSBenno Rice 
657f9bac91bSBenno Rice void
moea_cpu_bootstrap(int ap)65845b69dd6SJustin Hibbits moea_cpu_bootstrap(int ap)
65912640815SMarcel Moolenaar {
66012640815SMarcel Moolenaar 	u_int sdr;
66112640815SMarcel Moolenaar 	int i;
66212640815SMarcel Moolenaar 
66312640815SMarcel Moolenaar 	if (ap) {
664e4f72b32SMarcel Moolenaar 		powerpc_sync();
66512640815SMarcel Moolenaar 		__asm __volatile("mtdbatu 0,%0" :: "r"(battable[0].batu));
66612640815SMarcel Moolenaar 		__asm __volatile("mtdbatl 0,%0" :: "r"(battable[0].batl));
66712640815SMarcel Moolenaar 		isync();
66812640815SMarcel Moolenaar 		__asm __volatile("mtibatu 0,%0" :: "r"(battable[0].batu));
66912640815SMarcel Moolenaar 		__asm __volatile("mtibatl 0,%0" :: "r"(battable[0].batl));
67012640815SMarcel Moolenaar 		isync();
67112640815SMarcel Moolenaar 	}
67212640815SMarcel Moolenaar 
67301d8aa0dSMarcel Moolenaar 	__asm __volatile("mtdbatu 1,%0" :: "r"(battable[8].batu));
67401d8aa0dSMarcel Moolenaar 	__asm __volatile("mtdbatl 1,%0" :: "r"(battable[8].batl));
67512640815SMarcel Moolenaar 	isync();
67612640815SMarcel Moolenaar 
67701d8aa0dSMarcel Moolenaar 	__asm __volatile("mtibatu 1,%0" :: "r"(0));
67801d8aa0dSMarcel Moolenaar 	__asm __volatile("mtdbatu 2,%0" :: "r"(0));
67901d8aa0dSMarcel Moolenaar 	__asm __volatile("mtibatu 2,%0" :: "r"(0));
68001d8aa0dSMarcel Moolenaar 	__asm __volatile("mtdbatu 3,%0" :: "r"(0));
68101d8aa0dSMarcel Moolenaar 	__asm __volatile("mtibatu 3,%0" :: "r"(0));
68212640815SMarcel Moolenaar 	isync();
68312640815SMarcel Moolenaar 
68412640815SMarcel Moolenaar 	for (i = 0; i < 16; i++)
685fe3b4685SNathan Whitehorn 		mtsrin(i << ADDR_SR_SHFT, kernel_pmap->pm_sr[i]);
686e4f72b32SMarcel Moolenaar 	powerpc_sync();
68712640815SMarcel Moolenaar 
68812640815SMarcel Moolenaar 	sdr = (u_int)moea_pteg_table | (moea_pteg_mask >> 10);
68912640815SMarcel Moolenaar 	__asm __volatile("mtsdr1 %0" :: "r"(sdr));
69012640815SMarcel Moolenaar 	isync();
69112640815SMarcel Moolenaar 
69286c1fb4cSMarcel Moolenaar 	tlbia();
69312640815SMarcel Moolenaar }
69412640815SMarcel Moolenaar 
69512640815SMarcel Moolenaar void
moea_bootstrap(vm_offset_t kernelstart,vm_offset_t kernelend)69645b69dd6SJustin Hibbits moea_bootstrap(vm_offset_t kernelstart, vm_offset_t kernelend)
697f9bac91bSBenno Rice {
69831c82d03SBenno Rice 	ihandle_t	mmui;
6995244eac9SBenno Rice 	phandle_t	chosen, mmu;
7005244eac9SBenno Rice 	int		sz;
7015244eac9SBenno Rice 	int		i, j;
702e2f6d6e2SPeter Grehan 	vm_size_t	size, physsz, hwphyssz;
7035244eac9SBenno Rice 	vm_offset_t	pa, va, off;
70450c202c5SJeff Roberson 	void		*dpcpu;
7050d290675SBenno Rice 
7060d290675SBenno Rice 	/*
7070d290675SBenno Rice 	 * Map PCI memory space.
7080d290675SBenno Rice 	 */
7090d290675SBenno Rice 	battable[0x8].batl = BATL(0x80000000, BAT_I|BAT_G, BAT_PP_RW);
7100d290675SBenno Rice 	battable[0x8].batu = BATU(0x80000000, BAT_BL_256M, BAT_Vs);
7110d290675SBenno Rice 
7120d290675SBenno Rice 	battable[0x9].batl = BATL(0x90000000, BAT_I|BAT_G, BAT_PP_RW);
7130d290675SBenno Rice 	battable[0x9].batu = BATU(0x90000000, BAT_BL_256M, BAT_Vs);
7140d290675SBenno Rice 
7150d290675SBenno Rice 	battable[0xa].batl = BATL(0xa0000000, BAT_I|BAT_G, BAT_PP_RW);
7160d290675SBenno Rice 	battable[0xa].batu = BATU(0xa0000000, BAT_BL_256M, BAT_Vs);
7170d290675SBenno Rice 
7180d290675SBenno Rice 	battable[0xb].batl = BATL(0xb0000000, BAT_I|BAT_G, BAT_PP_RW);
7190d290675SBenno Rice 	battable[0xb].batu = BATU(0xb0000000, BAT_BL_256M, BAT_Vs);
7200d290675SBenno Rice 
721f10baa40SBrandon Bergren 	powerpc_sync();
7220d290675SBenno Rice 
7230d290675SBenno Rice 	/* map pci space */
72412640815SMarcel Moolenaar 	__asm __volatile("mtdbatu 1,%0" :: "r"(battable[8].batu));
72512640815SMarcel Moolenaar 	__asm __volatile("mtdbatl 1,%0" :: "r"(battable[8].batl));
72612640815SMarcel Moolenaar 	isync();
727f9bac91bSBenno Rice 
7281c96bdd1SNathan Whitehorn 	/* set global direct map flag */
7291c96bdd1SNathan Whitehorn 	hw_direct_map = 1;
7301c96bdd1SNathan Whitehorn 
73131c82d03SBenno Rice 	mem_regions(&pregions, &pregions_sz, &regions, &regions_sz);
73259276937SPeter Grehan 	CTR0(KTR_PMAP, "moea_bootstrap: physical memory");
73331c82d03SBenno Rice 
73431c82d03SBenno Rice 	for (i = 0; i < pregions_sz; i++) {
73532bc7846SPeter Grehan 		vm_offset_t pa;
73632bc7846SPeter Grehan 		vm_offset_t end;
73732bc7846SPeter Grehan 
73831c82d03SBenno Rice 		CTR3(KTR_PMAP, "physregion: %#x - %#x (%#x)",
73931c82d03SBenno Rice 			pregions[i].mr_start,
74031c82d03SBenno Rice 			pregions[i].mr_start + pregions[i].mr_size,
74131c82d03SBenno Rice 			pregions[i].mr_size);
74232bc7846SPeter Grehan 		/*
74332bc7846SPeter Grehan 		 * Install entries into the BAT table to allow all
74432bc7846SPeter Grehan 		 * of physmem to be convered by on-demand BAT entries.
74532bc7846SPeter Grehan 		 * The loop will sometimes set the same battable element
74632bc7846SPeter Grehan 		 * twice, but that's fine since they won't be used for
74732bc7846SPeter Grehan 		 * a while yet.
74832bc7846SPeter Grehan 		 */
74932bc7846SPeter Grehan 		pa = pregions[i].mr_start & 0xf0000000;
75032bc7846SPeter Grehan 		end = pregions[i].mr_start + pregions[i].mr_size;
75132bc7846SPeter Grehan 		do {
75232bc7846SPeter Grehan                         u_int n = pa >> ADDR_SR_SHFT;
75332bc7846SPeter Grehan 
75432bc7846SPeter Grehan 			battable[n].batl = BATL(pa, BAT_M, BAT_PP_RW);
75532bc7846SPeter Grehan 			battable[n].batu = BATU(pa, BAT_BL_256M, BAT_Vs);
75632bc7846SPeter Grehan 			pa += SEGMENT_LENGTH;
75732bc7846SPeter Grehan 		} while (pa < end);
75831c82d03SBenno Rice 	}
75931c82d03SBenno Rice 
76021943937SJeff Roberson 	if (PHYS_AVAIL_ENTRIES < regions_sz)
76159276937SPeter Grehan 		panic("moea_bootstrap: phys_avail too small");
76297f7cde4SNathan Whitehorn 
7635244eac9SBenno Rice 	phys_avail_count = 0;
764d2c1f576SBenno Rice 	physsz = 0;
765b0c21309SPeter Grehan 	hwphyssz = 0;
766b0c21309SPeter Grehan 	TUNABLE_ULONG_FETCH("hw.physmem", (u_long *) &hwphyssz);
76731c82d03SBenno Rice 	for (i = 0, j = 0; i < regions_sz; i++, j += 2) {
7685244eac9SBenno Rice 		CTR3(KTR_PMAP, "region: %#x - %#x (%#x)", regions[i].mr_start,
7695244eac9SBenno Rice 		    regions[i].mr_start + regions[i].mr_size,
7705244eac9SBenno Rice 		    regions[i].mr_size);
771e2f6d6e2SPeter Grehan 		if (hwphyssz != 0 &&
772e2f6d6e2SPeter Grehan 		    (physsz + regions[i].mr_size) >= hwphyssz) {
773e2f6d6e2SPeter Grehan 			if (physsz < hwphyssz) {
774e2f6d6e2SPeter Grehan 				phys_avail[j] = regions[i].mr_start;
775e2f6d6e2SPeter Grehan 				phys_avail[j + 1] = regions[i].mr_start +
776e2f6d6e2SPeter Grehan 				    hwphyssz - physsz;
777e2f6d6e2SPeter Grehan 				physsz = hwphyssz;
778e2f6d6e2SPeter Grehan 				phys_avail_count++;
779e2f6d6e2SPeter Grehan 			}
780e2f6d6e2SPeter Grehan 			break;
781e2f6d6e2SPeter Grehan 		}
7825244eac9SBenno Rice 		phys_avail[j] = regions[i].mr_start;
7835244eac9SBenno Rice 		phys_avail[j + 1] = regions[i].mr_start + regions[i].mr_size;
7845244eac9SBenno Rice 		phys_avail_count++;
785d2c1f576SBenno Rice 		physsz += regions[i].mr_size;
786f9bac91bSBenno Rice 	}
787e347e23bSNathan Whitehorn 
788e347e23bSNathan Whitehorn 	/* Check for overlap with the kernel and exception vectors */
789e347e23bSNathan Whitehorn 	for (j = 0; j < 2*phys_avail_count; j+=2) {
790e347e23bSNathan Whitehorn 		if (phys_avail[j] < EXC_LAST)
791e347e23bSNathan Whitehorn 			phys_avail[j] += EXC_LAST;
792e347e23bSNathan Whitehorn 
793e347e23bSNathan Whitehorn 		if (kernelstart >= phys_avail[j] &&
794e347e23bSNathan Whitehorn 		    kernelstart < phys_avail[j+1]) {
795e347e23bSNathan Whitehorn 			if (kernelend < phys_avail[j+1]) {
796e347e23bSNathan Whitehorn 				phys_avail[2*phys_avail_count] =
797e347e23bSNathan Whitehorn 				    (kernelend & ~PAGE_MASK) + PAGE_SIZE;
798e347e23bSNathan Whitehorn 				phys_avail[2*phys_avail_count + 1] =
799e347e23bSNathan Whitehorn 				    phys_avail[j+1];
800e347e23bSNathan Whitehorn 				phys_avail_count++;
801e347e23bSNathan Whitehorn 			}
802e347e23bSNathan Whitehorn 
803e347e23bSNathan Whitehorn 			phys_avail[j+1] = kernelstart & ~PAGE_MASK;
804e347e23bSNathan Whitehorn 		}
805e347e23bSNathan Whitehorn 
806e347e23bSNathan Whitehorn 		if (kernelend >= phys_avail[j] &&
807e347e23bSNathan Whitehorn 		    kernelend < phys_avail[j+1]) {
808e347e23bSNathan Whitehorn 			if (kernelstart > phys_avail[j]) {
809e347e23bSNathan Whitehorn 				phys_avail[2*phys_avail_count] = phys_avail[j];
810e347e23bSNathan Whitehorn 				phys_avail[2*phys_avail_count + 1] =
811e347e23bSNathan Whitehorn 				    kernelstart & ~PAGE_MASK;
812e347e23bSNathan Whitehorn 				phys_avail_count++;
813e347e23bSNathan Whitehorn 			}
814e347e23bSNathan Whitehorn 
815e347e23bSNathan Whitehorn 			phys_avail[j] = (kernelend & ~PAGE_MASK) + PAGE_SIZE;
816e347e23bSNathan Whitehorn 		}
817e347e23bSNathan Whitehorn 	}
818e347e23bSNathan Whitehorn 
819d2c1f576SBenno Rice 	physmem = btoc(physsz);
820f9bac91bSBenno Rice 
821f9bac91bSBenno Rice 	/*
8225244eac9SBenno Rice 	 * Allocate PTEG table.
823f9bac91bSBenno Rice 	 */
8245244eac9SBenno Rice #ifdef PTEGCOUNT
82559276937SPeter Grehan 	moea_pteg_count = PTEGCOUNT;
8265244eac9SBenno Rice #else
82759276937SPeter Grehan 	moea_pteg_count = 0x1000;
828f9bac91bSBenno Rice 
82959276937SPeter Grehan 	while (moea_pteg_count < physmem)
83059276937SPeter Grehan 		moea_pteg_count <<= 1;
831f9bac91bSBenno Rice 
83259276937SPeter Grehan 	moea_pteg_count >>= 1;
8335244eac9SBenno Rice #endif /* PTEGCOUNT */
834f9bac91bSBenno Rice 
83559276937SPeter Grehan 	size = moea_pteg_count * sizeof(struct pteg);
83659276937SPeter Grehan 	CTR2(KTR_PMAP, "moea_bootstrap: %d PTEGs, %d bytes", moea_pteg_count,
8375244eac9SBenno Rice 	    size);
83859276937SPeter Grehan 	moea_pteg_table = (struct pteg *)moea_bootstrap_alloc(size, size);
83959276937SPeter Grehan 	CTR1(KTR_PMAP, "moea_bootstrap: PTEG table at %p", moea_pteg_table);
84059276937SPeter Grehan 	bzero((void *)moea_pteg_table, moea_pteg_count * sizeof(struct pteg));
84159276937SPeter Grehan 	moea_pteg_mask = moea_pteg_count - 1;
842f9bac91bSBenno Rice 
8435244eac9SBenno Rice 	/*
844864bc520SBenno Rice 	 * Allocate pv/overflow lists.
8455244eac9SBenno Rice 	 */
84659276937SPeter Grehan 	size = sizeof(struct pvo_head) * moea_pteg_count;
84759276937SPeter Grehan 	moea_pvo_table = (struct pvo_head *)moea_bootstrap_alloc(size,
8485244eac9SBenno Rice 	    PAGE_SIZE);
84959276937SPeter Grehan 	CTR1(KTR_PMAP, "moea_bootstrap: PVO table at %p", moea_pvo_table);
85059276937SPeter Grehan 	for (i = 0; i < moea_pteg_count; i++)
85159276937SPeter Grehan 		LIST_INIT(&moea_pvo_table[i]);
8525244eac9SBenno Rice 
8535244eac9SBenno Rice 	/*
854f489bf21SAlan Cox 	 * Initialize the lock that synchronizes access to the pteg and pvo
855f489bf21SAlan Cox 	 * tables.
856f489bf21SAlan Cox 	 */
857d644a0b7SAlan Cox 	mtx_init(&moea_table_mutex, "pmap table", NULL, MTX_DEF |
858d644a0b7SAlan Cox 	    MTX_RECURSE);
859e9b5f218SNathan Whitehorn 	mtx_init(&moea_vsid_mutex, "VSID table", NULL, MTX_DEF);
860f489bf21SAlan Cox 
861e4f72b32SMarcel Moolenaar 	mtx_init(&tlbie_mtx, "tlbie", NULL, MTX_SPIN);
862e4f72b32SMarcel Moolenaar 
863f489bf21SAlan Cox 	/*
8645244eac9SBenno Rice 	 * Initialise the unmanaged pvo pool.
8655244eac9SBenno Rice 	 */
86659276937SPeter Grehan 	moea_bpvo_pool = (struct pvo_entry *)moea_bootstrap_alloc(
8670d290675SBenno Rice 		BPVO_POOL_SIZE*sizeof(struct pvo_entry), 0);
86859276937SPeter Grehan 	moea_bpvo_pool_index = 0;
8695244eac9SBenno Rice 
8705244eac9SBenno Rice 	/*
8715244eac9SBenno Rice 	 * Make sure kernel vsid is allocated as well as VSID 0.
8725244eac9SBenno Rice 	 */
87359276937SPeter Grehan 	moea_vsid_bitmap[(KERNEL_VSIDBITS & (NPMAPS - 1)) / VSID_NBPW]
8745244eac9SBenno Rice 		|= 1 << (KERNEL_VSIDBITS % VSID_NBPW);
87559276937SPeter Grehan 	moea_vsid_bitmap[0] |= 1;
8765244eac9SBenno Rice 
8775244eac9SBenno Rice 	/*
878fe3b4685SNathan Whitehorn 	 * Initialize the kernel pmap (which is statically allocated).
8795244eac9SBenno Rice 	 */
880fe3b4685SNathan Whitehorn 	PMAP_LOCK_INIT(kernel_pmap);
881fe3b4685SNathan Whitehorn 	for (i = 0; i < 16; i++)
882fe3b4685SNathan Whitehorn 		kernel_pmap->pm_sr[i] = EMPTY_SEGMENT + i;
883c47dd3dbSAttilio Rao 	CPU_FILL(&kernel_pmap->pm_active);
884ccc4a5c7SNathan Whitehorn 	RB_INIT(&kernel_pmap->pmap_pvo);
885fe3b4685SNathan Whitehorn 
886fe3b4685SNathan Whitehorn  	/*
8873653f5cbSAlan Cox 	 * Initialize the global pv list lock.
8883653f5cbSAlan Cox 	 */
8893653f5cbSAlan Cox 	rw_init(&pvh_global_lock, "pmap pv global");
8903653f5cbSAlan Cox 
8913653f5cbSAlan Cox 	/*
892fe3b4685SNathan Whitehorn 	 * Set up the Open Firmware mappings
893fe3b4685SNathan Whitehorn 	 */
894e347e23bSNathan Whitehorn 	chosen = OF_finddevice("/chosen");
895e347e23bSNathan Whitehorn 	if (chosen != -1 && OF_getprop(chosen, "mmu", &mmui, 4) != -1 &&
896e347e23bSNathan Whitehorn 	    (mmu = OF_instance_to_package(mmui)) != -1 &&
897e347e23bSNathan Whitehorn 	    (sz = OF_getproplen(mmu, "translations")) != -1) {
898aa39961eSBenno Rice 		translations = NULL;
8996cc1cdf4SPeter Grehan 		for (i = 0; phys_avail[i] != 0; i += 2) {
9006cc1cdf4SPeter Grehan 			if (phys_avail[i + 1] >= sz) {
901aa39961eSBenno Rice 				translations = (struct ofw_map *)phys_avail[i];
9026cc1cdf4SPeter Grehan 				break;
9036cc1cdf4SPeter Grehan 			}
904aa39961eSBenno Rice 		}
905aa39961eSBenno Rice 		if (translations == NULL)
90659276937SPeter Grehan 			panic("moea_bootstrap: no space to copy translations");
9075244eac9SBenno Rice 		bzero(translations, sz);
9085244eac9SBenno Rice 		if (OF_getprop(mmu, "translations", translations, sz) == -1)
90959276937SPeter Grehan 			panic("moea_bootstrap: can't get ofw translations");
91059276937SPeter Grehan 		CTR0(KTR_PMAP, "moea_bootstrap: translations");
91131c82d03SBenno Rice 		sz /= sizeof(*translations);
9125244eac9SBenno Rice 		qsort(translations, sz, sizeof (*translations), om_cmp);
913ed1e1e2aSNathan Whitehorn 		for (i = 0; i < sz; i++) {
9145244eac9SBenno Rice 			CTR3(KTR_PMAP, "translation: pa=%#x va=%#x len=%#x",
9155244eac9SBenno Rice 			    translations[i].om_pa, translations[i].om_va,
9165244eac9SBenno Rice 			    translations[i].om_len);
9175244eac9SBenno Rice 
91832bc7846SPeter Grehan 			/*
919e347e23bSNathan Whitehorn 			 * If the mapping is 1:1, let the RAM and device
920e347e23bSNathan Whitehorn 			 * on-demand BAT tables take care of the translation.
921f10baa40SBrandon Bergren 			 *
922f10baa40SBrandon Bergren 			 * However, always enter mappings for segment 16,
923f10baa40SBrandon Bergren 			 * which is mixed-protection and therefore not
924f10baa40SBrandon Bergren 			 * compatible with a BAT entry.
92532bc7846SPeter Grehan 			 */
926f10baa40SBrandon Bergren 			if ((translations[i].om_va >> ADDR_SR_SHFT) != 0xf &&
927f10baa40SBrandon Bergren 				translations[i].om_va == translations[i].om_pa)
92832bc7846SPeter Grehan 					continue;
9295244eac9SBenno Rice 
93032bc7846SPeter Grehan 			/* Enter the pages */
931e347e23bSNathan Whitehorn 			for (off = 0; off < translations[i].om_len;
932e347e23bSNathan Whitehorn 			    off += PAGE_SIZE)
933f10baa40SBrandon Bergren 				moea_kenter_attr(translations[i].om_va + off,
934f10baa40SBrandon Bergren 				    translations[i].om_pa + off,
935f10baa40SBrandon Bergren 				    moea_bootstrap_convert_wimg(translations[i].om_mode));
936f9bac91bSBenno Rice 		}
937e347e23bSNathan Whitehorn 	}
938014ffa99SMarcel Moolenaar 
939014ffa99SMarcel Moolenaar 	/*
940014ffa99SMarcel Moolenaar 	 * Calculate the last available physical address.
941014ffa99SMarcel Moolenaar 	 */
942014ffa99SMarcel Moolenaar 	for (i = 0; phys_avail[i + 2] != 0; i += 2)
943014ffa99SMarcel Moolenaar 		;
944014ffa99SMarcel Moolenaar 	Maxmem = powerpc_btop(phys_avail[i + 1]);
9455244eac9SBenno Rice 
94645b69dd6SJustin Hibbits 	moea_cpu_bootstrap(0);
9470081393dSNathan Whitehorn 	mtmsr(mfmsr() | PSL_DR | PSL_IR);
9485244eac9SBenno Rice 	pmap_bootstrapped++;
949014ffa99SMarcel Moolenaar 
950014ffa99SMarcel Moolenaar 	/*
951014ffa99SMarcel Moolenaar 	 * Set the start and end of kva.
952014ffa99SMarcel Moolenaar 	 */
953014ffa99SMarcel Moolenaar 	virtual_avail = VM_MIN_KERNEL_ADDRESS;
954ab739706SNathan Whitehorn 	virtual_end = VM_MAX_SAFE_KERNEL_ADDRESS;
955014ffa99SMarcel Moolenaar 
956014ffa99SMarcel Moolenaar 	/*
957014ffa99SMarcel Moolenaar 	 * Allocate a kernel stack with a guard page for thread0 and map it
958014ffa99SMarcel Moolenaar 	 * into the kernel page map.
959014ffa99SMarcel Moolenaar 	 */
960edc82223SKonstantin Belousov 	pa = moea_bootstrap_alloc(kstack_pages * PAGE_SIZE, PAGE_SIZE);
961014ffa99SMarcel Moolenaar 	va = virtual_avail + KSTACK_GUARD_PAGES * PAGE_SIZE;
962edc82223SKonstantin Belousov 	virtual_avail = va + kstack_pages * PAGE_SIZE;
963014ffa99SMarcel Moolenaar 	CTR2(KTR_PMAP, "moea_bootstrap: kstack0 at %#x (%#x)", pa, va);
964014ffa99SMarcel Moolenaar 	thread0.td_kstack = va;
965edc82223SKonstantin Belousov 	thread0.td_kstack_pages = kstack_pages;
966edc82223SKonstantin Belousov 	for (i = 0; i < kstack_pages; i++) {
96745b69dd6SJustin Hibbits 		moea_kenter(va, pa);
968014ffa99SMarcel Moolenaar 		pa += PAGE_SIZE;
969014ffa99SMarcel Moolenaar 		va += PAGE_SIZE;
970014ffa99SMarcel Moolenaar 	}
971014ffa99SMarcel Moolenaar 
972014ffa99SMarcel Moolenaar 	/*
973014ffa99SMarcel Moolenaar 	 * Allocate virtual address space for the message buffer.
974014ffa99SMarcel Moolenaar 	 */
9754053b05bSSergey Kandaurov 	pa = msgbuf_phys = moea_bootstrap_alloc(msgbufsize, PAGE_SIZE);
976014ffa99SMarcel Moolenaar 	msgbufp = (struct msgbuf *)virtual_avail;
977014ffa99SMarcel Moolenaar 	va = virtual_avail;
9784053b05bSSergey Kandaurov 	virtual_avail += round_page(msgbufsize);
979014ffa99SMarcel Moolenaar 	while (va < virtual_avail) {
98045b69dd6SJustin Hibbits 		moea_kenter(va, pa);
981014ffa99SMarcel Moolenaar 		pa += PAGE_SIZE;
982014ffa99SMarcel Moolenaar 		va += PAGE_SIZE;
983014ffa99SMarcel Moolenaar 	}
98450c202c5SJeff Roberson 
98550c202c5SJeff Roberson 	/*
98650c202c5SJeff Roberson 	 * Allocate virtual address space for the dynamic percpu area.
98750c202c5SJeff Roberson 	 */
98850c202c5SJeff Roberson 	pa = moea_bootstrap_alloc(DPCPU_SIZE, PAGE_SIZE);
98950c202c5SJeff Roberson 	dpcpu = (void *)virtual_avail;
99050c202c5SJeff Roberson 	va = virtual_avail;
99150c202c5SJeff Roberson 	virtual_avail += DPCPU_SIZE;
99250c202c5SJeff Roberson 	while (va < virtual_avail) {
99345b69dd6SJustin Hibbits 		moea_kenter(va, pa);
99450c202c5SJeff Roberson 		pa += PAGE_SIZE;
99550c202c5SJeff Roberson 		va += PAGE_SIZE;
99650c202c5SJeff Roberson 	}
99750c202c5SJeff Roberson 	dpcpu_init(dpcpu, 0);
9985244eac9SBenno Rice }
9995244eac9SBenno Rice 
10005244eac9SBenno Rice /*
10015244eac9SBenno Rice  * Activate a user pmap.  The pmap must be activated before it's address
10025244eac9SBenno Rice  * space can be accessed in any way.
1003f9bac91bSBenno Rice  */
1004f9bac91bSBenno Rice void
moea_activate(struct thread * td)100545b69dd6SJustin Hibbits moea_activate(struct thread *td)
1006f9bac91bSBenno Rice {
10078207b362SBenno Rice 	pmap_t	pm, pmr;
1008f9bac91bSBenno Rice 
1009f9bac91bSBenno Rice 	/*
101032bc7846SPeter Grehan 	 * Load all the data we need up front to encourage the compiler to
10115244eac9SBenno Rice 	 * not issue any loads while we have interrupts disabled below.
1012f9bac91bSBenno Rice 	 */
10135244eac9SBenno Rice 	pm = &td->td_proc->p_vmspace->vm_pmap;
101452a7870dSNathan Whitehorn 	pmr = pm->pmap_phys;
10158207b362SBenno Rice 
1016c7c2767eSAttilio Rao 	CPU_SET(PCPU_GET(cpuid), &pm->pm_active);
10178207b362SBenno Rice 	PCPU_SET(curpmap, pmr);
1018d1295abdSNathan Whitehorn 
1019d1295abdSNathan Whitehorn 	mtsrin(USER_SR << ADDR_SR_SHFT, td->td_pcb->pcb_cpu.aim.usr_vsid);
1020ac6ba8bdSBenno Rice }
1021ac6ba8bdSBenno Rice 
1022ac6ba8bdSBenno Rice void
moea_deactivate(struct thread * td)102345b69dd6SJustin Hibbits moea_deactivate(struct thread *td)
1024ac6ba8bdSBenno Rice {
1025ac6ba8bdSBenno Rice 	pmap_t	pm;
1026ac6ba8bdSBenno Rice 
1027ac6ba8bdSBenno Rice 	pm = &td->td_proc->p_vmspace->vm_pmap;
1028c7c2767eSAttilio Rao 	CPU_CLR(PCPU_GET(cpuid), &pm->pm_active);
10298207b362SBenno Rice 	PCPU_SET(curpmap, NULL);
1030f9bac91bSBenno Rice }
1031f9bac91bSBenno Rice 
1032f9bac91bSBenno Rice void
moea_unwire(pmap_t pm,vm_offset_t sva,vm_offset_t eva)103345b69dd6SJustin Hibbits moea_unwire(pmap_t pm, vm_offset_t sva, vm_offset_t eva)
1034a844c68fSAlan Cox {
1035a844c68fSAlan Cox 	struct	pvo_entry key, *pvo;
1036a844c68fSAlan Cox 
1037a844c68fSAlan Cox 	PMAP_LOCK(pm);
1038a844c68fSAlan Cox 	key.pvo_vaddr = sva;
1039a844c68fSAlan Cox 	for (pvo = RB_NFIND(pvo_tree, &pm->pmap_pvo, &key);
1040a844c68fSAlan Cox 	    pvo != NULL && PVO_VADDR(pvo) < eva;
1041a844c68fSAlan Cox 	    pvo = RB_NEXT(pvo_tree, &pm->pmap_pvo, pvo)) {
1042a844c68fSAlan Cox 		if ((pvo->pvo_vaddr & PVO_WIRED) == 0)
1043a844c68fSAlan Cox 			panic("moea_unwire: pvo %p is missing PVO_WIRED", pvo);
1044a844c68fSAlan Cox 		pvo->pvo_vaddr &= ~PVO_WIRED;
1045a844c68fSAlan Cox 		pm->pm_stats.wired_count--;
1046a844c68fSAlan Cox 	}
1047a844c68fSAlan Cox 	PMAP_UNLOCK(pm);
1048a844c68fSAlan Cox }
1049a844c68fSAlan Cox 
1050a844c68fSAlan Cox void
moea_copy_page(vm_page_t msrc,vm_page_t mdst)105145b69dd6SJustin Hibbits moea_copy_page(vm_page_t msrc, vm_page_t mdst)
1052f9bac91bSBenno Rice {
105325e2288dSBenno Rice 	vm_offset_t	dst;
105425e2288dSBenno Rice 	vm_offset_t	src;
105525e2288dSBenno Rice 
105625e2288dSBenno Rice 	dst = VM_PAGE_TO_PHYS(mdst);
105725e2288dSBenno Rice 	src = VM_PAGE_TO_PHYS(msrc);
105825e2288dSBenno Rice 
1059e3c2930dSNathan Whitehorn 	bcopy((void *)src, (void *)dst, PAGE_SIZE);
1060f9bac91bSBenno Rice }
1061111c77dcSBenno Rice 
1062e8a4a618SKonstantin Belousov void
moea_copy_pages(vm_page_t * ma,vm_offset_t a_offset,vm_page_t * mb,vm_offset_t b_offset,int xfersize)106345b69dd6SJustin Hibbits moea_copy_pages(vm_page_t *ma, vm_offset_t a_offset,
1064e8a4a618SKonstantin Belousov     vm_page_t *mb, vm_offset_t b_offset, int xfersize)
1065e8a4a618SKonstantin Belousov {
1066e8a4a618SKonstantin Belousov 	void *a_cp, *b_cp;
1067e8a4a618SKonstantin Belousov 	vm_offset_t a_pg_offset, b_pg_offset;
1068e8a4a618SKonstantin Belousov 	int cnt;
1069e8a4a618SKonstantin Belousov 
1070e8a4a618SKonstantin Belousov 	while (xfersize > 0) {
1071e8a4a618SKonstantin Belousov 		a_pg_offset = a_offset & PAGE_MASK;
1072e8a4a618SKonstantin Belousov 		cnt = min(xfersize, PAGE_SIZE - a_pg_offset);
1073e8a4a618SKonstantin Belousov 		a_cp = (char *)VM_PAGE_TO_PHYS(ma[a_offset >> PAGE_SHIFT]) +
1074e8a4a618SKonstantin Belousov 		    a_pg_offset;
1075e8a4a618SKonstantin Belousov 		b_pg_offset = b_offset & PAGE_MASK;
1076e8a4a618SKonstantin Belousov 		cnt = min(cnt, PAGE_SIZE - b_pg_offset);
1077e8a4a618SKonstantin Belousov 		b_cp = (char *)VM_PAGE_TO_PHYS(mb[b_offset >> PAGE_SHIFT]) +
1078e8a4a618SKonstantin Belousov 		    b_pg_offset;
1079e8a4a618SKonstantin Belousov 		bcopy(a_cp, b_cp, cnt);
1080e8a4a618SKonstantin Belousov 		a_offset += cnt;
1081e8a4a618SKonstantin Belousov 		b_offset += cnt;
1082e8a4a618SKonstantin Belousov 		xfersize -= cnt;
1083e8a4a618SKonstantin Belousov 	}
1084e8a4a618SKonstantin Belousov }
1085e8a4a618SKonstantin Belousov 
1086111c77dcSBenno Rice /*
10875244eac9SBenno Rice  * Zero a page of physical memory by temporarily mapping it into the tlb.
10885244eac9SBenno Rice  */
10895244eac9SBenno Rice void
moea_zero_page(vm_page_t m)109045b69dd6SJustin Hibbits moea_zero_page(vm_page_t m)
10915244eac9SBenno Rice {
1092fe938c08SJustin Hibbits 	vm_offset_t off, pa = VM_PAGE_TO_PHYS(m);
10935244eac9SBenno Rice 
1094fe938c08SJustin Hibbits 	for (off = 0; off < PAGE_SIZE; off += cacheline_size)
1095fe938c08SJustin Hibbits 		__asm __volatile("dcbz 0,%0" :: "r"(pa + off));
10965244eac9SBenno Rice }
10975244eac9SBenno Rice 
10985244eac9SBenno Rice void
moea_zero_page_area(vm_page_t m,int off,int size)109945b69dd6SJustin Hibbits moea_zero_page_area(vm_page_t m, int off, int size)
11005244eac9SBenno Rice {
11013495845eSBenno Rice 	vm_offset_t pa = VM_PAGE_TO_PHYS(m);
11025b43c63dSMarcel Moolenaar 	void *va = (void *)(pa + off);
11033495845eSBenno Rice 
11045b43c63dSMarcel Moolenaar 	bzero(va, size);
11055244eac9SBenno Rice }
11065244eac9SBenno Rice 
1107713841afSJason A. Harmening vm_offset_t
moea_quick_enter_page(vm_page_t m)110845b69dd6SJustin Hibbits moea_quick_enter_page(vm_page_t m)
1109713841afSJason A. Harmening {
1110713841afSJason A. Harmening 
1111713841afSJason A. Harmening 	return (VM_PAGE_TO_PHYS(m));
1112713841afSJason A. Harmening }
1113713841afSJason A. Harmening 
1114713841afSJason A. Harmening void
moea_quick_remove_page(vm_offset_t addr)111545b69dd6SJustin Hibbits moea_quick_remove_page(vm_offset_t addr)
1116713841afSJason A. Harmening {
1117713841afSJason A. Harmening }
1118713841afSJason A. Harmening 
1119*1f1b2286SJohn Baldwin bool
moea_page_is_mapped(vm_page_t m)112045b69dd6SJustin Hibbits moea_page_is_mapped(vm_page_t m)
112165bbba25SJustin Hibbits {
112265bbba25SJustin Hibbits 	return (!LIST_EMPTY(&(m)->md.mdpg_pvoh));
112365bbba25SJustin Hibbits }
112465bbba25SJustin Hibbits 
11258dc8feb5SJason A. Harmening bool
moea_ps_enabled(pmap_t pmap __unused)11268dc8feb5SJason A. Harmening moea_ps_enabled(pmap_t pmap __unused)
11278dc8feb5SJason A. Harmening {
11288dc8feb5SJason A. Harmening 	return (false);
11298dc8feb5SJason A. Harmening }
11308dc8feb5SJason A. Harmening 
11315244eac9SBenno Rice /*
11325244eac9SBenno Rice  * Map the given physical page at the specified virtual address in the
11335244eac9SBenno Rice  * target pmap with the protection requested.  If specified the page
11345244eac9SBenno Rice  * will be wired down.
11355244eac9SBenno Rice  */
113639ffa8c1SKonstantin Belousov int
moea_enter(pmap_t pmap,vm_offset_t va,vm_page_t m,vm_prot_t prot,u_int flags,int8_t psind)113745b69dd6SJustin Hibbits moea_enter(pmap_t pmap, vm_offset_t va, vm_page_t m, vm_prot_t prot,
113839ffa8c1SKonstantin Belousov     u_int flags, int8_t psind)
11395244eac9SBenno Rice {
114039ffa8c1SKonstantin Belousov 	int error;
1141ce142d9eSAlan Cox 
114239ffa8c1SKonstantin Belousov 	for (;;) {
11433653f5cbSAlan Cox 		rw_wlock(&pvh_global_lock);
1144ce142d9eSAlan Cox 		PMAP_LOCK(pmap);
114539ffa8c1SKonstantin Belousov 		error = moea_enter_locked(pmap, va, m, prot, flags, psind);
11463653f5cbSAlan Cox 		rw_wunlock(&pvh_global_lock);
1147ce142d9eSAlan Cox 		PMAP_UNLOCK(pmap);
114839ffa8c1SKonstantin Belousov 		if (error != ENOMEM)
114939ffa8c1SKonstantin Belousov 			return (KERN_SUCCESS);
115039ffa8c1SKonstantin Belousov 		if ((flags & PMAP_ENTER_NOSLEEP) != 0)
115139ffa8c1SKonstantin Belousov 			return (KERN_RESOURCE_SHORTAGE);
115239ffa8c1SKonstantin Belousov 		VM_OBJECT_ASSERT_UNLOCKED(m->object);
11532c0f13aaSKonstantin Belousov 		vm_wait(NULL);
115439ffa8c1SKonstantin Belousov 	}
1155ce142d9eSAlan Cox }
1156ce142d9eSAlan Cox 
1157ce142d9eSAlan Cox /*
1158ce142d9eSAlan Cox  * Map the given physical page at the specified virtual address in the
1159ce142d9eSAlan Cox  * target pmap with the protection requested.  If specified the page
1160ce142d9eSAlan Cox  * will be wired down.
1161ce142d9eSAlan Cox  *
1162f26bcf99SAlan Cox  * The global pvh and pmap must be locked.
1163ce142d9eSAlan Cox  */
116439ffa8c1SKonstantin Belousov static int
moea_enter_locked(pmap_t pmap,vm_offset_t va,vm_page_t m,vm_prot_t prot,u_int flags,int8_t psind __unused)1165ce142d9eSAlan Cox moea_enter_locked(pmap_t pmap, vm_offset_t va, vm_page_t m, vm_prot_t prot,
116639ffa8c1SKonstantin Belousov     u_int flags, int8_t psind __unused)
1167ce142d9eSAlan Cox {
11685244eac9SBenno Rice 	struct		pvo_head *pvo_head;
1169378862a7SJeff Roberson 	uma_zone_t	zone;
117057bd5cceSNathan Whitehorn 	u_int		pte_lo, pvo_flags;
11715244eac9SBenno Rice 	int		error;
11725244eac9SBenno Rice 
1173081b8e20SAlan Cox 	if (pmap_bootstrapped)
1174081b8e20SAlan Cox 		rw_assert(&pvh_global_lock, RA_WLOCKED);
1175081b8e20SAlan Cox 	PMAP_LOCK_ASSERT(pmap, MA_OWNED);
11762a499f92SKonstantin Belousov 	if ((m->oflags & VPO_UNMANAGED) == 0) {
11772a499f92SKonstantin Belousov 		if ((flags & PMAP_ENTER_QUICK_LOCKED) == 0)
1178205be21dSJeff Roberson 			VM_PAGE_OBJECT_BUSY_ASSERT(m);
11792a499f92SKonstantin Belousov 		else
11802a499f92SKonstantin Belousov 			VM_OBJECT_ASSERT_LOCKED(m->object);
11812a499f92SKonstantin Belousov 	}
1182081b8e20SAlan Cox 
1183081b8e20SAlan Cox 	if ((m->oflags & VPO_UNMANAGED) != 0 || !moea_initialized) {
118459276937SPeter Grehan 		pvo_head = &moea_pvo_kunmanaged;
118559276937SPeter Grehan 		zone = moea_upvo_zone;
11865244eac9SBenno Rice 		pvo_flags = 0;
11875244eac9SBenno Rice 	} else {
118803b6e025SPeter Grehan 		pvo_head = vm_page_to_pvoh(m);
118959276937SPeter Grehan 		zone = moea_mpvo_zone;
11905244eac9SBenno Rice 		pvo_flags = PVO_MANAGED;
11915244eac9SBenno Rice 	}
11924dba5df1SPeter Grehan 
1193cd6a97f0SNathan Whitehorn 	pte_lo = moea_calc_wimg(VM_PAGE_TO_PHYS(m), pmap_page_get_memattr(m));
11945244eac9SBenno Rice 
119544b8bd66SAlan Cox 	if (prot & VM_PROT_WRITE) {
11965244eac9SBenno Rice 		pte_lo |= PTE_BW;
11972368a371SAlan Cox 		if (pmap_bootstrapped &&
1198d98d0ce2SKonstantin Belousov 		    (m->oflags & VPO_UNMANAGED) == 0)
11993407fefeSKonstantin Belousov 			vm_page_aflag_set(m, PGA_WRITEABLE);
120044b8bd66SAlan Cox 	} else
12015244eac9SBenno Rice 		pte_lo |= PTE_BR;
12025244eac9SBenno Rice 
120339ffa8c1SKonstantin Belousov 	if ((flags & PMAP_ENTER_WIRED) != 0)
12045244eac9SBenno Rice 		pvo_flags |= PVO_WIRED;
12055244eac9SBenno Rice 
120659276937SPeter Grehan 	error = moea_pvo_enter(pmap, zone, pvo_head, va, VM_PAGE_TO_PHYS(m),
12078207b362SBenno Rice 	    pte_lo, pvo_flags);
12085244eac9SBenno Rice 
12098207b362SBenno Rice 	/*
121057bd5cceSNathan Whitehorn 	 * Flush the real page from the instruction cache. This has be done
121157bd5cceSNathan Whitehorn 	 * for all user mappings to prevent information leakage via the
1212805bee55SNathan Whitehorn 	 * instruction cache. moea_pvo_enter() returns ENOENT for the first
1213805bee55SNathan Whitehorn 	 * mapping for a page.
12148207b362SBenno Rice 	 */
1215805bee55SNathan Whitehorn 	if (pmap != kernel_pmap && error == ENOENT &&
1216805bee55SNathan Whitehorn 	    (pte_lo & (PTE_I | PTE_G)) == 0)
121759276937SPeter Grehan 		moea_syncicache(VM_PAGE_TO_PHYS(m), PAGE_SIZE);
121839ffa8c1SKonstantin Belousov 
121939ffa8c1SKonstantin Belousov 	return (error);
1220ce142d9eSAlan Cox }
1221ce142d9eSAlan Cox 
1222ce142d9eSAlan Cox /*
1223ce142d9eSAlan Cox  * Maps a sequence of resident pages belonging to the same object.
1224ce142d9eSAlan Cox  * The sequence begins with the given page m_start.  This page is
1225ce142d9eSAlan Cox  * mapped at the given virtual address start.  Each subsequent page is
1226ce142d9eSAlan Cox  * mapped at a virtual address that is offset from start by the same
1227ce142d9eSAlan Cox  * amount as the page is offset from m_start within the object.  The
1228ce142d9eSAlan Cox  * last page in the sequence is the page with the largest offset from
1229ce142d9eSAlan Cox  * m_start that can be mapped at a virtual address less than the given
1230ce142d9eSAlan Cox  * virtual address end.  Not every virtual page between start and end
1231ce142d9eSAlan Cox  * is mapped; only those for which a resident page exists with the
1232ce142d9eSAlan Cox  * corresponding offset from m_start are mapped.
1233ce142d9eSAlan Cox  */
1234ce142d9eSAlan Cox void
moea_enter_object(pmap_t pm,vm_offset_t start,vm_offset_t end,vm_page_t m_start,vm_prot_t prot)123545b69dd6SJustin Hibbits moea_enter_object(pmap_t pm, vm_offset_t start, vm_offset_t end,
1236ce142d9eSAlan Cox     vm_page_t m_start, vm_prot_t prot)
1237ce142d9eSAlan Cox {
1238ce142d9eSAlan Cox 	vm_page_t m;
1239ce142d9eSAlan Cox 	vm_pindex_t diff, psize;
1240ce142d9eSAlan Cox 
12419af6d512SAttilio Rao 	VM_OBJECT_ASSERT_LOCKED(m_start->object);
12429af6d512SAttilio Rao 
1243ce142d9eSAlan Cox 	psize = atop(end - start);
1244ce142d9eSAlan Cox 	m = m_start;
12453653f5cbSAlan Cox 	rw_wlock(&pvh_global_lock);
1246ce142d9eSAlan Cox 	PMAP_LOCK(pm);
1247ce142d9eSAlan Cox 	while (m != NULL && (diff = m->pindex - m_start->pindex) < psize) {
1248ce142d9eSAlan Cox 		moea_enter_locked(pm, start + ptoa(diff), m, prot &
12492a499f92SKonstantin Belousov 		    (VM_PROT_READ | VM_PROT_EXECUTE), PMAP_ENTER_QUICK_LOCKED,
12502a499f92SKonstantin Belousov 		    0);
1251ce142d9eSAlan Cox 		m = TAILQ_NEXT(m, listq);
1252ce142d9eSAlan Cox 	}
12533653f5cbSAlan Cox 	rw_wunlock(&pvh_global_lock);
1254ce142d9eSAlan Cox 	PMAP_UNLOCK(pm);
12555244eac9SBenno Rice }
12565244eac9SBenno Rice 
12572053c127SStephan Uphoff void
moea_enter_quick(pmap_t pm,vm_offset_t va,vm_page_t m,vm_prot_t prot)125845b69dd6SJustin Hibbits moea_enter_quick(pmap_t pm, vm_offset_t va, vm_page_t m,
12592053c127SStephan Uphoff     vm_prot_t prot)
1260dca96f1aSAlan Cox {
1261dca96f1aSAlan Cox 
12623653f5cbSAlan Cox 	rw_wlock(&pvh_global_lock);
1263ce142d9eSAlan Cox 	PMAP_LOCK(pm);
1264ce142d9eSAlan Cox 	moea_enter_locked(pm, va, m, prot & (VM_PROT_READ | VM_PROT_EXECUTE),
12652a499f92SKonstantin Belousov 	    PMAP_ENTER_QUICK_LOCKED, 0);
12663653f5cbSAlan Cox 	rw_wunlock(&pvh_global_lock);
1267ce142d9eSAlan Cox 	PMAP_UNLOCK(pm);
1268dca96f1aSAlan Cox }
1269dca96f1aSAlan Cox 
127056b09388SAlan Cox vm_paddr_t
moea_extract(pmap_t pm,vm_offset_t va)127145b69dd6SJustin Hibbits moea_extract(pmap_t pm, vm_offset_t va)
12725244eac9SBenno Rice {
12730f92104cSBenno Rice 	struct	pvo_entry *pvo;
127448d0b1a0SAlan Cox 	vm_paddr_t pa;
12750f92104cSBenno Rice 
127648d0b1a0SAlan Cox 	PMAP_LOCK(pm);
127759276937SPeter Grehan 	pvo = moea_pvo_find_va(pm, va & ~ADDR_POFF, NULL);
127848d0b1a0SAlan Cox 	if (pvo == NULL)
127948d0b1a0SAlan Cox 		pa = 0;
128048d0b1a0SAlan Cox 	else
12817be655c2SBrandon Bergren 		pa = PVO_PADDR(pvo) | (va & ADDR_POFF);
128248d0b1a0SAlan Cox 	PMAP_UNLOCK(pm);
128348d0b1a0SAlan Cox 	return (pa);
12845244eac9SBenno Rice }
12855244eac9SBenno Rice 
12865244eac9SBenno Rice /*
128784792e72SPeter Grehan  * Atomically extract and hold the physical page with the given
128884792e72SPeter Grehan  * pmap and virtual address pair if that mapping permits the given
128984792e72SPeter Grehan  * protection.
129084792e72SPeter Grehan  */
129184792e72SPeter Grehan vm_page_t
moea_extract_and_hold(pmap_t pmap,vm_offset_t va,vm_prot_t prot)129245b69dd6SJustin Hibbits moea_extract_and_hold(pmap_t pmap, vm_offset_t va, vm_prot_t prot)
129384792e72SPeter Grehan {
1294ab50a262SAlan Cox 	struct	pvo_entry *pvo;
129584792e72SPeter Grehan 	vm_page_t m;
129684792e72SPeter Grehan 
129784792e72SPeter Grehan 	m = NULL;
129848d0b1a0SAlan Cox 	PMAP_LOCK(pmap);
129959276937SPeter Grehan 	pvo = moea_pvo_find_va(pmap, va & ~ADDR_POFF, NULL);
130052a7870dSNathan Whitehorn 	if (pvo != NULL && (pvo->pvo_pte.pte.pte_hi & PTE_VALID) &&
130152a7870dSNathan Whitehorn 	    ((pvo->pvo_pte.pte.pte_lo & PTE_PP) == PTE_RW ||
1302ab50a262SAlan Cox 	     (prot & VM_PROT_WRITE) == 0)) {
13037be655c2SBrandon Bergren 		m = PHYS_TO_VM_PAGE(PVO_PADDR(pvo));
1304fee2a2faSMark Johnston 		if (!vm_page_wire_mapped(m))
1305fee2a2faSMark Johnston 			m = NULL;
130684792e72SPeter Grehan 	}
130748d0b1a0SAlan Cox 	PMAP_UNLOCK(pmap);
130884792e72SPeter Grehan 	return (m);
130984792e72SPeter Grehan }
131084792e72SPeter Grehan 
13115244eac9SBenno Rice void
moea_init(void)13129b02f2daSJohn Baldwin moea_init(void)
13135244eac9SBenno Rice {
13145244eac9SBenno Rice 
131559276937SPeter Grehan 	moea_upvo_zone = uma_zcreate("UPVO entry", sizeof (struct pvo_entry),
13160ee6dbd7SPeter Grehan 	    NULL, NULL, NULL, NULL, UMA_ALIGN_PTR,
13170ee6dbd7SPeter Grehan 	    UMA_ZONE_VM | UMA_ZONE_NOFREE);
131859276937SPeter Grehan 	moea_mpvo_zone = uma_zcreate("MPVO entry", sizeof(struct pvo_entry),
13190ee6dbd7SPeter Grehan 	    NULL, NULL, NULL, NULL, UMA_ALIGN_PTR,
13200ee6dbd7SPeter Grehan 	    UMA_ZONE_VM | UMA_ZONE_NOFREE);
1321*1f1b2286SJohn Baldwin 	moea_initialized = true;
13225244eac9SBenno Rice }
13235244eac9SBenno Rice 
1324*1f1b2286SJohn Baldwin bool
moea_is_referenced(vm_page_t m)132545b69dd6SJustin Hibbits moea_is_referenced(vm_page_t m)
13267b85f591SAlan Cox {
1327*1f1b2286SJohn Baldwin 	bool rv;
13287b85f591SAlan Cox 
1329d98d0ce2SKonstantin Belousov 	KASSERT((m->oflags & VPO_UNMANAGED) == 0,
1330c46b90e9SAlan Cox 	    ("moea_is_referenced: page %p is not managed", m));
13318d9e6d9fSAlan Cox 	rw_wlock(&pvh_global_lock);
13328d9e6d9fSAlan Cox 	rv = moea_query_bit(m, PTE_REF);
13338d9e6d9fSAlan Cox 	rw_wunlock(&pvh_global_lock);
13348d9e6d9fSAlan Cox 	return (rv);
13357b85f591SAlan Cox }
13367b85f591SAlan Cox 
1337*1f1b2286SJohn Baldwin bool
moea_is_modified(vm_page_t m)133845b69dd6SJustin Hibbits moea_is_modified(vm_page_t m)
13395244eac9SBenno Rice {
1340*1f1b2286SJohn Baldwin 	bool rv;
13410f92104cSBenno Rice 
1342d98d0ce2SKonstantin Belousov 	KASSERT((m->oflags & VPO_UNMANAGED) == 0,
1343567e51e1SAlan Cox 	    ("moea_is_modified: page %p is not managed", m));
1344567e51e1SAlan Cox 
1345567e51e1SAlan Cox 	/*
1346638f8678SJeff Roberson 	 * If the page is not busied then this check is racy.
1347567e51e1SAlan Cox 	 */
1348638f8678SJeff Roberson 	if (!pmap_page_is_write_mapped(m))
1349*1f1b2286SJohn Baldwin 		return (false);
1350638f8678SJeff Roberson 
13518d9e6d9fSAlan Cox 	rw_wlock(&pvh_global_lock);
13528d9e6d9fSAlan Cox 	rv = moea_query_bit(m, PTE_CHG);
13538d9e6d9fSAlan Cox 	rw_wunlock(&pvh_global_lock);
13548d9e6d9fSAlan Cox 	return (rv);
1355566526a9SAlan Cox }
1356566526a9SAlan Cox 
1357*1f1b2286SJohn Baldwin bool
moea_is_prefaultable(pmap_t pmap,vm_offset_t va)135845b69dd6SJustin Hibbits moea_is_prefaultable(pmap_t pmap, vm_offset_t va)
1359e396eb60SAlan Cox {
1360e396eb60SAlan Cox 	struct pvo_entry *pvo;
1361*1f1b2286SJohn Baldwin 	bool rv;
1362e396eb60SAlan Cox 
1363e396eb60SAlan Cox 	PMAP_LOCK(pmap);
1364e396eb60SAlan Cox 	pvo = moea_pvo_find_va(pmap, va & ~ADDR_POFF, NULL);
1365e396eb60SAlan Cox 	rv = pvo == NULL || (pvo->pvo_pte.pte.pte_hi & PTE_VALID) == 0;
1366e396eb60SAlan Cox 	PMAP_UNLOCK(pmap);
1367e396eb60SAlan Cox 	return (rv);
1368e396eb60SAlan Cox }
1369e396eb60SAlan Cox 
13705244eac9SBenno Rice void
moea_clear_modify(vm_page_t m)137145b69dd6SJustin Hibbits moea_clear_modify(vm_page_t m)
137203b6e025SPeter Grehan {
137303b6e025SPeter Grehan 
1374d98d0ce2SKonstantin Belousov 	KASSERT((m->oflags & VPO_UNMANAGED) == 0,
1375567e51e1SAlan Cox 	    ("moea_clear_modify: page %p is not managed", m));
1376638f8678SJeff Roberson 	vm_page_assert_busied(m);
1377567e51e1SAlan Cox 
1378638f8678SJeff Roberson 	if (!pmap_page_is_write_mapped(m))
137903b6e025SPeter Grehan 		return;
13808d9e6d9fSAlan Cox 	rw_wlock(&pvh_global_lock);
1381ce186587SAlan Cox 	moea_clear_bit(m, PTE_CHG);
13828d9e6d9fSAlan Cox 	rw_wunlock(&pvh_global_lock);
13835244eac9SBenno Rice }
13845244eac9SBenno Rice 
13857f3a4093SMike Silbersack /*
138678985e42SAlan Cox  * Clear the write and modified bits in each of the given page's mappings.
138778985e42SAlan Cox  */
138878985e42SAlan Cox void
moea_remove_write(vm_page_t m)138945b69dd6SJustin Hibbits moea_remove_write(vm_page_t m)
139078985e42SAlan Cox {
139178985e42SAlan Cox 	struct	pvo_entry *pvo;
139278985e42SAlan Cox 	struct	pte *pt;
139378985e42SAlan Cox 	pmap_t	pmap;
139478985e42SAlan Cox 	u_int	lo;
139578985e42SAlan Cox 
1396d98d0ce2SKonstantin Belousov 	KASSERT((m->oflags & VPO_UNMANAGED) == 0,
13979ab6032fSAlan Cox 	    ("moea_remove_write: page %p is not managed", m));
1398638f8678SJeff Roberson 	vm_page_assert_busied(m);
13999ab6032fSAlan Cox 
1400638f8678SJeff Roberson 	if (!pmap_page_is_write_mapped(m))
140178985e42SAlan Cox 		return;
14023653f5cbSAlan Cox 	rw_wlock(&pvh_global_lock);
140378985e42SAlan Cox 	lo = moea_attr_fetch(m);
1404e4f72b32SMarcel Moolenaar 	powerpc_sync();
140578985e42SAlan Cox 	LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink) {
140678985e42SAlan Cox 		pmap = pvo->pvo_pmap;
140778985e42SAlan Cox 		PMAP_LOCK(pmap);
140852a7870dSNathan Whitehorn 		if ((pvo->pvo_pte.pte.pte_lo & PTE_PP) != PTE_BR) {
140978985e42SAlan Cox 			pt = moea_pvo_to_pte(pvo, -1);
141052a7870dSNathan Whitehorn 			pvo->pvo_pte.pte.pte_lo &= ~PTE_PP;
141152a7870dSNathan Whitehorn 			pvo->pvo_pte.pte.pte_lo |= PTE_BR;
141278985e42SAlan Cox 			if (pt != NULL) {
141352a7870dSNathan Whitehorn 				moea_pte_synch(pt, &pvo->pvo_pte.pte);
141452a7870dSNathan Whitehorn 				lo |= pvo->pvo_pte.pte.pte_lo;
141552a7870dSNathan Whitehorn 				pvo->pvo_pte.pte.pte_lo &= ~PTE_CHG;
141652a7870dSNathan Whitehorn 				moea_pte_change(pt, &pvo->pvo_pte.pte,
141778985e42SAlan Cox 				    pvo->pvo_vaddr);
141878985e42SAlan Cox 				mtx_unlock(&moea_table_mutex);
141978985e42SAlan Cox 			}
142078985e42SAlan Cox 		}
142178985e42SAlan Cox 		PMAP_UNLOCK(pmap);
142278985e42SAlan Cox 	}
142378985e42SAlan Cox 	if ((lo & PTE_CHG) != 0) {
142478985e42SAlan Cox 		moea_attr_clear(m, PTE_CHG);
142578985e42SAlan Cox 		vm_page_dirty(m);
142678985e42SAlan Cox 	}
14273407fefeSKonstantin Belousov 	vm_page_aflag_clear(m, PGA_WRITEABLE);
14283653f5cbSAlan Cox 	rw_wunlock(&pvh_global_lock);
142978985e42SAlan Cox }
143078985e42SAlan Cox 
143178985e42SAlan Cox /*
143259276937SPeter Grehan  *	moea_ts_referenced:
14337f3a4093SMike Silbersack  *
14347f3a4093SMike Silbersack  *	Return a count of reference bits for a page, clearing those bits.
14357f3a4093SMike Silbersack  *	It is not necessary for every reference bit to be cleared, but it
14367f3a4093SMike Silbersack  *	is necessary that 0 only be returned when there are truly no
14377f3a4093SMike Silbersack  *	reference bits set.
14387f3a4093SMike Silbersack  *
14397f3a4093SMike Silbersack  *	XXX: The exact number of bits to check and clear is a matter that
14407f3a4093SMike Silbersack  *	should be tested and standardized at some point in the future for
14417f3a4093SMike Silbersack  *	optimal aging of shared pages.
14427f3a4093SMike Silbersack  */
14438d9e6d9fSAlan Cox int
moea_ts_referenced(vm_page_t m)144445b69dd6SJustin Hibbits moea_ts_referenced(vm_page_t m)
14455244eac9SBenno Rice {
14468d9e6d9fSAlan Cox 	int count;
144703b6e025SPeter Grehan 
1448d98d0ce2SKonstantin Belousov 	KASSERT((m->oflags & VPO_UNMANAGED) == 0,
1449ce186587SAlan Cox 	    ("moea_ts_referenced: page %p is not managed", m));
14508d9e6d9fSAlan Cox 	rw_wlock(&pvh_global_lock);
14518d9e6d9fSAlan Cox 	count = moea_clear_bit(m, PTE_REF);
14528d9e6d9fSAlan Cox 	rw_wunlock(&pvh_global_lock);
14538d9e6d9fSAlan Cox 	return (count);
14545244eac9SBenno Rice }
14555244eac9SBenno Rice 
14565244eac9SBenno Rice /*
1457c1f4123bSNathan Whitehorn  * Modify the WIMG settings of all mappings for a page.
1458c1f4123bSNathan Whitehorn  */
1459c1f4123bSNathan Whitehorn void
moea_page_set_memattr(vm_page_t m,vm_memattr_t ma)146045b69dd6SJustin Hibbits moea_page_set_memattr(vm_page_t m, vm_memattr_t ma)
1461c1f4123bSNathan Whitehorn {
1462c1f4123bSNathan Whitehorn 	struct	pvo_entry *pvo;
1463cd6a97f0SNathan Whitehorn 	struct	pvo_head *pvo_head;
1464c1f4123bSNathan Whitehorn 	struct	pte *pt;
1465c1f4123bSNathan Whitehorn 	pmap_t	pmap;
1466c1f4123bSNathan Whitehorn 	u_int	lo;
1467c1f4123bSNathan Whitehorn 
1468d98d0ce2SKonstantin Belousov 	if ((m->oflags & VPO_UNMANAGED) != 0) {
1469cd6a97f0SNathan Whitehorn 		m->md.mdpg_cache_attrs = ma;
1470cd6a97f0SNathan Whitehorn 		return;
1471cd6a97f0SNathan Whitehorn 	}
1472cd6a97f0SNathan Whitehorn 
14733653f5cbSAlan Cox 	rw_wlock(&pvh_global_lock);
1474cd6a97f0SNathan Whitehorn 	pvo_head = vm_page_to_pvoh(m);
1475c1f4123bSNathan Whitehorn 	lo = moea_calc_wimg(VM_PAGE_TO_PHYS(m), ma);
1476cd6a97f0SNathan Whitehorn 
1477cd6a97f0SNathan Whitehorn 	LIST_FOREACH(pvo, pvo_head, pvo_vlink) {
1478c1f4123bSNathan Whitehorn 		pmap = pvo->pvo_pmap;
1479c1f4123bSNathan Whitehorn 		PMAP_LOCK(pmap);
1480c1f4123bSNathan Whitehorn 		pt = moea_pvo_to_pte(pvo, -1);
1481c1f4123bSNathan Whitehorn 		pvo->pvo_pte.pte.pte_lo &= ~PTE_WIMG;
1482c1f4123bSNathan Whitehorn 		pvo->pvo_pte.pte.pte_lo |= lo;
1483c1f4123bSNathan Whitehorn 		if (pt != NULL) {
1484c1f4123bSNathan Whitehorn 			moea_pte_change(pt, &pvo->pvo_pte.pte,
1485c1f4123bSNathan Whitehorn 			    pvo->pvo_vaddr);
1486c1f4123bSNathan Whitehorn 			if (pvo->pvo_pmap == kernel_pmap)
1487c1f4123bSNathan Whitehorn 				isync();
1488c1f4123bSNathan Whitehorn 		}
1489c1f4123bSNathan Whitehorn 		mtx_unlock(&moea_table_mutex);
1490c1f4123bSNathan Whitehorn 		PMAP_UNLOCK(pmap);
1491c1f4123bSNathan Whitehorn 	}
1492c1f4123bSNathan Whitehorn 	m->md.mdpg_cache_attrs = ma;
14933653f5cbSAlan Cox 	rw_wunlock(&pvh_global_lock);
1494c1f4123bSNathan Whitehorn }
1495c1f4123bSNathan Whitehorn 
1496c1f4123bSNathan Whitehorn /*
14975244eac9SBenno Rice  * Map a wired page into kernel virtual address space.
14985244eac9SBenno Rice  */
14995244eac9SBenno Rice void
moea_kenter(vm_offset_t va,vm_paddr_t pa)150045b69dd6SJustin Hibbits moea_kenter(vm_offset_t va, vm_paddr_t pa)
15015244eac9SBenno Rice {
1502c1f4123bSNathan Whitehorn 
150345b69dd6SJustin Hibbits 	moea_kenter_attr(va, pa, VM_MEMATTR_DEFAULT);
1504c1f4123bSNathan Whitehorn }
1505c1f4123bSNathan Whitehorn 
1506c1f4123bSNathan Whitehorn void
moea_kenter_attr(vm_offset_t va,vm_paddr_t pa,vm_memattr_t ma)150745b69dd6SJustin Hibbits moea_kenter_attr(vm_offset_t va, vm_paddr_t pa, vm_memattr_t ma)
1508c1f4123bSNathan Whitehorn {
15095244eac9SBenno Rice 	u_int		pte_lo;
15105244eac9SBenno Rice 	int		error;
15115244eac9SBenno Rice 
15125244eac9SBenno Rice #if 0
15135244eac9SBenno Rice 	if (va < VM_MIN_KERNEL_ADDRESS)
151459276937SPeter Grehan 		panic("moea_kenter: attempt to enter non-kernel address %#x",
15155244eac9SBenno Rice 		    va);
15165244eac9SBenno Rice #endif
15175244eac9SBenno Rice 
1518c1f4123bSNathan Whitehorn 	pte_lo = moea_calc_wimg(pa, ma);
15195244eac9SBenno Rice 
15204711f8d7SAlan Cox 	PMAP_LOCK(kernel_pmap);
152159276937SPeter Grehan 	error = moea_pvo_enter(kernel_pmap, moea_upvo_zone,
152259276937SPeter Grehan 	    &moea_pvo_kunmanaged, va, pa, pte_lo, PVO_WIRED);
15235244eac9SBenno Rice 
15245244eac9SBenno Rice 	if (error != 0 && error != ENOENT)
152559276937SPeter Grehan 		panic("moea_kenter: failed to enter va %#x pa %#x: %d", va,
15265244eac9SBenno Rice 		    pa, error);
15275244eac9SBenno Rice 
15284711f8d7SAlan Cox 	PMAP_UNLOCK(kernel_pmap);
15295244eac9SBenno Rice }
15305244eac9SBenno Rice 
1531e79f59e8SBenno Rice /*
1532e79f59e8SBenno Rice  * Extract the physical page address associated with the given kernel virtual
1533e79f59e8SBenno Rice  * address.
1534e79f59e8SBenno Rice  */
153520b79612SRafal Jaworowski vm_paddr_t
moea_kextract(vm_offset_t va)153645b69dd6SJustin Hibbits moea_kextract(vm_offset_t va)
15375244eac9SBenno Rice {
1538e79f59e8SBenno Rice 	struct		pvo_entry *pvo;
153948d0b1a0SAlan Cox 	vm_paddr_t pa;
1540e79f59e8SBenno Rice 
15410efd0097SPeter Grehan 	/*
154252a7870dSNathan Whitehorn 	 * Allow direct mappings on 32-bit OEA
15430efd0097SPeter Grehan 	 */
15440efd0097SPeter Grehan 	if (va < VM_MIN_KERNEL_ADDRESS) {
15450efd0097SPeter Grehan 		return (va);
15460efd0097SPeter Grehan 	}
15470efd0097SPeter Grehan 
154848d0b1a0SAlan Cox 	PMAP_LOCK(kernel_pmap);
154959276937SPeter Grehan 	pvo = moea_pvo_find_va(kernel_pmap, va & ~ADDR_POFF, NULL);
155059276937SPeter Grehan 	KASSERT(pvo != NULL, ("moea_kextract: no addr found"));
15517be655c2SBrandon Bergren 	pa = PVO_PADDR(pvo) | (va & ADDR_POFF);
155248d0b1a0SAlan Cox 	PMAP_UNLOCK(kernel_pmap);
155348d0b1a0SAlan Cox 	return (pa);
1554e79f59e8SBenno Rice }
1555e79f59e8SBenno Rice 
155688afb2a3SBenno Rice /*
155788afb2a3SBenno Rice  * Remove a wired page from kernel virtual address space.
155888afb2a3SBenno Rice  */
15595244eac9SBenno Rice void
moea_kremove(vm_offset_t va)156045b69dd6SJustin Hibbits moea_kremove(vm_offset_t va)
15615244eac9SBenno Rice {
156288afb2a3SBenno Rice 
156345b69dd6SJustin Hibbits 	moea_remove(kernel_pmap, va, va + PAGE_SIZE);
15645244eac9SBenno Rice }
15655244eac9SBenno Rice 
15665244eac9SBenno Rice /*
156704329fa7SNathan Whitehorn  * Provide a kernel pointer corresponding to a given userland pointer.
156804329fa7SNathan Whitehorn  * The returned pointer is valid until the next time this function is
156904329fa7SNathan Whitehorn  * called in this thread. This is used internally in copyin/copyout.
157004329fa7SNathan Whitehorn  */
157104329fa7SNathan Whitehorn int
moea_map_user_ptr(pmap_t pm,volatile const void * uaddr,void ** kaddr,size_t ulen,size_t * klen)157245b69dd6SJustin Hibbits moea_map_user_ptr(pmap_t pm, volatile const void *uaddr,
157304329fa7SNathan Whitehorn     void **kaddr, size_t ulen, size_t *klen)
157404329fa7SNathan Whitehorn {
157504329fa7SNathan Whitehorn 	size_t l;
157604329fa7SNathan Whitehorn 	register_t vsid;
157704329fa7SNathan Whitehorn 
157804329fa7SNathan Whitehorn 	*kaddr = (char *)USER_ADDR + ((uintptr_t)uaddr & ~SEGMENT_MASK);
157904329fa7SNathan Whitehorn 	l = ((char *)USER_ADDR + SEGMENT_LENGTH) - (char *)(*kaddr);
158004329fa7SNathan Whitehorn 	if (l > ulen)
158104329fa7SNathan Whitehorn 		l = ulen;
158204329fa7SNathan Whitehorn 	if (klen)
158304329fa7SNathan Whitehorn 		*klen = l;
158404329fa7SNathan Whitehorn 	else if (l != ulen)
158504329fa7SNathan Whitehorn 		return (EFAULT);
158604329fa7SNathan Whitehorn 
158704329fa7SNathan Whitehorn 	vsid = va_to_vsid(pm, (vm_offset_t)uaddr);
158804329fa7SNathan Whitehorn 
158904329fa7SNathan Whitehorn 	/* Mark segment no-execute */
159004329fa7SNathan Whitehorn 	vsid |= SR_N;
159104329fa7SNathan Whitehorn 
159204329fa7SNathan Whitehorn 	/* If we have already set this VSID, we can just return */
159304329fa7SNathan Whitehorn 	if (curthread->td_pcb->pcb_cpu.aim.usr_vsid == vsid)
159404329fa7SNathan Whitehorn 		return (0);
159504329fa7SNathan Whitehorn 
159604329fa7SNathan Whitehorn 	__asm __volatile("isync");
159704329fa7SNathan Whitehorn 	curthread->td_pcb->pcb_cpu.aim.usr_segm =
159804329fa7SNathan Whitehorn 	    (uintptr_t)uaddr >> ADDR_SR_SHFT;
159904329fa7SNathan Whitehorn 	curthread->td_pcb->pcb_cpu.aim.usr_vsid = vsid;
160004329fa7SNathan Whitehorn 	__asm __volatile("mtsr %0,%1; isync" :: "n"(USER_SR), "r"(vsid));
160104329fa7SNathan Whitehorn 
160204329fa7SNathan Whitehorn 	return (0);
160304329fa7SNathan Whitehorn }
160404329fa7SNathan Whitehorn 
160504329fa7SNathan Whitehorn /*
1606eb1baf72SNathan Whitehorn  * Figure out where a given kernel pointer (usually in a fault) points
1607eb1baf72SNathan Whitehorn  * to from the VM's perspective, potentially remapping into userland's
1608eb1baf72SNathan Whitehorn  * address space.
1609eb1baf72SNathan Whitehorn  */
1610eb1baf72SNathan Whitehorn static int
moea_decode_kernel_ptr(vm_offset_t addr,int * is_user,vm_offset_t * decoded_addr)161145b69dd6SJustin Hibbits moea_decode_kernel_ptr(vm_offset_t addr, int *is_user,
1612eb1baf72SNathan Whitehorn     vm_offset_t *decoded_addr)
1613eb1baf72SNathan Whitehorn {
1614eb1baf72SNathan Whitehorn 	vm_offset_t user_sr;
1615eb1baf72SNathan Whitehorn 
1616eb1baf72SNathan Whitehorn 	if ((addr >> ADDR_SR_SHFT) == (USER_ADDR >> ADDR_SR_SHFT)) {
1617eb1baf72SNathan Whitehorn 		user_sr = curthread->td_pcb->pcb_cpu.aim.usr_segm;
1618eb1baf72SNathan Whitehorn 		addr &= ADDR_PIDX | ADDR_POFF;
1619eb1baf72SNathan Whitehorn 		addr |= user_sr << ADDR_SR_SHFT;
1620eb1baf72SNathan Whitehorn 		*decoded_addr = addr;
1621eb1baf72SNathan Whitehorn 		*is_user = 1;
1622eb1baf72SNathan Whitehorn 	} else {
1623eb1baf72SNathan Whitehorn 		*decoded_addr = addr;
1624eb1baf72SNathan Whitehorn 		*is_user = 0;
1625eb1baf72SNathan Whitehorn 	}
1626eb1baf72SNathan Whitehorn 
1627eb1baf72SNathan Whitehorn 	return (0);
1628eb1baf72SNathan Whitehorn }
1629eb1baf72SNathan Whitehorn 
1630eb1baf72SNathan Whitehorn /*
16315244eac9SBenno Rice  * Map a range of physical addresses into kernel virtual address space.
16325244eac9SBenno Rice  *
16335244eac9SBenno Rice  * The value passed in *virt is a suggested virtual address for the mapping.
16345244eac9SBenno Rice  * Architectures which can support a direct-mapped physical to virtual region
16355244eac9SBenno Rice  * can return the appropriate address within that region, leaving '*virt'
16365244eac9SBenno Rice  * unchanged.  We cannot and therefore do not; *virt is updated with the
16375244eac9SBenno Rice  * first usable address after the mapped region.
16385244eac9SBenno Rice  */
16395244eac9SBenno Rice vm_offset_t
moea_map(vm_offset_t * virt,vm_paddr_t pa_start,vm_paddr_t pa_end,int prot)164045b69dd6SJustin Hibbits moea_map(vm_offset_t *virt, vm_paddr_t pa_start,
164120b79612SRafal Jaworowski     vm_paddr_t pa_end, int prot)
16425244eac9SBenno Rice {
16435244eac9SBenno Rice 	vm_offset_t	sva, va;
16445244eac9SBenno Rice 
16455244eac9SBenno Rice 	sva = *virt;
16465244eac9SBenno Rice 	va = sva;
16475244eac9SBenno Rice 	for (; pa_start < pa_end; pa_start += PAGE_SIZE, va += PAGE_SIZE)
164845b69dd6SJustin Hibbits 		moea_kenter(va, pa_start);
16495244eac9SBenno Rice 	*virt = va;
16505244eac9SBenno Rice 	return (sva);
16515244eac9SBenno Rice }
16525244eac9SBenno Rice 
16535244eac9SBenno Rice /*
16547f3a4093SMike Silbersack  * Returns true if the pmap's pv is one of the first
16557f3a4093SMike Silbersack  * 16 pvs linked to from this page.  This count may
16567f3a4093SMike Silbersack  * be changed upwards or downwards in the future; it
16577f3a4093SMike Silbersack  * is only necessary that true be returned for a small
16587f3a4093SMike Silbersack  * subset of pmaps for proper page aging.
16597f3a4093SMike Silbersack  */
1660*1f1b2286SJohn Baldwin bool
moea_page_exists_quick(pmap_t pmap,vm_page_t m)166145b69dd6SJustin Hibbits moea_page_exists_quick(pmap_t pmap, vm_page_t m)
16625244eac9SBenno Rice {
166303b6e025SPeter Grehan         int loops;
166403b6e025SPeter Grehan 	struct pvo_entry *pvo;
1665*1f1b2286SJohn Baldwin 	bool rv;
166603b6e025SPeter Grehan 
1667d98d0ce2SKonstantin Belousov 	KASSERT((m->oflags & VPO_UNMANAGED) == 0,
1668ce186587SAlan Cox 	    ("moea_page_exists_quick: page %p is not managed", m));
166903b6e025SPeter Grehan 	loops = 0;
1670*1f1b2286SJohn Baldwin 	rv = false;
16713653f5cbSAlan Cox 	rw_wlock(&pvh_global_lock);
167203b6e025SPeter Grehan 	LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink) {
1673ce186587SAlan Cox 		if (pvo->pvo_pmap == pmap) {
1674*1f1b2286SJohn Baldwin 			rv = true;
1675ce186587SAlan Cox 			break;
1676ce186587SAlan Cox 		}
167703b6e025SPeter Grehan 		if (++loops >= 16)
167803b6e025SPeter Grehan 			break;
167903b6e025SPeter Grehan 	}
16803653f5cbSAlan Cox 	rw_wunlock(&pvh_global_lock);
1681ce186587SAlan Cox 	return (rv);
16825244eac9SBenno Rice }
16835244eac9SBenno Rice 
1684b999e9c8SMark Johnston void
moea_page_init(vm_page_t m)168545b69dd6SJustin Hibbits moea_page_init(vm_page_t m)
1686b999e9c8SMark Johnston {
1687b999e9c8SMark Johnston 
1688b999e9c8SMark Johnston 	m->md.mdpg_attrs = 0;
1689b999e9c8SMark Johnston 	m->md.mdpg_cache_attrs = VM_MEMATTR_DEFAULT;
1690b999e9c8SMark Johnston 	LIST_INIT(&m->md.mdpg_pvoh);
1691b999e9c8SMark Johnston }
1692b999e9c8SMark Johnston 
169359677d3cSAlan Cox /*
169459677d3cSAlan Cox  * Return the number of managed mappings to the given physical page
169559677d3cSAlan Cox  * that are wired.
169659677d3cSAlan Cox  */
169759677d3cSAlan Cox int
moea_page_wired_mappings(vm_page_t m)169845b69dd6SJustin Hibbits moea_page_wired_mappings(vm_page_t m)
169959677d3cSAlan Cox {
170059677d3cSAlan Cox 	struct pvo_entry *pvo;
170159677d3cSAlan Cox 	int count;
170259677d3cSAlan Cox 
170359677d3cSAlan Cox 	count = 0;
1704d98d0ce2SKonstantin Belousov 	if ((m->oflags & VPO_UNMANAGED) != 0)
170559677d3cSAlan Cox 		return (count);
17063653f5cbSAlan Cox 	rw_wlock(&pvh_global_lock);
170759677d3cSAlan Cox 	LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink)
170859677d3cSAlan Cox 		if ((pvo->pvo_vaddr & PVO_WIRED) != 0)
170959677d3cSAlan Cox 			count++;
17103653f5cbSAlan Cox 	rw_wunlock(&pvh_global_lock);
171159677d3cSAlan Cox 	return (count);
171259677d3cSAlan Cox }
171359677d3cSAlan Cox 
171459276937SPeter Grehan static u_int	moea_vsidcontext;
17155244eac9SBenno Rice 
171645b69dd6SJustin Hibbits int
moea_pinit(pmap_t pmap)171745b69dd6SJustin Hibbits moea_pinit(pmap_t pmap)
17185244eac9SBenno Rice {
17195244eac9SBenno Rice 	int	i, mask;
17205244eac9SBenno Rice 	u_int	entropy;
17215244eac9SBenno Rice 
1722ccc4a5c7SNathan Whitehorn 	RB_INIT(&pmap->pmap_pvo);
17234daf20b2SPeter Grehan 
17245244eac9SBenno Rice 	entropy = 0;
17255244eac9SBenno Rice 	__asm __volatile("mftb %0" : "=r"(entropy));
17265244eac9SBenno Rice 
172745b69dd6SJustin Hibbits 	if ((pmap->pmap_phys = (pmap_t)moea_kextract((vm_offset_t)pmap))
172852a7870dSNathan Whitehorn 	    == NULL) {
172952a7870dSNathan Whitehorn 		pmap->pmap_phys = pmap;
173052a7870dSNathan Whitehorn 	}
173152a7870dSNathan Whitehorn 
1732e9b5f218SNathan Whitehorn 	mtx_lock(&moea_vsid_mutex);
17335244eac9SBenno Rice 	/*
17345244eac9SBenno Rice 	 * Allocate some segment registers for this pmap.
17355244eac9SBenno Rice 	 */
17365244eac9SBenno Rice 	for (i = 0; i < NPMAPS; i += VSID_NBPW) {
17375244eac9SBenno Rice 		u_int	hash, n;
17385244eac9SBenno Rice 
17395244eac9SBenno Rice 		/*
1740f259d24fSGordon Bergling 		 * Create a new value by multiplying by a prime and adding in
17415244eac9SBenno Rice 		 * entropy from the timebase register.  This is to make the
17425244eac9SBenno Rice 		 * VSID more random so that the PT hash function collides
17435244eac9SBenno Rice 		 * less often.  (Note that the prime casues gcc to do shifts
17445244eac9SBenno Rice 		 * instead of a multiply.)
17455244eac9SBenno Rice 		 */
174659276937SPeter Grehan 		moea_vsidcontext = (moea_vsidcontext * 0x1105) + entropy;
174759276937SPeter Grehan 		hash = moea_vsidcontext & (NPMAPS - 1);
17485244eac9SBenno Rice 		if (hash == 0)		/* 0 is special, avoid it */
17495244eac9SBenno Rice 			continue;
17505244eac9SBenno Rice 		n = hash >> 5;
17515244eac9SBenno Rice 		mask = 1 << (hash & (VSID_NBPW - 1));
175259276937SPeter Grehan 		hash = (moea_vsidcontext & 0xfffff);
175359276937SPeter Grehan 		if (moea_vsid_bitmap[n] & mask) {	/* collision? */
17545244eac9SBenno Rice 			/* anything free in this bucket? */
175559276937SPeter Grehan 			if (moea_vsid_bitmap[n] == 0xffffffff) {
175659276937SPeter Grehan 				entropy = (moea_vsidcontext >> 20);
17575244eac9SBenno Rice 				continue;
17585244eac9SBenno Rice 			}
17590dfddf6eSNathan Whitehorn 			i = ffs(~moea_vsid_bitmap[n]) - 1;
17605244eac9SBenno Rice 			mask = 1 << i;
1761d9c9c81cSPedro F. Giffuni 			hash &= rounddown2(0xfffff, VSID_NBPW);
17625244eac9SBenno Rice 			hash |= i;
17635244eac9SBenno Rice 		}
176446e93cbbSNathan Whitehorn 		KASSERT(!(moea_vsid_bitmap[n] & mask),
176546e93cbbSNathan Whitehorn 		    ("Allocating in-use VSID group %#x\n", hash));
176659276937SPeter Grehan 		moea_vsid_bitmap[n] |= mask;
17675244eac9SBenno Rice 		for (i = 0; i < 16; i++)
17685244eac9SBenno Rice 			pmap->pm_sr[i] = VSID_MAKE(i, hash);
1769e9b5f218SNathan Whitehorn 		mtx_unlock(&moea_vsid_mutex);
177045b69dd6SJustin Hibbits 		return (1);
17715244eac9SBenno Rice 	}
17725244eac9SBenno Rice 
1773e9b5f218SNathan Whitehorn 	mtx_unlock(&moea_vsid_mutex);
177459276937SPeter Grehan 	panic("moea_pinit: out of segments");
17755244eac9SBenno Rice }
17765244eac9SBenno Rice 
17775244eac9SBenno Rice /*
17785244eac9SBenno Rice  * Initialize the pmap associated with process 0.
17795244eac9SBenno Rice  */
17805244eac9SBenno Rice void
moea_pinit0(pmap_t pm)178145b69dd6SJustin Hibbits moea_pinit0(pmap_t pm)
17825244eac9SBenno Rice {
17835244eac9SBenno Rice 
1784e68c64f0SKonstantin Belousov 	PMAP_LOCK_INIT(pm);
178545b69dd6SJustin Hibbits 	moea_pinit(pm);
17865244eac9SBenno Rice 	bzero(&pm->pm_stats, sizeof(pm->pm_stats));
17875244eac9SBenno Rice }
17885244eac9SBenno Rice 
1789e79f59e8SBenno Rice /*
1790e79f59e8SBenno Rice  * Set the physical protection on the specified range of this map as requested.
1791e79f59e8SBenno Rice  */
17925244eac9SBenno Rice void
moea_protect(pmap_t pm,vm_offset_t sva,vm_offset_t eva,vm_prot_t prot)179345b69dd6SJustin Hibbits moea_protect(pmap_t pm, vm_offset_t sva, vm_offset_t eva,
179459276937SPeter Grehan     vm_prot_t prot)
17955244eac9SBenno Rice {
1796ccc4a5c7SNathan Whitehorn 	struct	pvo_entry *pvo, *tpvo, key;
1797e79f59e8SBenno Rice 	struct	pte *pt;
1798e79f59e8SBenno Rice 
1799e79f59e8SBenno Rice 	KASSERT(pm == &curproc->p_vmspace->vm_pmap || pm == kernel_pmap,
180059276937SPeter Grehan 	    ("moea_protect: non current pmap"));
1801e79f59e8SBenno Rice 
1802e79f59e8SBenno Rice 	if ((prot & VM_PROT_READ) == VM_PROT_NONE) {
180345b69dd6SJustin Hibbits 		moea_remove(pm, sva, eva);
1804e79f59e8SBenno Rice 		return;
1805e79f59e8SBenno Rice 	}
1806e79f59e8SBenno Rice 
18073653f5cbSAlan Cox 	rw_wlock(&pvh_global_lock);
180848d0b1a0SAlan Cox 	PMAP_LOCK(pm);
1809ccc4a5c7SNathan Whitehorn 	key.pvo_vaddr = sva;
1810ccc4a5c7SNathan Whitehorn 	for (pvo = RB_NFIND(pvo_tree, &pm->pmap_pvo, &key);
1811ccc4a5c7SNathan Whitehorn 	    pvo != NULL && PVO_VADDR(pvo) < eva; pvo = tpvo) {
1812ccc4a5c7SNathan Whitehorn 		tpvo = RB_NEXT(pvo_tree, &pm->pmap_pvo, pvo);
1813e79f59e8SBenno Rice 
1814e79f59e8SBenno Rice 		/*
1815e79f59e8SBenno Rice 		 * Grab the PTE pointer before we diddle with the cached PTE
1816e79f59e8SBenno Rice 		 * copy.
1817e79f59e8SBenno Rice 		 */
1818ccc4a5c7SNathan Whitehorn 		pt = moea_pvo_to_pte(pvo, -1);
1819e79f59e8SBenno Rice 		/*
1820e79f59e8SBenno Rice 		 * Change the protection of the page.
1821e79f59e8SBenno Rice 		 */
182252a7870dSNathan Whitehorn 		pvo->pvo_pte.pte.pte_lo &= ~PTE_PP;
182352a7870dSNathan Whitehorn 		pvo->pvo_pte.pte.pte_lo |= PTE_BR;
1824e79f59e8SBenno Rice 
1825e79f59e8SBenno Rice 		/*
1826e79f59e8SBenno Rice 		 * If the PVO is in the page table, update that pte as well.
1827e79f59e8SBenno Rice 		 */
1828d644a0b7SAlan Cox 		if (pt != NULL) {
182952a7870dSNathan Whitehorn 			moea_pte_change(pt, &pvo->pvo_pte.pte, pvo->pvo_vaddr);
1830d644a0b7SAlan Cox 			mtx_unlock(&moea_table_mutex);
1831d644a0b7SAlan Cox 		}
1832e79f59e8SBenno Rice 	}
18333653f5cbSAlan Cox 	rw_wunlock(&pvh_global_lock);
183448d0b1a0SAlan Cox 	PMAP_UNLOCK(pm);
18355244eac9SBenno Rice }
18365244eac9SBenno Rice 
183788afb2a3SBenno Rice /*
183888afb2a3SBenno Rice  * Map a list of wired pages into kernel virtual address space.  This is
183988afb2a3SBenno Rice  * intended for temporary mappings which do not need page modification or
184088afb2a3SBenno Rice  * references recorded.  Existing mappings in the region are overwritten.
184188afb2a3SBenno Rice  */
18425244eac9SBenno Rice void
moea_qenter(vm_offset_t sva,vm_page_t * m,int count)184345b69dd6SJustin Hibbits moea_qenter(vm_offset_t sva, vm_page_t *m, int count)
18445244eac9SBenno Rice {
184503b6e025SPeter Grehan 	vm_offset_t va;
18465244eac9SBenno Rice 
184703b6e025SPeter Grehan 	va = sva;
184803b6e025SPeter Grehan 	while (count-- > 0) {
184945b69dd6SJustin Hibbits 		moea_kenter(va, VM_PAGE_TO_PHYS(*m));
185003b6e025SPeter Grehan 		va += PAGE_SIZE;
185103b6e025SPeter Grehan 		m++;
185203b6e025SPeter Grehan 	}
18535244eac9SBenno Rice }
18545244eac9SBenno Rice 
185588afb2a3SBenno Rice /*
185688afb2a3SBenno Rice  * Remove page mappings from kernel virtual address space.  Intended for
185759276937SPeter Grehan  * temporary mappings entered by moea_qenter.
185888afb2a3SBenno Rice  */
18595244eac9SBenno Rice void
moea_qremove(vm_offset_t sva,int count)186045b69dd6SJustin Hibbits moea_qremove(vm_offset_t sva, int count)
18615244eac9SBenno Rice {
186203b6e025SPeter Grehan 	vm_offset_t va;
186388afb2a3SBenno Rice 
186403b6e025SPeter Grehan 	va = sva;
186503b6e025SPeter Grehan 	while (count-- > 0) {
186645b69dd6SJustin Hibbits 		moea_kremove(va);
186703b6e025SPeter Grehan 		va += PAGE_SIZE;
186803b6e025SPeter Grehan 	}
18695244eac9SBenno Rice }
18705244eac9SBenno Rice 
18715244eac9SBenno Rice void
moea_release(pmap_t pmap)187245b69dd6SJustin Hibbits moea_release(pmap_t pmap)
18735244eac9SBenno Rice {
187432bc7846SPeter Grehan         int idx, mask;
187532bc7846SPeter Grehan 
187632bc7846SPeter Grehan 	/*
187732bc7846SPeter Grehan 	 * Free segment register's VSID
187832bc7846SPeter Grehan 	 */
187932bc7846SPeter Grehan         if (pmap->pm_sr[0] == 0)
188059276937SPeter Grehan                 panic("moea_release");
188132bc7846SPeter Grehan 
1882e9b5f218SNathan Whitehorn 	mtx_lock(&moea_vsid_mutex);
188332bc7846SPeter Grehan         idx = VSID_TO_HASH(pmap->pm_sr[0]) & (NPMAPS-1);
188432bc7846SPeter Grehan         mask = 1 << (idx % VSID_NBPW);
188532bc7846SPeter Grehan         idx /= VSID_NBPW;
188659276937SPeter Grehan         moea_vsid_bitmap[idx] &= ~mask;
1887e9b5f218SNathan Whitehorn 	mtx_unlock(&moea_vsid_mutex);
18885244eac9SBenno Rice }
18895244eac9SBenno Rice 
189088afb2a3SBenno Rice /*
189188afb2a3SBenno Rice  * Remove the given range of addresses from the specified map.
189288afb2a3SBenno Rice  */
18935244eac9SBenno Rice void
moea_remove(pmap_t pm,vm_offset_t sva,vm_offset_t eva)189445b69dd6SJustin Hibbits moea_remove(pmap_t pm, vm_offset_t sva, vm_offset_t eva)
18955244eac9SBenno Rice {
1896ccc4a5c7SNathan Whitehorn 	struct	pvo_entry *pvo, *tpvo, key;
189788afb2a3SBenno Rice 
18983653f5cbSAlan Cox 	rw_wlock(&pvh_global_lock);
189948d0b1a0SAlan Cox 	PMAP_LOCK(pm);
1900ccc4a5c7SNathan Whitehorn 	key.pvo_vaddr = sva;
1901ccc4a5c7SNathan Whitehorn 	for (pvo = RB_NFIND(pvo_tree, &pm->pmap_pvo, &key);
1902ccc4a5c7SNathan Whitehorn 	    pvo != NULL && PVO_VADDR(pvo) < eva; pvo = tpvo) {
1903ccc4a5c7SNathan Whitehorn 		tpvo = RB_NEXT(pvo_tree, &pm->pmap_pvo, pvo);
1904598d99ddSNathan Whitehorn 		moea_pvo_remove(pvo, -1);
1905598d99ddSNathan Whitehorn 	}
190648d0b1a0SAlan Cox 	PMAP_UNLOCK(pm);
19073653f5cbSAlan Cox 	rw_wunlock(&pvh_global_lock);
19085244eac9SBenno Rice }
19095244eac9SBenno Rice 
1910e79f59e8SBenno Rice /*
191159276937SPeter Grehan  * Remove physical page from all pmaps in which it resides. moea_pvo_remove()
191203b6e025SPeter Grehan  * will reflect changes in pte's back to the vm_page.
191303b6e025SPeter Grehan  */
191403b6e025SPeter Grehan void
moea_remove_all(vm_page_t m)191545b69dd6SJustin Hibbits moea_remove_all(vm_page_t m)
191603b6e025SPeter Grehan {
191703b6e025SPeter Grehan 	struct  pvo_head *pvo_head;
191803b6e025SPeter Grehan 	struct	pvo_entry *pvo, *next_pvo;
191948d0b1a0SAlan Cox 	pmap_t	pmap;
192003b6e025SPeter Grehan 
19213653f5cbSAlan Cox 	rw_wlock(&pvh_global_lock);
192203b6e025SPeter Grehan 	pvo_head = vm_page_to_pvoh(m);
192303b6e025SPeter Grehan 	for (pvo = LIST_FIRST(pvo_head); pvo != NULL; pvo = next_pvo) {
192403b6e025SPeter Grehan 		next_pvo = LIST_NEXT(pvo, pvo_vlink);
192503b6e025SPeter Grehan 
192648d0b1a0SAlan Cox 		pmap = pvo->pvo_pmap;
192748d0b1a0SAlan Cox 		PMAP_LOCK(pmap);
192859276937SPeter Grehan 		moea_pvo_remove(pvo, -1);
192948d0b1a0SAlan Cox 		PMAP_UNLOCK(pmap);
193003b6e025SPeter Grehan 	}
19315cff1f4dSMark Johnston 	if ((m->a.flags & PGA_WRITEABLE) && moea_query_bit(m, PTE_CHG)) {
1932c668b5b4SNathan Whitehorn 		moea_attr_clear(m, PTE_CHG);
1933062c8f4cSNathan Whitehorn 		vm_page_dirty(m);
1934062c8f4cSNathan Whitehorn 	}
19353407fefeSKonstantin Belousov 	vm_page_aflag_clear(m, PGA_WRITEABLE);
19363653f5cbSAlan Cox 	rw_wunlock(&pvh_global_lock);
193703b6e025SPeter Grehan }
193803b6e025SPeter Grehan 
193943d3fc80SBrandon Bergren static int
moea_mincore(pmap_t pm,vm_offset_t va,vm_paddr_t * pap)194043d3fc80SBrandon Bergren moea_mincore(pmap_t pm, vm_offset_t va, vm_paddr_t *pap)
194143d3fc80SBrandon Bergren {
194243d3fc80SBrandon Bergren 	struct pvo_entry *pvo;
194343d3fc80SBrandon Bergren 	vm_paddr_t pa;
194443d3fc80SBrandon Bergren 	vm_page_t m;
194543d3fc80SBrandon Bergren 	int val;
194643d3fc80SBrandon Bergren 	bool managed;
194743d3fc80SBrandon Bergren 
194843d3fc80SBrandon Bergren 	PMAP_LOCK(pm);
194943d3fc80SBrandon Bergren 
195043d3fc80SBrandon Bergren 	pvo = moea_pvo_find_va(pm, va & ~ADDR_POFF, NULL);
195143d3fc80SBrandon Bergren 	if (pvo != NULL) {
195243d3fc80SBrandon Bergren 		pa = PVO_PADDR(pvo);
195343d3fc80SBrandon Bergren 		m = PHYS_TO_VM_PAGE(pa);
195443d3fc80SBrandon Bergren 		managed = (pvo->pvo_vaddr & PVO_MANAGED) == PVO_MANAGED;
195543d3fc80SBrandon Bergren 		val = MINCORE_INCORE;
195643d3fc80SBrandon Bergren 	} else {
195743d3fc80SBrandon Bergren 		PMAP_UNLOCK(pm);
195843d3fc80SBrandon Bergren 		return (0);
195943d3fc80SBrandon Bergren 	}
196043d3fc80SBrandon Bergren 
196143d3fc80SBrandon Bergren 	PMAP_UNLOCK(pm);
196243d3fc80SBrandon Bergren 
196343d3fc80SBrandon Bergren 	if (m == NULL)
196443d3fc80SBrandon Bergren 		return (0);
196543d3fc80SBrandon Bergren 
196643d3fc80SBrandon Bergren 	if (managed) {
196743d3fc80SBrandon Bergren 		if (moea_is_modified(m))
196843d3fc80SBrandon Bergren 			val |= MINCORE_MODIFIED | MINCORE_MODIFIED_OTHER;
196943d3fc80SBrandon Bergren 
197043d3fc80SBrandon Bergren 		if (moea_is_referenced(m))
197143d3fc80SBrandon Bergren 			val |= MINCORE_REFERENCED | MINCORE_REFERENCED_OTHER;
197243d3fc80SBrandon Bergren 	}
197343d3fc80SBrandon Bergren 
197443d3fc80SBrandon Bergren 	if ((val & (MINCORE_MODIFIED_OTHER | MINCORE_REFERENCED_OTHER)) !=
197543d3fc80SBrandon Bergren 	    (MINCORE_MODIFIED_OTHER | MINCORE_REFERENCED_OTHER) &&
197643d3fc80SBrandon Bergren 	    managed) {
197743d3fc80SBrandon Bergren 		*pap = pa;
197843d3fc80SBrandon Bergren 	}
197943d3fc80SBrandon Bergren 
198043d3fc80SBrandon Bergren 	return (val);
198143d3fc80SBrandon Bergren }
198243d3fc80SBrandon Bergren 
198303b6e025SPeter Grehan /*
19845244eac9SBenno Rice  * Allocate a physical page of memory directly from the phys_avail map.
198559276937SPeter Grehan  * Can only be called from moea_bootstrap before avail start and end are
19865244eac9SBenno Rice  * calculated.
19875244eac9SBenno Rice  */
19885244eac9SBenno Rice static vm_offset_t
moea_bootstrap_alloc(vm_size_t size,u_int align)198959276937SPeter Grehan moea_bootstrap_alloc(vm_size_t size, u_int align)
19905244eac9SBenno Rice {
19915244eac9SBenno Rice 	vm_offset_t	s, e;
19925244eac9SBenno Rice 	int		i, j;
19935244eac9SBenno Rice 
19945244eac9SBenno Rice 	size = round_page(size);
19955244eac9SBenno Rice 	for (i = 0; phys_avail[i + 1] != 0; i += 2) {
19965244eac9SBenno Rice 		if (align != 0)
1997d9c9c81cSPedro F. Giffuni 			s = roundup2(phys_avail[i], align);
19985244eac9SBenno Rice 		else
19995244eac9SBenno Rice 			s = phys_avail[i];
20005244eac9SBenno Rice 		e = s + size;
20015244eac9SBenno Rice 
20025244eac9SBenno Rice 		if (s < phys_avail[i] || e > phys_avail[i + 1])
20035244eac9SBenno Rice 			continue;
20045244eac9SBenno Rice 
20055244eac9SBenno Rice 		if (s == phys_avail[i]) {
20065244eac9SBenno Rice 			phys_avail[i] += size;
20075244eac9SBenno Rice 		} else if (e == phys_avail[i + 1]) {
20085244eac9SBenno Rice 			phys_avail[i + 1] -= size;
20095244eac9SBenno Rice 		} else {
20105244eac9SBenno Rice 			for (j = phys_avail_count * 2; j > i; j -= 2) {
20115244eac9SBenno Rice 				phys_avail[j] = phys_avail[j - 2];
20125244eac9SBenno Rice 				phys_avail[j + 1] = phys_avail[j - 1];
20135244eac9SBenno Rice 			}
20145244eac9SBenno Rice 
20155244eac9SBenno Rice 			phys_avail[i + 3] = phys_avail[i + 1];
20165244eac9SBenno Rice 			phys_avail[i + 1] = s;
20175244eac9SBenno Rice 			phys_avail[i + 2] = e;
20185244eac9SBenno Rice 			phys_avail_count++;
20195244eac9SBenno Rice 		}
20205244eac9SBenno Rice 
20215244eac9SBenno Rice 		return (s);
20225244eac9SBenno Rice 	}
202359276937SPeter Grehan 	panic("moea_bootstrap_alloc: could not allocate memory");
20245244eac9SBenno Rice }
20255244eac9SBenno Rice 
20265244eac9SBenno Rice static void
moea_syncicache(vm_paddr_t pa,vm_size_t len)20270936003eSJustin Hibbits moea_syncicache(vm_paddr_t pa, vm_size_t len)
20285244eac9SBenno Rice {
20295244eac9SBenno Rice 	__syncicache((void *)pa, len);
20305244eac9SBenno Rice }
20315244eac9SBenno Rice 
20325244eac9SBenno Rice static int
moea_pvo_enter(pmap_t pm,uma_zone_t zone,struct pvo_head * pvo_head,vm_offset_t va,vm_paddr_t pa,u_int pte_lo,int flags)203359276937SPeter Grehan moea_pvo_enter(pmap_t pm, uma_zone_t zone, struct pvo_head *pvo_head,
20340936003eSJustin Hibbits     vm_offset_t va, vm_paddr_t pa, u_int pte_lo, int flags)
20355244eac9SBenno Rice {
20365244eac9SBenno Rice 	struct	pvo_entry *pvo;
20375244eac9SBenno Rice 	u_int	sr;
20385244eac9SBenno Rice 	int	first;
20395244eac9SBenno Rice 	u_int	ptegidx;
20405244eac9SBenno Rice 	int	i;
204132bc7846SPeter Grehan 	int     bootstrap;
20425244eac9SBenno Rice 
204359276937SPeter Grehan 	moea_pvo_enter_calls++;
20448207b362SBenno Rice 	first = 0;
204532bc7846SPeter Grehan 	bootstrap = 0;
204632bc7846SPeter Grehan 
20475244eac9SBenno Rice 	/*
20485244eac9SBenno Rice 	 * Compute the PTE Group index.
20495244eac9SBenno Rice 	 */
20505244eac9SBenno Rice 	va &= ~ADDR_POFF;
20515244eac9SBenno Rice 	sr = va_to_sr(pm->pm_sr, va);
20525244eac9SBenno Rice 	ptegidx = va_to_pteg(sr, va);
20535244eac9SBenno Rice 
20545244eac9SBenno Rice 	/*
20555244eac9SBenno Rice 	 * Remove any existing mapping for this page.  Reuse the pvo entry if
20565244eac9SBenno Rice 	 * there is a mapping.
20575244eac9SBenno Rice 	 */
205859276937SPeter Grehan 	mtx_lock(&moea_table_mutex);
205959276937SPeter Grehan 	LIST_FOREACH(pvo, &moea_pvo_table[ptegidx], pvo_olink) {
20605244eac9SBenno Rice 		if (pvo->pvo_pmap == pm && PVO_VADDR(pvo) == va) {
20617be655c2SBrandon Bergren 			if (PVO_PADDR(pvo) == pa &&
206252a7870dSNathan Whitehorn 			    (pvo->pvo_pte.pte.pte_lo & PTE_PP) ==
2063fafc7362SBenno Rice 			    (pte_lo & PTE_PP)) {
2064add03590SAlan Cox 				/*
2065add03590SAlan Cox 				 * The PTE is not changing.  Instead, this may
2066add03590SAlan Cox 				 * be a request to change the mapping's wired
2067add03590SAlan Cox 				 * attribute.
2068add03590SAlan Cox 				 */
206959276937SPeter Grehan 				mtx_unlock(&moea_table_mutex);
2070add03590SAlan Cox 				if ((flags & PVO_WIRED) != 0 &&
2071add03590SAlan Cox 				    (pvo->pvo_vaddr & PVO_WIRED) == 0) {
2072add03590SAlan Cox 					pvo->pvo_vaddr |= PVO_WIRED;
2073add03590SAlan Cox 					pm->pm_stats.wired_count++;
2074add03590SAlan Cox 				} else if ((flags & PVO_WIRED) == 0 &&
2075add03590SAlan Cox 				    (pvo->pvo_vaddr & PVO_WIRED) != 0) {
2076add03590SAlan Cox 					pvo->pvo_vaddr &= ~PVO_WIRED;
2077add03590SAlan Cox 					pm->pm_stats.wired_count--;
2078add03590SAlan Cox 				}
207949f8f727SBenno Rice 				return (0);
2080fafc7362SBenno Rice 			}
208159276937SPeter Grehan 			moea_pvo_remove(pvo, -1);
20825244eac9SBenno Rice 			break;
20835244eac9SBenno Rice 		}
20845244eac9SBenno Rice 	}
20855244eac9SBenno Rice 
20865244eac9SBenno Rice 	/*
20875244eac9SBenno Rice 	 * If we aren't overwriting a mapping, try to allocate.
20885244eac9SBenno Rice 	 */
208959276937SPeter Grehan 	if (moea_initialized) {
2090378862a7SJeff Roberson 		pvo = uma_zalloc(zone, M_NOWAIT);
209149f8f727SBenno Rice 	} else {
209259276937SPeter Grehan 		if (moea_bpvo_pool_index >= BPVO_POOL_SIZE) {
209359276937SPeter Grehan 			panic("moea_enter: bpvo pool exhausted, %d, %d, %d",
209459276937SPeter Grehan 			      moea_bpvo_pool_index, BPVO_POOL_SIZE,
20950d290675SBenno Rice 			      BPVO_POOL_SIZE * sizeof(struct pvo_entry));
209649f8f727SBenno Rice 		}
209759276937SPeter Grehan 		pvo = &moea_bpvo_pool[moea_bpvo_pool_index];
209859276937SPeter Grehan 		moea_bpvo_pool_index++;
209932bc7846SPeter Grehan 		bootstrap = 1;
210049f8f727SBenno Rice 	}
21015244eac9SBenno Rice 
21025244eac9SBenno Rice 	if (pvo == NULL) {
210359276937SPeter Grehan 		mtx_unlock(&moea_table_mutex);
21045244eac9SBenno Rice 		return (ENOMEM);
21055244eac9SBenno Rice 	}
21065244eac9SBenno Rice 
210759276937SPeter Grehan 	moea_pvo_entries++;
21085244eac9SBenno Rice 	pvo->pvo_vaddr = va;
21095244eac9SBenno Rice 	pvo->pvo_pmap = pm;
211059276937SPeter Grehan 	LIST_INSERT_HEAD(&moea_pvo_table[ptegidx], pvo, pvo_olink);
21115244eac9SBenno Rice 	pvo->pvo_vaddr &= ~ADDR_POFF;
21125244eac9SBenno Rice 	if (flags & PVO_WIRED)
21135244eac9SBenno Rice 		pvo->pvo_vaddr |= PVO_WIRED;
211459276937SPeter Grehan 	if (pvo_head != &moea_pvo_kunmanaged)
21155244eac9SBenno Rice 		pvo->pvo_vaddr |= PVO_MANAGED;
211632bc7846SPeter Grehan 	if (bootstrap)
211732bc7846SPeter Grehan 		pvo->pvo_vaddr |= PVO_BOOTSTRAP;
21184dba5df1SPeter Grehan 
211952a7870dSNathan Whitehorn 	moea_pte_create(&pvo->pvo_pte.pte, sr, va, pa | pte_lo);
21205244eac9SBenno Rice 
21215244eac9SBenno Rice 	/*
2122598d99ddSNathan Whitehorn 	 * Add to pmap list
2123598d99ddSNathan Whitehorn 	 */
2124ccc4a5c7SNathan Whitehorn 	RB_INSERT(pvo_tree, &pm->pmap_pvo, pvo);
2125598d99ddSNathan Whitehorn 
2126598d99ddSNathan Whitehorn 	/*
21275244eac9SBenno Rice 	 * Remember if the list was empty and therefore will be the first
21285244eac9SBenno Rice 	 * item.
21295244eac9SBenno Rice 	 */
21308207b362SBenno Rice 	if (LIST_FIRST(pvo_head) == NULL)
21318207b362SBenno Rice 		first = 1;
21325244eac9SBenno Rice 	LIST_INSERT_HEAD(pvo_head, pvo, pvo_vlink);
21334dba5df1SPeter Grehan 
2134bfc30490SAlan Cox 	if (pvo->pvo_vaddr & PVO_WIRED)
2135c3d11d22SAlan Cox 		pm->pm_stats.wired_count++;
2136c3d11d22SAlan Cox 	pm->pm_stats.resident_count++;
21375244eac9SBenno Rice 
213852a7870dSNathan Whitehorn 	i = moea_pte_insert(ptegidx, &pvo->pvo_pte.pte);
2139804d1cc1SJustin Hibbits 	KASSERT(i < 8, ("Invalid PTE index"));
21405244eac9SBenno Rice 	if (i >= 0) {
21415244eac9SBenno Rice 		PVO_PTEGIDX_SET(pvo, i);
21425244eac9SBenno Rice 	} else {
214359276937SPeter Grehan 		panic("moea_pvo_enter: overflow");
214459276937SPeter Grehan 		moea_pte_overflow++;
21455244eac9SBenno Rice 	}
214659276937SPeter Grehan 	mtx_unlock(&moea_table_mutex);
21474dba5df1SPeter Grehan 
21485244eac9SBenno Rice 	return (first ? ENOENT : 0);
21495244eac9SBenno Rice }
21505244eac9SBenno Rice 
21515244eac9SBenno Rice static void
moea_pvo_remove(struct pvo_entry * pvo,int pteidx)215259276937SPeter Grehan moea_pvo_remove(struct pvo_entry *pvo, int pteidx)
21535244eac9SBenno Rice {
21545244eac9SBenno Rice 	struct	pte *pt;
21555244eac9SBenno Rice 
21565244eac9SBenno Rice 	/*
21575244eac9SBenno Rice 	 * If there is an active pte entry, we need to deactivate it (and
21585244eac9SBenno Rice 	 * save the ref & cfg bits).
21595244eac9SBenno Rice 	 */
216059276937SPeter Grehan 	pt = moea_pvo_to_pte(pvo, pteidx);
21615244eac9SBenno Rice 	if (pt != NULL) {
216252a7870dSNathan Whitehorn 		moea_pte_unset(pt, &pvo->pvo_pte.pte, pvo->pvo_vaddr);
2163d644a0b7SAlan Cox 		mtx_unlock(&moea_table_mutex);
21645244eac9SBenno Rice 		PVO_PTEGIDX_CLR(pvo);
21655244eac9SBenno Rice 	} else {
216659276937SPeter Grehan 		moea_pte_overflow--;
21675244eac9SBenno Rice 	}
21685244eac9SBenno Rice 
21695244eac9SBenno Rice 	/*
21705244eac9SBenno Rice 	 * Update our statistics.
21715244eac9SBenno Rice 	 */
21725244eac9SBenno Rice 	pvo->pvo_pmap->pm_stats.resident_count--;
2173bfc30490SAlan Cox 	if (pvo->pvo_vaddr & PVO_WIRED)
21745244eac9SBenno Rice 		pvo->pvo_pmap->pm_stats.wired_count--;
21755244eac9SBenno Rice 
21765244eac9SBenno Rice 	/*
2177b4efea53SMark Johnston 	 * Remove this PVO from the PV and pmap lists.
2178b4efea53SMark Johnston 	 */
2179b4efea53SMark Johnston 	LIST_REMOVE(pvo, pvo_vlink);
2180b4efea53SMark Johnston 	RB_REMOVE(pvo_tree, &pvo->pvo_pmap->pmap_pvo, pvo);
2181b4efea53SMark Johnston 
2182b4efea53SMark Johnston 	/*
21835244eac9SBenno Rice 	 * Save the REF/CHG bits into their cache if the page is managed.
2184b4efea53SMark Johnston 	 * Clear PGA_WRITEABLE if all mappings of the page have been removed.
21855244eac9SBenno Rice 	 */
2186d98d0ce2SKonstantin Belousov 	if ((pvo->pvo_vaddr & PVO_MANAGED) == PVO_MANAGED) {
21875244eac9SBenno Rice 		struct vm_page *pg;
21885244eac9SBenno Rice 
21897be655c2SBrandon Bergren 		pg = PHYS_TO_VM_PAGE(PVO_PADDR(pvo));
21905244eac9SBenno Rice 		if (pg != NULL) {
219152a7870dSNathan Whitehorn 			moea_attr_save(pg, pvo->pvo_pte.pte.pte_lo &
21925244eac9SBenno Rice 			    (PTE_REF | PTE_CHG));
2193b4efea53SMark Johnston 			if (LIST_EMPTY(&pg->md.mdpg_pvoh))
2194b4efea53SMark Johnston 				vm_page_aflag_clear(pg, PGA_WRITEABLE);
21955244eac9SBenno Rice 		}
21965244eac9SBenno Rice 	}
21975244eac9SBenno Rice 
21985244eac9SBenno Rice 	/*
21995244eac9SBenno Rice 	 * Remove this from the overflow list and return it to the pool
22005244eac9SBenno Rice 	 * if we aren't going to reuse it.
22015244eac9SBenno Rice 	 */
22025244eac9SBenno Rice 	LIST_REMOVE(pvo, pvo_olink);
220349f8f727SBenno Rice 	if (!(pvo->pvo_vaddr & PVO_BOOTSTRAP))
220459276937SPeter Grehan 		uma_zfree(pvo->pvo_vaddr & PVO_MANAGED ? moea_mpvo_zone :
220559276937SPeter Grehan 		    moea_upvo_zone, pvo);
220659276937SPeter Grehan 	moea_pvo_entries--;
220759276937SPeter Grehan 	moea_pvo_remove_calls++;
22085244eac9SBenno Rice }
22095244eac9SBenno Rice 
22105244eac9SBenno Rice static __inline int
moea_pvo_pte_index(const struct pvo_entry * pvo,int ptegidx)221159276937SPeter Grehan moea_pvo_pte_index(const struct pvo_entry *pvo, int ptegidx)
22125244eac9SBenno Rice {
22135244eac9SBenno Rice 	int	pteidx;
22145244eac9SBenno Rice 
22155244eac9SBenno Rice 	/*
22165244eac9SBenno Rice 	 * We can find the actual pte entry without searching by grabbing
22175244eac9SBenno Rice 	 * the PTEG index from 3 unused bits in pte_lo[11:9] and by
22185244eac9SBenno Rice 	 * noticing the HID bit.
22195244eac9SBenno Rice 	 */
22205244eac9SBenno Rice 	pteidx = ptegidx * 8 + PVO_PTEGIDX_GET(pvo);
222152a7870dSNathan Whitehorn 	if (pvo->pvo_pte.pte.pte_hi & PTE_HID)
222259276937SPeter Grehan 		pteidx ^= moea_pteg_mask * 8;
22235244eac9SBenno Rice 
22245244eac9SBenno Rice 	return (pteidx);
22255244eac9SBenno Rice }
22265244eac9SBenno Rice 
22275244eac9SBenno Rice static struct pvo_entry *
moea_pvo_find_va(pmap_t pm,vm_offset_t va,int * pteidx_p)222859276937SPeter Grehan moea_pvo_find_va(pmap_t pm, vm_offset_t va, int *pteidx_p)
22295244eac9SBenno Rice {
22305244eac9SBenno Rice 	struct	pvo_entry *pvo;
22315244eac9SBenno Rice 	int	ptegidx;
22325244eac9SBenno Rice 	u_int	sr;
22335244eac9SBenno Rice 
22345244eac9SBenno Rice 	va &= ~ADDR_POFF;
22355244eac9SBenno Rice 	sr = va_to_sr(pm->pm_sr, va);
22365244eac9SBenno Rice 	ptegidx = va_to_pteg(sr, va);
22375244eac9SBenno Rice 
223859276937SPeter Grehan 	mtx_lock(&moea_table_mutex);
223959276937SPeter Grehan 	LIST_FOREACH(pvo, &moea_pvo_table[ptegidx], pvo_olink) {
22405244eac9SBenno Rice 		if (pvo->pvo_pmap == pm && PVO_VADDR(pvo) == va) {
22415244eac9SBenno Rice 			if (pteidx_p)
224259276937SPeter Grehan 				*pteidx_p = moea_pvo_pte_index(pvo, ptegidx);
2243f489bf21SAlan Cox 			break;
22445244eac9SBenno Rice 		}
22455244eac9SBenno Rice 	}
224659276937SPeter Grehan 	mtx_unlock(&moea_table_mutex);
22475244eac9SBenno Rice 
2248f489bf21SAlan Cox 	return (pvo);
22495244eac9SBenno Rice }
22505244eac9SBenno Rice 
22515244eac9SBenno Rice static struct pte *
moea_pvo_to_pte(const struct pvo_entry * pvo,int pteidx)225259276937SPeter Grehan moea_pvo_to_pte(const struct pvo_entry *pvo, int pteidx)
22535244eac9SBenno Rice {
22545244eac9SBenno Rice 	struct	pte *pt;
22555244eac9SBenno Rice 
22565244eac9SBenno Rice 	/*
22575244eac9SBenno Rice 	 * If we haven't been supplied the ptegidx, calculate it.
22585244eac9SBenno Rice 	 */
22595244eac9SBenno Rice 	if (pteidx == -1) {
22605244eac9SBenno Rice 		int	ptegidx;
22615244eac9SBenno Rice 		u_int	sr;
22625244eac9SBenno Rice 
22635244eac9SBenno Rice 		sr = va_to_sr(pvo->pvo_pmap->pm_sr, pvo->pvo_vaddr);
22645244eac9SBenno Rice 		ptegidx = va_to_pteg(sr, pvo->pvo_vaddr);
226559276937SPeter Grehan 		pteidx = moea_pvo_pte_index(pvo, ptegidx);
22665244eac9SBenno Rice 	}
22675244eac9SBenno Rice 
226859276937SPeter Grehan 	pt = &moea_pteg_table[pteidx >> 3].pt[pteidx & 7];
2269d644a0b7SAlan Cox 	mtx_lock(&moea_table_mutex);
22705244eac9SBenno Rice 
227152a7870dSNathan Whitehorn 	if ((pvo->pvo_pte.pte.pte_hi & PTE_VALID) && !PVO_PTEGIDX_ISSET(pvo)) {
227259276937SPeter Grehan 		panic("moea_pvo_to_pte: pvo %p has valid pte in pvo but no "
22735244eac9SBenno Rice 		    "valid pte index", pvo);
22745244eac9SBenno Rice 	}
22755244eac9SBenno Rice 
227652a7870dSNathan Whitehorn 	if ((pvo->pvo_pte.pte.pte_hi & PTE_VALID) == 0 && PVO_PTEGIDX_ISSET(pvo)) {
227759276937SPeter Grehan 		panic("moea_pvo_to_pte: pvo %p has valid pte index in pvo "
22785244eac9SBenno Rice 		    "pvo but no valid pte", pvo);
22795244eac9SBenno Rice 	}
22805244eac9SBenno Rice 
228152a7870dSNathan Whitehorn 	if ((pt->pte_hi ^ (pvo->pvo_pte.pte.pte_hi & ~PTE_VALID)) == PTE_VALID) {
228252a7870dSNathan Whitehorn 		if ((pvo->pvo_pte.pte.pte_hi & PTE_VALID) == 0) {
228359276937SPeter Grehan 			panic("moea_pvo_to_pte: pvo %p has valid pte in "
228459276937SPeter Grehan 			    "moea_pteg_table %p but invalid in pvo", pvo, pt);
22855244eac9SBenno Rice 		}
22865244eac9SBenno Rice 
228752a7870dSNathan Whitehorn 		if (((pt->pte_lo ^ pvo->pvo_pte.pte.pte_lo) & ~(PTE_CHG|PTE_REF))
22885244eac9SBenno Rice 		    != 0) {
228959276937SPeter Grehan 			panic("moea_pvo_to_pte: pvo %p pte does not match "
229059276937SPeter Grehan 			    "pte %p in moea_pteg_table", pvo, pt);
22915244eac9SBenno Rice 		}
22925244eac9SBenno Rice 
2293d644a0b7SAlan Cox 		mtx_assert(&moea_table_mutex, MA_OWNED);
22945244eac9SBenno Rice 		return (pt);
22955244eac9SBenno Rice 	}
22965244eac9SBenno Rice 
229752a7870dSNathan Whitehorn 	if (pvo->pvo_pte.pte.pte_hi & PTE_VALID) {
229859276937SPeter Grehan 		panic("moea_pvo_to_pte: pvo %p has invalid pte %p in "
2299804d1cc1SJustin Hibbits 		    "moea_pteg_table but valid in pvo: %8x, %8x", pvo, pt, pvo->pvo_pte.pte.pte_hi, pt->pte_hi);
23005244eac9SBenno Rice 	}
23015244eac9SBenno Rice 
2302d644a0b7SAlan Cox 	mtx_unlock(&moea_table_mutex);
23035244eac9SBenno Rice 	return (NULL);
23045244eac9SBenno Rice }
23055244eac9SBenno Rice 
23065244eac9SBenno Rice /*
23075244eac9SBenno Rice  * XXX: THIS STUFF SHOULD BE IN pte.c?
23085244eac9SBenno Rice  */
23095244eac9SBenno Rice int
moea_pte_spill(vm_offset_t addr)231059276937SPeter Grehan moea_pte_spill(vm_offset_t addr)
23115244eac9SBenno Rice {
23125244eac9SBenno Rice 	struct	pvo_entry *source_pvo, *victim_pvo;
23135244eac9SBenno Rice 	struct	pvo_entry *pvo;
23145244eac9SBenno Rice 	int	ptegidx, i, j;
23155244eac9SBenno Rice 	u_int	sr;
23165244eac9SBenno Rice 	struct	pteg *pteg;
23175244eac9SBenno Rice 	struct	pte *pt;
23185244eac9SBenno Rice 
231959276937SPeter Grehan 	moea_pte_spills++;
23205244eac9SBenno Rice 
2321d080d5fdSBenno Rice 	sr = mfsrin(addr);
23225244eac9SBenno Rice 	ptegidx = va_to_pteg(sr, addr);
23235244eac9SBenno Rice 
23245244eac9SBenno Rice 	/*
23255244eac9SBenno Rice 	 * Have to substitute some entry.  Use the primary hash for this.
23265244eac9SBenno Rice 	 * Use low bits of timebase as random generator.
23275244eac9SBenno Rice 	 */
232859276937SPeter Grehan 	pteg = &moea_pteg_table[ptegidx];
232959276937SPeter Grehan 	mtx_lock(&moea_table_mutex);
23305244eac9SBenno Rice 	__asm __volatile("mftb %0" : "=r"(i));
23315244eac9SBenno Rice 	i &= 7;
23325244eac9SBenno Rice 	pt = &pteg->pt[i];
23335244eac9SBenno Rice 
23345244eac9SBenno Rice 	source_pvo = NULL;
23355244eac9SBenno Rice 	victim_pvo = NULL;
233659276937SPeter Grehan 	LIST_FOREACH(pvo, &moea_pvo_table[ptegidx], pvo_olink) {
23375244eac9SBenno Rice 		/*
23385244eac9SBenno Rice 		 * We need to find a pvo entry for this address.
23395244eac9SBenno Rice 		 */
23405244eac9SBenno Rice 		if (source_pvo == NULL &&
234152a7870dSNathan Whitehorn 		    moea_pte_match(&pvo->pvo_pte.pte, sr, addr,
234252a7870dSNathan Whitehorn 		    pvo->pvo_pte.pte.pte_hi & PTE_HID)) {
23435244eac9SBenno Rice 			/*
23445244eac9SBenno Rice 			 * Now found an entry to be spilled into the pteg.
23455244eac9SBenno Rice 			 * The PTE is now valid, so we know it's active.
23465244eac9SBenno Rice 			 */
234752a7870dSNathan Whitehorn 			j = moea_pte_insert(ptegidx, &pvo->pvo_pte.pte);
23485244eac9SBenno Rice 
23495244eac9SBenno Rice 			if (j >= 0) {
23505244eac9SBenno Rice 				PVO_PTEGIDX_SET(pvo, j);
235159276937SPeter Grehan 				moea_pte_overflow--;
235259276937SPeter Grehan 				mtx_unlock(&moea_table_mutex);
23535244eac9SBenno Rice 				return (1);
23545244eac9SBenno Rice 			}
23555244eac9SBenno Rice 
23565244eac9SBenno Rice 			source_pvo = pvo;
23575244eac9SBenno Rice 
23585244eac9SBenno Rice 			if (victim_pvo != NULL)
23595244eac9SBenno Rice 				break;
23605244eac9SBenno Rice 		}
23615244eac9SBenno Rice 
23625244eac9SBenno Rice 		/*
23635244eac9SBenno Rice 		 * We also need the pvo entry of the victim we are replacing
23645244eac9SBenno Rice 		 * so save the R & C bits of the PTE.
23655244eac9SBenno Rice 		 */
23665244eac9SBenno Rice 		if ((pt->pte_hi & PTE_HID) == 0 && victim_pvo == NULL &&
236752a7870dSNathan Whitehorn 		    moea_pte_compare(pt, &pvo->pvo_pte.pte)) {
23685244eac9SBenno Rice 			victim_pvo = pvo;
23695244eac9SBenno Rice 			if (source_pvo != NULL)
23705244eac9SBenno Rice 				break;
23715244eac9SBenno Rice 		}
23725244eac9SBenno Rice 	}
23735244eac9SBenno Rice 
2374f489bf21SAlan Cox 	if (source_pvo == NULL) {
237559276937SPeter Grehan 		mtx_unlock(&moea_table_mutex);
23765244eac9SBenno Rice 		return (0);
2377f489bf21SAlan Cox 	}
23785244eac9SBenno Rice 
23795244eac9SBenno Rice 	if (victim_pvo == NULL) {
23805244eac9SBenno Rice 		if ((pt->pte_hi & PTE_HID) == 0)
238159276937SPeter Grehan 			panic("moea_pte_spill: victim p-pte (%p) has no pvo"
23825244eac9SBenno Rice 			    "entry", pt);
23835244eac9SBenno Rice 
23845244eac9SBenno Rice 		/*
23855244eac9SBenno Rice 		 * If this is a secondary PTE, we need to search it's primary
23865244eac9SBenno Rice 		 * pvo bucket for the matching PVO.
23875244eac9SBenno Rice 		 */
238859276937SPeter Grehan 		LIST_FOREACH(pvo, &moea_pvo_table[ptegidx ^ moea_pteg_mask],
23895244eac9SBenno Rice 		    pvo_olink) {
23905244eac9SBenno Rice 			/*
23915244eac9SBenno Rice 			 * We also need the pvo entry of the victim we are
23925244eac9SBenno Rice 			 * replacing so save the R & C bits of the PTE.
23935244eac9SBenno Rice 			 */
239452a7870dSNathan Whitehorn 			if (moea_pte_compare(pt, &pvo->pvo_pte.pte)) {
23955244eac9SBenno Rice 				victim_pvo = pvo;
23965244eac9SBenno Rice 				break;
23975244eac9SBenno Rice 			}
23985244eac9SBenno Rice 		}
23995244eac9SBenno Rice 
24005244eac9SBenno Rice 		if (victim_pvo == NULL)
240159276937SPeter Grehan 			panic("moea_pte_spill: victim s-pte (%p) has no pvo"
24025244eac9SBenno Rice 			    "entry", pt);
24035244eac9SBenno Rice 	}
24045244eac9SBenno Rice 
24055244eac9SBenno Rice 	/*
24065244eac9SBenno Rice 	 * We are invalidating the TLB entry for the EA we are replacing even
24075244eac9SBenno Rice 	 * though it's valid.  If we don't, we lose any ref/chg bit changes
24085244eac9SBenno Rice 	 * contained in the TLB entry.
24095244eac9SBenno Rice 	 */
241052a7870dSNathan Whitehorn 	source_pvo->pvo_pte.pte.pte_hi &= ~PTE_HID;
24115244eac9SBenno Rice 
241252a7870dSNathan Whitehorn 	moea_pte_unset(pt, &victim_pvo->pvo_pte.pte, victim_pvo->pvo_vaddr);
241352a7870dSNathan Whitehorn 	moea_pte_set(pt, &source_pvo->pvo_pte.pte);
24145244eac9SBenno Rice 
24155244eac9SBenno Rice 	PVO_PTEGIDX_CLR(victim_pvo);
24165244eac9SBenno Rice 	PVO_PTEGIDX_SET(source_pvo, i);
241759276937SPeter Grehan 	moea_pte_replacements++;
24185244eac9SBenno Rice 
241959276937SPeter Grehan 	mtx_unlock(&moea_table_mutex);
24205244eac9SBenno Rice 	return (1);
24215244eac9SBenno Rice }
24225244eac9SBenno Rice 
2423804d1cc1SJustin Hibbits static __inline struct pvo_entry *
moea_pte_spillable_ident(u_int ptegidx)2424804d1cc1SJustin Hibbits moea_pte_spillable_ident(u_int ptegidx)
2425804d1cc1SJustin Hibbits {
2426804d1cc1SJustin Hibbits 	struct	pte *pt;
2427804d1cc1SJustin Hibbits 	struct	pvo_entry *pvo_walk, *pvo = NULL;
2428804d1cc1SJustin Hibbits 
2429804d1cc1SJustin Hibbits 	LIST_FOREACH(pvo_walk, &moea_pvo_table[ptegidx], pvo_olink) {
2430804d1cc1SJustin Hibbits 		if (pvo_walk->pvo_vaddr & PVO_WIRED)
2431804d1cc1SJustin Hibbits 			continue;
2432804d1cc1SJustin Hibbits 
2433804d1cc1SJustin Hibbits 		if (!(pvo_walk->pvo_pte.pte.pte_hi & PTE_VALID))
2434804d1cc1SJustin Hibbits 			continue;
2435804d1cc1SJustin Hibbits 
2436804d1cc1SJustin Hibbits 		pt = moea_pvo_to_pte(pvo_walk, -1);
2437804d1cc1SJustin Hibbits 
2438804d1cc1SJustin Hibbits 		if (pt == NULL)
2439804d1cc1SJustin Hibbits 			continue;
2440804d1cc1SJustin Hibbits 
2441804d1cc1SJustin Hibbits 		pvo = pvo_walk;
2442804d1cc1SJustin Hibbits 
2443804d1cc1SJustin Hibbits 		mtx_unlock(&moea_table_mutex);
2444804d1cc1SJustin Hibbits 		if (!(pt->pte_lo & PTE_REF))
2445804d1cc1SJustin Hibbits 			return (pvo_walk);
2446804d1cc1SJustin Hibbits 	}
2447804d1cc1SJustin Hibbits 
2448804d1cc1SJustin Hibbits 	return (pvo);
2449804d1cc1SJustin Hibbits }
2450804d1cc1SJustin Hibbits 
24515244eac9SBenno Rice static int
moea_pte_insert(u_int ptegidx,struct pte * pvo_pt)245259276937SPeter Grehan moea_pte_insert(u_int ptegidx, struct pte *pvo_pt)
24535244eac9SBenno Rice {
24545244eac9SBenno Rice 	struct	pte *pt;
2455804d1cc1SJustin Hibbits 	struct	pvo_entry *victim_pvo;
24565244eac9SBenno Rice 	int	i;
2457804d1cc1SJustin Hibbits 	int	victim_idx;
2458804d1cc1SJustin Hibbits 	u_int	pteg_bkpidx = ptegidx;
24595244eac9SBenno Rice 
2460d644a0b7SAlan Cox 	mtx_assert(&moea_table_mutex, MA_OWNED);
2461d644a0b7SAlan Cox 
24625244eac9SBenno Rice 	/*
24635244eac9SBenno Rice 	 * First try primary hash.
24645244eac9SBenno Rice 	 */
246559276937SPeter Grehan 	for (pt = moea_pteg_table[ptegidx].pt, i = 0; i < 8; i++, pt++) {
24665244eac9SBenno Rice 		if ((pt->pte_hi & PTE_VALID) == 0) {
24675244eac9SBenno Rice 			pvo_pt->pte_hi &= ~PTE_HID;
246859276937SPeter Grehan 			moea_pte_set(pt, pvo_pt);
24695244eac9SBenno Rice 			return (i);
24705244eac9SBenno Rice 		}
24715244eac9SBenno Rice 	}
24725244eac9SBenno Rice 
24735244eac9SBenno Rice 	/*
24745244eac9SBenno Rice 	 * Now try secondary hash.
24755244eac9SBenno Rice 	 */
247659276937SPeter Grehan 	ptegidx ^= moea_pteg_mask;
2477bd8e6f87SPeter Grehan 
247859276937SPeter Grehan 	for (pt = moea_pteg_table[ptegidx].pt, i = 0; i < 8; i++, pt++) {
24795244eac9SBenno Rice 		if ((pt->pte_hi & PTE_VALID) == 0) {
24805244eac9SBenno Rice 			pvo_pt->pte_hi |= PTE_HID;
248159276937SPeter Grehan 			moea_pte_set(pt, pvo_pt);
24825244eac9SBenno Rice 			return (i);
24835244eac9SBenno Rice 		}
24845244eac9SBenno Rice 	}
24855244eac9SBenno Rice 
2486804d1cc1SJustin Hibbits 	/* Try again, but this time try to force a PTE out. */
2487804d1cc1SJustin Hibbits 	ptegidx = pteg_bkpidx;
2488804d1cc1SJustin Hibbits 
2489804d1cc1SJustin Hibbits 	victim_pvo = moea_pte_spillable_ident(ptegidx);
2490804d1cc1SJustin Hibbits 	if (victim_pvo == NULL) {
2491804d1cc1SJustin Hibbits 		ptegidx ^= moea_pteg_mask;
2492804d1cc1SJustin Hibbits 		victim_pvo = moea_pte_spillable_ident(ptegidx);
2493804d1cc1SJustin Hibbits 	}
2494804d1cc1SJustin Hibbits 
2495804d1cc1SJustin Hibbits 	if (victim_pvo == NULL) {
249659276937SPeter Grehan 		panic("moea_pte_insert: overflow");
24975244eac9SBenno Rice 		return (-1);
24985244eac9SBenno Rice 	}
24995244eac9SBenno Rice 
2500804d1cc1SJustin Hibbits 	victim_idx = moea_pvo_pte_index(victim_pvo, ptegidx);
2501804d1cc1SJustin Hibbits 
2502804d1cc1SJustin Hibbits 	if (pteg_bkpidx == ptegidx)
2503804d1cc1SJustin Hibbits 		pvo_pt->pte_hi &= ~PTE_HID;
2504804d1cc1SJustin Hibbits 	else
2505804d1cc1SJustin Hibbits 		pvo_pt->pte_hi |= PTE_HID;
2506804d1cc1SJustin Hibbits 
2507804d1cc1SJustin Hibbits 	/*
2508804d1cc1SJustin Hibbits 	 * Synchronize the sacrifice PTE with its PVO, then mark both
2509804d1cc1SJustin Hibbits 	 * invalid. The PVO will be reused when/if the VM system comes
2510804d1cc1SJustin Hibbits 	 * here after a fault.
2511804d1cc1SJustin Hibbits 	 */
2512804d1cc1SJustin Hibbits 	pt = &moea_pteg_table[victim_idx >> 3].pt[victim_idx & 7];
2513804d1cc1SJustin Hibbits 
2514804d1cc1SJustin Hibbits 	if (pt->pte_hi != victim_pvo->pvo_pte.pte.pte_hi)
2515804d1cc1SJustin Hibbits 	    panic("Victim PVO doesn't match PTE! PVO: %8x, PTE: %8x", victim_pvo->pvo_pte.pte.pte_hi, pt->pte_hi);
2516804d1cc1SJustin Hibbits 
2517804d1cc1SJustin Hibbits 	/*
2518804d1cc1SJustin Hibbits 	 * Set the new PTE.
2519804d1cc1SJustin Hibbits 	 */
2520804d1cc1SJustin Hibbits 	moea_pte_unset(pt, &victim_pvo->pvo_pte.pte, victim_pvo->pvo_vaddr);
2521804d1cc1SJustin Hibbits 	PVO_PTEGIDX_CLR(victim_pvo);
2522804d1cc1SJustin Hibbits 	moea_pte_overflow++;
2523804d1cc1SJustin Hibbits 	moea_pte_set(pt, pvo_pt);
2524804d1cc1SJustin Hibbits 
2525804d1cc1SJustin Hibbits 	return (victim_idx & 7);
2526804d1cc1SJustin Hibbits }
2527804d1cc1SJustin Hibbits 
2528*1f1b2286SJohn Baldwin static bool
moea_query_bit(vm_page_t m,int ptebit)252959276937SPeter Grehan moea_query_bit(vm_page_t m, int ptebit)
25305244eac9SBenno Rice {
25315244eac9SBenno Rice 	struct	pvo_entry *pvo;
25325244eac9SBenno Rice 	struct	pte *pt;
25335244eac9SBenno Rice 
25348d9e6d9fSAlan Cox 	rw_assert(&pvh_global_lock, RA_WLOCKED);
253559276937SPeter Grehan 	if (moea_attr_fetch(m) & ptebit)
2536*1f1b2286SJohn Baldwin 		return (true);
25375244eac9SBenno Rice 
25385244eac9SBenno Rice 	LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink) {
25395244eac9SBenno Rice 		/*
25405244eac9SBenno Rice 		 * See if we saved the bit off.  If so, cache it and return
25415244eac9SBenno Rice 		 * success.
25425244eac9SBenno Rice 		 */
254352a7870dSNathan Whitehorn 		if (pvo->pvo_pte.pte.pte_lo & ptebit) {
254459276937SPeter Grehan 			moea_attr_save(m, ptebit);
2545*1f1b2286SJohn Baldwin 			return (true);
25465244eac9SBenno Rice 		}
25475244eac9SBenno Rice 	}
25485244eac9SBenno Rice 
25495244eac9SBenno Rice 	/*
25505244eac9SBenno Rice 	 * No luck, now go through the hard part of looking at the PTEs
25515244eac9SBenno Rice 	 * themselves.  Sync so that any pending REF/CHG bits are flushed to
25525244eac9SBenno Rice 	 * the PTEs.
25535244eac9SBenno Rice 	 */
2554e4f72b32SMarcel Moolenaar 	powerpc_sync();
25555244eac9SBenno Rice 	LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink) {
25565244eac9SBenno Rice 		/*
25575244eac9SBenno Rice 		 * See if this pvo has a valid PTE.  if so, fetch the
25585244eac9SBenno Rice 		 * REF/CHG bits from the valid PTE.  If the appropriate
25595244eac9SBenno Rice 		 * ptebit is set, cache it and return success.
25605244eac9SBenno Rice 		 */
256159276937SPeter Grehan 		pt = moea_pvo_to_pte(pvo, -1);
25625244eac9SBenno Rice 		if (pt != NULL) {
256352a7870dSNathan Whitehorn 			moea_pte_synch(pt, &pvo->pvo_pte.pte);
2564d644a0b7SAlan Cox 			mtx_unlock(&moea_table_mutex);
256552a7870dSNathan Whitehorn 			if (pvo->pvo_pte.pte.pte_lo & ptebit) {
256659276937SPeter Grehan 				moea_attr_save(m, ptebit);
2567*1f1b2286SJohn Baldwin 				return (true);
25685244eac9SBenno Rice 			}
25695244eac9SBenno Rice 		}
25705244eac9SBenno Rice 	}
25715244eac9SBenno Rice 
2572*1f1b2286SJohn Baldwin 	return (false);
25735244eac9SBenno Rice }
25745244eac9SBenno Rice 
257503b6e025SPeter Grehan static u_int
moea_clear_bit(vm_page_t m,int ptebit)2576ce186587SAlan Cox moea_clear_bit(vm_page_t m, int ptebit)
25775244eac9SBenno Rice {
257803b6e025SPeter Grehan 	u_int	count;
25795244eac9SBenno Rice 	struct	pvo_entry *pvo;
25805244eac9SBenno Rice 	struct	pte *pt;
2581ce186587SAlan Cox 
25828d9e6d9fSAlan Cox 	rw_assert(&pvh_global_lock, RA_WLOCKED);
25835244eac9SBenno Rice 
25845244eac9SBenno Rice 	/*
25855244eac9SBenno Rice 	 * Clear the cached value.
25865244eac9SBenno Rice 	 */
258759276937SPeter Grehan 	moea_attr_clear(m, ptebit);
25885244eac9SBenno Rice 
25895244eac9SBenno Rice 	/*
25905244eac9SBenno Rice 	 * Sync so that any pending REF/CHG bits are flushed to the PTEs (so
25915244eac9SBenno Rice 	 * we can reset the right ones).  note that since the pvo entries and
25925244eac9SBenno Rice 	 * list heads are accessed via BAT0 and are never placed in the page
25935244eac9SBenno Rice 	 * table, we don't have to worry about further accesses setting the
25945244eac9SBenno Rice 	 * REF/CHG bits.
25955244eac9SBenno Rice 	 */
2596e4f72b32SMarcel Moolenaar 	powerpc_sync();
25975244eac9SBenno Rice 
25985244eac9SBenno Rice 	/*
25995244eac9SBenno Rice 	 * For each pvo entry, clear the pvo's ptebit.  If this pvo has a
26005244eac9SBenno Rice 	 * valid pte clear the ptebit from the valid pte.
26015244eac9SBenno Rice 	 */
260203b6e025SPeter Grehan 	count = 0;
26035244eac9SBenno Rice 	LIST_FOREACH(pvo, vm_page_to_pvoh(m), pvo_vlink) {
260459276937SPeter Grehan 		pt = moea_pvo_to_pte(pvo, -1);
26055244eac9SBenno Rice 		if (pt != NULL) {
260652a7870dSNathan Whitehorn 			moea_pte_synch(pt, &pvo->pvo_pte.pte);
260752a7870dSNathan Whitehorn 			if (pvo->pvo_pte.pte.pte_lo & ptebit) {
260803b6e025SPeter Grehan 				count++;
260959276937SPeter Grehan 				moea_pte_clear(pt, PVO_VADDR(pvo), ptebit);
26105244eac9SBenno Rice 			}
2611d644a0b7SAlan Cox 			mtx_unlock(&moea_table_mutex);
261203b6e025SPeter Grehan 		}
261352a7870dSNathan Whitehorn 		pvo->pvo_pte.pte.pte_lo &= ~ptebit;
26145244eac9SBenno Rice 	}
26155244eac9SBenno Rice 
261603b6e025SPeter Grehan 	return (count);
2617bdf71f56SBenno Rice }
26188bbfa33aSBenno Rice 
26198bbfa33aSBenno Rice /*
262032bc7846SPeter Grehan  * Return true if the physical range is encompassed by the battable[idx]
262132bc7846SPeter Grehan  */
262232bc7846SPeter Grehan static int
moea_bat_mapped(int idx,vm_paddr_t pa,vm_size_t size)26230936003eSJustin Hibbits moea_bat_mapped(int idx, vm_paddr_t pa, vm_size_t size)
262432bc7846SPeter Grehan {
262532bc7846SPeter Grehan 	u_int prot;
262632bc7846SPeter Grehan 	u_int32_t start;
262732bc7846SPeter Grehan 	u_int32_t end;
262832bc7846SPeter Grehan 	u_int32_t bat_ble;
262932bc7846SPeter Grehan 
263032bc7846SPeter Grehan 	/*
263132bc7846SPeter Grehan 	 * Return immediately if not a valid mapping
263232bc7846SPeter Grehan 	 */
2633c4bcebedSNathan Whitehorn 	if (!(battable[idx].batu & BAT_Vs))
263432bc7846SPeter Grehan 		return (EINVAL);
263532bc7846SPeter Grehan 
263632bc7846SPeter Grehan 	/*
263732bc7846SPeter Grehan 	 * The BAT entry must be cache-inhibited, guarded, and r/w
263832bc7846SPeter Grehan 	 * so it can function as an i/o page
263932bc7846SPeter Grehan 	 */
264032bc7846SPeter Grehan 	prot = battable[idx].batl & (BAT_I|BAT_G|BAT_PP_RW);
264132bc7846SPeter Grehan 	if (prot != (BAT_I|BAT_G|BAT_PP_RW))
264232bc7846SPeter Grehan 		return (EPERM);
264332bc7846SPeter Grehan 
264432bc7846SPeter Grehan 	/*
264532bc7846SPeter Grehan 	 * The address should be within the BAT range. Assume that the
264632bc7846SPeter Grehan 	 * start address in the BAT has the correct alignment (thus
264732bc7846SPeter Grehan 	 * not requiring masking)
264832bc7846SPeter Grehan 	 */
264932bc7846SPeter Grehan 	start = battable[idx].batl & BAT_PBS;
265032bc7846SPeter Grehan 	bat_ble = (battable[idx].batu & ~(BAT_EBS)) | 0x03;
265132bc7846SPeter Grehan 	end = start | (bat_ble << 15) | 0x7fff;
265232bc7846SPeter Grehan 
265332bc7846SPeter Grehan 	if ((pa < start) || ((pa + size) > end))
265432bc7846SPeter Grehan 		return (ERANGE);
265532bc7846SPeter Grehan 
265632bc7846SPeter Grehan 	return (0);
265732bc7846SPeter Grehan }
265832bc7846SPeter Grehan 
2659d1426018SDimitry Andric int
moea_dev_direct_mapped(vm_paddr_t pa,vm_size_t size)266045b69dd6SJustin Hibbits moea_dev_direct_mapped(vm_paddr_t pa, vm_size_t size)
2661c0763d37SSuleiman Souhlal {
2662c0763d37SSuleiman Souhlal 	int i;
2663c0763d37SSuleiman Souhlal 
2664c0763d37SSuleiman Souhlal 	/*
2665c0763d37SSuleiman Souhlal 	 * This currently does not work for entries that
2666c0763d37SSuleiman Souhlal 	 * overlap 256M BAT segments.
2667c0763d37SSuleiman Souhlal 	 */
2668c0763d37SSuleiman Souhlal 
2669c0763d37SSuleiman Souhlal 	for(i = 0; i < 16; i++)
267059276937SPeter Grehan 		if (moea_bat_mapped(i, pa, size) == 0)
2671c0763d37SSuleiman Souhlal 			return (0);
2672c0763d37SSuleiman Souhlal 
2673c0763d37SSuleiman Souhlal 	return (EFAULT);
2674c0763d37SSuleiman Souhlal }
267532bc7846SPeter Grehan 
267632bc7846SPeter Grehan /*
26778bbfa33aSBenno Rice  * Map a set of physical memory pages into the kernel virtual
26788bbfa33aSBenno Rice  * address space. Return a pointer to where it is mapped. This
26798bbfa33aSBenno Rice  * routine is intended to be used for mapping device memory,
26808bbfa33aSBenno Rice  * NOT real memory.
26818bbfa33aSBenno Rice  */
26828bbfa33aSBenno Rice void *
moea_mapdev(vm_paddr_t pa,vm_size_t size)268345b69dd6SJustin Hibbits moea_mapdev(vm_paddr_t pa, vm_size_t size)
26848bbfa33aSBenno Rice {
2685c1f4123bSNathan Whitehorn 
268645b69dd6SJustin Hibbits 	return (moea_mapdev_attr(pa, size, VM_MEMATTR_DEFAULT));
2687c1f4123bSNathan Whitehorn }
2688c1f4123bSNathan Whitehorn 
2689c1f4123bSNathan Whitehorn void *
moea_mapdev_attr(vm_paddr_t pa,vm_size_t size,vm_memattr_t ma)269045b69dd6SJustin Hibbits moea_mapdev_attr(vm_paddr_t pa, vm_size_t size, vm_memattr_t ma)
2691c1f4123bSNathan Whitehorn {
269232bc7846SPeter Grehan 	vm_offset_t va, tmpva, ppa, offset;
269332bc7846SPeter Grehan 	int i;
26948bbfa33aSBenno Rice 
269532bc7846SPeter Grehan 	ppa = trunc_page(pa);
26968bbfa33aSBenno Rice 	offset = pa & PAGE_MASK;
26978bbfa33aSBenno Rice 	size = roundup(offset + size, PAGE_SIZE);
26988bbfa33aSBenno Rice 
269932bc7846SPeter Grehan 	/*
270032bc7846SPeter Grehan 	 * If the physical address lies within a valid BAT table entry,
270132bc7846SPeter Grehan 	 * return the 1:1 mapping. This currently doesn't work
270232bc7846SPeter Grehan 	 * for regions that overlap 256M BAT segments.
270332bc7846SPeter Grehan 	 */
270432bc7846SPeter Grehan 	for (i = 0; i < 16; i++) {
270559276937SPeter Grehan 		if (moea_bat_mapped(i, pa, size) == 0)
270632bc7846SPeter Grehan 			return ((void *) pa);
270732bc7846SPeter Grehan 	}
270832bc7846SPeter Grehan 
27095df87b21SJeff Roberson 	va = kva_alloc(size);
27108bbfa33aSBenno Rice 	if (!va)
271159276937SPeter Grehan 		panic("moea_mapdev: Couldn't alloc kernel virtual memory");
27128bbfa33aSBenno Rice 
27138bbfa33aSBenno Rice 	for (tmpva = va; size > 0;) {
271445b69dd6SJustin Hibbits 		moea_kenter_attr(tmpva, ppa, ma);
2715e4f72b32SMarcel Moolenaar 		tlbie(tmpva);
27168bbfa33aSBenno Rice 		size -= PAGE_SIZE;
27178bbfa33aSBenno Rice 		tmpva += PAGE_SIZE;
271832bc7846SPeter Grehan 		ppa += PAGE_SIZE;
27198bbfa33aSBenno Rice 	}
27208bbfa33aSBenno Rice 
27218bbfa33aSBenno Rice 	return ((void *)(va + offset));
27228bbfa33aSBenno Rice }
27238bbfa33aSBenno Rice 
27248bbfa33aSBenno Rice void
moea_unmapdev(void * p,vm_size_t size)27257ae99f80SJohn Baldwin moea_unmapdev(void *p, vm_size_t size)
27268bbfa33aSBenno Rice {
27277ae99f80SJohn Baldwin 	vm_offset_t base, offset, va;
27288bbfa33aSBenno Rice 
272932bc7846SPeter Grehan 	/*
273032bc7846SPeter Grehan 	 * If this is outside kernel virtual space, then it's a
273132bc7846SPeter Grehan 	 * battable entry and doesn't require unmapping
273232bc7846SPeter Grehan 	 */
27337ae99f80SJohn Baldwin 	va = (vm_offset_t)p;
2734ab739706SNathan Whitehorn 	if ((va >= VM_MIN_KERNEL_ADDRESS) && (va <= virtual_end)) {
27358bbfa33aSBenno Rice 		base = trunc_page(va);
27368bbfa33aSBenno Rice 		offset = va & PAGE_MASK;
27378bbfa33aSBenno Rice 		size = roundup(offset + size, PAGE_SIZE);
27384ae224c6SConrad Meyer 		moea_qremove(base, atop(size));
27395df87b21SJeff Roberson 		kva_free(base, size);
27408bbfa33aSBenno Rice 	}
274132bc7846SPeter Grehan }
27421a4fcaebSMarcel Moolenaar 
27431a4fcaebSMarcel Moolenaar static void
moea_sync_icache(pmap_t pm,vm_offset_t va,vm_size_t sz)274445b69dd6SJustin Hibbits moea_sync_icache(pmap_t pm, vm_offset_t va, vm_size_t sz)
27451a4fcaebSMarcel Moolenaar {
27461a4fcaebSMarcel Moolenaar 	struct pvo_entry *pvo;
27471a4fcaebSMarcel Moolenaar 	vm_offset_t lim;
27481a4fcaebSMarcel Moolenaar 	vm_paddr_t pa;
27491a4fcaebSMarcel Moolenaar 	vm_size_t len;
27501a4fcaebSMarcel Moolenaar 
27511a4fcaebSMarcel Moolenaar 	PMAP_LOCK(pm);
27521a4fcaebSMarcel Moolenaar 	while (sz > 0) {
2753a11dc32eSJustin Hibbits 		lim = round_page(va + 1);
27541a4fcaebSMarcel Moolenaar 		len = MIN(lim - va, sz);
27551a4fcaebSMarcel Moolenaar 		pvo = moea_pvo_find_va(pm, va & ~ADDR_POFF, NULL);
27561a4fcaebSMarcel Moolenaar 		if (pvo != NULL) {
27577be655c2SBrandon Bergren 			pa = PVO_PADDR(pvo) | (va & ADDR_POFF);
27581a4fcaebSMarcel Moolenaar 			moea_syncicache(pa, len);
27591a4fcaebSMarcel Moolenaar 		}
27601a4fcaebSMarcel Moolenaar 		va += len;
27611a4fcaebSMarcel Moolenaar 		sz -= len;
27621a4fcaebSMarcel Moolenaar 	}
27631a4fcaebSMarcel Moolenaar 	PMAP_UNLOCK(pm);
27641a4fcaebSMarcel Moolenaar }
2765afd9cb6cSJustin Hibbits 
2766bdb9ab0dSMark Johnston void
moea_dumpsys_map(vm_paddr_t pa,size_t sz,void ** va)276745b69dd6SJustin Hibbits moea_dumpsys_map(vm_paddr_t pa, size_t sz, void **va)
2768afd9cb6cSJustin Hibbits {
2769bdb9ab0dSMark Johnston 
2770bdb9ab0dSMark Johnston 	*va = (void *)pa;
2771afd9cb6cSJustin Hibbits }
2772afd9cb6cSJustin Hibbits 
2773bdb9ab0dSMark Johnston extern struct dump_pa dump_map[PHYS_AVAIL_SZ + 1];
2774bdb9ab0dSMark Johnston 
2775bdb9ab0dSMark Johnston void
moea_scan_init(void)27769b02f2daSJohn Baldwin moea_scan_init(void)
2777afd9cb6cSJustin Hibbits {
2778afd9cb6cSJustin Hibbits 	struct pvo_entry *pvo;
2779afd9cb6cSJustin Hibbits 	vm_offset_t va;
2780bdb9ab0dSMark Johnston 	int i;
2781afd9cb6cSJustin Hibbits 
2782bdb9ab0dSMark Johnston 	if (!do_minidump) {
2783bdb9ab0dSMark Johnston 		/* Initialize phys. segments for dumpsys(). */
2784bdb9ab0dSMark Johnston 		memset(&dump_map, 0, sizeof(dump_map));
2785bdb9ab0dSMark Johnston 		mem_regions(&pregions, &pregions_sz, &regions, &regions_sz);
2786bdb9ab0dSMark Johnston 		for (i = 0; i < pregions_sz; i++) {
2787bdb9ab0dSMark Johnston 			dump_map[i].pa_start = pregions[i].mr_start;
2788bdb9ab0dSMark Johnston 			dump_map[i].pa_size = pregions[i].mr_size;
2789afd9cb6cSJustin Hibbits 		}
2790bdb9ab0dSMark Johnston 		return;
2791bdb9ab0dSMark Johnston 	}
2792bdb9ab0dSMark Johnston 
2793bdb9ab0dSMark Johnston 	/* Virtual segments for minidumps: */
2794bdb9ab0dSMark Johnston 	memset(&dump_map, 0, sizeof(dump_map));
2795bdb9ab0dSMark Johnston 
2796bdb9ab0dSMark Johnston 	/* 1st: kernel .data and .bss. */
2797bdb9ab0dSMark Johnston 	dump_map[0].pa_start = trunc_page((uintptr_t)_etext);
2798bdb9ab0dSMark Johnston 	dump_map[0].pa_size =
2799bdb9ab0dSMark Johnston 	    round_page((uintptr_t)_end) - dump_map[0].pa_start;
2800bdb9ab0dSMark Johnston 
2801afd9cb6cSJustin Hibbits 	/* 2nd: msgbuf and tables (see pmap_bootstrap()). */
2802bdb9ab0dSMark Johnston 	dump_map[1].pa_start = (vm_paddr_t)msgbufp->msg_ptr;
2803bdb9ab0dSMark Johnston 	dump_map[1].pa_size = round_page(msgbufp->msg_size);
2804bdb9ab0dSMark Johnston 
2805afd9cb6cSJustin Hibbits 	/* 3rd: kernel VM. */
2806bdb9ab0dSMark Johnston 	va = dump_map[1].pa_start + dump_map[1].pa_size;
2807afd9cb6cSJustin Hibbits 	/* Find start of next chunk (from va). */
2808afd9cb6cSJustin Hibbits 	while (va < virtual_end) {
2809afd9cb6cSJustin Hibbits 		/* Don't dump the buffer cache. */
2810bdb9ab0dSMark Johnston 		if (va >= kmi.buffer_sva && va < kmi.buffer_eva) {
2811afd9cb6cSJustin Hibbits 			va = kmi.buffer_eva;
2812afd9cb6cSJustin Hibbits 			continue;
2813afd9cb6cSJustin Hibbits 		}
2814bdb9ab0dSMark Johnston 		pvo = moea_pvo_find_va(kernel_pmap, va & ~ADDR_POFF, NULL);
2815bdb9ab0dSMark Johnston 		if (pvo != NULL && (pvo->pvo_pte.pte.pte_hi & PTE_VALID))
2816afd9cb6cSJustin Hibbits 			break;
2817afd9cb6cSJustin Hibbits 		va += PAGE_SIZE;
2818afd9cb6cSJustin Hibbits 	}
2819afd9cb6cSJustin Hibbits 	if (va < virtual_end) {
2820bdb9ab0dSMark Johnston 		dump_map[2].pa_start = va;
2821afd9cb6cSJustin Hibbits 		va += PAGE_SIZE;
2822afd9cb6cSJustin Hibbits 		/* Find last page in chunk. */
2823afd9cb6cSJustin Hibbits 		while (va < virtual_end) {
2824afd9cb6cSJustin Hibbits 			/* Don't run into the buffer cache. */
2825afd9cb6cSJustin Hibbits 			if (va == kmi.buffer_sva)
2826afd9cb6cSJustin Hibbits 				break;
2827bdb9ab0dSMark Johnston 			pvo = moea_pvo_find_va(kernel_pmap, va & ~ADDR_POFF,
2828bdb9ab0dSMark Johnston 			    NULL);
2829afd9cb6cSJustin Hibbits 			if (pvo == NULL ||
2830afd9cb6cSJustin Hibbits 			    !(pvo->pvo_pte.pte.pte_hi & PTE_VALID))
2831afd9cb6cSJustin Hibbits 				break;
2832afd9cb6cSJustin Hibbits 			va += PAGE_SIZE;
2833afd9cb6cSJustin Hibbits 		}
2834bdb9ab0dSMark Johnston 		dump_map[2].pa_size = va - dump_map[2].pa_start;
2835afd9cb6cSJustin Hibbits 	}
2836afd9cb6cSJustin Hibbits }
2837