Home | History | Annotate | Line # | Download | only in integrator
intmmu.S revision 1.4.2.1
      1  1.4.2.1   gehenna /*	$NetBSD: intmmu.S,v 1.4.2.1 2002/07/16 01:38:08 gehenna 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.4.2.1   gehenna 	.section .start,"ax",%progbits
     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.4   thorpej 	mov	r3, #(L1_S_AP(AP_KRW))
     55      1.4   thorpej 	add	r3, r3, #(L1_TYPE_S)
     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.4.2.1   gehenna  * Map VA 0xc0000000->0xc03fffff to PA 0x00000000->0x003fffff
     68      1.1  rearnsha  */
     69      1.4   thorpej 	mov	r3, #(L1_S_AP(AP_KRW))
     70      1.4   thorpej 	add	r3, r3, #(L1_TYPE_S)
     71      1.1  rearnsha 	mov	r1, #0x8000		/* page table start */
     72      1.3   thorpej 	add	r1, r1, #(0xc00 * 4)	/* offset to 0xc00xxxxx */
     73  1.4.2.1   gehenna #	add	r1, r1, #(0x001 * 4)	/* offset to 0xc01xxxxx */
     74  1.4.2.1   gehenna 	mov	r0, #63
     75      1.1  rearnsha Lkern:
     76  1.4.2.1   gehenna 	str	r3, [r1], #0x0004	/* 0xc000000-0xc03fffff */
     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.4   thorpej 	mov	r3, #(L1_S_AP(AP_KRW))
     88      1.4   thorpej 	add	r3, r3, #L1_TYPE_S
     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