WebSVN – HelenOS – Diff – /trunk/kernel/arch/xen32/src/mm/frame.c


/*
 * Copyright (C) 2001-2004 Jakub Jermar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/** @addtogroup xen32mm
 * @{
 */
/** @file
 * @ingroup xen32mm
 */
 
#include <mm/frame.h>
#include <arch/mm/frame.h>
#include <mm/as.h>
#include <config.h>
#include <arch/boot/boot.h>
#include <arch/hypercall.h>
#include <panic.h>
#include <debug.h>
#include <align.h>
#include <macros.h>
 
#include <console/cmd.h>
#include <console/kconsole.h>
 
uintptr_t last_frame = 0;
 
#define L1_PT_SHIFT 10
#define L2_PT_SHIFT 0
 
#define L1_PT_ENTRIES   1024
#define L2_PT_ENTRIES   1024
 
#define L1_OFFSET_MASK          (L1_PT_ENTRIES - 1)
#define L2_OFFSET_MASK          (L2_PT_ENTRIES - 1)
 
#define PFN2PTL1_OFFSET(pfn)    ((pfn >> L1_PT_SHIFT) & L1_OFFSET_MASK)
#define PFN2PTL2_OFFSET(pfn)    ((pfn >> L2_PT_SHIFT) & L2_OFFSET_MASK)
 
#define PAGE_MASK   (~(PAGE_SIZE - 1))
 
#define PTE2ADDR(pte)   (pte & PAGE_MASK)
 
#define _PAGE_PRESENT   0x001UL
#define _PAGE_RW        0x002UL
#define _PAGE_USER      0x004UL
#define _PAGE_PWT       0x008UL
#define _PAGE_PCD       0x010UL
#define _PAGE_ACCESSED  0x020UL
#define _PAGE_DIRTY     0x040UL
#define _PAGE_PAT       0x080UL
#define _PAGE_PSE       0x080UL
#define _PAGE_GLOBAL    0x100UL
 
#define L1_PROT (_PAGE_PRESENT | _PAGE_ACCESSED)
#define L2_PROT (_PAGE_PRESENT | _PAGE_RW | _PAGE_ACCESSED)
 
void frame_arch_init(void)
{
    if (config.cpu_active == 1) {
        /* The only memory zone starts just after page table */
        pfn_t start = ADDR2PFN(ALIGN_UP(KA2PA(start_info.pt_base), PAGE_SIZE)) + start_info.nr_pt_frames;
        size_t size = start_info.nr_pages - start;
       
        /* Create identity mapping */
        pfn_t phys;
        count_t count = 0;
        for (phys = start; phys < start + size; phys++) {
            mmu_update_t updates[L2_PT_ENTRIES];
            pfn_t virt = ADDR2PFN(PA2KA(PFN2ADDR(phys)));
           
            size_t ptl1_offset = PFN2PTL1_OFFSET(virt);
            size_t ptl2_offset = PFN2PTL2_OFFSET(virt);
           
            unsigned long *ptl2_base = (unsigned long *) PTE2ADDR(start_info.pt_base[ptl1_offset]);
           
            if (ptl2_base == 0) {
                mmuext_op_t mmu_ext;
               
                pfn_t virt2 = ADDR2PFN(PA2KA(PFN2ADDR(start)));
               
                /* New L1 page table entry needed */
                memsetb(PFN2ADDR(virt2), PAGE_SIZE, 0);
               
                size_t ptl1_offset2 = PFN2PTL1_OFFSET(virt2);
                size_t ptl2_offset2 = PFN2PTL2_OFFSET(virt2);
                unsigned long *ptl2_base2 = (unsigned long *) PTE2ADDR(start_info.pt_base[ptl1_offset2]);
               
                if (ptl2_base2 == 0)
                    panic("Unable to find page table reference");
               
                updates[count].ptr = (uintptr_t) &ptl2_base2[ptl2_offset2];
                updates[count].val = PFN2ADDR(start_info.mfn_list[start]) | L1_PROT;
                if (xen_mmu_update(updates, count + 1, NULL, DOMID_SELF) < 0)
                    panic("Unable to map new page table");
                count = 0;
               
                mmu_ext.cmd = MMUEXT_PIN_L1_TABLE;
                mmu_ext.arg1.mfn = start_info.mfn_list[start];
                if (xen_mmuext_op(&mmu_ext, 1, NULL, DOMID_SELF) < 0)
                    panic("Error pinning new page table");
               
                unsigned long *ptl0 = (unsigned long *) PFN2ADDR(start_info.mfn_list[ADDR2PFN(KA2PA(start_info.pt_base))]);
               
                updates[count].ptr = (uintptr_t) &ptl0[ptl1_offset];
                updates[count].val = PFN2ADDR(start_info.mfn_list[start]) | L2_PROT;
                if (xen_mmu_update(updates, count + 1, NULL, DOMID_SELF) < 0)
                    panic("Unable to update PTE for page table");
                count = 0;
               
                ptl2_base = (unsigned long *) PTE2ADDR(start_info.pt_base[ptl1_offset]);
                start++;
                size--;
            }
           
            updates[count].ptr = (uintptr_t) &ptl2_base[ptl2_offset];
            updates[count].val = PFN2ADDR(start_info.mfn_list[phys]) | L2_PROT;
            count++;
           
            if ((count == L2_PT_ENTRIES) || (phys + 1 == start + size)) {
                if (xen_mmu_update(updates, count, NULL, DOMID_SELF) < 0)
                    panic("Unable to update PTE");
                count = 0;
            }
        }
       
        zone_create(start, size, start, 0);
        last_frame = start + size;
    }
}
 
