Home | History | Annotate | Line # | Download | only in integrator
intmmu.S revision 1.1
      1  1.1  rearnsha /*	$NetBSD: intmmu.S,v 1.1 2001/10/27 16:17:52 rearnsha Exp $ */
      2  1.1  rearnsha 
      3  1.1  rearnsha /*
      4  1.1  rearnsha  * Copyright (c) 2001 ARM Ltd
      5  1.1  rearnsha  * All rights reserved.
      6  1.1  rearnsha  *
      7  1.1  rearnsha  * Redistribution and use in source and binary forms, with or without
      8  1.1  rearnsha  * modification, are permitted provided that the following conditions
      9  1.1  rearnsha  * are met:
     10  1.1  rearnsha  * 1. Redistributions of source code must retain the above copyright
     11  1.1  rearnsha  *    notice, this list of conditions and the following disclaimer.
     12  1.1  rearnsha  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  rearnsha  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  rearnsha  *    documentation and/or other materials provided with the distribution.
     15  1.1  rearnsha  * 3. The name of the company may not be used to endorse or promote
     16  1.1  rearnsha  *    products derived from this software without specific prior written
     17  1.1  rearnsha  *    permission.
     18  1.1  rearnsha  *
     19  1.1  rearnsha  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
     20  1.1  rearnsha  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
     21  1.1  rearnsha  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     22  1.1  rearnsha  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
     23  1.1  rearnsha  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     24  1.1  rearnsha  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     25  1.1  rearnsha  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26  1.1  rearnsha  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27  1.1  rearnsha  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28  1.1  rearnsha  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29  1.1  rearnsha  * SUCH DAMAGE.
     30  1.1  rearnsha  */
     31  1.1  rearnsha #include "assym.h"
     32  1.1  rearnsha #include <machine/asm.h>
     33  1.1  rearnsha #include <arm/armreg.h>
     34  1.1  rearnsha #include <arm/pte.h>
     35  1.1  rearnsha 
     36  1.1  rearnsha 	.text
     37  1.1  rearnsha 
     38  1.1  rearnsha ASENTRY_NP(integrator_start)
     39  1.1  rearnsha 	mov	r6, #0x16000000		/* UART0 Physical base*/
     40  1.1  rearnsha 	mov	r3, #'A'
     41  1.1  rearnsha 	str	r3, [r6]		/* Let the world know we are alive */
     42  1.1  rearnsha 
     43  1.1  rearnsha /*
     44  1.1  rearnsha  * At this time the MMU is off.
     45  1.1  rearnsha  * We build up an initial memory map at 0x8000 that we can use to get
     46  1.1  rearnsha  * the kernel running from the top of memory.  All mappings in this table
     47  1.1  rearnsha  * use L1 section maps.
     48  1.1  rearnsha  */
     49  1.1  rearnsha 
     50  1.1  rearnsha /*
     51  1.1  rearnsha  * Set Virtual == Physical
     52  1.1  rearnsha  */
     53  1.1  rearnsha 	mov	r3, #(AP_KRW << AP_SECTION_SHIFT)
     54  1.1  rearnsha 	add	r3, r3, #(L1_SECTION)
     55  1.1  rearnsha 	mov	r2, #0x100000		/* advance by 1MB */
     56  1.1  rearnsha 	mov	r1, #0x8000		/* page table start */
     57  1.1  rearnsha 	mov	r0, #0x1000		/* page table size */
     58  1.1  rearnsha 
     59  1.1  rearnsha Lflat:
     60  1.1  rearnsha 	str	r3, [r1], #0x0004
     61  1.1  rearnsha 	add	r3, r3, r2
     62  1.1  rearnsha 	subs	r0, r0, #1
     63  1.1  rearnsha 	bgt	Lflat
     64  1.1  rearnsha 
     65  1.1  rearnsha /*
     66  1.1  rearnsha  * Map VA 0xa0100000->0xa03fffff to PA 0x00000000->0x002fffff
     67  1.1  rearnsha  */
     68  1.1  rearnsha 	mov	r3, #(AP_KRW << AP_SECTION_SHIFT)
     69  1.1  rearnsha 	add	r3, r3, #(L1_SECTION)
     70  1.1  rearnsha 	mov	r1, #0x8000		/* page table start */
     71  1.1  rearnsha 	add	r1, r1, #(0xa00 * 4)	/* offset to 0xa00xxxxx */
     72  1.1  rearnsha 	add	r1, r1, #(0x001 * 4)	/* offset to 0xa01xxxxx */
     73  1.1  rearnsha 	mov	r0, #47
     74  1.1  rearnsha Lkern:
     75  1.1  rearnsha 	str	r3, [r1], #0x0004	/* 0xa010000-0xa03fffff */
     76  1.1  rearnsha 	add	r3, r3, r2
     77  1.1  rearnsha 	subs	r0, r0, #1
     78  1.1  rearnsha 	bgt	Lkern
     79  1.1  rearnsha /*
     80  1.1  rearnsha  * Mapping the peripheral register region (0x10000000->0x1fffffff) linearly
     81  1.1  rearnsha  * would require 256MB of virtual memory (as much space as the entire kernel
     82  1.1  rearnsha  * virtual space).  So we map the first 1M of each 16MB sub-space into the
     83  1.1  rearnsha  * region VA 0xfd000000->0xfdffffff; this should map enough of the peripheral
     84  1.1  rearnsha  * space to at least get us up and running.
     85  1.1  rearnsha  */
     86  1.1  rearnsha 	mov	r3, #(AP_KRW << AP_SECTION_SHIFT)
     87  1.1  rearnsha 	add	r3, r3, #L1_SECTION
     88  1.1  rearnsha 	add	r3, r3, #0x10000000	/* Peripherals base */
     89  1.1  rearnsha 	mov	r1, #0x8000		/* page table start */
     90  1.1  rearnsha 	add	r1, r1, #(0xfd0 * 4)
     91  1.1  rearnsha 	mov	r2, #0x01000000		/* 16MB increment.  */
     92  1.1  rearnsha 	mov	r0, #16
     93  1.1  rearnsha Lperiph:
     94  1.1  rearnsha 	str	r3, [r1], #4		/* 0xfd000000-0xfdffffff */
     95  1.1  rearnsha 	add	r3, r3, r2
     96  1.1  rearnsha 	subs	r0, r0, #1
     97  1.1  rearnsha 	bgt	Lperiph
     98  1.1  rearnsha 
     99  1.1  rearnsha /*
    100  1.1  rearnsha  * We now have our page table ready, so load it up and light the blue
    101  1.1  rearnsha  * touch paper.
    102  1.1  rearnsha  */
    103  1.1  rearnsha 
    104  1.1  rearnsha 	/* set the location of the L1 page table */
    105  1.1  rearnsha 	mov	r1, #0x8000
    106  1.1  rearnsha 	mcr	p15, 0, r1, c2, c0, 0
    107  1.1  rearnsha 
    108  1.1  rearnsha 	/* Flush the old TLBs (just in case) */
    109  1.1  rearnsha 	mcr	p15, 0, r1, c8, c7, 0
    110  1.1  rearnsha 	mov	r2, #'B'
    111  1.1  rearnsha 	strb	r2, [r6]
    112  1.1  rearnsha 
    113  1.1  rearnsha 	/* Set the Domain Access register.  Very important! */
    114  1.1  rearnsha 	mov	r1, #1
    115  1.1  rearnsha 	mcr	p15, 0, r1, c3, c0, 0
    116  1.1  rearnsha 
    117  1.1  rearnsha 	/*
    118  1.1  rearnsha 	 * set mmu bit (don't set anything else for now, we don't know
    119  1.1  rearnsha 	 * what sort of CPU we have yet.
    120  1.1  rearnsha 	 */
    121  1.1  rearnsha 	mov	r1, #CPU_CONTROL_MMU_ENABLE
    122  1.1  rearnsha 
    123  1.1  rearnsha /*
    124  1.1  rearnsha  * This is where it might all start to go wrong if the cpu fitted to your
    125  1.1  rearnsha  * integrator does not have an MMU.
    126  1.1  rearnsha  */
    127  1.1  rearnsha 	/* fetch current control state */
    128  1.1  rearnsha 	mrc	p15, 0, r2, c1, c0, 0
    129  1.1  rearnsha 	orr	r2, r2, r1
    130  1.1  rearnsha 
    131  1.1  rearnsha 	/* set new control state */
    132  1.1  rearnsha 	mcr	p15, 0, r2, c1, c0, 0
    133  1.1  rearnsha 
    134  1.1  rearnsha 	mov	r0, r0
    135  1.1  rearnsha 	mov	r0, r0
    136  1.1  rearnsha 	mov	r0, r0
    137  1.1  rearnsha 
    138  1.1  rearnsha 	/* emit a char.  Uart is now at 0xfd600000 */
    139  1.1  rearnsha 	mov	r6, #0xfd000000
    140  1.1  rearnsha 	add	r6, r6, #0x00600000
    141  1.1  rearnsha 	mov	r2, #'C'
    142  1.1  rearnsha 	strb	r2, [r6]
    143  1.1  rearnsha 
    144  1.1  rearnsha 	/* jump to kernel space */
    145  1.1  rearnsha 	mov	r0, #0x0200
    146  1.1  rearnsha 
    147  1.1  rearnsha 	/* Switch to kernel VM and really set the ball rolling.  */
    148  1.1  rearnsha 	ldr	pc, Lstart
    149  1.1  rearnsha 
    150  1.1  rearnsha Lstart:	.long	start
    151