Home | History | Annotate | Line # | Download | only in integrator
intmmu.S revision 1.2
      1  1.2   thorpej /*	$NetBSD: intmmu.S,v 1.2 2001/11/23 17:39:05 thorpej 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.2   thorpej 
     32  1.1  rearnsha #include "assym.h"
     33  1.1  rearnsha #include <machine/asm.h>
     34  1.1  rearnsha #include <arm/armreg.h>
     35  1.2   thorpej #include <arm/arm32/pte.h>
     36  1.1  rearnsha 
     37  1.1  rearnsha 	.text
     38  1.1  rearnsha 
     39  1.1  rearnsha ASENTRY_NP(integrator_start)
     40  1.1  rearnsha 	mov	r6, #0x16000000		/* UART0 Physical base*/
     41  1.1  rearnsha 	mov	r3, #'A'
     42  1.1  rearnsha 	str	r3, [r6]		/* Let the world know we are alive */
     43  1.1  rearnsha 
     44  1.1  rearnsha /*
     45  1.1  rearnsha  * At this time the MMU is off.
     46  1.1  rearnsha  * We build up an initial memory map at 0x8000 that we can use to get
     47  1.1  rearnsha  * the kernel running from the top of memory.  All mappings in this table
     48  1.1  rearnsha  * use L1 section maps.
     49  1.1  rearnsha  */
     50  1.1  rearnsha 
     51  1.1  rearnsha /*
     52  1.1  rearnsha  * Set Virtual == Physical
     53  1.1  rearnsha  */
     54  1.1  rearnsha 	mov	r3, #(AP_KRW << AP_SECTION_SHIFT)
     55  1.1  rearnsha 	add	r3, r3, #(L1_SECTION)
     56  1.1  rearnsha 	mov	r2, #0x100000		/* advance by 1MB */
     57  1.1  rearnsha 	mov	r1, #0x8000		/* page table start */
     58  1.1  rearnsha 	mov	r0, #0x1000		/* page table size */
     59  1.1  rearnsha 
     60  1.1  rearnsha Lflat:
     61  1.1  rearnsha 	str	r3, [r1], #0x0004
     62  1.1  rearnsha 	add	r3, r3, r2
     63  1.1  rearnsha 	subs	r0, r0, #1
     64  1.1  rearnsha 	bgt	Lflat
     65  1.1  rearnsha 
     66  1.1  rearnsha /*
     67  1.1  rearnsha  * Map VA 0xa0100000->0xa03fffff to PA 0x00000000->0x002fffff
     68  1.1  rearnsha  */
     69  1.1  rearnsha 	mov	r3, #(AP_KRW << AP_SECTION_SHIFT)
     70  1.1  rearnsha 	add	r3, r3, #(L1_SECTION)
     71  1.1  rearnsha 	mov	r1, #0x8000		/* page table start */
     72  1.1  rearnsha 	add	r1, r1, #(0xa00 * 4)	/* offset to 0xa00xxxxx */
     73  1.1  rearnsha 	add	r1, r1, #(0x001 * 4)	/* offset to 0xa01xxxxx */
     74  1.1  rearnsha 	mov	r0, #47
     75  1.1  rearnsha Lkern:
     76  1.1  rearnsha 	str	r3, [r1], #0x0004	/* 0xa010000-0xa03fffff */
     77  1.1  rearnsha 	add	r3, r3, r2
     78  1.1  rearnsha 	subs	r0, r0, #1
     79  1.1  rearnsha 	bgt	Lkern
     80  1.1  rearnsha /*
     81  1.1  rearnsha  * Mapping the peripheral register region (0x10000000->0x1fffffff) linearly
     82  1.1  rearnsha  * would require 256MB of virtual memory (as much space as the entire kernel
     83  1.1  rearnsha  * virtual space).  So we map the first 1M of each 16MB sub-space into the
     84  1.1  rearnsha  * region VA 0xfd000000->0xfdffffff; this should map enough of the peripheral
     85  1.1  rearnsha  * space to at least get us up and running.
     86  1.1  rearnsha  */
     87  1.1  rearnsha 	mov	r3, #(AP_KRW << AP_SECTION_SHIFT)
     88  1.1  rearnsha 	add	r3, r3, #L1_SECTION
     89  1.1  rearnsha 	add	r3, r3, #0x10000000	/* Peripherals base */
     90  1.1  rearnsha 	mov	r1, #0x8000		/* page table start */
     91  1.1  rearnsha 	add	r1, r1, #(0xfd0 * 4)
     92  1.1  rearnsha 	mov	r2, #0x01000000		/* 16MB increment.  */
     93  1.1  rearnsha 	mov	r0, #16
     94  1.1  rearnsha Lperiph:
     95  1.1  rearnsha 	str	r3, [r1], #4		/* 0xfd000000-0xfdffffff */
     96  1.1  rearnsha 	add	r3, r3, r2
     97  1.1  rearnsha 	subs	r0, r0, #1
     98  1.1  rearnsha 	bgt	Lperiph
     99  1.1  rearnsha 
    100  1.1  rearnsha /*
    101  1.1  rearnsha  * We now have our page table ready, so load it up and light the blue
    102  1.1  rearnsha  * touch paper.
    103  1.1  rearnsha  */
    104  1.1  rearnsha 
    105  1.1  rearnsha 	/* set the location of the L1 page table */
    106  1.1  rearnsha 	mov	r1, #0x8000
    107  1.1  rearnsha 	mcr	p15, 0, r1, c2, c0, 0
    108  1.1  rearnsha 
    109  1.1  rearnsha 	/* Flush the old TLBs (just in case) */
    110  1.1  rearnsha 	mcr	p15, 0, r1, c8, c7, 0
    111  1.1  rearnsha 	mov	r2, #'B'
    112  1.1  rearnsha 	strb	r2, [r6]
    113  1.1  rearnsha 
    114  1.1  rearnsha 	/* Set the Domain Access register.  Very important! */
    115  1.1  rearnsha 	mov	r1, #1
    116  1.1  rearnsha 	mcr	p15, 0, r1, c3, c0, 0
    117  1.1  rearnsha 
    118  1.1  rearnsha 	/*
    119  1.1  rearnsha 	 * set mmu bit (don't set anything else for now, we don't know
    120  1.1  rearnsha 	 * what sort of CPU we have yet.
    121  1.1  rearnsha 	 */
    122  1.1  rearnsha 	mov	r1, #CPU_CONTROL_MMU_ENABLE
    123  1.1  rearnsha 
    124  1.1  rearnsha /*
    125  1.1  rearnsha  * This is where it might all start to go wrong if the cpu fitted to your
    126  1.1  rearnsha  * integrator does not have an MMU.
    127  1.1  rearnsha  */
    128  1.1  rearnsha 	/* fetch current control state */
    129  1.1  rearnsha 	mrc	p15, 0, r2, c1, c0, 0
    130  1.1  rearnsha 	orr	r2, r2, r1
    131  1.1  rearnsha 
    132  1.1  rearnsha 	/* set new control state */
    133  1.1  rearnsha 	mcr	p15, 0, r2, c1, c0, 0
    134  1.1  rearnsha 
    135  1.1  rearnsha 	mov	r0, r0
    136  1.1  rearnsha 	mov	r0, r0
    137  1.1  rearnsha 	mov	r0, r0
    138  1.1  rearnsha 
    139  1.1  rearnsha 	/* emit a char.  Uart is now at 0xfd600000 */
    140  1.1  rearnsha 	mov	r6, #0xfd000000
    141  1.1  rearnsha 	add	r6, r6, #0x00600000
    142  1.1  rearnsha 	mov	r2, #'C'
    143  1.1  rearnsha 	strb	r2, [r6]
    144  1.1  rearnsha 
    145  1.1  rearnsha 	/* jump to kernel space */
    146  1.1  rearnsha 	mov	r0, #0x0200
    147  1.1  rearnsha 
    148  1.1  rearnsha 	/* Switch to kernel VM and really set the ball rolling.  */
    149  1.1  rearnsha 	ldr	pc, Lstart
    150  1.1  rearnsha 
    151  1.1  rearnsha Lstart:	.long	start
    152