Merge the FDT versions of initarm.
The copies of initarm used on platforms with FDT support were almost identical. The differences were pulled out into separate functions that were called by initarm. This change merges the, now identical, copies of initarm and a few of it's support functions. This is a step towards a common kernel on ARMv6.
This commit is contained in:
parent
422c281c83
commit
7bf9ab5331
Notes:
svn2git
2020-12-20 02:59:44 +00:00
svn path=/head/; revision=242531
@ -44,6 +44,7 @@
|
||||
|
||||
#include "opt_compat.h"
|
||||
#include "opt_ddb.h"
|
||||
#include "opt_platform.h"
|
||||
#include "opt_timer.h"
|
||||
|
||||
#include <sys/cdefs.h>
|
||||
@ -59,11 +60,13 @@ __FBSDID("$FreeBSD$");
|
||||
#include <sys/cpu.h>
|
||||
#include <sys/exec.h>
|
||||
#include <sys/imgact.h>
|
||||
#include <sys/kdb.h>
|
||||
#include <sys/kernel.h>
|
||||
#include <sys/ktr.h>
|
||||
#include <sys/linker.h>
|
||||
#include <sys/lock.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/msgbuf.h>
|
||||
#include <sys/mutex.h>
|
||||
#include <sys/pcpu.h>
|
||||
#include <sys/ptrace.h>
|
||||
@ -94,6 +97,17 @@ __FBSDID("$FreeBSD$");
|
||||
#include <machine/vmparam.h>
|
||||
#include <machine/sysarch.h>
|
||||
|
||||
#ifdef FDT
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
#include <dev/ofw/openfirm.h>
|
||||
#endif
|
||||
|
||||
#ifdef DEBUG
|
||||
#define debugf(fmt, args...) printf(fmt, ##args)
|
||||
#else
|
||||
#define debugf(fmt, args...)
|
||||
#endif
|
||||
|
||||
struct pcpu __pcpu[MAXCPU];
|
||||
struct pcpu *pcpup = &__pcpu[0];
|
||||
|
||||
@ -114,6 +128,35 @@ extern int *end;
|
||||
extern vm_offset_t ksym_start, ksym_end;
|
||||
#endif
|
||||
|
||||
#ifdef FDT
|
||||
/*
|
||||
* This is the number of L2 page tables required for covering max
|
||||
* (hypothetical) memsize of 4GB and all kernel mappings (vectors, msgbuf,
|
||||
* stacks etc.), uprounded to be divisible by 4.
|
||||
*/
|
||||
#define KERNEL_PT_MAX 78
|
||||
|
||||
static struct pv_addr kernel_pt_table[KERNEL_PT_MAX];
|
||||
|
||||
vm_paddr_t phys_avail[10];
|
||||
vm_paddr_t dump_avail[4];
|
||||
|
||||
extern u_int data_abort_handler_address;
|
||||
extern u_int prefetch_abort_handler_address;
|
||||
extern u_int undefined_handler_address;
|
||||
|
||||
vm_paddr_t pmap_pa;
|
||||
|
||||
struct pv_addr systempage;
|
||||
static struct pv_addr msgbufpv;
|
||||
struct pv_addr irqstack;
|
||||
struct pv_addr undstack;
|
||||
struct pv_addr abtstack;
|
||||
static struct pv_addr kernelstack;
|
||||
|
||||
const struct pmap_devmap *pmap_devmap_bootstrap_table;
|
||||
#endif
|
||||
|
||||
#if defined(LINUX_BOOT_ABI)
|
||||
#define LBABI_MAX_BANKS 10
|
||||
|
||||
@ -961,3 +1004,411 @@ set_stackptrs(int cpu)
|
||||
undstack.pv_va + ((UND_STACK_SIZE * PAGE_SIZE) * (cpu + 1)));
|
||||
}
|
||||
|
||||
#ifdef FDT
|
||||
static char *
|
||||
kenv_next(char *cp)
|
||||
{
|
||||
|
||||
if (cp != NULL) {
|
||||
while (*cp != 0)
|
||||
cp++;
|
||||
cp++;
|
||||
if (*cp == 0)
|
||||
cp = NULL;
|
||||
}
|
||||
return (cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kenv(void)
|
||||
{
|
||||
int len;
|
||||
char *cp;
|
||||
|
||||
debugf("loader passed (static) kenv:\n");
|
||||
if (kern_envp == NULL) {
|
||||
debugf(" no env, null ptr\n");
|
||||
return;
|
||||
}
|
||||
debugf(" kern_envp = 0x%08x\n", (uint32_t)kern_envp);
|
||||
|
||||
len = 0;
|
||||
for (cp = kern_envp; cp != NULL; cp = kenv_next(cp))
|
||||
debugf(" %x %s\n", (uint32_t)cp, cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kernel_section_addr(void)
|
||||
{
|
||||
|
||||
debugf("kernel image addresses:\n");
|
||||
debugf(" kernbase = 0x%08x\n", (uint32_t)kernbase);
|
||||
debugf(" _etext (sdata) = 0x%08x\n", (uint32_t)_etext);
|
||||
debugf(" _edata = 0x%08x\n", (uint32_t)_edata);
|
||||
debugf(" __bss_start = 0x%08x\n", (uint32_t)__bss_start);
|
||||
debugf(" _end = 0x%08x\n", (uint32_t)_end);
|
||||
}
|
||||
|
||||
static void
|
||||
physmap_init(struct mem_region *availmem_regions, int availmem_regions_sz)
|
||||
{
|
||||
int i, j, cnt;
|
||||
vm_offset_t phys_kernelend, kernload;
|
||||
uint32_t s, e, sz;
|
||||
struct mem_region *mp, *mp1;
|
||||
|
||||
phys_kernelend = KERNPHYSADDR + (virtual_avail - KERNVIRTADDR);
|
||||
kernload = KERNPHYSADDR;
|
||||
|
||||
/*
|
||||
* Remove kernel physical address range from avail
|
||||
* regions list. Page align all regions.
|
||||
* Non-page aligned memory isn't very interesting to us.
|
||||
* Also, sort the entries for ascending addresses.
|
||||
*/
|
||||
sz = 0;
|
||||
cnt = availmem_regions_sz;
|
||||
debugf("processing avail regions:\n");
|
||||
for (mp = availmem_regions; mp->mr_size; mp++) {
|
||||
s = mp->mr_start;
|
||||
e = mp->mr_start + mp->mr_size;
|
||||
debugf(" %08x-%08x -> ", s, e);
|
||||
/* Check whether this region holds all of the kernel. */
|
||||
if (s < kernload && e > phys_kernelend) {
|
||||
availmem_regions[cnt].mr_start = phys_kernelend;
|
||||
availmem_regions[cnt++].mr_size = e - phys_kernelend;
|
||||
e = kernload;
|
||||
}
|
||||
/* Look whether this regions starts within the kernel. */
|
||||
if (s >= kernload && s < phys_kernelend) {
|
||||
if (e <= phys_kernelend)
|
||||
goto empty;
|
||||
s = phys_kernelend;
|
||||
}
|
||||
/* Now look whether this region ends within the kernel. */
|
||||
if (e > kernload && e <= phys_kernelend) {
|
||||
if (s >= kernload) {
|
||||
goto empty;
|
||||
}
|
||||
e = kernload;
|
||||
}
|
||||
/* Now page align the start and size of the region. */
|
||||
s = round_page(s);
|
||||
e = trunc_page(e);
|
||||
if (e < s)
|
||||
e = s;
|
||||
sz = e - s;
|
||||
debugf("%08x-%08x = %x\n", s, e, sz);
|
||||
|
||||
/* Check whether some memory is left here. */
|
||||
if (sz == 0) {
|
||||
empty:
|
||||
printf("skipping\n");
|
||||
bcopy(mp + 1, mp,
|
||||
(cnt - (mp - availmem_regions)) * sizeof(*mp));
|
||||
cnt--;
|
||||
mp--;
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Do an insertion sort. */
|
||||
for (mp1 = availmem_regions; mp1 < mp; mp1++)
|
||||
if (s < mp1->mr_start)
|
||||
break;
|
||||
if (mp1 < mp) {
|
||||
bcopy(mp1, mp1 + 1, (char *)mp - (char *)mp1);
|
||||
mp1->mr_start = s;
|
||||
mp1->mr_size = sz;
|
||||
} else {
|
||||
mp->mr_start = s;
|
||||
mp->mr_size = sz;
|
||||
}
|
||||
}
|
||||
availmem_regions_sz = cnt;
|
||||
|
||||
/* Fill in phys_avail table, based on availmem_regions */
|
||||
debugf("fill in phys_avail:\n");
|
||||
for (i = 0, j = 0; i < availmem_regions_sz; i++, j += 2) {
|
||||
|
||||
debugf(" region: 0x%08x - 0x%08x (0x%08x)\n",
|
||||
availmem_regions[i].mr_start,
|
||||
availmem_regions[i].mr_start + availmem_regions[i].mr_size,
|
||||
availmem_regions[i].mr_size);
|
||||
|
||||
/*
|
||||
* We should not map the page at PA 0x0000000, the VM can't
|
||||
* handle it, as pmap_extract() == 0 means failure.
|
||||
*/
|
||||
if (availmem_regions[i].mr_start > 0 ||
|
||||
availmem_regions[i].mr_size > PAGE_SIZE) {
|
||||
phys_avail[j] = availmem_regions[i].mr_start;
|
||||
if (phys_avail[j] == 0)
|
||||
phys_avail[j] += PAGE_SIZE;
|
||||
phys_avail[j + 1] = availmem_regions[i].mr_start +
|
||||
availmem_regions[i].mr_size;
|
||||
} else
|
||||
j -= 2;
|
||||
}
|
||||
phys_avail[j] = 0;
|
||||
phys_avail[j + 1] = 0;
|
||||
}
|
||||
|
||||
void *
|
||||
initarm(struct arm_boot_params *abp)
|
||||
{
|
||||
struct mem_region availmem_regions[FDT_MEM_REGIONS];
|
||||
struct pv_addr kernel_l1pt;
|
||||
struct pv_addr dpcpu;
|
||||
vm_offset_t dtbp, freemempos, l2_start, lastaddr;
|
||||
vm_offset_t pmap_bootstrap_lastaddr;
|
||||
uint32_t memsize, l2size;
|
||||
char *env;
|
||||
void *kmdp;
|
||||
u_int l1pagetable;
|
||||
int i = 0, j = 0, err_devmap = 0;
|
||||
int availmem_regions_sz;
|
||||
|
||||
lastaddr = parse_boot_param(abp);
|
||||
memsize = 0;
|
||||
set_cpufuncs();
|
||||
|
||||
/*
|
||||
* Find the dtb passed in by the boot loader.
|
||||
*/
|
||||
kmdp = preload_search_by_type("elf kernel");
|
||||
if (kmdp != NULL)
|
||||
dtbp = MD_FETCH(kmdp, MODINFOMD_DTBP, vm_offset_t);
|
||||
else
|
||||
dtbp = (vm_offset_t)NULL;
|
||||
|
||||
#if defined(FDT_DTB_STATIC)
|
||||
/*
|
||||
* In case the device tree blob was not retrieved (from metadata) try
|
||||
* to use the statically embedded one.
|
||||
*/
|
||||
if (dtbp == (vm_offset_t)NULL)
|
||||
dtbp = (vm_offset_t)&fdt_static_dtb;
|
||||
#endif
|
||||
|
||||
if (OF_install(OFW_FDT, 0) == FALSE)
|
||||
while (1);
|
||||
|
||||
if (OF_init((void *)dtbp) != 0)
|
||||
while (1);
|
||||
|
||||
/* Grab physical memory regions information from device tree. */
|
||||
if (fdt_get_mem_regions(availmem_regions, &availmem_regions_sz,
|
||||
&memsize) != 0)
|
||||
while(1);
|
||||
|
||||
/* Platform-specific initialisation */
|
||||
pmap_bootstrap_lastaddr = initarm_lastaddr();
|
||||
|
||||
pcpu0_init();
|
||||
|
||||
/* Calculate number of L2 tables needed for mapping vm_page_array */
|
||||
l2size = (memsize / PAGE_SIZE) * sizeof(struct vm_page);
|
||||
l2size = (l2size >> L1_S_SHIFT) + 1;
|
||||
|
||||
/*
|
||||
* Add one table for end of kernel map, one for stacks, msgbuf and
|
||||
* L1 and L2 tables map and one for vectors map.
|
||||
*/
|
||||
l2size += 3;
|
||||
|
||||
/* Make it divisible by 4 */
|
||||
l2size = (l2size + 3) & ~3;
|
||||
|
||||
#define KERNEL_TEXT_BASE (KERNBASE)
|
||||
freemempos = (lastaddr + PAGE_MASK) & ~PAGE_MASK;
|
||||
|
||||
/* Define a macro to simplify memory allocation */
|
||||
#define valloc_pages(var, np) \
|
||||
alloc_pages((var).pv_va, (np)); \
|
||||
(var).pv_pa = (var).pv_va + (KERNPHYSADDR - KERNVIRTADDR);
|
||||
|
||||
#define alloc_pages(var, np) \
|
||||
(var) = freemempos; \
|
||||
freemempos += (np * PAGE_SIZE); \
|
||||
memset((char *)(var), 0, ((np) * PAGE_SIZE));
|
||||
|
||||
while (((freemempos - L1_TABLE_SIZE) & (L1_TABLE_SIZE - 1)) != 0)
|
||||
freemempos += PAGE_SIZE;
|
||||
valloc_pages(kernel_l1pt, L1_TABLE_SIZE / PAGE_SIZE);
|
||||
|
||||
for (i = 0; i < l2size; ++i) {
|
||||
if (!(i % (PAGE_SIZE / L2_TABLE_SIZE_REAL))) {
|
||||
valloc_pages(kernel_pt_table[i],
|
||||
L2_TABLE_SIZE / PAGE_SIZE);
|
||||
j = i;
|
||||
} else {
|
||||
kernel_pt_table[i].pv_va = kernel_pt_table[j].pv_va +
|
||||
L2_TABLE_SIZE_REAL * (i - j);
|
||||
kernel_pt_table[i].pv_pa =
|
||||
kernel_pt_table[i].pv_va - KERNVIRTADDR +
|
||||
KERNPHYSADDR;
|
||||
|
||||
}
|
||||
}
|
||||
/*
|
||||
* Allocate a page for the system page mapped to 0x00000000
|
||||
* or 0xffff0000. This page will just contain the system vectors
|
||||
* and can be shared by all processes.
|
||||
*/
|
||||
valloc_pages(systempage, 1);
|
||||
|
||||
/* Allocate dynamic per-cpu area. */
|
||||
valloc_pages(dpcpu, DPCPU_SIZE / PAGE_SIZE);
|
||||
dpcpu_init((void *)dpcpu.pv_va, 0);
|
||||
|
||||
/* Allocate stacks for all modes */
|
||||
valloc_pages(irqstack, (IRQ_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(abtstack, (ABT_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(undstack, (UND_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(kernelstack, (KSTACK_PAGES * MAXCPU));
|
||||
|
||||
init_param1();
|
||||
|
||||
valloc_pages(msgbufpv, round_page(msgbufsize) / PAGE_SIZE);
|
||||
|
||||
/*
|
||||
* Now we start construction of the L1 page table
|
||||
* We start by mapping the L2 page tables into the L1.
|
||||
* This means that we can replace L1 mappings later on if necessary
|
||||
*/
|
||||
l1pagetable = kernel_l1pt.pv_va;
|
||||
|
||||
/*
|
||||
* Try to map as much as possible of kernel text and data using
|
||||
* 1MB section mapping and for the rest of initial kernel address
|
||||
* space use L2 coarse tables.
|
||||
*
|
||||
* Link L2 tables for mapping remainder of kernel (modulo 1MB)
|
||||
* and kernel structures
|
||||
*/
|
||||
l2_start = lastaddr & ~(L1_S_OFFSET);
|
||||
for (i = 0 ; i < l2size - 1; i++)
|
||||
pmap_link_l2pt(l1pagetable, l2_start + i * L1_S_SIZE,
|
||||
&kernel_pt_table[i]);
|
||||
|
||||
pmap_curmaxkvaddr = l2_start + (l2size - 1) * L1_S_SIZE;
|
||||
|
||||
/* Map kernel code and data */
|
||||
pmap_map_chunk(l1pagetable, KERNVIRTADDR, KERNPHYSADDR,
|
||||
(((uint32_t)(lastaddr) - KERNVIRTADDR) + PAGE_MASK) & ~PAGE_MASK,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
|
||||
/* Map L1 directory and allocated L2 page tables */
|
||||
pmap_map_chunk(l1pagetable, kernel_l1pt.pv_va, kernel_l1pt.pv_pa,
|
||||
L1_TABLE_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
pmap_map_chunk(l1pagetable, kernel_pt_table[0].pv_va,
|
||||
kernel_pt_table[0].pv_pa,
|
||||
L2_TABLE_SIZE_REAL * l2size,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
/* Map allocated DPCPU, stacks and msgbuf */
|
||||
pmap_map_chunk(l1pagetable, dpcpu.pv_va, dpcpu.pv_pa,
|
||||
freemempos - dpcpu.pv_va,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
/* Link and map the vector page */
|
||||
pmap_link_l2pt(l1pagetable, ARM_VECTORS_HIGH,
|
||||
&kernel_pt_table[l2size - 1]);
|
||||
pmap_map_entry(l1pagetable, ARM_VECTORS_HIGH, systempage.pv_pa,
|
||||
VM_PROT_READ|VM_PROT_WRITE|VM_PROT_EXECUTE, PTE_CACHE);
|
||||
|
||||
/* Map pmap_devmap[] entries */
|
||||
err_devmap = platform_devmap_init();
|
||||
pmap_devmap_bootstrap(l1pagetable, pmap_devmap_bootstrap_table);
|
||||
|
||||
cpu_domains((DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2)) |
|
||||
DOMAIN_CLIENT);
|
||||
pmap_pa = kernel_l1pt.pv_pa;
|
||||
setttb(kernel_l1pt.pv_pa);
|
||||
cpu_tlb_flushID();
|
||||
cpu_domains(DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2));
|
||||
|
||||
/*
|
||||
* Only after the SOC registers block is mapped we can perform device
|
||||
* tree fixups, as they may attempt to read parameters from hardware.
|
||||
*/
|
||||
OF_interpret("perform-fixup", 0);
|
||||
|
||||
initarm_gpio_init();
|
||||
|
||||
cninit();
|
||||
|
||||
physmem = memsize / PAGE_SIZE;
|
||||
|
||||
debugf("initarm: console initialized\n");
|
||||
debugf(" arg1 kmdp = 0x%08x\n", (uint32_t)kmdp);
|
||||
debugf(" boothowto = 0x%08x\n", boothowto);
|
||||
debugf(" dtbp = 0x%08x\n", (uint32_t)dtbp);
|
||||
print_kernel_section_addr();
|
||||
print_kenv();
|
||||
|
||||
env = getenv("kernelname");
|
||||
if (env != NULL)
|
||||
strlcpy(kernelname, env, sizeof(kernelname));
|
||||
|
||||
if (err_devmap != 0)
|
||||
printf("WARNING: could not fully configure devmap, error=%d\n",
|
||||
err_devmap);
|
||||
|
||||
initarm_late_init();
|
||||
|
||||
/*
|
||||
* Pages were allocated during the secondary bootstrap for the
|
||||
* stacks for different CPU modes.
|
||||
* We must now set the r13 registers in the different CPU modes to
|
||||
* point to these stacks.
|
||||
* Since the ARM stacks use STMFD etc. we must set r13 to the top end
|
||||
* of the stack memory.
|
||||
*/
|
||||
cpu_control(CPU_CONTROL_MMU_ENABLE, CPU_CONTROL_MMU_ENABLE);
|
||||
|
||||
set_stackptrs(0);
|
||||
|
||||
/*
|
||||
* We must now clean the cache again....
|
||||
* Cleaning may be done by reading new data to displace any
|
||||
* dirty data in the cache. This will have happened in setttb()
|
||||
* but since we are boot strapping the addresses used for the read
|
||||
* may have just been remapped and thus the cache could be out
|
||||
* of sync. A re-clean after the switch will cure this.
|
||||
* After booting there are no gross relocations of the kernel thus
|
||||
* this problem will not occur after initarm().
|
||||
*/
|
||||
cpu_idcache_wbinv_all();
|
||||
|
||||
/* Set stack for exception handlers */
|
||||
data_abort_handler_address = (u_int)data_abort_handler;
|
||||
prefetch_abort_handler_address = (u_int)prefetch_abort_handler;
|
||||
undefined_handler_address = (u_int)undefinedinstruction_bounce;
|
||||
undefined_init();
|
||||
|
||||
init_proc0(kernelstack.pv_va);
|
||||
|
||||
arm_vector_init(ARM_VECTORS_HIGH, ARM_VEC_ALL);
|
||||
arm_dump_avail_init(memsize, sizeof(dump_avail) / sizeof(dump_avail[0]));
|
||||
pmap_bootstrap(freemempos, pmap_bootstrap_lastaddr, &kernel_l1pt);
|
||||
msgbufp = (void *)msgbufpv.pv_va;
|
||||
msgbufinit(msgbufp, msgbufsize);
|
||||
mutex_init();
|
||||
|
||||
/*
|
||||
* Prepare map of physical memory regions available to vm subsystem.
|
||||
*/
|
||||
physmap_init(availmem_regions, availmem_regions_sz);
|
||||
|
||||
/* Do basic tuning, hz etc */
|
||||
init_param2(physmem);
|
||||
kdb_init();
|
||||
|
||||
return ((void *)(kernelstack.pv_va + USPACE_SVC_STACK_TOP -
|
||||
sizeof(struct pcb)));
|
||||
}
|
||||
#endif
|
||||
|
||||
|
@ -46,514 +46,23 @@ __FBSDID("$FreeBSD$");
|
||||
#define _ARM32_BUS_DMA_PRIVATE
|
||||
#include <sys/param.h>
|
||||
#include <sys/systm.h>
|
||||
#include <sys/sysproto.h>
|
||||
#include <sys/signalvar.h>
|
||||
#include <sys/imgact.h>
|
||||
#include <sys/kernel.h>
|
||||
#include <sys/ktr.h>
|
||||
#include <sys/linker.h>
|
||||
#include <sys/lock.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/mutex.h>
|
||||
#include <sys/pcpu.h>
|
||||
#include <sys/proc.h>
|
||||
#include <sys/ptrace.h>
|
||||
#include <sys/cons.h>
|
||||
#include <sys/bio.h>
|
||||
#include <sys/bus.h>
|
||||
#include <sys/buf.h>
|
||||
#include <sys/exec.h>
|
||||
#include <sys/kdb.h>
|
||||
#include <sys/msgbuf.h>
|
||||
#include <machine/reg.h>
|
||||
#include <machine/cpu.h>
|
||||
#include <machine/fdt.h>
|
||||
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
#include <dev/ofw/openfirm.h>
|
||||
|
||||
#include <vm/vm.h>
|
||||
#include <vm/pmap.h>
|
||||
#include <vm/vm_object.h>
|
||||
#include <vm/vm_page.h>
|
||||
#include <vm/vm_pager.h>
|
||||
#include <vm/vm_map.h>
|
||||
#include <machine/pte.h>
|
||||
#include <machine/pmap.h>
|
||||
#include <machine/vmparam.h>
|
||||
#include <machine/pcb.h>
|
||||
#include <machine/undefined.h>
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/metadata.h>
|
||||
#include <machine/armreg.h>
|
||||
|
||||
#include <machine/bus.h>
|
||||
#include <sys/reboot.h>
|
||||
#include <machine/frame.h> /* For trapframe_t, used in <machine/machdep.h> */
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/pmap.h>
|
||||
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
|
||||
#include <arm/broadcom/bcm2835/bcm2835_wdog.h>
|
||||
|
||||
#define DEBUG
|
||||
#ifdef DEBUG
|
||||
#define debugf(fmt, args...) printf(fmt, ##args)
|
||||
#else
|
||||
#define debugf(fmt, args...)
|
||||
#endif
|
||||
|
||||
/* Start of address space used for bootstrap map */
|
||||
#define DEVMAP_BOOTSTRAP_MAP_START 0xE0000000
|
||||
|
||||
/*
|
||||
* This is the number of L2 page tables required for covering max
|
||||
* (hypothetical) memsize of 4GB and all kernel mappings (vectors, msgbuf,
|
||||
* stacks etc.), uprounded to be divisible by 4.
|
||||
*/
|
||||
#define KERNEL_PT_MAX 78
|
||||
|
||||
extern unsigned char kernbase[];
|
||||
extern unsigned char _etext[];
|
||||
extern unsigned char _edata[];
|
||||
extern unsigned char __bss_start[];
|
||||
extern unsigned char _end[];
|
||||
|
||||
#ifdef DDB
|
||||
extern vm_offset_t ksym_start, ksym_end;
|
||||
#endif
|
||||
|
||||
extern u_int data_abort_handler_address;
|
||||
extern u_int prefetch_abort_handler_address;
|
||||
extern u_int undefined_handler_address;
|
||||
|
||||
extern vm_offset_t pmap_bootstrap_lastaddr;
|
||||
extern int *end;
|
||||
|
||||
struct pv_addr kernel_pt_table[KERNEL_PT_MAX];
|
||||
|
||||
/* Physical and virtual addresses for some global pages */
|
||||
vm_paddr_t phys_avail[10];
|
||||
vm_paddr_t dump_avail[4];
|
||||
vm_offset_t physical_pages;
|
||||
vm_offset_t pmap_bootstrap_lastaddr;
|
||||
vm_paddr_t pmap_pa;
|
||||
|
||||
const struct pmap_devmap *pmap_devmap_bootstrap_table;
|
||||
struct pv_addr systempage;
|
||||
struct pv_addr msgbufpv;
|
||||
struct pv_addr irqstack;
|
||||
struct pv_addr undstack;
|
||||
struct pv_addr abtstack;
|
||||
struct pv_addr kernelstack;
|
||||
|
||||
static struct mem_region availmem_regions[FDT_MEM_REGIONS];
|
||||
static int availmem_regions_sz;
|
||||
|
||||
static void print_kenv(void);
|
||||
static void print_kernel_section_addr(void);
|
||||
|
||||
static void physmap_init(void);
|
||||
static int platform_devmap_init(void);
|
||||
|
||||
static char *
|
||||
kenv_next(char *cp)
|
||||
{
|
||||
|
||||
if (cp != NULL) {
|
||||
while (*cp != 0)
|
||||
cp++;
|
||||
cp++;
|
||||
if (*cp == 0)
|
||||
cp = NULL;
|
||||
}
|
||||
return (cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kenv(void)
|
||||
{
|
||||
int len;
|
||||
char *cp;
|
||||
|
||||
debugf("loader passed (static) kenv:\n");
|
||||
if (kern_envp == NULL) {
|
||||
debugf(" no env, null ptr\n");
|
||||
return;
|
||||
}
|
||||
debugf(" kern_envp = 0x%08x\n", (uint32_t)kern_envp);
|
||||
|
||||
len = 0;
|
||||
for (cp = kern_envp; cp != NULL; cp = kenv_next(cp))
|
||||
debugf(" %x %s\n", (uint32_t)cp, cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kernel_section_addr(void)
|
||||
{
|
||||
|
||||
debugf("kernel image addresses:\n");
|
||||
debugf(" kernbase = 0x%08x\n", (uint32_t)kernbase);
|
||||
debugf(" _etext (sdata) = 0x%08x\n", (uint32_t)_etext);
|
||||
debugf(" _edata = 0x%08x\n", (uint32_t)_edata);
|
||||
debugf(" __bss_start = 0x%08x\n", (uint32_t)__bss_start);
|
||||
debugf(" _end = 0x%08x\n", (uint32_t)_end);
|
||||
}
|
||||
|
||||
static void
|
||||
physmap_init(void)
|
||||
{
|
||||
int i, j, cnt;
|
||||
vm_offset_t phys_kernelend, kernload;
|
||||
uint32_t s, e, sz;
|
||||
struct mem_region *mp, *mp1;
|
||||
|
||||
phys_kernelend = KERNPHYSADDR + (virtual_avail - KERNVIRTADDR);
|
||||
kernload = KERNPHYSADDR;
|
||||
|
||||
/*
|
||||
* Remove kernel physical address range from avail
|
||||
* regions list. Page align all regions.
|
||||
* Non-page aligned memory isn't very interesting to us.
|
||||
* Also, sort the entries for ascending addresses.
|
||||
*/
|
||||
sz = 0;
|
||||
cnt = availmem_regions_sz;
|
||||
debugf("processing avail regions:\n");
|
||||
for (mp = availmem_regions; mp->mr_size; mp++) {
|
||||
s = mp->mr_start;
|
||||
e = mp->mr_start + mp->mr_size;
|
||||
debugf(" %08x-%08x -> ", s, e);
|
||||
/* Check whether this region holds all of the kernel. */
|
||||
if (s < kernload && e > phys_kernelend) {
|
||||
availmem_regions[cnt].mr_start = phys_kernelend;
|
||||
availmem_regions[cnt++].mr_size = e - phys_kernelend;
|
||||
e = kernload;
|
||||
}
|
||||
/* Look whether this regions starts within the kernel. */
|
||||
if (s >= kernload && s < phys_kernelend) {
|
||||
if (e <= phys_kernelend)
|
||||
goto empty;
|
||||
s = phys_kernelend;
|
||||
}
|
||||
/* Now look whether this region ends within the kernel. */
|
||||
if (e > kernload && e <= phys_kernelend) {
|
||||
if (s >= kernload) {
|
||||
goto empty;
|
||||
}
|
||||
e = kernload;
|
||||
}
|
||||
/* Now page align the start and size of the region. */
|
||||
s = round_page(s);
|
||||
e = trunc_page(e);
|
||||
if (e < s)
|
||||
e = s;
|
||||
sz = e - s;
|
||||
debugf("%08x-%08x = %x\n", s, e, sz);
|
||||
|
||||
/* Check whether some memory is left here. */
|
||||
if (sz == 0) {
|
||||
empty:
|
||||
printf("skipping\n");
|
||||
bcopy(mp + 1, mp,
|
||||
(cnt - (mp - availmem_regions)) * sizeof(*mp));
|
||||
cnt--;
|
||||
mp--;
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Do an insertion sort. */
|
||||
for (mp1 = availmem_regions; mp1 < mp; mp1++)
|
||||
if (s < mp1->mr_start)
|
||||
break;
|
||||
if (mp1 < mp) {
|
||||
bcopy(mp1, mp1 + 1, (char *)mp - (char *)mp1);
|
||||
mp1->mr_start = s;
|
||||
mp1->mr_size = sz;
|
||||
} else {
|
||||
mp->mr_start = s;
|
||||
mp->mr_size = sz;
|
||||
}
|
||||
}
|
||||
availmem_regions_sz = cnt;
|
||||
|
||||
/* Fill in phys_avail table, based on availmem_regions */
|
||||
debugf("fill in phys_avail:\n");
|
||||
for (i = 0, j = 0; i < availmem_regions_sz; i++, j += 2) {
|
||||
|
||||
debugf(" region: 0x%08x - 0x%08x (0x%08x)\n",
|
||||
availmem_regions[i].mr_start,
|
||||
availmem_regions[i].mr_start + availmem_regions[i].mr_size,
|
||||
availmem_regions[i].mr_size);
|
||||
|
||||
/*
|
||||
* We should not map the page at PA 0x0000000, the VM can't
|
||||
* handle it, as pmap_extract() == 0 means failure.
|
||||
*/
|
||||
if (availmem_regions[i].mr_start > 0 ||
|
||||
availmem_regions[i].mr_size > PAGE_SIZE) {
|
||||
phys_avail[j] = availmem_regions[i].mr_start;
|
||||
if (phys_avail[j] == 0)
|
||||
phys_avail[j] += PAGE_SIZE;
|
||||
phys_avail[j + 1] = availmem_regions[i].mr_start +
|
||||
availmem_regions[i].mr_size;
|
||||
} else
|
||||
j -= 2;
|
||||
}
|
||||
phys_avail[j] = 0;
|
||||
phys_avail[j + 1] = 0;
|
||||
}
|
||||
|
||||
void *
|
||||
initarm(struct arm_boot_params *abp)
|
||||
{
|
||||
struct pv_addr kernel_l1pt;
|
||||
struct pv_addr dpcpu;
|
||||
vm_offset_t dtbp, freemempos, l2_start, lastaddr;
|
||||
uint32_t memsize, l2size;
|
||||
char *env;
|
||||
void *kmdp;
|
||||
u_int l1pagetable;
|
||||
int i = 0, j = 0, err_devmap = 0;
|
||||
|
||||
lastaddr = parse_boot_param(abp);
|
||||
memsize = 0;
|
||||
set_cpufuncs();
|
||||
|
||||
/*
|
||||
* Find the dtb passed in by the boot loader.
|
||||
*/
|
||||
kmdp = preload_search_by_type("elf kernel");
|
||||
if (kmdp != NULL)
|
||||
dtbp = MD_FETCH(kmdp, MODINFOMD_DTBP, vm_offset_t);
|
||||
else
|
||||
dtbp = (vm_offset_t)NULL;
|
||||
|
||||
#if defined(FDT_DTB_STATIC)
|
||||
/*
|
||||
* In case the device tree blob was not retrieved (from metadata) try
|
||||
* to use the statically embedded one.
|
||||
*/
|
||||
if (dtbp == (vm_offset_t)NULL)
|
||||
dtbp = (vm_offset_t)&fdt_static_dtb;
|
||||
#endif
|
||||
|
||||
if (OF_install(OFW_FDT, 0) == FALSE)
|
||||
while (1);
|
||||
|
||||
if (OF_init((void *)dtbp) != 0)
|
||||
while (1);
|
||||
|
||||
/* Grab physical memory regions information from device tree. */
|
||||
if (fdt_get_mem_regions(availmem_regions, &availmem_regions_sz,
|
||||
&memsize) != 0)
|
||||
while(1);
|
||||
|
||||
/* Platform-specific initialisation */
|
||||
pmap_bootstrap_lastaddr = initarm_lastaddr();
|
||||
|
||||
pcpu0_init();
|
||||
|
||||
/* Calculate number of L2 tables needed for mapping vm_page_array */
|
||||
l2size = (memsize / PAGE_SIZE) * sizeof(struct vm_page);
|
||||
l2size = (l2size >> L1_S_SHIFT) + 1;
|
||||
|
||||
/*
|
||||
* Add one table for end of kernel map, one for stacks, msgbuf and
|
||||
* L1 and L2 tables map and one for vectors map.
|
||||
*/
|
||||
l2size += 3;
|
||||
|
||||
/* Make it divisible by 4 */
|
||||
l2size = (l2size + 3) & ~3;
|
||||
|
||||
#define KERNEL_TEXT_BASE (KERNBASE)
|
||||
freemempos = (lastaddr + PAGE_MASK) & ~PAGE_MASK;
|
||||
|
||||
/* Define a macro to simplify memory allocation */
|
||||
#define valloc_pages(var, np) \
|
||||
alloc_pages((var).pv_va, (np)); \
|
||||
(var).pv_pa = (var).pv_va + (KERNPHYSADDR - KERNVIRTADDR);
|
||||
|
||||
#define alloc_pages(var, np) \
|
||||
(var) = freemempos; \
|
||||
freemempos += (np * PAGE_SIZE); \
|
||||
memset((char *)(var), 0, ((np) * PAGE_SIZE));
|
||||
|
||||
while (((freemempos - L1_TABLE_SIZE) & (L1_TABLE_SIZE - 1)) != 0)
|
||||
freemempos += PAGE_SIZE;
|
||||
valloc_pages(kernel_l1pt, L1_TABLE_SIZE / PAGE_SIZE);
|
||||
|
||||
for (i = 0; i < l2size; ++i) {
|
||||
if (!(i % (PAGE_SIZE / L2_TABLE_SIZE_REAL))) {
|
||||
valloc_pages(kernel_pt_table[i],
|
||||
L2_TABLE_SIZE / PAGE_SIZE);
|
||||
j = i;
|
||||
} else {
|
||||
kernel_pt_table[i].pv_va = kernel_pt_table[j].pv_va +
|
||||
L2_TABLE_SIZE_REAL * (i - j);
|
||||
kernel_pt_table[i].pv_pa =
|
||||
kernel_pt_table[i].pv_va - KERNVIRTADDR +
|
||||
KERNPHYSADDR;
|
||||
|
||||
}
|
||||
}
|
||||
/*
|
||||
* Allocate a page for the system page mapped to 0x00000000
|
||||
* or 0xffff0000. This page will just contain the system vectors
|
||||
* and can be shared by all processes.
|
||||
*/
|
||||
valloc_pages(systempage, 1);
|
||||
|
||||
/* Allocate dynamic per-cpu area. */
|
||||
valloc_pages(dpcpu, DPCPU_SIZE / PAGE_SIZE);
|
||||
dpcpu_init((void *)dpcpu.pv_va, 0);
|
||||
|
||||
/* Allocate stacks for all modes */
|
||||
valloc_pages(irqstack, (IRQ_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(abtstack, (ABT_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(undstack, (UND_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(kernelstack, (KSTACK_PAGES * MAXCPU));
|
||||
|
||||
init_param1();
|
||||
|
||||
valloc_pages(msgbufpv, round_page(msgbufsize) / PAGE_SIZE);
|
||||
|
||||
/*
|
||||
* Now we start construction of the L1 page table
|
||||
* We start by mapping the L2 page tables into the L1.
|
||||
* This means that we can replace L1 mappings later on if necessary
|
||||
*/
|
||||
l1pagetable = kernel_l1pt.pv_va;
|
||||
|
||||
/*
|
||||
* Try to map as much as possible of kernel text and data using
|
||||
* 1MB section mapping and for the rest of initial kernel address
|
||||
* space use L2 coarse tables.
|
||||
*
|
||||
* Link L2 tables for mapping remainder of kernel (modulo 1MB)
|
||||
* and kernel structures
|
||||
*/
|
||||
l2_start = lastaddr & ~(L1_S_OFFSET);
|
||||
for (i = 0 ; i < l2size - 1; i++)
|
||||
pmap_link_l2pt(l1pagetable, l2_start + i * L1_S_SIZE,
|
||||
&kernel_pt_table[i]);
|
||||
|
||||
pmap_curmaxkvaddr = l2_start + (l2size - 1) * L1_S_SIZE;
|
||||
|
||||
/* Map kernel code and data */
|
||||
pmap_map_chunk(l1pagetable, KERNVIRTADDR, KERNPHYSADDR,
|
||||
(((uint32_t)(lastaddr) - KERNVIRTADDR) + PAGE_MASK) & ~PAGE_MASK,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
|
||||
/* Map L1 directory and allocated L2 page tables */
|
||||
pmap_map_chunk(l1pagetable, kernel_l1pt.pv_va, kernel_l1pt.pv_pa,
|
||||
L1_TABLE_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
pmap_map_chunk(l1pagetable, kernel_pt_table[0].pv_va,
|
||||
kernel_pt_table[0].pv_pa,
|
||||
L2_TABLE_SIZE_REAL * l2size,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
/* Map allocated DPCPU, stacks and msgbuf */
|
||||
pmap_map_chunk(l1pagetable, dpcpu.pv_va, dpcpu.pv_pa,
|
||||
freemempos - dpcpu.pv_va,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
/* Link and map the vector page */
|
||||
pmap_link_l2pt(l1pagetable, ARM_VECTORS_HIGH,
|
||||
&kernel_pt_table[l2size - 1]);
|
||||
pmap_map_entry(l1pagetable, ARM_VECTORS_HIGH, systempage.pv_pa,
|
||||
VM_PROT_READ|VM_PROT_WRITE|VM_PROT_EXECUTE, PTE_CACHE);
|
||||
|
||||
/* Map pmap_devmap[] entries */
|
||||
err_devmap = platform_devmap_init();
|
||||
pmap_devmap_bootstrap(l1pagetable, pmap_devmap_bootstrap_table);
|
||||
|
||||
cpu_domains((DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2)) |
|
||||
DOMAIN_CLIENT);
|
||||
pmap_pa = kernel_l1pt.pv_pa;
|
||||
setttb(kernel_l1pt.pv_pa);
|
||||
cpu_tlb_flushID();
|
||||
cpu_domains(DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2));
|
||||
|
||||
/*
|
||||
* Only after the SOC registers block is mapped we can perform device
|
||||
* tree fixups, as they may attempt to read parameters from hardware.
|
||||
*/
|
||||
OF_interpret("perform-fixup", 0);
|
||||
|
||||
initarm_gpio_init();
|
||||
|
||||
cninit();
|
||||
|
||||
physmem = memsize / PAGE_SIZE;
|
||||
|
||||
debugf("initarm: console initialized\n");
|
||||
debugf(" arg1 kmdp = 0x%08x\n", (uint32_t)kmdp);
|
||||
debugf(" boothowto = 0x%08x\n", boothowto);
|
||||
debugf(" dtbp = 0x%08x\n", (uint32_t)dtbp);
|
||||
print_kernel_section_addr();
|
||||
print_kenv();
|
||||
|
||||
env = getenv("kernelname");
|
||||
if (env != NULL)
|
||||
strlcpy(kernelname, env, sizeof(kernelname));
|
||||
|
||||
if (err_devmap != 0)
|
||||
printf("WARNING: could not fully configure devmap, error=%d\n",
|
||||
err_devmap);
|
||||
|
||||
initarm_late_init();
|
||||
|
||||
/*
|
||||
* Pages were allocated during the secondary bootstrap for the
|
||||
* stacks for different CPU modes.
|
||||
* We must now set the r13 registers in the different CPU modes to
|
||||
* point to these stacks.
|
||||
* Since the ARM stacks use STMFD etc. we must set r13 to the top end
|
||||
* of the stack memory.
|
||||
*/
|
||||
cpu_control(CPU_CONTROL_MMU_ENABLE, CPU_CONTROL_MMU_ENABLE);
|
||||
|
||||
set_stackptrs(0);
|
||||
|
||||
/*
|
||||
* We must now clean the cache again....
|
||||
* Cleaning may be done by reading new data to displace any
|
||||
* dirty data in the cache. This will have happened in setttb()
|
||||
* but since we are boot strapping the addresses used for the read
|
||||
* may have just been remapped and thus the cache could be out
|
||||
* of sync. A re-clean after the switch will cure this.
|
||||
* After booting there are no gross relocations of the kernel thus
|
||||
* this problem will not occur after initarm().
|
||||
*/
|
||||
cpu_idcache_wbinv_all();
|
||||
|
||||
/* Set stack for exception handlers */
|
||||
data_abort_handler_address = (u_int)data_abort_handler;
|
||||
prefetch_abort_handler_address = (u_int)prefetch_abort_handler;
|
||||
undefined_handler_address = (u_int)undefinedinstruction_bounce;
|
||||
undefined_init();
|
||||
|
||||
init_proc0(kernelstack.pv_va);
|
||||
|
||||
arm_vector_init(ARM_VECTORS_HIGH, ARM_VEC_ALL);
|
||||
arm_dump_avail_init(memsize, sizeof(dump_avail) / sizeof(dump_avail[0]));
|
||||
pmap_bootstrap(freemempos, pmap_bootstrap_lastaddr, &kernel_l1pt);
|
||||
msgbufp = (void *)msgbufpv.pv_va;
|
||||
msgbufinit(msgbufp, msgbufsize);
|
||||
mutex_init();
|
||||
|
||||
/*
|
||||
* Prepare map of physical memory regions available to vm subsystem.
|
||||
*/
|
||||
physmap_init();
|
||||
|
||||
/* Do basic tuning, hz etc */
|
||||
init_param2(physmem);
|
||||
kdb_init();
|
||||
|
||||
return ((void *)(kernelstack.pv_va + USPACE_SVC_STACK_TOP -
|
||||
sizeof(struct pcb)));
|
||||
}
|
||||
|
||||
vm_offset_t
|
||||
initarm_lastaddr(void)
|
||||
{
|
||||
@ -580,7 +89,7 @@ static struct pmap_devmap fdt_devmap[FDT_DEVMAP_MAX] = {
|
||||
/*
|
||||
* Construct pmap_devmap[] with DT-derived config data.
|
||||
*/
|
||||
static int
|
||||
int
|
||||
platform_devmap_init(void)
|
||||
{
|
||||
int i = 0;
|
||||
@ -616,3 +125,4 @@ cpu_reset()
|
||||
bcmwd_watchdog_reset();
|
||||
while (1);
|
||||
}
|
||||
|
||||
|
@ -35,6 +35,10 @@ vm_offset_t parse_boot_param(struct arm_boot_params *abp);
|
||||
vm_offset_t initarm_lastaddr(void);
|
||||
void initarm_gpio_init(void);
|
||||
void initarm_late_init(void);
|
||||
int platform_devmap_init(void);
|
||||
|
||||
/* Needs to be initialised by platform_devmap_init */
|
||||
extern const struct pmap_devmap *pmap_devmap_bootstrap_table;
|
||||
|
||||
/* Setup standard arrays */
|
||||
void arm_dump_avail_init( vm_offset_t memsize, size_t max);
|
||||
|
@ -44,517 +44,22 @@ __FBSDID("$FreeBSD$");
|
||||
#define _ARM32_BUS_DMA_PRIVATE
|
||||
#include <sys/param.h>
|
||||
#include <sys/systm.h>
|
||||
#include <sys/sysproto.h>
|
||||
#include <sys/signalvar.h>
|
||||
#include <sys/imgact.h>
|
||||
#include <sys/kernel.h>
|
||||
#include <sys/ktr.h>
|
||||
#include <sys/linker.h>
|
||||
#include <sys/lock.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/mutex.h>
|
||||
#include <sys/pcpu.h>
|
||||
#include <sys/proc.h>
|
||||
#include <sys/ptrace.h>
|
||||
#include <sys/cons.h>
|
||||
#include <sys/bio.h>
|
||||
#include <sys/bus.h>
|
||||
#include <sys/buf.h>
|
||||
#include <sys/exec.h>
|
||||
#include <sys/kdb.h>
|
||||
#include <sys/msgbuf.h>
|
||||
#include <machine/reg.h>
|
||||
#include <machine/cpu.h>
|
||||
#include <machine/fdt.h>
|
||||
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
#include <dev/ofw/openfirm.h>
|
||||
#include <vm/vm.h>
|
||||
#include <vm/pmap.h>
|
||||
|
||||
#include <machine/bus.h>
|
||||
#include <machine/frame.h> /* For trapframe_t, used in <machine/machdep.h> */
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/pmap.h>
|
||||
|
||||
#include <arm/lpc/lpcreg.h>
|
||||
#include <arm/lpc/lpcvar.h>
|
||||
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
#include <dev/ic/ns16550.h>
|
||||
|
||||
#include <vm/vm.h>
|
||||
#include <vm/pmap.h>
|
||||
#include <vm/vm_object.h>
|
||||
#include <vm/vm_page.h>
|
||||
#include <vm/vm_pager.h>
|
||||
#include <vm/vm_map.h>
|
||||
#include <machine/bus.h>
|
||||
#include <machine/pte.h>
|
||||
#include <machine/pmap.h>
|
||||
#include <machine/vmparam.h>
|
||||
#include <machine/pcb.h>
|
||||
#include <machine/undefined.h>
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/metadata.h>
|
||||
#include <machine/armreg.h>
|
||||
#include <machine/bus.h>
|
||||
#include <sys/reboot.h>
|
||||
|
||||
#define DEBUG
|
||||
#undef DEBUG
|
||||
|
||||
#ifdef DEBUG
|
||||
#define debugf(fmt, args...) printf(fmt, ##args)
|
||||
#else
|
||||
#define debugf(fmt, args...)
|
||||
#endif
|
||||
|
||||
/*
|
||||
* This is the number of L2 page tables required for covering max
|
||||
* (hypothetical) memsize of 4GB and all kernel mappings (vectors, msgbuf,
|
||||
* stacks etc.), uprounded to be divisible by 4.
|
||||
*/
|
||||
#define KERNEL_PT_MAX 78
|
||||
|
||||
extern unsigned char kernbase[];
|
||||
extern unsigned char _etext[];
|
||||
extern unsigned char _edata[];
|
||||
extern unsigned char __bss_start[];
|
||||
extern unsigned char _end[];
|
||||
|
||||
#ifdef DDB
|
||||
extern vm_offset_t ksym_start, ksym_end;
|
||||
#endif
|
||||
|
||||
extern u_int data_abort_handler_address;
|
||||
extern u_int prefetch_abort_handler_address;
|
||||
extern u_int undefined_handler_address;
|
||||
|
||||
extern vm_offset_t pmap_bootstrap_lastaddr;
|
||||
extern int *end;
|
||||
|
||||
struct pv_addr kernel_pt_table[KERNEL_PT_MAX];
|
||||
|
||||
/* Physical and virtual addresses for some global pages */
|
||||
vm_paddr_t phys_avail[10];
|
||||
vm_paddr_t dump_avail[4];
|
||||
vm_offset_t physical_pages;
|
||||
vm_offset_t pmap_bootstrap_lastaddr;
|
||||
vm_paddr_t pmap_pa;
|
||||
|
||||
const struct pmap_devmap *pmap_devmap_bootstrap_table;
|
||||
struct pv_addr systempage;
|
||||
struct pv_addr msgbufpv;
|
||||
struct pv_addr irqstack;
|
||||
struct pv_addr undstack;
|
||||
struct pv_addr abtstack;
|
||||
struct pv_addr kernelstack;
|
||||
|
||||
static struct mem_region availmem_regions[FDT_MEM_REGIONS];
|
||||
static int availmem_regions_sz;
|
||||
|
||||
static void print_kenv(void);
|
||||
static void print_kernel_section_addr(void);
|
||||
|
||||
static void physmap_init(void);
|
||||
static int platform_devmap_init(void);
|
||||
|
||||
static char *
|
||||
kenv_next(char *cp)
|
||||
{
|
||||
|
||||
if (cp != NULL) {
|
||||
while (*cp != 0)
|
||||
cp++;
|
||||
cp++;
|
||||
if (*cp == 0)
|
||||
cp = NULL;
|
||||
}
|
||||
return (cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kenv(void)
|
||||
{
|
||||
int len;
|
||||
char *cp;
|
||||
|
||||
debugf("loader passed (static) kenv:\n");
|
||||
if (kern_envp == NULL) {
|
||||
debugf(" no env, null ptr\n");
|
||||
return;
|
||||
}
|
||||
debugf(" kern_envp = 0x%08x\n", (uint32_t)kern_envp);
|
||||
|
||||
len = 0;
|
||||
for (cp = kern_envp; cp != NULL; cp = kenv_next(cp))
|
||||
debugf(" %x %s\n", (uint32_t)cp, cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kernel_section_addr(void)
|
||||
{
|
||||
|
||||
debugf("kernel image addresses:\n");
|
||||
debugf(" kernbase = 0x%08x\n", (uint32_t)kernbase);
|
||||
debugf(" _etext (sdata) = 0x%08x\n", (uint32_t)_etext);
|
||||
debugf(" _edata = 0x%08x\n", (uint32_t)_edata);
|
||||
debugf(" __bss_start = 0x%08x\n", (uint32_t)__bss_start);
|
||||
debugf(" _end = 0x%08x\n", (uint32_t)_end);
|
||||
}
|
||||
|
||||
static void
|
||||
physmap_init(void)
|
||||
{
|
||||
int i, j, cnt;
|
||||
vm_offset_t phys_kernelend, kernload;
|
||||
uint32_t s, e, sz;
|
||||
struct mem_region *mp, *mp1;
|
||||
|
||||
phys_kernelend = KERNPHYSADDR + (virtual_avail - KERNVIRTADDR);
|
||||
kernload = KERNPHYSADDR;
|
||||
|
||||
/*
|
||||
* Remove kernel physical address range from avail
|
||||
* regions list. Page align all regions.
|
||||
* Non-page aligned memory isn't very interesting to us.
|
||||
* Also, sort the entries for ascending addresses.
|
||||
*/
|
||||
sz = 0;
|
||||
cnt = availmem_regions_sz;
|
||||
debugf("processing avail regions:\n");
|
||||
for (mp = availmem_regions; mp->mr_size; mp++) {
|
||||
s = mp->mr_start;
|
||||
e = mp->mr_start + mp->mr_size;
|
||||
debugf(" %08x-%08x -> ", s, e);
|
||||
/* Check whether this region holds all of the kernel. */
|
||||
if (s < kernload && e > phys_kernelend) {
|
||||
availmem_regions[cnt].mr_start = phys_kernelend;
|
||||
availmem_regions[cnt++].mr_size = e - phys_kernelend;
|
||||
e = kernload;
|
||||
}
|
||||
/* Look whether this regions starts within the kernel. */
|
||||
if (s >= kernload && s < phys_kernelend) {
|
||||
if (e <= phys_kernelend)
|
||||
goto empty;
|
||||
s = phys_kernelend;
|
||||
}
|
||||
/* Now look whether this region ends within the kernel. */
|
||||
if (e > kernload && e <= phys_kernelend) {
|
||||
if (s >= kernload) {
|
||||
goto empty;
|
||||
}
|
||||
e = kernload;
|
||||
}
|
||||
/* Now page align the start and size of the region. */
|
||||
s = round_page(s);
|
||||
e = trunc_page(e);
|
||||
if (e < s)
|
||||
e = s;
|
||||
sz = e - s;
|
||||
debugf("%08x-%08x = %x\n", s, e, sz);
|
||||
|
||||
/* Check whether some memory is left here. */
|
||||
if (sz == 0) {
|
||||
empty:
|
||||
printf("skipping\n");
|
||||
bcopy(mp + 1, mp,
|
||||
(cnt - (mp - availmem_regions)) * sizeof(*mp));
|
||||
cnt--;
|
||||
mp--;
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Do an insertion sort. */
|
||||
for (mp1 = availmem_regions; mp1 < mp; mp1++)
|
||||
if (s < mp1->mr_start)
|
||||
break;
|
||||
if (mp1 < mp) {
|
||||
bcopy(mp1, mp1 + 1, (char *)mp - (char *)mp1);
|
||||
mp1->mr_start = s;
|
||||
mp1->mr_size = sz;
|
||||
} else {
|
||||
mp->mr_start = s;
|
||||
mp->mr_size = sz;
|
||||
}
|
||||
}
|
||||
availmem_regions_sz = cnt;
|
||||
|
||||
/* Fill in phys_avail table, based on availmem_regions */
|
||||
debugf("fill in phys_avail:\n");
|
||||
for (i = 0, j = 0; i < availmem_regions_sz; i++, j += 2) {
|
||||
|
||||
debugf(" region: 0x%08x - 0x%08x (0x%08x)\n",
|
||||
availmem_regions[i].mr_start,
|
||||
availmem_regions[i].mr_start + availmem_regions[i].mr_size,
|
||||
availmem_regions[i].mr_size);
|
||||
|
||||
/*
|
||||
* We should not map the page at PA 0x0000000, the VM can't
|
||||
* handle it, as pmap_extract() == 0 means failure.
|
||||
*/
|
||||
if (availmem_regions[i].mr_start > 0 ||
|
||||
availmem_regions[i].mr_size > PAGE_SIZE) {
|
||||
phys_avail[j] = availmem_regions[i].mr_start;
|
||||
if (phys_avail[j] == 0)
|
||||
phys_avail[j] += PAGE_SIZE;
|
||||
phys_avail[j + 1] = availmem_regions[i].mr_start +
|
||||
availmem_regions[i].mr_size;
|
||||
} else
|
||||
j -= 2;
|
||||
}
|
||||
phys_avail[j] = 0;
|
||||
phys_avail[j + 1] = 0;
|
||||
}
|
||||
|
||||
void *
|
||||
initarm(struct arm_boot_params *abp)
|
||||
{
|
||||
struct pv_addr kernel_l1pt;
|
||||
struct pv_addr dpcpu;
|
||||
vm_offset_t dtbp, freemempos, l2_start, lastaddr;
|
||||
uint32_t memsize, l2size;
|
||||
char *env;
|
||||
void *kmdp;
|
||||
u_int l1pagetable;
|
||||
int i = 0, j = 0, err_devmap = 0;
|
||||
|
||||
lastaddr = parse_boot_param(abp);
|
||||
memsize = 0;
|
||||
set_cpufuncs();
|
||||
|
||||
/*
|
||||
* Find the dtb passed in by the boot loader.
|
||||
*/
|
||||
kmdp = preload_search_by_type("elf kernel");
|
||||
if (kmdp != NULL)
|
||||
dtbp = MD_FETCH(kmdp, MODINFOMD_DTBP, vm_offset_t);
|
||||
else
|
||||
dtbp = (vm_offset_t)NULL;
|
||||
|
||||
#if defined(FDT_DTB_STATIC)
|
||||
/*
|
||||
* In case the device tree blob was not retrieved (from metadata) try
|
||||
* to use the statically embedded one.
|
||||
*/
|
||||
if (dtbp == (vm_offset_t)NULL)
|
||||
dtbp = (vm_offset_t)&fdt_static_dtb;
|
||||
#endif
|
||||
|
||||
if (OF_install(OFW_FDT, 0) == FALSE)
|
||||
while (1);
|
||||
|
||||
if (OF_init((void *)dtbp) != 0)
|
||||
while (1);
|
||||
|
||||
/* Grab physical memory regions information from device tree. */
|
||||
if (fdt_get_mem_regions(availmem_regions, &availmem_regions_sz,
|
||||
&memsize) != 0)
|
||||
while(1);
|
||||
|
||||
/* Platform-specific initialisation */
|
||||
pmap_bootstrap_lastaddr = initarm_lastaddr();
|
||||
|
||||
pcpu0_init();
|
||||
|
||||
/* Calculate number of L2 tables needed for mapping vm_page_array */
|
||||
l2size = (memsize / PAGE_SIZE) * sizeof(struct vm_page);
|
||||
l2size = (l2size >> L1_S_SHIFT) + 1;
|
||||
|
||||
/*
|
||||
* Add one table for end of kernel map, one for stacks, msgbuf and
|
||||
* L1 and L2 tables map and one for vectors map.
|
||||
*/
|
||||
l2size += 3;
|
||||
|
||||
/* Make it divisible by 4 */
|
||||
l2size = (l2size + 3) & ~3;
|
||||
|
||||
#define KERNEL_TEXT_BASE (KERNBASE)
|
||||
freemempos = (lastaddr + PAGE_MASK) & ~PAGE_MASK;
|
||||
|
||||
/* Define a macro to simplify memory allocation */
|
||||
#define valloc_pages(var, np) \
|
||||
alloc_pages((var).pv_va, (np)); \
|
||||
(var).pv_pa = (var).pv_va + (KERNPHYSADDR - KERNVIRTADDR);
|
||||
|
||||
#define alloc_pages(var, np) \
|
||||
(var) = freemempos; \
|
||||
freemempos += (np * PAGE_SIZE); \
|
||||
memset((char *)(var), 0, ((np) * PAGE_SIZE));
|
||||
|
||||
while (((freemempos - L1_TABLE_SIZE) & (L1_TABLE_SIZE - 1)) != 0)
|
||||
freemempos += PAGE_SIZE;
|
||||
valloc_pages(kernel_l1pt, L1_TABLE_SIZE / PAGE_SIZE);
|
||||
|
||||
for (i = 0; i < l2size; ++i) {
|
||||
if (!(i % (PAGE_SIZE / L2_TABLE_SIZE_REAL))) {
|
||||
valloc_pages(kernel_pt_table[i],
|
||||
L2_TABLE_SIZE / PAGE_SIZE);
|
||||
j = i;
|
||||
} else {
|
||||
kernel_pt_table[i].pv_va = kernel_pt_table[j].pv_va +
|
||||
L2_TABLE_SIZE_REAL * (i - j);
|
||||
kernel_pt_table[i].pv_pa =
|
||||
kernel_pt_table[i].pv_va - KERNVIRTADDR +
|
||||
KERNPHYSADDR;
|
||||
|
||||
}
|
||||
}
|
||||
/*
|
||||
* Allocate a page for the system page mapped to 0x00000000
|
||||
* or 0xffff0000. This page will just contain the system vectors
|
||||
* and can be shared by all processes.
|
||||
*/
|
||||
valloc_pages(systempage, 1);
|
||||
|
||||
/* Allocate dynamic per-cpu area. */
|
||||
valloc_pages(dpcpu, DPCPU_SIZE / PAGE_SIZE);
|
||||
dpcpu_init((void *)dpcpu.pv_va, 0);
|
||||
|
||||
/* Allocate stacks for all modes */
|
||||
valloc_pages(irqstack, (IRQ_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(abtstack, (ABT_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(undstack, (UND_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(kernelstack, (KSTACK_PAGES * MAXCPU));
|
||||
|
||||
init_param1();
|
||||
|
||||
valloc_pages(msgbufpv, round_page(msgbufsize) / PAGE_SIZE);
|
||||
|
||||
/*
|
||||
* Now we start construction of the L1 page table
|
||||
* We start by mapping the L2 page tables into the L1.
|
||||
* This means that we can replace L1 mappings later on if necessary
|
||||
*/
|
||||
l1pagetable = kernel_l1pt.pv_va;
|
||||
|
||||
/*
|
||||
* Try to map as much as possible of kernel text and data using
|
||||
* 1MB section mapping and for the rest of initial kernel address
|
||||
* space use L2 coarse tables.
|
||||
*
|
||||
* Link L2 tables for mapping remainder of kernel (modulo 1MB)
|
||||
* and kernel structures
|
||||
*/
|
||||
l2_start = lastaddr & ~(L1_S_OFFSET);
|
||||
for (i = 0 ; i < l2size - 1; i++)
|
||||
pmap_link_l2pt(l1pagetable, l2_start + i * L1_S_SIZE,
|
||||
&kernel_pt_table[i]);
|
||||
|
||||
pmap_curmaxkvaddr = l2_start + (l2size - 1) * L1_S_SIZE;
|
||||
|
||||
/* Map kernel code and data */
|
||||
pmap_map_chunk(l1pagetable, KERNVIRTADDR, KERNPHYSADDR,
|
||||
(((uint32_t)(lastaddr) - KERNVIRTADDR) + PAGE_MASK) & ~PAGE_MASK,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
|
||||
/* Map L1 directory and allocated L2 page tables */
|
||||
pmap_map_chunk(l1pagetable, kernel_l1pt.pv_va, kernel_l1pt.pv_pa,
|
||||
L1_TABLE_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
pmap_map_chunk(l1pagetable, kernel_pt_table[0].pv_va,
|
||||
kernel_pt_table[0].pv_pa,
|
||||
L2_TABLE_SIZE_REAL * l2size,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
/* Map allocated DPCPU, stacks and msgbuf */
|
||||
pmap_map_chunk(l1pagetable, dpcpu.pv_va, dpcpu.pv_pa,
|
||||
freemempos - dpcpu.pv_va,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
/* Link and map the vector page */
|
||||
pmap_link_l2pt(l1pagetable, ARM_VECTORS_HIGH,
|
||||
&kernel_pt_table[l2size - 1]);
|
||||
pmap_map_entry(l1pagetable, ARM_VECTORS_HIGH, systempage.pv_pa,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
/* Map pmap_devmap[] entries */
|
||||
err_devmap = platform_devmap_init();
|
||||
pmap_devmap_bootstrap(l1pagetable, pmap_devmap_bootstrap_table);
|
||||
|
||||
cpu_domains((DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2)) |
|
||||
DOMAIN_CLIENT);
|
||||
pmap_pa = kernel_l1pt.pv_pa;
|
||||
setttb(kernel_l1pt.pv_pa);
|
||||
cpu_tlb_flushID();
|
||||
cpu_domains(DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2));
|
||||
|
||||
/*
|
||||
* Only after the SOC registers block is mapped we can perform device
|
||||
* tree fixups, as they may attempt to read parameters from hardware.
|
||||
*/
|
||||
OF_interpret("perform-fixup", 0);
|
||||
|
||||
initarm_gpio_init();
|
||||
|
||||
cninit();
|
||||
|
||||
physmem = memsize / PAGE_SIZE;
|
||||
|
||||
debugf("initarm: console initialized\n");
|
||||
debugf(" arg1 kmdp = 0x%08x\n", (uint32_t)kmdp);
|
||||
debugf(" boothowto = 0x%08x\n", boothowto);
|
||||
debugf(" dtbp = 0x%08x\n", (uint32_t)dtbp);
|
||||
print_kernel_section_addr();
|
||||
print_kenv();
|
||||
|
||||
env = getenv("kernelname");
|
||||
if (env != NULL)
|
||||
strlcpy(kernelname, env, sizeof(kernelname));
|
||||
|
||||
if (err_devmap != 0)
|
||||
printf("WARNING: could not fully configure devmap, error=%d\n",
|
||||
err_devmap);
|
||||
|
||||
initarm_late_init();
|
||||
|
||||
/*
|
||||
* Pages were allocated during the secondary bootstrap for the
|
||||
* stacks for different CPU modes.
|
||||
* We must now set the r13 registers in the different CPU modes to
|
||||
* point to these stacks.
|
||||
* Since the ARM stacks use STMFD etc. we must set r13 to the top end
|
||||
* of the stack memory.
|
||||
*/
|
||||
cpu_control(CPU_CONTROL_MMU_ENABLE, CPU_CONTROL_MMU_ENABLE);
|
||||
|
||||
set_stackptrs(0);
|
||||
|
||||
/*
|
||||
* We must now clean the cache again....
|
||||
* Cleaning may be done by reading new data to displace any
|
||||
* dirty data in the cache. This will have happened in setttb()
|
||||
* but since we are boot strapping the addresses used for the read
|
||||
* may have just been remapped and thus the cache could be out
|
||||
* of sync. A re-clean after the switch will cure this.
|
||||
* After booting there are no gross relocations of the kernel thus
|
||||
* this problem will not occur after initarm().
|
||||
*/
|
||||
cpu_idcache_wbinv_all();
|
||||
|
||||
/* Set stack for exception handlers */
|
||||
data_abort_handler_address = (u_int)data_abort_handler;
|
||||
prefetch_abort_handler_address = (u_int)prefetch_abort_handler;
|
||||
undefined_handler_address = (u_int)undefinedinstruction_bounce;
|
||||
undefined_init();
|
||||
|
||||
init_proc0(kernelstack.pv_va);
|
||||
|
||||
arm_vector_init(ARM_VECTORS_HIGH, ARM_VEC_ALL);
|
||||
arm_dump_avail_init(memsize, sizeof(dump_avail) / sizeof(dump_avail[0]));
|
||||
pmap_bootstrap(freemempos, pmap_bootstrap_lastaddr, &kernel_l1pt);
|
||||
msgbufp = (void *)msgbufpv.pv_va;
|
||||
msgbufinit(msgbufp, msgbufsize);
|
||||
mutex_init();
|
||||
|
||||
/*
|
||||
* Prepare map of physical memory regions available to vm subsystem.
|
||||
*/
|
||||
physmap_init();
|
||||
|
||||
/* Do basic tuning, hz etc */
|
||||
init_param2(physmem);
|
||||
kdb_init();
|
||||
|
||||
return ((void *)(kernelstack.pv_va + USPACE_SVC_STACK_TOP -
|
||||
sizeof(struct pcb)));
|
||||
}
|
||||
|
||||
vm_offset_t
|
||||
initarm_lastaddr(void)
|
||||
{
|
||||
@ -589,7 +94,7 @@ static struct pmap_devmap fdt_devmap[FDT_DEVMAP_MAX] = {
|
||||
/*
|
||||
* Construct pmap_devmap[] with DT-derived config data.
|
||||
*/
|
||||
static int
|
||||
int
|
||||
platform_devmap_init(void)
|
||||
{
|
||||
|
||||
@ -634,3 +139,4 @@ cpu_reset(void)
|
||||
|
||||
for (;;);
|
||||
}
|
||||
|
||||
|
@ -44,507 +44,24 @@ __FBSDID("$FreeBSD$");
|
||||
#define _ARM32_BUS_DMA_PRIVATE
|
||||
#include <sys/param.h>
|
||||
#include <sys/systm.h>
|
||||
#include <sys/sysproto.h>
|
||||
#include <sys/signalvar.h>
|
||||
#include <sys/imgact.h>
|
||||
#include <sys/kernel.h>
|
||||
#include <sys/ktr.h>
|
||||
#include <sys/linker.h>
|
||||
#include <sys/lock.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/mutex.h>
|
||||
#include <sys/pcpu.h>
|
||||
#include <sys/proc.h>
|
||||
#include <sys/ptrace.h>
|
||||
#include <sys/cons.h>
|
||||
#include <sys/bio.h>
|
||||
#include <sys/bus.h>
|
||||
#include <sys/buf.h>
|
||||
#include <sys/exec.h>
|
||||
#include <sys/kdb.h>
|
||||
#include <sys/msgbuf.h>
|
||||
#include <machine/reg.h>
|
||||
#include <machine/cpu.h>
|
||||
#include <machine/fdt.h>
|
||||
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
#include <dev/ofw/openfirm.h>
|
||||
|
||||
#include <vm/vm.h>
|
||||
#include <vm/pmap.h>
|
||||
#include <vm/vm_object.h>
|
||||
#include <vm/vm_page.h>
|
||||
#include <vm/vm_pager.h>
|
||||
#include <vm/vm_map.h>
|
||||
#include <machine/pte.h>
|
||||
#include <machine/pmap.h>
|
||||
#include <machine/vmparam.h>
|
||||
#include <machine/pcb.h>
|
||||
#include <machine/undefined.h>
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/metadata.h>
|
||||
#include <machine/armreg.h>
|
||||
|
||||
#include <machine/bus.h>
|
||||
#include <sys/reboot.h>
|
||||
#include <machine/frame.h> /* For trapframe_t, used in <machine/machdep.h> */
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/pmap.h>
|
||||
|
||||
#include <arm/mv/mvreg.h> /* XXX */
|
||||
#include <arm/mv/mvvar.h> /* XXX eventually this should be eliminated */
|
||||
#include <arm/mv/mvwin.h>
|
||||
|
||||
#ifdef DEBUG
|
||||
#define debugf(fmt, args...) printf(fmt, ##args)
|
||||
#else
|
||||
#define debugf(fmt, args...)
|
||||
#endif
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
|
||||
/*
|
||||
* This is the number of L2 page tables required for covering max
|
||||
* (hypothetical) memsize of 4GB and all kernel mappings (vectors, msgbuf,
|
||||
* stacks etc.), uprounded to be divisible by 4.
|
||||
*/
|
||||
#define KERNEL_PT_MAX 78
|
||||
|
||||
extern unsigned char kernbase[];
|
||||
extern unsigned char _etext[];
|
||||
extern unsigned char _edata[];
|
||||
extern unsigned char __bss_start[];
|
||||
extern unsigned char _end[];
|
||||
|
||||
extern u_int data_abort_handler_address;
|
||||
extern u_int prefetch_abort_handler_address;
|
||||
extern u_int undefined_handler_address;
|
||||
|
||||
extern vm_offset_t pmap_bootstrap_lastaddr;
|
||||
|
||||
struct pv_addr kernel_pt_table[KERNEL_PT_MAX];
|
||||
|
||||
/* Physical and virtual addresses for some global pages */
|
||||
vm_paddr_t phys_avail[10];
|
||||
vm_paddr_t dump_avail[4];
|
||||
vm_offset_t pmap_bootstrap_lastaddr;
|
||||
vm_paddr_t pmap_pa;
|
||||
|
||||
const struct pmap_devmap *pmap_devmap_bootstrap_table;
|
||||
struct pv_addr systempage;
|
||||
struct pv_addr msgbufpv;
|
||||
struct pv_addr irqstack;
|
||||
struct pv_addr undstack;
|
||||
struct pv_addr abtstack;
|
||||
struct pv_addr kernelstack;
|
||||
|
||||
static struct mem_region availmem_regions[FDT_MEM_REGIONS];
|
||||
static int availmem_regions_sz;
|
||||
|
||||
static void print_kenv(void);
|
||||
static void print_kernel_section_addr(void);
|
||||
|
||||
static void physmap_init(void);
|
||||
static int platform_devmap_init(void);
|
||||
static int platform_mpp_init(void);
|
||||
|
||||
static char *
|
||||
kenv_next(char *cp)
|
||||
{
|
||||
|
||||
if (cp != NULL) {
|
||||
while (*cp != 0)
|
||||
cp++;
|
||||
cp++;
|
||||
if (*cp == 0)
|
||||
cp = NULL;
|
||||
}
|
||||
return (cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kenv(void)
|
||||
{
|
||||
int len;
|
||||
char *cp;
|
||||
|
||||
debugf("loader passed (static) kenv:\n");
|
||||
if (kern_envp == NULL) {
|
||||
debugf(" no env, null ptr\n");
|
||||
return;
|
||||
}
|
||||
debugf(" kern_envp = 0x%08x\n", (uint32_t)kern_envp);
|
||||
|
||||
len = 0;
|
||||
for (cp = kern_envp; cp != NULL; cp = kenv_next(cp))
|
||||
debugf(" %x %s\n", (uint32_t)cp, cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kernel_section_addr(void)
|
||||
{
|
||||
|
||||
debugf("kernel image addresses:\n");
|
||||
debugf(" kernbase = 0x%08x\n", (uint32_t)kernbase);
|
||||
debugf(" _etext (sdata) = 0x%08x\n", (uint32_t)_etext);
|
||||
debugf(" _edata = 0x%08x\n", (uint32_t)_edata);
|
||||
debugf(" __bss_start = 0x%08x\n", (uint32_t)__bss_start);
|
||||
debugf(" _end = 0x%08x\n", (uint32_t)_end);
|
||||
}
|
||||
|
||||
static void
|
||||
physmap_init(void)
|
||||
{
|
||||
int i, j, cnt;
|
||||
vm_offset_t phys_kernelend, kernload;
|
||||
uint32_t s, e, sz;
|
||||
struct mem_region *mp, *mp1;
|
||||
|
||||
phys_kernelend = KERNPHYSADDR + (virtual_avail - KERNVIRTADDR);
|
||||
kernload = KERNPHYSADDR;
|
||||
|
||||
/*
|
||||
* Remove kernel physical address range from avail
|
||||
* regions list. Page align all regions.
|
||||
* Non-page aligned memory isn't very interesting to us.
|
||||
* Also, sort the entries for ascending addresses.
|
||||
*/
|
||||
sz = 0;
|
||||
cnt = availmem_regions_sz;
|
||||
debugf("processing avail regions:\n");
|
||||
for (mp = availmem_regions; mp->mr_size; mp++) {
|
||||
s = mp->mr_start;
|
||||
e = mp->mr_start + mp->mr_size;
|
||||
debugf(" %08x-%08x -> ", s, e);
|
||||
/* Check whether this region holds all of the kernel. */
|
||||
if (s < kernload && e > phys_kernelend) {
|
||||
availmem_regions[cnt].mr_start = phys_kernelend;
|
||||
availmem_regions[cnt++].mr_size = e - phys_kernelend;
|
||||
e = kernload;
|
||||
}
|
||||
/* Look whether this regions starts within the kernel. */
|
||||
if (s >= kernload && s < phys_kernelend) {
|
||||
if (e <= phys_kernelend)
|
||||
goto empty;
|
||||
s = phys_kernelend;
|
||||
}
|
||||
/* Now look whether this region ends within the kernel. */
|
||||
if (e > kernload && e <= phys_kernelend) {
|
||||
if (s >= kernload) {
|
||||
goto empty;
|
||||
}
|
||||
e = kernload;
|
||||
}
|
||||
/* Now page align the start and size of the region. */
|
||||
s = round_page(s);
|
||||
e = trunc_page(e);
|
||||
if (e < s)
|
||||
e = s;
|
||||
sz = e - s;
|
||||
debugf("%08x-%08x = %x\n", s, e, sz);
|
||||
|
||||
/* Check whether some memory is left here. */
|
||||
if (sz == 0) {
|
||||
empty:
|
||||
printf("skipping\n");
|
||||
bcopy(mp + 1, mp,
|
||||
(cnt - (mp - availmem_regions)) * sizeof(*mp));
|
||||
cnt--;
|
||||
mp--;
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Do an insertion sort. */
|
||||
for (mp1 = availmem_regions; mp1 < mp; mp1++)
|
||||
if (s < mp1->mr_start)
|
||||
break;
|
||||
if (mp1 < mp) {
|
||||
bcopy(mp1, mp1 + 1, (char *)mp - (char *)mp1);
|
||||
mp1->mr_start = s;
|
||||
mp1->mr_size = sz;
|
||||
} else {
|
||||
mp->mr_start = s;
|
||||
mp->mr_size = sz;
|
||||
}
|
||||
}
|
||||
availmem_regions_sz = cnt;
|
||||
|
||||
/* Fill in phys_avail table, based on availmem_regions */
|
||||
debugf("fill in phys_avail:\n");
|
||||
for (i = 0, j = 0; i < availmem_regions_sz; i++, j += 2) {
|
||||
|
||||
debugf(" region: 0x%08x - 0x%08x (0x%08x)\n",
|
||||
availmem_regions[i].mr_start,
|
||||
availmem_regions[i].mr_start + availmem_regions[i].mr_size,
|
||||
availmem_regions[i].mr_size);
|
||||
|
||||
/*
|
||||
* We should not map the page at PA 0x0000000, the VM can't
|
||||
* handle it, as pmap_extract() == 0 means failure.
|
||||
*/
|
||||
if (availmem_regions[i].mr_start > 0 ||
|
||||
availmem_regions[i].mr_size > PAGE_SIZE) {
|
||||
phys_avail[j] = availmem_regions[i].mr_start;
|
||||
if (phys_avail[j] == 0)
|
||||
phys_avail[j] += PAGE_SIZE;
|
||||
phys_avail[j + 1] = availmem_regions[i].mr_start +
|
||||
availmem_regions[i].mr_size;
|
||||
} else
|
||||
j -= 2;
|
||||
}
|
||||
phys_avail[j] = 0;
|
||||
phys_avail[j + 1] = 0;
|
||||
}
|
||||
|
||||
void *
|
||||
initarm(struct arm_boot_params *abp)
|
||||
{
|
||||
struct pv_addr kernel_l1pt;
|
||||
struct pv_addr dpcpu;
|
||||
vm_offset_t dtbp, freemempos, l2_start, lastaddr;
|
||||
uint32_t memsize, l2size;
|
||||
char *env;
|
||||
void *kmdp;
|
||||
u_int l1pagetable;
|
||||
int i = 0, j = 0, err_devmap = 0;
|
||||
|
||||
lastaddr = parse_boot_param(abp);
|
||||
memsize = 0;
|
||||
set_cpufuncs();
|
||||
|
||||
/*
|
||||
* Find the dtb passed in by the boot loader.
|
||||
*/
|
||||
kmdp = preload_search_by_type("elf kernel");
|
||||
if (kmdp != NULL)
|
||||
dtbp = MD_FETCH(kmdp, MODINFOMD_DTBP, vm_offset_t);
|
||||
else
|
||||
dtbp = (vm_offset_t)NULL;
|
||||
|
||||
#if defined(FDT_DTB_STATIC)
|
||||
/*
|
||||
* In case the device tree blob was not retrieved (from metadata) try
|
||||
* to use the statically embedded one.
|
||||
*/
|
||||
if (dtbp == (vm_offset_t)NULL)
|
||||
dtbp = (vm_offset_t)&fdt_static_dtb;
|
||||
#endif
|
||||
|
||||
if (OF_install(OFW_FDT, 0) == FALSE)
|
||||
while (1);
|
||||
|
||||
if (OF_init((void *)dtbp) != 0)
|
||||
while (1);
|
||||
|
||||
/* Grab physical memory regions information from device tree. */
|
||||
if (fdt_get_mem_regions(availmem_regions, &availmem_regions_sz,
|
||||
&memsize) != 0)
|
||||
while(1);
|
||||
|
||||
/* Platform-specific initialisation */
|
||||
pmap_bootstrap_lastaddr = initarm_lastaddr();
|
||||
|
||||
pcpu0_init();
|
||||
|
||||
/* Calculate number of L2 tables needed for mapping vm_page_array */
|
||||
l2size = (memsize / PAGE_SIZE) * sizeof(struct vm_page);
|
||||
l2size = (l2size >> L1_S_SHIFT) + 1;
|
||||
|
||||
/*
|
||||
* Add one table for end of kernel map, one for stacks, msgbuf and
|
||||
* L1 and L2 tables map and one for vectors map.
|
||||
*/
|
||||
l2size += 3;
|
||||
|
||||
/* Make it divisible by 4 */
|
||||
l2size = (l2size + 3) & ~3;
|
||||
|
||||
#define KERNEL_TEXT_BASE (KERNBASE)
|
||||
freemempos = (lastaddr + PAGE_MASK) & ~PAGE_MASK;
|
||||
|
||||
/* Define a macro to simplify memory allocation */
|
||||
#define valloc_pages(var, np) \
|
||||
alloc_pages((var).pv_va, (np)); \
|
||||
(var).pv_pa = (var).pv_va + (KERNPHYSADDR - KERNVIRTADDR);
|
||||
|
||||
#define alloc_pages(var, np) \
|
||||
(var) = freemempos; \
|
||||
freemempos += (np * PAGE_SIZE); \
|
||||
memset((char *)(var), 0, ((np) * PAGE_SIZE));
|
||||
|
||||
while (((freemempos - L1_TABLE_SIZE) & (L1_TABLE_SIZE - 1)) != 0)
|
||||
freemempos += PAGE_SIZE;
|
||||
valloc_pages(kernel_l1pt, L1_TABLE_SIZE / PAGE_SIZE);
|
||||
|
||||
for (i = 0; i < l2size; ++i) {
|
||||
if (!(i % (PAGE_SIZE / L2_TABLE_SIZE_REAL))) {
|
||||
valloc_pages(kernel_pt_table[i],
|
||||
L2_TABLE_SIZE / PAGE_SIZE);
|
||||
j = i;
|
||||
} else {
|
||||
kernel_pt_table[i].pv_va = kernel_pt_table[j].pv_va +
|
||||
L2_TABLE_SIZE_REAL * (i - j);
|
||||
kernel_pt_table[i].pv_pa =
|
||||
kernel_pt_table[i].pv_va - KERNVIRTADDR +
|
||||
KERNPHYSADDR;
|
||||
|
||||
}
|
||||
}
|
||||
/*
|
||||
* Allocate a page for the system page mapped to 0x00000000
|
||||
* or 0xffff0000. This page will just contain the system vectors
|
||||
* and can be shared by all processes.
|
||||
*/
|
||||
valloc_pages(systempage, 1);
|
||||
|
||||
/* Allocate dynamic per-cpu area. */
|
||||
valloc_pages(dpcpu, DPCPU_SIZE / PAGE_SIZE);
|
||||
dpcpu_init((void *)dpcpu.pv_va, 0);
|
||||
|
||||
/* Allocate stacks for all modes */
|
||||
valloc_pages(irqstack, (IRQ_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(abtstack, (ABT_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(undstack, (UND_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(kernelstack, (KSTACK_PAGES * MAXCPU));
|
||||
|
||||
init_param1();
|
||||
|
||||
valloc_pages(msgbufpv, round_page(msgbufsize) / PAGE_SIZE);
|
||||
|
||||
/*
|
||||
* Now we start construction of the L1 page table
|
||||
* We start by mapping the L2 page tables into the L1.
|
||||
* This means that we can replace L1 mappings later on if necessary
|
||||
*/
|
||||
l1pagetable = kernel_l1pt.pv_va;
|
||||
|
||||
/*
|
||||
* Try to map as much as possible of kernel text and data using
|
||||
* 1MB section mapping and for the rest of initial kernel address
|
||||
* space use L2 coarse tables.
|
||||
*
|
||||
* Link L2 tables for mapping remainder of kernel (modulo 1MB)
|
||||
* and kernel structures
|
||||
*/
|
||||
l2_start = lastaddr & ~(L1_S_OFFSET);
|
||||
for (i = 0 ; i < l2size - 1; i++)
|
||||
pmap_link_l2pt(l1pagetable, l2_start + i * L1_S_SIZE,
|
||||
&kernel_pt_table[i]);
|
||||
|
||||
pmap_curmaxkvaddr = l2_start + (l2size - 1) * L1_S_SIZE;
|
||||
|
||||
/* Map kernel code and data */
|
||||
pmap_map_chunk(l1pagetable, KERNVIRTADDR, KERNPHYSADDR,
|
||||
(((uint32_t)(lastaddr) - KERNVIRTADDR) + PAGE_MASK) & ~PAGE_MASK,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
|
||||
/* Map L1 directory and allocated L2 page tables */
|
||||
pmap_map_chunk(l1pagetable, kernel_l1pt.pv_va, kernel_l1pt.pv_pa,
|
||||
L1_TABLE_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
pmap_map_chunk(l1pagetable, kernel_pt_table[0].pv_va,
|
||||
kernel_pt_table[0].pv_pa,
|
||||
L2_TABLE_SIZE_REAL * l2size,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
/* Map allocated DPCPU, stacks and msgbuf */
|
||||
pmap_map_chunk(l1pagetable, dpcpu.pv_va, dpcpu.pv_pa,
|
||||
freemempos - dpcpu.pv_va,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
/* Link and map the vector page */
|
||||
pmap_link_l2pt(l1pagetable, ARM_VECTORS_HIGH,
|
||||
&kernel_pt_table[l2size - 1]);
|
||||
pmap_map_entry(l1pagetable, ARM_VECTORS_HIGH, systempage.pv_pa,
|
||||
VM_PROT_READ|VM_PROT_WRITE|VM_PROT_EXECUTE, PTE_CACHE);
|
||||
|
||||
/* Map pmap_devmap[] entries */
|
||||
err_devmap = platform_devmap_init();
|
||||
pmap_devmap_bootstrap(l1pagetable, pmap_devmap_bootstrap_table);
|
||||
|
||||
cpu_domains((DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2)) |
|
||||
DOMAIN_CLIENT);
|
||||
pmap_pa = kernel_l1pt.pv_pa;
|
||||
setttb(kernel_l1pt.pv_pa);
|
||||
cpu_tlb_flushID();
|
||||
cpu_domains(DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2));
|
||||
|
||||
/*
|
||||
* Only after the SOC registers block is mapped we can perform device
|
||||
* tree fixups, as they may attempt to read parameters from hardware.
|
||||
*/
|
||||
OF_interpret("perform-fixup", 0);
|
||||
|
||||
initarm_gpio_init();
|
||||
|
||||
cninit();
|
||||
|
||||
physmem = memsize / PAGE_SIZE;
|
||||
|
||||
debugf("initarm: console initialized\n");
|
||||
debugf(" arg1 kmdp = 0x%08x\n", (uint32_t)kmdp);
|
||||
debugf(" boothowto = 0x%08x\n", boothowto);
|
||||
debugf(" dtbp = 0x%08x\n", (uint32_t)dtbp);
|
||||
print_kernel_section_addr();
|
||||
print_kenv();
|
||||
|
||||
env = getenv("kernelname");
|
||||
if (env != NULL)
|
||||
strlcpy(kernelname, env, sizeof(kernelname));
|
||||
|
||||
if (err_devmap != 0)
|
||||
printf("WARNING: could not fully configure devmap, error=%d\n",
|
||||
err_devmap);
|
||||
|
||||
initarm_late_init();
|
||||
|
||||
/*
|
||||
* Pages were allocated during the secondary bootstrap for the
|
||||
* stacks for different CPU modes.
|
||||
* We must now set the r13 registers in the different CPU modes to
|
||||
* point to these stacks.
|
||||
* Since the ARM stacks use STMFD etc. we must set r13 to the top end
|
||||
* of the stack memory.
|
||||
*/
|
||||
cpu_control(CPU_CONTROL_MMU_ENABLE, CPU_CONTROL_MMU_ENABLE);
|
||||
|
||||
set_stackptrs(0);
|
||||
|
||||
/*
|
||||
* We must now clean the cache again....
|
||||
* Cleaning may be done by reading new data to displace any
|
||||
* dirty data in the cache. This will have happened in setttb()
|
||||
* but since we are boot strapping the addresses used for the read
|
||||
* may have just been remapped and thus the cache could be out
|
||||
* of sync. A re-clean after the switch will cure this.
|
||||
* After booting there are no gross relocations of the kernel thus
|
||||
* this problem will not occur after initarm().
|
||||
*/
|
||||
cpu_idcache_wbinv_all();
|
||||
|
||||
/* Set stack for exception handlers */
|
||||
data_abort_handler_address = (u_int)data_abort_handler;
|
||||
prefetch_abort_handler_address = (u_int)prefetch_abort_handler;
|
||||
undefined_handler_address = (u_int)undefinedinstruction_bounce;
|
||||
undefined_init();
|
||||
|
||||
init_proc0(kernelstack.pv_va);
|
||||
|
||||
arm_vector_init(ARM_VECTORS_HIGH, ARM_VEC_ALL);
|
||||
arm_dump_avail_init(memsize, sizeof(dump_avail) / sizeof(dump_avail[0]));
|
||||
pmap_bootstrap(freemempos, pmap_bootstrap_lastaddr, &kernel_l1pt);
|
||||
msgbufp = (void *)msgbufpv.pv_va;
|
||||
msgbufinit(msgbufp, msgbufsize);
|
||||
mutex_init();
|
||||
|
||||
/*
|
||||
* Prepare map of physical memory regions available to vm subsystem.
|
||||
*/
|
||||
physmap_init();
|
||||
|
||||
/* Do basic tuning, hz etc */
|
||||
init_param2(physmem);
|
||||
kdb_init();
|
||||
|
||||
return ((void *)(kernelstack.pv_va + USPACE_SVC_STACK_TOP -
|
||||
sizeof(struct pcb)));
|
||||
}
|
||||
|
||||
#define MPP_PIN_MAX 68
|
||||
#define MPP_PIN_CELLS 2
|
||||
#define MPP_PINS_PER_REG 8
|
||||
@ -769,8 +286,7 @@ platform_sram_devmap(struct pmap_devmap *map)
|
||||
/*
|
||||
* Construct pmap_devmap[] with DT-derived config data.
|
||||
*/
|
||||
|
||||
static int
|
||||
int
|
||||
platform_devmap_init(void)
|
||||
{
|
||||
phandle_t root, child;
|
||||
|
@ -39,258 +39,23 @@ __FBSDID("$FreeBSD$");
|
||||
#define _ARM32_BUS_DMA_PRIVATE
|
||||
#include <sys/param.h>
|
||||
#include <sys/systm.h>
|
||||
#include <sys/sysproto.h>
|
||||
#include <sys/signalvar.h>
|
||||
#include <sys/imgact.h>
|
||||
#include <sys/kernel.h>
|
||||
#include <sys/ktr.h>
|
||||
#include <sys/linker.h>
|
||||
#include <sys/lock.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/mutex.h>
|
||||
#include <sys/pcpu.h>
|
||||
#include <sys/proc.h>
|
||||
#include <sys/ptrace.h>
|
||||
#include <sys/cons.h>
|
||||
#include <sys/bio.h>
|
||||
#include <sys/bus.h>
|
||||
#include <sys/buf.h>
|
||||
#include <sys/exec.h>
|
||||
#include <sys/kdb.h>
|
||||
#include <sys/msgbuf.h>
|
||||
#include <machine/reg.h>
|
||||
#include <machine/cpu.h>
|
||||
#include <machine/fdt.h>
|
||||
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
#include <dev/ofw/openfirm.h>
|
||||
|
||||
#include <vm/vm.h>
|
||||
#include <vm/pmap.h>
|
||||
#include <vm/vm_object.h>
|
||||
#include <vm/vm_page.h>
|
||||
#include <vm/vm_pager.h>
|
||||
#include <vm/vm_map.h>
|
||||
#include <vm/vnode_pager.h>
|
||||
#include <machine/pmap.h>
|
||||
#include <machine/vmparam.h>
|
||||
#include <machine/pcb.h>
|
||||
#include <machine/undefined.h>
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/metadata.h>
|
||||
#include <machine/armreg.h>
|
||||
|
||||
#include <machine/bus.h>
|
||||
#include <sys/reboot.h>
|
||||
#include <machine/frame.h> /* For trapframe_t, used in <machine/machdep.h> */
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/pmap.h>
|
||||
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
|
||||
/* FIXME move to tegrareg.h */
|
||||
#define TEGRA2_BASE 0xE0000000 /* KVM base for peripherials */
|
||||
#define TEGRA2_UARTA_VA_BASE 0xE0006000
|
||||
#define TEGRA2_UARTA_PA_BASE 0x70006000
|
||||
|
||||
|
||||
|
||||
|
||||
|
||||
#define KERNEL_PT_MAX 78
|
||||
|
||||
#define debugf(fmt, args...) printf(fmt, ##args)
|
||||
|
||||
#define KERNEL_PT_SYS 0 /* Page table for mapping proc0 zero page */
|
||||
#define KERNEL_PT_KERN 1
|
||||
#define KERNEL_PT_KERN_NUM 22
|
||||
#define KERNEL_PT_AFKERNEL KERNEL_PT_KERN + KERNEL_PT_KERN_NUM /* L2 table for mapping after kernel */
|
||||
#define KERNEL_PT_AFKERNEL_NUM 5
|
||||
|
||||
/* this should be evenly divisable by PAGE_SIZE / L2_TABLE_SIZE_REAL (or 4) */
|
||||
#define NUM_KERNEL_PTS (KERNEL_PT_AFKERNEL + KERNEL_PT_AFKERNEL_NUM)
|
||||
|
||||
#ifdef DDB
|
||||
extern vm_offset_t ksym_start, ksym_end;
|
||||
#endif
|
||||
|
||||
|
||||
extern unsigned char kernbase[];
|
||||
extern unsigned char _etext[];
|
||||
extern unsigned char _edata[];
|
||||
extern unsigned char __bss_start[];
|
||||
extern unsigned char _end[];
|
||||
|
||||
extern u_int data_abort_handler_address;
|
||||
extern u_int prefetch_abort_handler_address;
|
||||
extern u_int undefined_handler_address;
|
||||
|
||||
struct pv_addr kernel_pt_table[KERNEL_PT_MAX];
|
||||
|
||||
/* Physical and virtual addresses for some global pages */
|
||||
vm_paddr_t phys_avail[10];
|
||||
vm_paddr_t dump_avail[4];
|
||||
|
||||
static struct mem_region availmem_regions[FDT_MEM_REGIONS];
|
||||
static int availmem_regions_sz;
|
||||
|
||||
extern vm_offset_t pmap_bootstrap_lastaddr;
|
||||
|
||||
vm_offset_t pmap_bootstrap_lastaddr;
|
||||
vm_paddr_t pmap_pa;
|
||||
|
||||
const struct pmap_devmap *pmap_devmap_bootstrap_table;
|
||||
struct pv_addr systempage;
|
||||
struct pv_addr msgbufpv;
|
||||
struct pv_addr irqstack;
|
||||
struct pv_addr undstack;
|
||||
struct pv_addr abtstack;
|
||||
static struct pv_addr kernelstack;
|
||||
|
||||
static int platform_devmap_init(void);
|
||||
|
||||
static char *
|
||||
kenv_next(char *cp)
|
||||
{
|
||||
|
||||
if (cp != NULL) {
|
||||
while (*cp != 0)
|
||||
cp++;
|
||||
cp++;
|
||||
if (*cp == 0)
|
||||
cp = NULL;
|
||||
}
|
||||
return (cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kenv(void)
|
||||
{
|
||||
int len;
|
||||
char *cp;
|
||||
|
||||
debugf("loader passed (static) kenv:\n");
|
||||
if (kern_envp == NULL) {
|
||||
debugf(" no env, null ptr\n");
|
||||
return;
|
||||
}
|
||||
debugf(" kern_envp = 0x%08x\n", (uint32_t)kern_envp);
|
||||
|
||||
len = 0;
|
||||
for (cp = kern_envp; cp != NULL; cp = kenv_next(cp))
|
||||
debugf(" %x %s\n", (uint32_t)cp, cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kernel_section_addr(void)
|
||||
{
|
||||
|
||||
debugf("kernel image addresses:\n");
|
||||
debugf(" kernbase = 0x%08x\n", (uint32_t)kernbase);
|
||||
debugf(" _etext (sdata) = 0x%08x\n", (uint32_t)_etext);
|
||||
debugf(" _edata = 0x%08x\n", (uint32_t)_edata);
|
||||
debugf(" __bss_start = 0x%08x\n", (uint32_t)__bss_start);
|
||||
debugf(" _end = 0x%08x\n", (uint32_t)_end);
|
||||
}
|
||||
|
||||
static void
|
||||
physmap_init(void)
|
||||
{
|
||||
int i, j, cnt;
|
||||
vm_offset_t phys_kernelend, kernload;
|
||||
uint32_t s, e, sz;
|
||||
struct mem_region *mp, *mp1;
|
||||
|
||||
phys_kernelend = KERNPHYSADDR + (virtual_avail - KERNVIRTADDR);
|
||||
kernload = KERNPHYSADDR;
|
||||
|
||||
/*
|
||||
* Remove kernel physical address range from avail
|
||||
* regions list. Page align all regions.
|
||||
* Non-page aligned memory isn't very interesting to us.
|
||||
* Also, sort the entries for ascending addresses.
|
||||
*/
|
||||
sz = 0;
|
||||
cnt = availmem_regions_sz;
|
||||
debugf("processing avail regions:\n");
|
||||
for (mp = availmem_regions; mp->mr_size; mp++) {
|
||||
s = mp->mr_start;
|
||||
e = mp->mr_start + mp->mr_size;
|
||||
debugf(" %08x-%08x -> ", s, e);
|
||||
/* Check whether this region holds all of the kernel. */
|
||||
if (s < kernload && e > phys_kernelend) {
|
||||
availmem_regions[cnt].mr_start = phys_kernelend;
|
||||
availmem_regions[cnt++].mr_size = e - phys_kernelend;
|
||||
e = kernload;
|
||||
}
|
||||
/* Look whether this regions starts within the kernel. */
|
||||
if (s >= kernload && s < phys_kernelend) {
|
||||
if (e <= phys_kernelend)
|
||||
goto empty;
|
||||
s = phys_kernelend;
|
||||
}
|
||||
/* Now look whether this region ends within the kernel. */
|
||||
if (e > kernload && e <= phys_kernelend) {
|
||||
if (s >= kernload) {
|
||||
goto empty;
|
||||
}
|
||||
e = kernload;
|
||||
}
|
||||
/* Now page align the start and size of the region. */
|
||||
s = round_page(s);
|
||||
e = trunc_page(e);
|
||||
if (e < s)
|
||||
e = s;
|
||||
sz = e - s;
|
||||
debugf("%08x-%08x = %x\n", s, e, sz);
|
||||
|
||||
/* Check whether some memory is left here. */
|
||||
if (sz == 0) {
|
||||
empty:
|
||||
printf("skipping\n");
|
||||
bcopy(mp + 1, mp,
|
||||
(cnt - (mp - availmem_regions)) * sizeof(*mp));
|
||||
cnt--;
|
||||
mp--;
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Do an insertion sort. */
|
||||
for (mp1 = availmem_regions; mp1 < mp; mp1++)
|
||||
if (s < mp1->mr_start)
|
||||
break;
|
||||
if (mp1 < mp) {
|
||||
bcopy(mp1, mp1 + 1, (char *)mp - (char *)mp1);
|
||||
mp1->mr_start = s;
|
||||
mp1->mr_size = sz;
|
||||
} else {
|
||||
mp->mr_start = s;
|
||||
mp->mr_size = sz;
|
||||
}
|
||||
}
|
||||
availmem_regions_sz = cnt;
|
||||
|
||||
/* Fill in phys_avail table, based on availmem_regions */
|
||||
debugf("fill in phys_avail:\n");
|
||||
for (i = 0, j = 0; i < availmem_regions_sz; i++, j += 2) {
|
||||
|
||||
debugf(" region: 0x%08x - 0x%08x (0x%08x)\n",
|
||||
availmem_regions[i].mr_start,
|
||||
availmem_regions[i].mr_start + availmem_regions[i].mr_size,
|
||||
availmem_regions[i].mr_size);
|
||||
|
||||
/*
|
||||
* We should not map the page at PA 0x0000000, the VM can't
|
||||
* handle it, as pmap_extract() == 0 means failure.
|
||||
*/
|
||||
if (availmem_regions[i].mr_start > 0 ||
|
||||
availmem_regions[i].mr_size > PAGE_SIZE) {
|
||||
phys_avail[j] = availmem_regions[i].mr_start;
|
||||
if (phys_avail[j] == 0)
|
||||
phys_avail[j] += PAGE_SIZE;
|
||||
phys_avail[j + 1] = availmem_regions[i].mr_start +
|
||||
availmem_regions[i].mr_size;
|
||||
} else
|
||||
j -= 2;
|
||||
}
|
||||
phys_avail[j] = 0;
|
||||
phys_avail[j + 1] = 0;
|
||||
}
|
||||
|
||||
#define TEGRA2_CLK_RST_PA_BASE 0x60006000
|
||||
|
||||
#define TEGRA2_CLK_RST_OSC_FREQ_DET_REG 0x58
|
||||
@ -339,261 +104,6 @@ tegra2_osc_freq_detect(void)
|
||||
}
|
||||
#endif
|
||||
|
||||
void *
|
||||
initarm(struct arm_boot_params *abp)
|
||||
{
|
||||
struct pv_addr kernel_l1pt;
|
||||
struct pv_addr dpcpu;
|
||||
vm_offset_t dtbp, freemempos, l2_start, lastaddr;
|
||||
uint32_t memsize, l2size;
|
||||
char *env;
|
||||
void *kmdp;
|
||||
u_int l1pagetable;
|
||||
int i = 0, j = 0, err_devmap = 0;
|
||||
|
||||
lastaddr = parse_boot_param(abp);
|
||||
memsize = 0;
|
||||
set_cpufuncs();
|
||||
|
||||
/*
|
||||
* Find the dtb passed in by the boot loader.
|
||||
*/
|
||||
kmdp = preload_search_by_type("elf kernel");
|
||||
if (kmdp != NULL)
|
||||
dtbp = MD_FETCH(kmdp, MODINFOMD_DTBP, vm_offset_t);
|
||||
else
|
||||
dtbp = (vm_offset_t)NULL;
|
||||
|
||||
#if defined(FDT_DTB_STATIC)
|
||||
/*
|
||||
* In case the device tree blob was not retrieved (from metadata) try
|
||||
* to use the statically embedded one.
|
||||
*/
|
||||
if (dtbp == (vm_offset_t)NULL)
|
||||
dtbp = (vm_offset_t)&fdt_static_dtb;
|
||||
#endif
|
||||
|
||||
if (OF_install(OFW_FDT, 0) == FALSE)
|
||||
while (1);
|
||||
|
||||
if (OF_init((void *)dtbp) != 0)
|
||||
while (1);
|
||||
|
||||
/* Grab physical memory regions information from device tree. */
|
||||
if (fdt_get_mem_regions(availmem_regions, &availmem_regions_sz,
|
||||
&memsize) != 0)
|
||||
while(1);
|
||||
|
||||
/* Platform-specific initialisation */
|
||||
pmap_bootstrap_lastaddr = initarm_lastaddr();
|
||||
|
||||
pcpu0_init();
|
||||
|
||||
/* Calculate number of L2 tables needed for mapping vm_page_array */
|
||||
l2size = (memsize / PAGE_SIZE) * sizeof(struct vm_page);
|
||||
l2size = (l2size >> L1_S_SHIFT) + 1;
|
||||
|
||||
/*
|
||||
* Add one table for end of kernel map, one for stacks, msgbuf and
|
||||
* L1 and L2 tables map and one for vectors map.
|
||||
*/
|
||||
l2size += 3;
|
||||
|
||||
/* Make it divisible by 4 */
|
||||
l2size = (l2size + 3) & ~3;
|
||||
|
||||
#define KERNEL_TEXT_BASE (KERNBASE)
|
||||
freemempos = (lastaddr + PAGE_MASK) & ~PAGE_MASK;
|
||||
|
||||
/* Define a macro to simplify memory allocation */
|
||||
#define valloc_pages(var, np) \
|
||||
alloc_pages((var).pv_va, (np)); \
|
||||
(var).pv_pa = (var).pv_va + (KERNPHYSADDR - KERNVIRTADDR);
|
||||
|
||||
#define alloc_pages(var, np) \
|
||||
(var) = freemempos; \
|
||||
freemempos += (np * PAGE_SIZE); \
|
||||
memset((char *)(var), 0, ((np) * PAGE_SIZE));
|
||||
|
||||
while (((freemempos - L1_TABLE_SIZE) & (L1_TABLE_SIZE - 1)) != 0)
|
||||
freemempos += PAGE_SIZE;
|
||||
valloc_pages(kernel_l1pt, L1_TABLE_SIZE / PAGE_SIZE);
|
||||
|
||||
for (i = 0; i < l2size; ++i) {
|
||||
if (!(i % (PAGE_SIZE / L2_TABLE_SIZE_REAL))) {
|
||||
valloc_pages(kernel_pt_table[i],
|
||||
L2_TABLE_SIZE / PAGE_SIZE);
|
||||
j = i;
|
||||
} else {
|
||||
kernel_pt_table[i].pv_va = kernel_pt_table[j].pv_va +
|
||||
L2_TABLE_SIZE_REAL * (i - j);
|
||||
kernel_pt_table[i].pv_pa =
|
||||
kernel_pt_table[i].pv_va - KERNVIRTADDR +
|
||||
KERNPHYSADDR;
|
||||
|
||||
}
|
||||
}
|
||||
/*
|
||||
* Allocate a page for the system page mapped to 0x00000000
|
||||
* or 0xffff0000. This page will just contain the system vectors
|
||||
* and can be shared by all processes.
|
||||
*/
|
||||
valloc_pages(systempage, 1);
|
||||
|
||||
/* Allocate dynamic per-cpu area. */
|
||||
valloc_pages(dpcpu, DPCPU_SIZE / PAGE_SIZE);
|
||||
dpcpu_init((void *)dpcpu.pv_va, 0);
|
||||
|
||||
/* Allocate stacks for all modes */
|
||||
valloc_pages(irqstack, (IRQ_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(abtstack, (ABT_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(undstack, (UND_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(kernelstack, (KSTACK_PAGES * MAXCPU));
|
||||
|
||||
init_param1();
|
||||
|
||||
valloc_pages(msgbufpv, round_page(msgbufsize) / PAGE_SIZE);
|
||||
|
||||
/*
|
||||
* Now we start construction of the L1 page table
|
||||
* We start by mapping the L2 page tables into the L1.
|
||||
* This means that we can replace L1 mappings later on if necessary
|
||||
*/
|
||||
l1pagetable = kernel_l1pt.pv_va;
|
||||
|
||||
/*
|
||||
* Try to map as much as possible of kernel text and data using
|
||||
* 1MB section mapping and for the rest of initial kernel address
|
||||
* space use L2 coarse tables.
|
||||
*
|
||||
* Link L2 tables for mapping remainder of kernel (modulo 1MB)
|
||||
* and kernel structures
|
||||
*/
|
||||
l2_start = lastaddr & ~(L1_S_OFFSET);
|
||||
for (i = 0 ; i < l2size - 1; i++)
|
||||
pmap_link_l2pt(l1pagetable, l2_start + i * L1_S_SIZE,
|
||||
&kernel_pt_table[i]);
|
||||
|
||||
pmap_curmaxkvaddr = l2_start + (l2size - 1) * L1_S_SIZE;
|
||||
|
||||
/* Map kernel code and data */
|
||||
pmap_map_chunk(l1pagetable, KERNVIRTADDR, KERNPHYSADDR,
|
||||
(((uint32_t)(lastaddr) - KERNVIRTADDR) + PAGE_MASK) & ~PAGE_MASK,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
|
||||
/* Map L1 directory and allocated L2 page tables */
|
||||
pmap_map_chunk(l1pagetable, kernel_l1pt.pv_va, kernel_l1pt.pv_pa,
|
||||
L1_TABLE_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
pmap_map_chunk(l1pagetable, kernel_pt_table[0].pv_va,
|
||||
kernel_pt_table[0].pv_pa,
|
||||
L2_TABLE_SIZE_REAL * l2size,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
/* Map allocated DPCPU, stacks and msgbuf */
|
||||
pmap_map_chunk(l1pagetable, dpcpu.pv_va, dpcpu.pv_pa,
|
||||
freemempos - dpcpu.pv_va,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
/* Link and map the vector page */
|
||||
pmap_link_l2pt(l1pagetable, ARM_VECTORS_HIGH,
|
||||
&kernel_pt_table[l2size - 1]);
|
||||
pmap_map_entry(l1pagetable, ARM_VECTORS_HIGH, systempage.pv_pa,
|
||||
VM_PROT_READ|VM_PROT_WRITE|VM_PROT_EXECUTE, PTE_CACHE);
|
||||
|
||||
/* Map pmap_devmap[] entries */
|
||||
err_devmap = platform_devmap_init();
|
||||
pmap_devmap_bootstrap(l1pagetable, pmap_devmap_bootstrap_table);
|
||||
|
||||
cpu_domains((DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2)) |
|
||||
DOMAIN_CLIENT);
|
||||
pmap_pa = kernel_l1pt.pv_pa;
|
||||
setttb(kernel_l1pt.pv_pa);
|
||||
cpu_tlb_flushID();
|
||||
cpu_domains(DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2));
|
||||
|
||||
/*
|
||||
* Only after the SOC registers block is mapped we can perform device
|
||||
* tree fixups, as they may attempt to read parameters from hardware.
|
||||
*/
|
||||
OF_interpret("perform-fixup", 0);
|
||||
|
||||
initarm_gpio_init();
|
||||
|
||||
cninit();
|
||||
|
||||
physmem = memsize / PAGE_SIZE;
|
||||
|
||||
debugf("initarm: console initialized\n");
|
||||
debugf(" arg1 kmdp = 0x%08x\n", (uint32_t)kmdp);
|
||||
debugf(" boothowto = 0x%08x\n", boothowto);
|
||||
debugf(" dtbp = 0x%08x\n", (uint32_t)dtbp);
|
||||
print_kernel_section_addr();
|
||||
print_kenv();
|
||||
|
||||
env = getenv("kernelname");
|
||||
if (env != NULL)
|
||||
strlcpy(kernelname, env, sizeof(kernelname));
|
||||
|
||||
if (err_devmap != 0)
|
||||
printf("WARNING: could not fully configure devmap, error=%d\n",
|
||||
err_devmap);
|
||||
|
||||
initarm_late_init();
|
||||
|
||||
/*
|
||||
* Pages were allocated during the secondary bootstrap for the
|
||||
* stacks for different CPU modes.
|
||||
* We must now set the r13 registers in the different CPU modes to
|
||||
* point to these stacks.
|
||||
* Since the ARM stacks use STMFD etc. we must set r13 to the top end
|
||||
* of the stack memory.
|
||||
*/
|
||||
cpu_control(CPU_CONTROL_MMU_ENABLE, CPU_CONTROL_MMU_ENABLE);
|
||||
|
||||
set_stackptrs(0);
|
||||
|
||||
/*
|
||||
* We must now clean the cache again....
|
||||
* Cleaning may be done by reading new data to displace any
|
||||
* dirty data in the cache. This will have happened in setttb()
|
||||
* but since we are boot strapping the addresses used for the read
|
||||
* may have just been remapped and thus the cache could be out
|
||||
* of sync. A re-clean after the switch will cure this.
|
||||
* After booting there are no gross relocations of the kernel thus
|
||||
* this problem will not occur after initarm().
|
||||
*/
|
||||
cpu_idcache_wbinv_all();
|
||||
|
||||
/* Set stack for exception handlers */
|
||||
data_abort_handler_address = (u_int)data_abort_handler;
|
||||
prefetch_abort_handler_address = (u_int)prefetch_abort_handler;
|
||||
undefined_handler_address = (u_int)undefinedinstruction_bounce;
|
||||
undefined_init();
|
||||
|
||||
init_proc0(kernelstack.pv_va);
|
||||
|
||||
arm_vector_init(ARM_VECTORS_HIGH, ARM_VEC_ALL);
|
||||
arm_dump_avail_init(memsize, sizeof(dump_avail) / sizeof(dump_avail[0]));
|
||||
pmap_bootstrap(freemempos, pmap_bootstrap_lastaddr, &kernel_l1pt);
|
||||
msgbufp = (void *)msgbufpv.pv_va;
|
||||
msgbufinit(msgbufp, msgbufsize);
|
||||
mutex_init();
|
||||
|
||||
/*
|
||||
* Prepare map of physical memory regions available to vm subsystem.
|
||||
*/
|
||||
physmap_init();
|
||||
|
||||
/* Do basic tuning, hz etc */
|
||||
init_param2(physmem);
|
||||
kdb_init();
|
||||
|
||||
return ((void *)(kernelstack.pv_va + USPACE_SVC_STACK_TOP -
|
||||
sizeof(struct pcb)));
|
||||
}
|
||||
|
||||
vm_offset_t
|
||||
initarm_lastaddr(void)
|
||||
{
|
||||
@ -622,7 +132,7 @@ static struct pmap_devmap fdt_devmap[FDT_DEVMAP_MAX] = {
|
||||
/*
|
||||
* Construct pmap_devmap[] with DT-derived config data.
|
||||
*/
|
||||
static int
|
||||
int
|
||||
platform_devmap_init(void)
|
||||
{
|
||||
int i = 0;
|
||||
@ -650,3 +160,4 @@ bus_dma_get_range_nb(void)
|
||||
|
||||
return (0);
|
||||
}
|
||||
|
||||
|
@ -35,9 +35,7 @@
|
||||
* from: FreeBSD: //depot/projects/arm/src/sys/arm/at91/kb920x_machdep.c, rev 45
|
||||
*/
|
||||
|
||||
#include "opt_ddb.h"
|
||||
#include "opt_platform.h"
|
||||
#include "opt_global.h"
|
||||
|
||||
#include <sys/cdefs.h>
|
||||
__FBSDID("$FreeBSD$");
|
||||
@ -45,515 +43,23 @@ __FBSDID("$FreeBSD$");
|
||||
#define _ARM32_BUS_DMA_PRIVATE
|
||||
#include <sys/param.h>
|
||||
#include <sys/systm.h>
|
||||
#include <sys/sysproto.h>
|
||||
#include <sys/signalvar.h>
|
||||
#include <sys/imgact.h>
|
||||
#include <sys/kernel.h>
|
||||
#include <sys/ktr.h>
|
||||
#include <sys/linker.h>
|
||||
#include <sys/lock.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/mutex.h>
|
||||
#include <sys/pcpu.h>
|
||||
#include <sys/proc.h>
|
||||
#include <sys/ptrace.h>
|
||||
#include <sys/cons.h>
|
||||
#include <sys/bio.h>
|
||||
#include <sys/bus.h>
|
||||
#include <sys/buf.h>
|
||||
#include <sys/exec.h>
|
||||
#include <sys/kdb.h>
|
||||
#include <sys/msgbuf.h>
|
||||
#include <machine/reg.h>
|
||||
#include <machine/cpu.h>
|
||||
#include <machine/fdt.h>
|
||||
|
||||
#include <dev/fdt/fdt_common.h>
|
||||
#include <dev/ofw/openfirm.h>
|
||||
|
||||
#include <vm/vm.h>
|
||||
#include <vm/pmap.h>
|
||||
#include <vm/vm_object.h>
|
||||
#include <vm/vm_page.h>
|
||||
#include <vm/vm_pager.h>
|
||||
#include <vm/vm_map.h>
|
||||
#include <machine/pte.h>
|
||||
#include <machine/pmap.h>
|
||||
#include <machine/vmparam.h>
|
||||
#include <machine/pcb.h>
|
||||
#include <machine/undefined.h>
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/metadata.h>
|
||||
#include <machine/armreg.h>
|
||||
|
||||
#include <machine/bus.h>
|
||||
#include <sys/reboot.h>
|
||||
#include <machine/frame.h> /* For trapframe_t, used in <machine/machdep.h> */
|
||||
#include <machine/machdep.h>
|
||||
#include <machine/pmap.h>
|
||||
|
||||
#include <arm/ti/omap4/omap4_reg.h>
|
||||
|
||||
#define DEBUG
|
||||
#ifdef DEBUG
|
||||
#define debugf(fmt, args...) printf(fmt, ##args)
|
||||
#else
|
||||
#define debugf(fmt, args...)
|
||||
#endif
|
||||
|
||||
/* Start of address space used for bootstrap map */
|
||||
#define DEVMAP_BOOTSTRAP_MAP_START 0xE0000000
|
||||
|
||||
/*
|
||||
* This is the number of L2 page tables required for covering max
|
||||
* (hypothetical) memsize of 4GB and all kernel mappings (vectors, msgbuf,
|
||||
* stacks etc.), uprounded to be divisible by 4.
|
||||
*/
|
||||
#define KERNEL_PT_MAX 78
|
||||
|
||||
extern unsigned char kernbase[];
|
||||
extern unsigned char _etext[];
|
||||
extern unsigned char _edata[];
|
||||
extern unsigned char __bss_start[];
|
||||
extern unsigned char _end[];
|
||||
|
||||
#ifdef DDB
|
||||
extern vm_offset_t ksym_start, ksym_end;
|
||||
#endif
|
||||
|
||||
extern u_int data_abort_handler_address;
|
||||
extern u_int prefetch_abort_handler_address;
|
||||
extern u_int undefined_handler_address;
|
||||
|
||||
extern vm_offset_t pmap_bootstrap_lastaddr;
|
||||
extern int *end;
|
||||
|
||||
struct pv_addr kernel_pt_table[KERNEL_PT_MAX];
|
||||
|
||||
/* Physical and virtual addresses for some global pages */
|
||||
vm_paddr_t phys_avail[10];
|
||||
vm_paddr_t dump_avail[4];
|
||||
vm_offset_t physical_pages;
|
||||
vm_offset_t pmap_bootstrap_lastaddr;
|
||||
vm_paddr_t pmap_pa;
|
||||
|
||||
const struct pmap_devmap *pmap_devmap_bootstrap_table;
|
||||
struct pv_addr systempage;
|
||||
struct pv_addr msgbufpv;
|
||||
struct pv_addr irqstack;
|
||||
struct pv_addr undstack;
|
||||
struct pv_addr abtstack;
|
||||
struct pv_addr kernelstack;
|
||||
|
||||
static struct mem_region availmem_regions[FDT_MEM_REGIONS];
|
||||
static int availmem_regions_sz;
|
||||
|
||||
static void print_kenv(void);
|
||||
static void print_kernel_section_addr(void);
|
||||
|
||||
static void physmap_init(void);
|
||||
static int platform_devmap_init(void);
|
||||
void (*ti_cpu_reset)(void);
|
||||
|
||||
static char *
|
||||
kenv_next(char *cp)
|
||||
{
|
||||
|
||||
if (cp != NULL) {
|
||||
while (*cp != 0)
|
||||
cp++;
|
||||
cp++;
|
||||
if (*cp == 0)
|
||||
cp = NULL;
|
||||
}
|
||||
return (cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kenv(void)
|
||||
{
|
||||
int len;
|
||||
char *cp;
|
||||
|
||||
debugf("loader passed (static) kenv:\n");
|
||||
if (kern_envp == NULL) {
|
||||
debugf(" no env, null ptr\n");
|
||||
return;
|
||||
}
|
||||
debugf(" kern_envp = 0x%08x\n", (uint32_t)kern_envp);
|
||||
|
||||
len = 0;
|
||||
for (cp = kern_envp; cp != NULL; cp = kenv_next(cp))
|
||||
debugf(" %x %s\n", (uint32_t)cp, cp);
|
||||
}
|
||||
|
||||
static void
|
||||
print_kernel_section_addr(void)
|
||||
{
|
||||
|
||||
debugf("kernel image addresses:\n");
|
||||
debugf(" kernbase = 0x%08x\n", (uint32_t)kernbase);
|
||||
debugf(" _etext (sdata) = 0x%08x\n", (uint32_t)_etext);
|
||||
debugf(" _edata = 0x%08x\n", (uint32_t)_edata);
|
||||
debugf(" __bss_start = 0x%08x\n", (uint32_t)__bss_start);
|
||||
debugf(" _end = 0x%08x\n", (uint32_t)_end);
|
||||
}
|
||||
|
||||
static void
|
||||
physmap_init(void)
|
||||
{
|
||||
int i, j, cnt;
|
||||
vm_offset_t phys_kernelend, kernload;
|
||||
uint32_t s, e, sz;
|
||||
struct mem_region *mp, *mp1;
|
||||
|
||||
phys_kernelend = KERNPHYSADDR + (virtual_avail - KERNVIRTADDR);
|
||||
kernload = KERNPHYSADDR;
|
||||
|
||||
/*
|
||||
* Remove kernel physical address range from avail
|
||||
* regions list. Page align all regions.
|
||||
* Non-page aligned memory isn't very interesting to us.
|
||||
* Also, sort the entries for ascending addresses.
|
||||
*/
|
||||
sz = 0;
|
||||
cnt = availmem_regions_sz;
|
||||
debugf("processing avail regions:\n");
|
||||
for (mp = availmem_regions; mp->mr_size; mp++) {
|
||||
s = mp->mr_start;
|
||||
e = mp->mr_start + mp->mr_size;
|
||||
debugf(" %08x-%08x -> ", s, e);
|
||||
/* Check whether this region holds all of the kernel. */
|
||||
if (s < kernload && e > phys_kernelend) {
|
||||
availmem_regions[cnt].mr_start = phys_kernelend;
|
||||
availmem_regions[cnt++].mr_size = e - phys_kernelend;
|
||||
e = kernload;
|
||||
}
|
||||
/* Look whether this regions starts within the kernel. */
|
||||
if (s >= kernload && s < phys_kernelend) {
|
||||
if (e <= phys_kernelend)
|
||||
goto empty;
|
||||
s = phys_kernelend;
|
||||
}
|
||||
/* Now look whether this region ends within the kernel. */
|
||||
if (e > kernload && e <= phys_kernelend) {
|
||||
if (s >= kernload) {
|
||||
goto empty;
|
||||
}
|
||||
e = kernload;
|
||||
}
|
||||
/* Now page align the start and size of the region. */
|
||||
s = round_page(s);
|
||||
e = trunc_page(e);
|
||||
if (e < s)
|
||||
e = s;
|
||||
sz = e - s;
|
||||
debugf("%08x-%08x = %x\n", s, e, sz);
|
||||
|
||||
/* Check whether some memory is left here. */
|
||||
if (sz == 0) {
|
||||
empty:
|
||||
printf("skipping\n");
|
||||
bcopy(mp + 1, mp,
|
||||
(cnt - (mp - availmem_regions)) * sizeof(*mp));
|
||||
cnt--;
|
||||
mp--;
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Do an insertion sort. */
|
||||
for (mp1 = availmem_regions; mp1 < mp; mp1++)
|
||||
if (s < mp1->mr_start)
|
||||
break;
|
||||
if (mp1 < mp) {
|
||||
bcopy(mp1, mp1 + 1, (char *)mp - (char *)mp1);
|
||||
mp1->mr_start = s;
|
||||
mp1->mr_size = sz;
|
||||
} else {
|
||||
mp->mr_start = s;
|
||||
mp->mr_size = sz;
|
||||
}
|
||||
}
|
||||
availmem_regions_sz = cnt;
|
||||
|
||||
/* Fill in phys_avail table, based on availmem_regions */
|
||||
debugf("fill in phys_avail:\n");
|
||||
for (i = 0, j = 0; i < availmem_regions_sz; i++, j += 2) {
|
||||
|
||||
debugf(" region: 0x%08x - 0x%08x (0x%08x)\n",
|
||||
availmem_regions[i].mr_start,
|
||||
availmem_regions[i].mr_start + availmem_regions[i].mr_size,
|
||||
availmem_regions[i].mr_size);
|
||||
|
||||
/*
|
||||
* We should not map the page at PA 0x0000000, the VM can't
|
||||
* handle it, as pmap_extract() == 0 means failure.
|
||||
*/
|
||||
if (availmem_regions[i].mr_start > 0 ||
|
||||
availmem_regions[i].mr_size > PAGE_SIZE) {
|
||||
phys_avail[j] = availmem_regions[i].mr_start;
|
||||
if (phys_avail[j] == 0)
|
||||
phys_avail[j] += PAGE_SIZE;
|
||||
phys_avail[j + 1] = availmem_regions[i].mr_start +
|
||||
availmem_regions[i].mr_size;
|
||||
} else
|
||||
j -= 2;
|
||||
}
|
||||
phys_avail[j] = 0;
|
||||
phys_avail[j + 1] = 0;
|
||||
}
|
||||
|
||||
void *
|
||||
initarm(struct arm_boot_params *abp)
|
||||
{
|
||||
struct pv_addr kernel_l1pt;
|
||||
struct pv_addr dpcpu;
|
||||
vm_offset_t dtbp, freemempos, l2_start, lastaddr;
|
||||
uint32_t memsize, l2size;
|
||||
char *env;
|
||||
void *kmdp;
|
||||
u_int l1pagetable;
|
||||
int i = 0, j = 0, err_devmap = 0;
|
||||
|
||||
lastaddr = parse_boot_param(abp);
|
||||
memsize = 0;
|
||||
set_cpufuncs();
|
||||
|
||||
/*
|
||||
* Find the dtb passed in by the boot loader.
|
||||
*/
|
||||
kmdp = preload_search_by_type("elf kernel");
|
||||
if (kmdp != NULL)
|
||||
dtbp = MD_FETCH(kmdp, MODINFOMD_DTBP, vm_offset_t);
|
||||
else
|
||||
dtbp = (vm_offset_t)NULL;
|
||||
|
||||
#if defined(FDT_DTB_STATIC)
|
||||
/*
|
||||
* In case the device tree blob was not retrieved (from metadata) try
|
||||
* to use the statically embedded one.
|
||||
*/
|
||||
if (dtbp == (vm_offset_t)NULL)
|
||||
dtbp = (vm_offset_t)&fdt_static_dtb;
|
||||
#endif
|
||||
|
||||
if (OF_install(OFW_FDT, 0) == FALSE)
|
||||
while (1);
|
||||
|
||||
if (OF_init((void *)dtbp) != 0)
|
||||
while (1);
|
||||
|
||||
/* Grab physical memory regions information from device tree. */
|
||||
if (fdt_get_mem_regions(availmem_regions, &availmem_regions_sz,
|
||||
&memsize) != 0)
|
||||
while(1);
|
||||
|
||||
/* Platform-specific initialisation */
|
||||
pmap_bootstrap_lastaddr = initarm_lastaddr();
|
||||
|
||||
pcpu0_init();
|
||||
|
||||
/* Calculate number of L2 tables needed for mapping vm_page_array */
|
||||
l2size = (memsize / PAGE_SIZE) * sizeof(struct vm_page);
|
||||
l2size = (l2size >> L1_S_SHIFT) + 1;
|
||||
|
||||
/*
|
||||
* Add one table for end of kernel map, one for stacks, msgbuf and
|
||||
* L1 and L2 tables map and one for vectors map.
|
||||
*/
|
||||
l2size += 3;
|
||||
|
||||
/* Make it divisible by 4 */
|
||||
l2size = (l2size + 3) & ~3;
|
||||
|
||||
#define KERNEL_TEXT_BASE (KERNBASE)
|
||||
freemempos = (lastaddr + PAGE_MASK) & ~PAGE_MASK;
|
||||
|
||||
/* Define a macro to simplify memory allocation */
|
||||
#define valloc_pages(var, np) \
|
||||
alloc_pages((var).pv_va, (np)); \
|
||||
(var).pv_pa = (var).pv_va + (KERNPHYSADDR - KERNVIRTADDR);
|
||||
|
||||
#define alloc_pages(var, np) \
|
||||
(var) = freemempos; \
|
||||
freemempos += (np * PAGE_SIZE); \
|
||||
memset((char *)(var), 0, ((np) * PAGE_SIZE));
|
||||
|
||||
while (((freemempos - L1_TABLE_SIZE) & (L1_TABLE_SIZE - 1)) != 0)
|
||||
freemempos += PAGE_SIZE;
|
||||
valloc_pages(kernel_l1pt, L1_TABLE_SIZE / PAGE_SIZE);
|
||||
|
||||
for (i = 0; i < l2size; ++i) {
|
||||
if (!(i % (PAGE_SIZE / L2_TABLE_SIZE_REAL))) {
|
||||
valloc_pages(kernel_pt_table[i],
|
||||
L2_TABLE_SIZE / PAGE_SIZE);
|
||||
j = i;
|
||||
} else {
|
||||
kernel_pt_table[i].pv_va = kernel_pt_table[j].pv_va +
|
||||
L2_TABLE_SIZE_REAL * (i - j);
|
||||
kernel_pt_table[i].pv_pa =
|
||||
kernel_pt_table[i].pv_va - KERNVIRTADDR +
|
||||
KERNPHYSADDR;
|
||||
|
||||
}
|
||||
}
|
||||
/*
|
||||
* Allocate a page for the system page mapped to 0x00000000
|
||||
* or 0xffff0000. This page will just contain the system vectors
|
||||
* and can be shared by all processes.
|
||||
*/
|
||||
valloc_pages(systempage, 1);
|
||||
|
||||
/* Allocate dynamic per-cpu area. */
|
||||
valloc_pages(dpcpu, DPCPU_SIZE / PAGE_SIZE);
|
||||
dpcpu_init((void *)dpcpu.pv_va, 0);
|
||||
|
||||
/* Allocate stacks for all modes */
|
||||
valloc_pages(irqstack, (IRQ_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(abtstack, (ABT_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(undstack, (UND_STACK_SIZE * MAXCPU));
|
||||
valloc_pages(kernelstack, (KSTACK_PAGES * MAXCPU));
|
||||
|
||||
init_param1();
|
||||
|
||||
valloc_pages(msgbufpv, round_page(msgbufsize) / PAGE_SIZE);
|
||||
|
||||
/*
|
||||
* Now we start construction of the L1 page table
|
||||
* We start by mapping the L2 page tables into the L1.
|
||||
* This means that we can replace L1 mappings later on if necessary
|
||||
*/
|
||||
l1pagetable = kernel_l1pt.pv_va;
|
||||
|
||||
/*
|
||||
* Try to map as much as possible of kernel text and data using
|
||||
* 1MB section mapping and for the rest of initial kernel address
|
||||
* space use L2 coarse tables.
|
||||
*
|
||||
* Link L2 tables for mapping remainder of kernel (modulo 1MB)
|
||||
* and kernel structures
|
||||
*/
|
||||
l2_start = lastaddr & ~(L1_S_OFFSET);
|
||||
for (i = 0 ; i < l2size - 1; i++)
|
||||
pmap_link_l2pt(l1pagetable, l2_start + i * L1_S_SIZE,
|
||||
&kernel_pt_table[i]);
|
||||
|
||||
pmap_curmaxkvaddr = l2_start + (l2size - 1) * L1_S_SIZE;
|
||||
|
||||
/* Map kernel code and data */
|
||||
pmap_map_chunk(l1pagetable, KERNVIRTADDR, KERNPHYSADDR,
|
||||
(((uint32_t)(lastaddr) - KERNVIRTADDR) + PAGE_MASK) & ~PAGE_MASK,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
|
||||
/* Map L1 directory and allocated L2 page tables */
|
||||
pmap_map_chunk(l1pagetable, kernel_l1pt.pv_va, kernel_l1pt.pv_pa,
|
||||
L1_TABLE_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
pmap_map_chunk(l1pagetable, kernel_pt_table[0].pv_va,
|
||||
kernel_pt_table[0].pv_pa,
|
||||
L2_TABLE_SIZE_REAL * l2size,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
|
||||
|
||||
/* Map allocated DPCPU, stacks and msgbuf */
|
||||
pmap_map_chunk(l1pagetable, dpcpu.pv_va, dpcpu.pv_pa,
|
||||
freemempos - dpcpu.pv_va,
|
||||
VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
|
||||
|
||||
/* Link and map the vector page */
|
||||
pmap_link_l2pt(l1pagetable, ARM_VECTORS_HIGH,
|
||||
&kernel_pt_table[l2size - 1]);
|
||||
pmap_map_entry(l1pagetable, ARM_VECTORS_HIGH, systempage.pv_pa,
|
||||
VM_PROT_READ|VM_PROT_WRITE|VM_PROT_EXECUTE, PTE_CACHE);
|
||||
|
||||
/* Map pmap_devmap[] entries */
|
||||
err_devmap = platform_devmap_init();
|
||||
pmap_devmap_bootstrap(l1pagetable, pmap_devmap_bootstrap_table);
|
||||
|
||||
cpu_domains((DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2)) |
|
||||
DOMAIN_CLIENT);
|
||||
pmap_pa = kernel_l1pt.pv_pa;
|
||||
setttb(kernel_l1pt.pv_pa);
|
||||
cpu_tlb_flushID();
|
||||
cpu_domains(DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL * 2));
|
||||
|
||||
/*
|
||||
* Only after the SOC registers block is mapped we can perform device
|
||||
* tree fixups, as they may attempt to read parameters from hardware.
|
||||
*/
|
||||
OF_interpret("perform-fixup", 0);
|
||||
|
||||
initarm_gpio_init();
|
||||
|
||||
cninit();
|
||||
|
||||
physmem = memsize / PAGE_SIZE;
|
||||
|
||||
debugf("initarm: console initialized\n");
|
||||
debugf(" arg1 kmdp = 0x%08x\n", (uint32_t)kmdp);
|
||||
debugf(" boothowto = 0x%08x\n", boothowto);
|
||||
debugf(" dtbp = 0x%08x\n", (uint32_t)dtbp);
|
||||
print_kernel_section_addr();
|
||||
print_kenv();
|
||||
|
||||
env = getenv("kernelname");
|
||||
if (env != NULL)
|
||||
strlcpy(kernelname, env, sizeof(kernelname));
|
||||
|
||||
if (err_devmap != 0)
|
||||
printf("WARNING: could not fully configure devmap, error=%d\n",
|
||||
err_devmap);
|
||||
|
||||
initarm_late_init();
|
||||
|
||||
/*
|
||||
* Pages were allocated during the secondary bootstrap for the
|
||||
* stacks for different CPU modes.
|
||||
* We must now set the r13 registers in the different CPU modes to
|
||||
* point to these stacks.
|
||||
* Since the ARM stacks use STMFD etc. we must set r13 to the top end
|
||||
* of the stack memory.
|
||||
*/
|
||||
cpu_control(CPU_CONTROL_MMU_ENABLE, CPU_CONTROL_MMU_ENABLE);
|
||||
|
||||
set_stackptrs(0);
|
||||
|
||||
/*
|
||||
* We must now clean the cache again....
|
||||
* Cleaning may be done by reading new data to displace any
|
||||
* dirty data in the cache. This will have happened in setttb()
|
||||
* but since we are boot strapping the addresses used for the read
|
||||
* may have just been remapped and thus the cache could be out
|
||||
* of sync. A re-clean after the switch will cure this.
|
||||
* After booting there are no gross relocations of the kernel thus
|
||||
* this problem will not occur after initarm().
|
||||
*/
|
||||
cpu_idcache_wbinv_all();
|
||||
|
||||
/* Set stack for exception handlers */
|
||||
data_abort_handler_address = (u_int)data_abort_handler;
|
||||
prefetch_abort_handler_address = (u_int)prefetch_abort_handler;
|
||||
undefined_handler_address = (u_int)undefinedinstruction_bounce;
|
||||
undefined_init();
|
||||
|
||||
init_proc0(kernelstack.pv_va);
|
||||
|
||||
arm_vector_init(ARM_VECTORS_HIGH, ARM_VEC_ALL);
|
||||
arm_dump_avail_init(memsize, sizeof(dump_avail) / sizeof(dump_avail[0]));
|
||||
pmap_bootstrap(freemempos, pmap_bootstrap_lastaddr, &kernel_l1pt);
|
||||
msgbufp = (void *)msgbufpv.pv_va;
|
||||
msgbufinit(msgbufp, msgbufsize);
|
||||
mutex_init();
|
||||
|
||||
/*
|
||||
* Prepare map of physical memory regions available to vm subsystem.
|
||||
*/
|
||||
physmap_init();
|
||||
|
||||
/* Do basic tuning, hz etc */
|
||||
init_param2(physmem);
|
||||
kdb_init();
|
||||
|
||||
return ((void *)(kernelstack.pv_va + USPACE_SVC_STACK_TOP -
|
||||
sizeof(struct pcb)));
|
||||
}
|
||||
|
||||
vm_offset_t
|
||||
initarm_lastaddr(void)
|
||||
{
|
||||
@ -581,7 +87,7 @@ static struct pmap_devmap fdt_devmap[FDT_DEVMAP_MAX] = {
|
||||
/*
|
||||
* Construct pmap_devmap[] with DT-derived config data.
|
||||
*/
|
||||
static int
|
||||
int
|
||||
platform_devmap_init(void)
|
||||
{
|
||||
int i = 0;
|
||||
|
Loading…
Reference in New Issue
Block a user