2 * Copyright (C) 2000 - 2003 Jeff Dike (jdike@addtoit.com)
3 * Licensed under the GPL
7 #include "linux/ghash.h"
8 #include "linux/slab.h"
9 #include "linux/vmalloc.h"
10 #include "linux/bootmem.h"
11 #include "asm/types.h"
12 #include "asm/pgtable.h"
13 #include "kern_util.h"
14 #include "user_util.h"
15 #include "mode_kern.h"
23 static pgd_t physmem_pgd[PTRS_PER_PGD];
25 static struct phys_desc *lookup_mapping(void *addr)
27 pgd = &physmem_pgd[pgd_index(addr)];
31 pmd = pmd_offset(pgd, addr);
35 pte = pte_offset_kernel(pmd, addr);
36 return((struct phys_desc *) pte_val(pte));
39 static struct add_mapping(void *addr, struct phys_desc *new)
44 #define PHYS_HASHSIZE (8192)
48 DEF_HASH_STRUCTS(virtmem, PHYS_HASHSIZE, struct phys_desc);
51 struct virtmem_ptrs virt_ptrs;
56 struct list_head list;
59 struct virtmem_table virtmem_hash;
61 static int virt_cmp(void *virt1, void *virt2)
63 return(virt1 != virt2);
66 static int virt_hash(void *virt)
68 unsigned long addr = ((unsigned long) virt) >> PAGE_SHIFT;
69 return(addr % PHYS_HASHSIZE);
72 DEF_HASH(static, virtmem, struct phys_desc, virt_ptrs, void *, virt, virt_cmp,
75 LIST_HEAD(descriptor_mappings);
79 struct list_head list;
80 struct list_head pages;
83 static struct desc_mapping *find_mapping(int fd)
85 struct desc_mapping *desc;
86 struct list_head *ele;
88 list_for_each(ele, &descriptor_mappings){
89 desc = list_entry(ele, struct desc_mapping, list);
97 static struct desc_mapping *descriptor_mapping(int fd)
99 struct desc_mapping *desc;
101 desc = find_mapping(fd);
105 desc = kmalloc(sizeof(*desc), GFP_ATOMIC);
109 *desc = ((struct desc_mapping)
111 .list = LIST_HEAD_INIT(desc->list),
112 .pages = LIST_HEAD_INIT(desc->pages) });
113 list_add(&desc->list, &descriptor_mappings);
118 int physmem_subst_mapping(void *virt, int fd, __u64 offset, int w)
120 struct desc_mapping *fd_maps;
121 struct phys_desc *desc;
125 fd_maps = descriptor_mapping(fd);
130 if(find_virtmem_hash(&virtmem_hash, virt) != NULL)
131 panic("Address 0x%p is already substituted\n", virt);
134 desc = kmalloc(sizeof(*desc), GFP_ATOMIC);
138 *desc = ((struct phys_desc)
139 { .virt_ptrs = { NULL, NULL },
144 .list = LIST_HEAD_INIT(desc->list) });
145 insert_virtmem_hash(&virtmem_hash, desc);
147 list_add(&desc->list, &fd_maps->pages);
149 virt = (void *) ((unsigned long) virt & PAGE_MASK);
150 err = os_map_memory(virt, fd, offset, PAGE_SIZE, 1, w, 0);
154 remove_virtmem_hash(&virtmem_hash, desc);
160 static int physmem_fd = -1;
162 static void remove_mapping(struct phys_desc *desc)
164 void *virt = desc->virt;
167 remove_virtmem_hash(&virtmem_hash, desc);
168 list_del(&desc->list);
171 err = os_map_memory(virt, physmem_fd, __pa(virt), PAGE_SIZE, 1, 1, 0);
173 panic("Failed to unmap block device page from physical memory, "
177 int physmem_remove_mapping(void *virt)
179 struct phys_desc *desc;
181 virt = (void *) ((unsigned long) virt & PAGE_MASK);
182 desc = find_virtmem_hash(&virtmem_hash, virt);
186 remove_mapping(desc);
190 void physmem_forget_descriptor(int fd)
192 struct desc_mapping *desc;
193 struct phys_desc *page;
194 struct list_head *ele, *next;
199 desc = find_mapping(fd);
203 list_for_each_safe(ele, next, &desc->pages){
204 page = list_entry(ele, struct phys_desc, list);
205 offset = page->offset;
207 remove_mapping(page);
208 err = os_seek_file(fd, offset);
210 panic("physmem_forget_descriptor - failed to seek "
211 "to %lld in fd %d, error = %d\n",
213 err = os_read_file(fd, addr, PAGE_SIZE);
215 panic("physmem_forget_descriptor - failed to read "
216 "from fd %d to 0x%p, error = %d\n",
220 list_del(&desc->list);
224 void arch_free_page(struct page *page, int order)
229 for(i = 0; i < (1 << order); i++){
230 virt = __va(page_to_phys(page + i));
231 physmem_remove_mapping(virt);
235 int is_remapped(void *virt)
237 return(find_virtmem_hash(&virtmem_hash, virt) != NULL);
240 /* Changed during early boot */
241 unsigned long high_physmem;
243 extern unsigned long physmem_size;
245 void *to_virt(unsigned long phys)
247 return((void *) uml_physmem + phys);
250 unsigned long to_phys(void *virt)
252 return(((unsigned long) virt) - uml_physmem);
255 int init_maps(unsigned long physmem, unsigned long iomem, unsigned long highmem)
257 struct page *p, *map;
258 unsigned long phys_len, phys_pages, highmem_len, highmem_pages;
259 unsigned long iomem_len, iomem_pages, total_len, total_pages;
262 phys_pages = physmem >> PAGE_SHIFT;
263 phys_len = phys_pages * sizeof(struct page);
265 iomem_pages = iomem >> PAGE_SHIFT;
266 iomem_len = iomem_pages * sizeof(struct page);
268 highmem_pages = highmem >> PAGE_SHIFT;
269 highmem_len = highmem_pages * sizeof(struct page);
271 total_pages = phys_pages + iomem_pages + highmem_pages;
272 total_len = phys_len + iomem_pages + highmem_len;
275 map = kmalloc(total_len, GFP_KERNEL);
277 map = vmalloc(total_len);
279 else map = alloc_bootmem_low_pages(total_len);
284 for(i = 0; i < total_pages; i++){
286 set_page_count(p, 0);
288 INIT_LIST_HEAD(&p->lru);
292 max_mapnr = total_pages;
296 struct page *phys_to_page(const unsigned long phys)
298 return(&mem_map[phys >> PAGE_SHIFT]);
301 struct page *__virt_to_page(const unsigned long virt)
303 return(&mem_map[__pa(virt) >> PAGE_SHIFT]);
306 unsigned long page_to_phys(struct page *page)
308 return((page - mem_map) << PAGE_SHIFT);
311 pte_t mk_pte(struct page *page, pgprot_t pgprot)
315 pte_val(pte) = page_to_phys(page) + pgprot_val(pgprot);
316 if(pte_present(pte)) pte_mknewprot(pte_mknewpage(pte));
320 /* Changed during early boot */
321 static unsigned long kmem_top = 0;
323 unsigned long get_kmem_end(void)
326 kmem_top = CHOOSE_MODE(kmem_end_tt, kmem_end_skas);
330 void map_memory(unsigned long virt, unsigned long phys, unsigned long len,
336 fd = phys_mapping(phys, &offset);
337 err = os_map_memory((void *) virt, fd, offset, len, r, w, x);
339 panic("map_memory(0x%lx, %d, 0x%llx, %ld, %d, %d, %d) failed, "
340 "err = %d\n", virt, fd, offset, len, r, w, x, err);
343 #define PFN_UP(x) (((x) + PAGE_SIZE-1) >> PAGE_SHIFT)
345 void setup_physmem(unsigned long start, unsigned long reserve_end,
346 unsigned long len, unsigned long highmem)
348 unsigned long reserve = reserve_end - start;
349 int pfn = PFN_UP(__pa(reserve_end));
350 int delta = (len - reserve) >> PAGE_SHIFT;
351 int err, offset, bootmap_size;
353 physmem_fd = create_mem_file(len + highmem);
355 offset = uml_reserved - uml_physmem;
356 err = os_map_memory((void *) uml_reserved, physmem_fd, offset,
357 len - offset, 1, 1, 0);
359 os_print_error(err, "Mapping memory");
363 bootmap_size = init_bootmem(pfn, pfn + delta);
364 free_bootmem(__pa(reserve_end) + bootmap_size,
365 len - bootmap_size - reserve);
368 int phys_mapping(unsigned long phys, __u64 *offset_out)
370 struct phys_desc *desc = find_virtmem_hash(&virtmem_hash,
371 __va(phys & PAGE_MASK));
376 *offset_out = desc->offset;
378 else if(phys < physmem_size){
382 else if(phys < __pa(end_iomem)){
383 struct iomem_region *region = iomem_regions;
385 while(region != NULL){
386 if((phys >= region->phys) &&
387 (phys < region->phys + region->size)){
389 *offset_out = phys - region->phys;
392 region = region->next;
395 else if(phys < __pa(end_iomem) + highmem){
397 *offset_out = phys - iomem_size;
403 static int __init uml_mem_setup(char *line, int *add)
406 physmem_size = memparse(line,&retptr);
409 __uml_setup("mem=", uml_mem_setup,
410 "mem=<Amount of desired ram>\n"
411 " This controls how much \"physical\" memory the kernel allocates\n"
412 " for the system. The size is specified as a number followed by\n"
413 " one of 'k', 'K', 'm', 'M', which have the obvious meanings.\n"
414 " This is not related to the amount of memory in the host. It can\n"
415 " be more, and the excess, if it's ever used, will just be swapped out.\n"
416 " Example: mem=64M\n\n"
419 unsigned long find_iomem(char *driver, unsigned long *len_out)
421 struct iomem_region *region = iomem_regions;
423 while(region != NULL){
424 if(!strcmp(region->driver, driver)){
425 *len_out = region->size;
426 return(region->virt);
433 int setup_iomem(void)
435 struct iomem_region *region = iomem_regions;
436 unsigned long iomem_start = high_physmem + PAGE_SIZE;
439 while(region != NULL){
440 err = os_map_memory((void *) iomem_start, region->fd, 0,
441 region->size, 1, 1, 0);
443 printk("Mapping iomem region for driver '%s' failed, "
444 "errno = %d\n", region->driver, -err);
446 region->virt = iomem_start;
447 region->phys = __pa(region->virt);
450 iomem_start += region->size + PAGE_SIZE;
451 region = region->next;
457 __initcall(setup_iomem);
460 * Overrides for Emacs so that we follow Linus's tabbing style.
461 * Emacs will notice this stuff at the end of the file and automatically
462 * adjust the settings for this buffer only. This must remain at the end
464 * ---------------------------------------------------------------------------
466 * c-file-style: "linux"