/** @}
 */
 

Rev 1817	Rev 1818
1	/*	1	/*
2	* Copyright (C) 2001-2004 Jakub Jermar	2	* Copyright (C) 2001-2004 Jakub Jermar
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup xen32mm	29	/** @addtogroup xen32mm
30	* @{	30	* @{
31	*/	31	*/
32	/** @file	32	/** @file
33	* @ingroup xen32mm	33	* @ingroup xen32mm
34	*/	34	*/
35		35
36	#include <mm/frame.h>	36	#include <mm/frame.h>
37	#include <arch/mm/frame.h>	37	#include <arch/mm/frame.h>
38	#include <mm/as.h>	38	#include <mm/as.h>
39	#include <config.h>	39	#include <config.h>
40	#include <arch/boot/boot.h>	40	#include <arch/boot/boot.h>
41	#include <arch/hypercall.h>	41	#include <arch/hypercall.h>
42	#include <panic.h>	42	#include <panic.h>
43	#include <debug.h>	43	#include <debug.h>
44	#include <align.h>	44	#include <align.h>
45	#include <macros.h>	45	#include <macros.h>
46		46
47	#include <console/cmd.h>	47	#include <console/cmd.h>
48	#include <console/kconsole.h>	48	#include <console/kconsole.h>
49		49
50	uintptr_t last_frame = 0;	50	uintptr_t last_frame = 0;
51		51
52	#define L1_PT_SHIFT 10	52	#define L1_PT_SHIFT 10
53	#define L2_PT_SHIFT 0	53	#define L2_PT_SHIFT 0
54		54
-		55	#define L1_PT_ENTRIES 1024
-		56	#define L2_PT_ENTRIES 1024
-		57
55	#define L1_OFFSET_MASK 0x3ff	58	#define L1_OFFSET_MASK (L1_PT_ENTRIES - 1)
56	#define L2_OFFSET_MASK 0x3ff	59	#define L2_OFFSET_MASK (L2_PT_ENTRIES - 1)
57		60
58	#define PFN2PTL1_OFFSET(pfn) ((pfn >> L1_PT_SHIFT) & L1_OFFSET_MASK)	61	#define PFN2PTL1_OFFSET(pfn) ((pfn >> L1_PT_SHIFT) & L1_OFFSET_MASK)
59	#define PFN2PTL2_OFFSET(pfn) ((pfn >> L2_PT_SHIFT) & L2_OFFSET_MASK)	62	#define PFN2PTL2_OFFSET(pfn) ((pfn >> L2_PT_SHIFT) & L2_OFFSET_MASK)
60		63
61	#define PAGE_MASK (~(PAGE_SIZE - 1))	64	#define PAGE_MASK (~(PAGE_SIZE - 1))
62		65
63	#define PTE2ADDR(pte) (pte & PAGE_MASK)	66	#define PTE2ADDR(pte) (pte & PAGE_MASK)
64		67
65	#define _PAGE_PRESENT 0x001UL	68	#define _PAGE_PRESENT 0x001UL
66	#define _PAGE_RW 0x002UL	69	#define _PAGE_RW 0x002UL
67	#define _PAGE_USER 0x004UL	70	#define _PAGE_USER 0x004UL
68	#define _PAGE_PWT 0x008UL	71	#define _PAGE_PWT 0x008UL
69	#define _PAGE_PCD 0x010UL	72	#define _PAGE_PCD 0x010UL
70	#define _PAGE_ACCESSED 0x020UL	73	#define _PAGE_ACCESSED 0x020UL
71	#define _PAGE_DIRTY 0x040UL	74	#define _PAGE_DIRTY 0x040UL
72	#define _PAGE_PAT 0x080UL	75	#define _PAGE_PAT 0x080UL
73	#define _PAGE_PSE 0x080UL	76	#define _PAGE_PSE 0x080UL
74	#define _PAGE_GLOBAL 0x100UL	77	#define _PAGE_GLOBAL 0x100UL
75		78
76	#define L1_PROT (_PAGE_PRESENT \| _PAGE_ACCESSED)	79	#define L1_PROT (_PAGE_PRESENT \| _PAGE_ACCESSED)
77	#define L2_PROT (_PAGE_PRESENT \| _PAGE_RW \| _PAGE_ACCESSED)	80	#define L2_PROT (_PAGE_PRESENT \| _PAGE_RW \| _PAGE_ACCESSED)
78		81
79	void frame_arch_init(void)	82	void frame_arch_init(void)
80	{	83	{
81	if (config.cpu_active == 1) {	84	if (config.cpu_active == 1) {
82	/* The only memory zone starts just after page table */	85	/* The only memory zone starts just after page table */
83	pfn_t start = ADDR2PFN(ALIGN_UP(KA2PA(start_info.pt_base), PAGE_SIZE)) + start_info.nr_pt_frames;	86	pfn_t start = ADDR2PFN(ALIGN_UP(KA2PA(start_info.pt_base), PAGE_SIZE)) + start_info.nr_pt_frames;
84	size_t size = start_info.nr_pages - start;	87	size_t size = start_info.nr_pages - start;
85		88
86	/* Create identity mapping */	89	/* Create identity mapping */
87	pfn_t phys;	90	pfn_t phys;
-		91	count_t count = 0;
88	for (phys = start; phys < start + size; phys++) {	92	for (phys = start; phys < start + size; phys++) {
89	mmu_update_t updates[1];	93	mmu_update_t updates[L2_PT_ENTRIES];
90	pfn_t virt = ADDR2PFN(PA2KA(PFN2ADDR(phys)));	94	pfn_t virt = ADDR2PFN(PA2KA(PFN2ADDR(phys)));
91		95
92	size_t ptl1_offset = PFN2PTL1_OFFSET(virt);	96	size_t ptl1_offset = PFN2PTL1_OFFSET(virt);
93	size_t ptl2_offset = PFN2PTL2_OFFSET(virt);	97	size_t ptl2_offset = PFN2PTL2_OFFSET(virt);
94		98
95	unsigned long ptl2_base = (unsigned long ) PTE2ADDR(start_info.pt_base[ptl1_offset]);	99	unsigned long ptl2_base = (unsigned long ) PTE2ADDR(start_info.pt_base[ptl1_offset]);
96		100
97	if (ptl2_base == 0) {	101	if (ptl2_base == 0) {
98	mmuext_op_t mmu_ext;	102	mmuext_op_t mmu_ext;
99		103
100	pfn_t virt2 = ADDR2PFN(PA2KA(PFN2ADDR(start)));	104	pfn_t virt2 = ADDR2PFN(PA2KA(PFN2ADDR(start)));
101		105
102	/* New L1 page table entry needed */	106	/* New L1 page table entry needed */
103	memsetb(PFN2ADDR(virt2), PAGE_SIZE, 0);	107	memsetb(PFN2ADDR(virt2), PAGE_SIZE, 0);
104		108
105	size_t ptl1_offset2 = PFN2PTL1_OFFSET(virt2);	109	size_t ptl1_offset2 = PFN2PTL1_OFFSET(virt2);
106	size_t ptl2_offset2 = PFN2PTL2_OFFSET(virt2);	110	size_t ptl2_offset2 = PFN2PTL2_OFFSET(virt2);
107	unsigned long ptl2_base2 = (unsigned long ) PTE2ADDR(start_info.pt_base[ptl1_offset2]);	111	unsigned long ptl2_base2 = (unsigned long ) PTE2ADDR(start_info.pt_base[ptl1_offset2]);
108		112
109	if (ptl2_base2 == 0)	113	if (ptl2_base2 == 0)
110	panic("Unable to find page table reference");	114	panic("Unable to find page table reference");
111		115
112	updates[0].ptr = (uintptr_t) &ptl2_base2[ptl2_offset2];	116	updates[count].ptr = (uintptr_t) &ptl2_base2[ptl2_offset2];
113	updates[0].val = PFN2ADDR(start_info.mfn_list[start]) \| L1_PROT;	117	updates[count].val = PFN2ADDR(start_info.mfn_list[start]) \| L1_PROT;
114	if (xen_mmu_update(updates, 1, NULL, DOMID_SELF) < 0)	118	if (xen_mmu_update(updates, count + 1, NULL, DOMID_SELF) < 0)
115	panic("Unable to map new page table");	119	panic("Unable to map new page table");
-		120	count = 0;
116		121
117	mmu_ext.cmd = MMUEXT_PIN_L1_TABLE;	122	mmu_ext.cmd = MMUEXT_PIN_L1_TABLE;
118	mmu_ext.arg1.mfn = start_info.mfn_list[start];	123	mmu_ext.arg1.mfn = start_info.mfn_list[start];
119	if (xen_mmuext_op(&mmu_ext, 1, NULL, DOMID_SELF) < 0)	124	if (xen_mmuext_op(&mmu_ext, 1, NULL, DOMID_SELF) < 0)
120	panic("Error pinning new page table");	125	panic("Error pinning new page table");
121		126
122	unsigned long ptl0 = (unsigned long ) PFN2ADDR(start_info.mfn_list[ADDR2PFN(KA2PA(start_info.pt_base))]);	127	unsigned long ptl0 = (unsigned long ) PFN2ADDR(start_info.mfn_list[ADDR2PFN(KA2PA(start_info.pt_base))]);
123		128
124	updates[0].ptr = (uintptr_t) &ptl0[ptl1_offset];	129	updates[count].ptr = (uintptr_t) &ptl0[ptl1_offset];
125	updates[0].val = PFN2ADDR(start_info.mfn_list[start]) \| L2_PROT;	130	updates[count].val = PFN2ADDR(start_info.mfn_list[start]) \| L2_PROT;
126	if (xen_mmu_update(updates, 1, NULL, DOMID_SELF) < 0)	131	if (xen_mmu_update(updates, count + 1, NULL, DOMID_SELF) < 0)
127	panic("Unable to update PTE for page table");	132	panic("Unable to update PTE for page table");
-		133	count = 0;
128		134
129	ptl2_base = (unsigned long *) PTE2ADDR(start_info.pt_base[ptl1_offset]);	135	ptl2_base = (unsigned long *) PTE2ADDR(start_info.pt_base[ptl1_offset]);
130	start++;	136	start++;
131	size--;	137	size--;
132	}	138	}
133		139
134	updates[0].ptr = (uintptr_t) &ptl2_base[ptl2_offset];	140	updates[count].ptr = (uintptr_t) &ptl2_base[ptl2_offset];
135	updates[0].val = PFN2ADDR(start_info.mfn_list[phys]) \| L2_PROT;	141	updates[count].val = PFN2ADDR(start_info.mfn_list[phys]) \| L2_PROT;
-		142	count++;
-		143
-		144	if ((count == L2_PT_ENTRIES) \|\| (phys + 1 == start + size)) {
136	if (xen_mmu_update(updates, 1, NULL, DOMID_SELF) < 0)	145	if (xen_mmu_update(updates, count, NULL, DOMID_SELF) < 0)
137	panic("Unable to update PTE");	146	panic("Unable to update PTE");
-		147	count = 0;
-		148	}
138	}	149	}
139		150
140	zone_create(start, size, start, 0);	151	zone_create(start, size, start, 0);
141	last_frame = start + size;	152	last_frame = start + size;
142	}	153	}
143	}	154	}
144		155
145	/** @}	156	/** @}
146	*/	157	*/
147		158

Subversion Repositories HelenOS

(root)/trunk/kernel/arch/xen32/src/mm/frame.c – Rev 1817 → 1818