[BACK]Return to jornada_machdep.c CVS log [TXT][DIR] Up to [local] / sys / arch / jornada / jornada

Annotation of sys/arch/jornada/jornada/jornada_machdep.c, Revision 1.1

1.1     ! nbrk        1: /*     $OpenBSD: armish_machdep.c,v 1.10 2007/05/19 15:49:05 miod Exp $ */
        !             2: /*     $NetBSD: lubbock_machdep.c,v 1.2 2003/07/15 00:25:06 lukem Exp $ */
        !             3:
        !             4: /*
        !             5:  * Copyright (c) 2001, 2002, 2003 Wasabi Systems, Inc.
        !             6:  * All rights reserved.
        !             7:  *
        !             8:  * Written by Jason R. Thorpe for Wasabi Systems, Inc.
        !             9:  *
        !            10:  * Redistribution and use in source and binary forms, with or without
        !            11:  * modification, are permitted provided that the following conditions
        !            12:  * are met:
        !            13:  * 1. Redistributions of source code must retain the above copyright
        !            14:  *    notice, this list of conditions and the following disclaimer.
        !            15:  * 2. Redistributions in binary form must reproduce the above copyright
        !            16:  *    notice, this list of conditions and the following disclaimer in the
        !            17:  *    documentation and/or other materials provided with the distribution.
        !            18:  * 3. All advertising materials mentioning features or use of this software
        !            19:  *    must display the following acknowledgement:
        !            20:  *     This product includes software developed for the NetBSD Project by
        !            21:  *     Wasabi Systems, Inc.
        !            22:  * 4. The name of Wasabi Systems, Inc. may not be used to endorse
        !            23:  *    or promote products derived from this software without specific prior
        !            24:  *    written permission.
        !            25:  *
        !            26:  * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
        !            27:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
        !            28:  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
        !            29:  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL WASABI SYSTEMS, INC
        !            30:  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
        !            31:  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
        !            32:  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
        !            33:  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
        !            34:  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
        !            35:  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
        !            36:  * POSSIBILITY OF SUCH DAMAGE.
        !            37:  */
        !            38:
        !            39: /*
        !            40:  * Copyright (c) 1997,1998 Mark Brinicombe.
        !            41:  * Copyright (c) 1997,1998 Causality Limited.
        !            42:  * All rights reserved.
        !            43:  *
        !            44:  * Redistribution and use in source and binary forms, with or without
        !            45:  * modification, are permitted provided that the following conditions
        !            46:  * are met:
        !            47:  * 1. Redistributions of source code must retain the above copyright
        !            48:  *    notice, this list of conditions and the following disclaimer.
        !            49:  * 2. Redistributions in binary form must reproduce the above copyright
        !            50:  *    notice, this list of conditions and the following disclaimer in the
        !            51:  *    documentation and/or other materials provided with the distribution.
        !            52:  * 3. All advertising materials mentioning features or use of this software
        !            53:  *    must display the following acknowledgement:
        !            54:  *     This product includes software developed by Mark Brinicombe
        !            55:  *     for the NetBSD Project.
        !            56:  * 4. The name of the company nor the name of the author may be used to
        !            57:  *    endorse or promote products derived from this software without specific
        !            58:  *    prior written permission.
        !            59:  *
        !            60:  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
        !            61:  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
        !            62:  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
        !            63:  * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
        !            64:  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
        !            65:  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
        !            66:  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
        !            67:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
        !            68:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
        !            69:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
        !            70:  * SUCH DAMAGE.
        !            71:  *
        !            72:  * Machine dependant functions for kernel setup for Intel IQ80321 evaluation
        !            73:  * boards using RedBoot firmware.
        !            74:  */
        !            75:
        !            76: /*
        !            77:  * DIP switches:
        !            78:  *
        !            79:  * S19: no-dot: set RB_KDB.  enter kgdb session.
        !            80:  * S20: no-dot: set RB_SINGLE. don't go multi user mode.
        !            81:  */
        !            82:
        !            83: #include <sys/param.h>
        !            84: #include <sys/device.h>
        !            85: #include <sys/systm.h>
        !            86: #include <sys/kernel.h>
        !            87: #include <sys/exec.h>
        !            88: #include <sys/proc.h>
        !            89: #include <sys/msgbuf.h>
        !            90: #include <sys/reboot.h>
        !            91: #include <sys/termios.h>
        !            92: #include <sys/kcore.h>
        !            93:
        !            94: #include <uvm/uvm_extern.h>
        !            95:
        !            96: #include <sys/conf.h>
        !            97: #include <sys/queue.h>
        !            98: #include <sys/device.h>
        !            99: #include <dev/cons.h>
        !           100:
        !           101: #include <machine/db_machdep.h>
        !           102: #include <ddb/db_sym.h>
        !           103: #include <ddb/db_extern.h>
        !           104:
        !           105: #include <machine/bootconfig.h>
        !           106: #include <machine/bus.h>
        !           107: #include <machine/cpu.h>
        !           108: #include <machine/frame.h>
        !           109: #include <arm/kcore.h>
        !           110: #include <arm/undefined.h>
        !           111: #include <arm/machdep.h>
        !           112:
        !           113: #include <arm/sa11x0/sa11x0_reg.h>
        !           114: #include <arm/sa11x0/sa11x0_var.h>
        !           115: #include <machine/jornada_reg.h>
        !           116:
        !           117: /* Kernel text starts 2MB in from the bottom of the kernel address space. */
        !           118: #define        KERNEL_TEXT_BASE        (KERNEL_BASE + 0x00200000)
        !           119: #define        KERNEL_VM_BASE          (KERNEL_BASE + 0x10000000)
        !           120:
        !           121: /*
        !           122:  * The range 0xc1000000 - 0xcfffffff is available for kernel VM space
        !           123:  * Core-logic registers and I/O mappings occupy 0xfd000000 - 0xffffffff
        !           124:  */
        !           125: #define KERNEL_VM_SIZE         0x20000000
        !           126:
        !           127:
        !           128: /*
        !           129:  * Address to call from cpu_reset() to reset the machine.
        !           130:  * This is machine architecture dependant as it varies depending
        !           131:  * on where the ROM appears when you turn the MMU off.
        !           132:  */
        !           133:
        !           134: u_int cpu_reset_address = 0;
        !           135:
        !           136: /* Define various stack sizes in pages */
        !           137: #define IRQ_STACK_SIZE 1
        !           138: #define ABT_STACK_SIZE 1
        !           139: #ifdef IPKDB
        !           140: #define UND_STACK_SIZE 2
        !           141: #else
        !           142: #define UND_STACK_SIZE 1
        !           143: #endif
        !           144:
        !           145: BootConfig bootconfig;         /* Boot config storage */
        !           146: char *boot_args = NULL;
        !           147: char *boot_file = NULL;
        !           148:
        !           149: paddr_t physical_start;
        !           150: paddr_t physical_freestart;
        !           151: paddr_t physical_freeend;
        !           152: paddr_t physical_end;
        !           153: u_int free_pages;
        !           154: paddr_t pagetables_start;
        !           155: int physmem = 0;
        !           156:
        !           157: /*int debug_flags;*/
        !           158: #ifndef PMAP_STATIC_L1S
        !           159: int max_processes = 64;                        /* Default number */
        !           160: #endif /* !PMAP_STATIC_L1S */
        !           161:
        !           162: /* Physical and virtual addresses for some global pages */
        !           163: pv_addr_t systempage;
        !           164: pv_addr_t irqstack;
        !           165: pv_addr_t undstack;
        !           166: pv_addr_t abtstack;
        !           167: extern pv_addr_t kernelstack;
        !           168: pv_addr_t minidataclean;
        !           169:
        !           170: #define CPU_SA110_CACHE_CLEAN_SIZE (0x4000 * 2)
        !           171: extern unsigned int sa1_cache_clean_addr;
        !           172: extern unsigned int sa1_cache_clean_size;
        !           173: static vaddr_t sa1_cc_base;
        !           174:
        !           175: paddr_t msgbufphys;
        !           176:
        !           177: extern u_int data_abort_handler_address;
        !           178: extern u_int prefetch_abort_handler_address;
        !           179: extern u_int undefined_handler_address;
        !           180:
        !           181: #ifdef PMAP_DEBUG
        !           182: extern int pmap_debug_level;
        !           183: #endif
        !           184:
        !           185: #define KERNEL_PT_SYS          0       /* L2 table for mapping zero page */
        !           186: #define KERNEL_PT_KERNEL       1       /* L2 table for mapping kernel */
        !           187: #define        KERNEL_PT_KERNEL_NUM    8
        !           188: /* L2 table for mapping peripherals */
        !           189: #define        KERNEL_PT_IO            (KERNEL_PT_KERNEL + KERNEL_PT_KERNEL_NUM)
        !           190: /* L2 tables for mapping kernel VM */
        !           191: #define KERNEL_PT_VMDATA       (KERNEL_PT_IO + 1)
        !           192: #define        KERNEL_PT_VMDATA_NUM    4       /* start with 16MB of KVM */
        !           193: #define NUM_KERNEL_PTS         (KERNEL_PT_VMDATA + KERNEL_PT_VMDATA_NUM)
        !           194:
        !           195: pv_addr_t kernel_pt_table[NUM_KERNEL_PTS];
        !           196:
        !           197: extern struct user *proc0paddr;
        !           198:
        !           199: /* Prototypes */
        !           200:
        !           201: #define        BOOT_STRING_MAGIC 0x4f425344
        !           202:
        !           203: char   bootargs[MAX_BOOT_STRING];
        !           204: void   process_kernel_args(char *);
        !           205:
        !           206: void   consinit(void);
        !           207: void   fakecninit(bus_addr_t paddr);
        !           208:
        !           209: #ifdef BOOTCONSOLE_COM
        !           210: int    sacomcnattach(bus_space_tag_t bust, bus_addr_t busa, int speed);
        !           211: void   sacomfakecnattach(bus_addr_t addr);
        !           212: #else /* !BOOTCONSOLE_COM */
        !           213: #include <arch/jornada/dev/jfbreg.h>
        !           214: void   jfbfakecnattach(bus_addr_t addr);
        !           215: int    jfbcnattach(bus_space_tag_t bust, bus_addr_t busa);
        !           216: #endif /* BOOTCONSOLE_COM */
        !           217:
        !           218: #ifndef CONSPEED
        !           219: #define CONSPEED 115200
        !           220: #endif
        !           221:
        !           222: int comcnspeed = CONSPEED;
        !           223:
        !           224:
        !           225: /*
        !           226:  * void boot(int howto, char *bootstr)
        !           227:  *
        !           228:  * Reboots the system
        !           229:  *
        !           230:  * Deal with any syncing, unmounting, dumping and shutdown hooks,
        !           231:  * then reset the CPU.
        !           232:  */
        !           233: void   board_reset(void);
        !           234: void   board_powerdown(void);
        !           235: void
        !           236: boot(int howto)
        !           237: {
        !           238:        /*
        !           239:         * If we are still cold then hit the air brakes
        !           240:         * and crash to earth fast
        !           241:         */
        !           242:        if (cold) {
        !           243:                doshutdownhooks();
        !           244:                if ((howto & (RB_HALT | RB_USERREQ)) != RB_USERREQ) {
        !           245:                        printf("The operating system has halted.\n");
        !           246:                        printf("Please press any key to reboot.\n\n");
        !           247:                        cngetc();
        !           248:                }
        !           249: #ifndef DO_NOT_RESET_SA1
        !           250:                printf("rebooting...\n");
        !           251:                delay(60000);
        !           252:                cpu_reset();
        !           253:                printf("reboot failed; spinning\n");
        !           254: #else /* DO_NOT_RESET_SA1 */
        !           255:                printf("will not reset CPU; spinning\n");
        !           256: #endif /* !DO_NOT_RESET_SA1 */
        !           257:                while(1);
        !           258:                /*NOTREACHED*/
        !           259:        }
        !           260:
        !           261:        /* Disable console buffering */
        !           262: /*     cnpollc(1);*/
        !           263:
        !           264:        /*
        !           265:         * If RB_NOSYNC was not specified sync the discs.
        !           266:         * Note: Unless cold is set to 1 here, syslogd will die during the
        !           267:         * unmount.  It looks like syslogd is getting woken up only to find
        !           268:         * that it cannot page part of the binary in as the filesystem has
        !           269:         * been unmounted.
        !           270:         */
        !           271:        if (!(howto & RB_NOSYNC))
        !           272:                bootsync(howto);
        !           273:
        !           274:        /* Say NO to interrupts */
        !           275:        splhigh();
        !           276:
        !           277:        /* Do a dump if requested. */
        !           278:        if ((howto & (RB_DUMP | RB_HALT)) == RB_DUMP)
        !           279:                dumpsys();
        !           280:
        !           281:        /* Run any shutdown hooks */
        !           282:        doshutdownhooks();
        !           283:
        !           284:        /* Make sure IRQ's are disabled */
        !           285:        IRQdisable;
        !           286:
        !           287:        if (howto & RB_HALT) {
        !           288:                if (howto & RB_POWERDOWN) {
        !           289:                        /* TODO */
        !           290:                        //board_powerdown();
        !           291:                        printf("WARNING: powerdown failed!\n");
        !           292:                }
        !           293:
        !           294:                printf("The operating system has halted.\n");
        !           295:                printf("Please press any key to reboot.\n\n");
        !           296:                cngetc();
        !           297:        }
        !           298:
        !           299: #ifndef DO_NOT_RESET_SA1
        !           300:        printf("rebooting...\n");
        !           301:
        !           302: /* TODO board_reset */
        !           303:        cpu_reset();
        !           304:        printf("reboot failed; spinning\n");
        !           305: #else /* DO_NOT_RESET_SA1 */
        !           306:        printf("will not reset CPU; spinning\n");
        !           307: #endif /* !DO_NOT_RESET_SA1 */
        !           308:        while(1)
        !           309:                ;
        !           310:        /*NOTREACHED*/
        !           311: }
        !           312:
        !           313: /*
        !           314:  * Mapping table for core kernel memory. These areas are mapped in
        !           315:  * init time at fixed virtual address with section mappings.
        !           316:  */
        !           317: const struct pmap_devmap jornada_devmap[] = {
        !           318:     /*
        !           319:      * Map the on-board devices VA == PA so that we can access them
        !           320:      * with the MMU on or off.
        !           321:      */
        !           322:     {
        !           323:        SACOM3_BASE,
        !           324:        SACOM3_HW_BASE,
        !           325:        0x24 /* SACOM3_SIZE, */,
        !           326:        VM_PROT_READ|VM_PROT_WRITE,
        !           327:        PTE_NOCACHE,
        !           328:     },
        !           329:     {
        !           330:        SAIPIC_VBASE,
        !           331:        SAIPIC_BASE,
        !           332:        0x24 /* SAIPIC_SIZE, */,
        !           333:        VM_PROT_READ|VM_PROT_WRITE,
        !           334:        PTE_NOCACHE,
        !           335:     },
        !           336: #ifndef BOOTCONSOLE_COM
        !           337:     {
        !           338:        JFB_VBASE,
        !           339:        JFB_BASE,
        !           340:        JFB_SIZE,
        !           341:        VM_PROT_READ|VM_PROT_WRITE,
        !           342:        PTE_NOCACHE,
        !           343:     },
        !           344: #endif /* !BOOTCONSOLE_COM */
        !           345:     {0, 0, 0, 0, 0}
        !           346: };
        !           347:
        !           348:
        !           349: /*
        !           350:  * u_int initarm(...)
        !           351:  *
        !           352:  * Initial entry point on startup. This gets called before main() is
        !           353:  * entered.
        !           354:  * It should be responsible for setting up everything that must be
        !           355:  * in place when main is called.
        !           356:  * This includes
        !           357:  *   Taking a copy of the boot configuration structure.
        !           358:  *   Initialising the physical console so characters can be printed.
        !           359:  *   Setting up page tables for the kernel
        !           360:  *   Relocating the kernel to the bottom of physical memory
        !           361:  */
        !           362: u_int
        !           363: initarm(void *arg)
        !           364: {
        !           365:        extern cpu_kcore_hdr_t cpu_kcore_hdr;
        !           366:        int loop;
        !           367:        int loop1;
        !           368:        u_int l1pagetable;
        !           369:        pv_addr_t kernel_l1pt;
        !           370:        paddr_t memstart;
        !           371:        psize_t memsize;
        !           372:        extern u_int32_t esym;  /* &_end if no symbols are loaded */
        !           373:
        !           374:        /* get ready for splfoo() */
        !           375:        sa11x0_intr_bootstrap(SAIPIC_BASE);
        !           376:
        !           377:        pmap_devmap_register(jornada_devmap);
        !           378:
        !           379:        /* setup a serial console for very early boot */
        !           380: #ifdef BOOTCONSOLE_COM
        !           381:        fakecninit(SACOM3_HW_BASE);
        !           382: #else
        !           383:        fakecninit(JFB_BASE);
        !           384: #endif
        !           385:
        !           386:        /*
        !           387:         * Heads up ... Setup the CPU / MMU / TLB functions
        !           388:         */
        !           389:        if (set_cpufuncs())
        !           390:                panic("cpu not recognized!");
        !           391:
        !           392:        /*
        !           393:         * Examine the boot args string for options we need to know about
        !           394:         * now.
        !           395:         */
        !           396:        /* XXX should really be done after setting up the console, but we
        !           397:         * XXX need to parse the console selection flags right now. */
        !           398:        process_kernel_args((char *)0xc0200000 - MAX_BOOT_STRING - 1);
        !           399: #ifdef RAMDISK_HOOKS
        !           400:         boothowto |= RB_DFLTROOT;
        !           401: #endif /* RAMDISK_HOOKS */
        !           402:
        !           403:        /* Talk to the user */
        !           404:        printf("\nOpenBSD/jornada booting ...\n");
        !           405:
        !           406: #define VERBOSE_INIT_ARM
        !           407:
        !           408:        /* Ugly hardcode DRAM bounds */
        !           409:        /* TODO */
        !           410:        memstart = (paddr_t)0xc0000000;
        !           411:        memsize = (psize_t)32 * 1024 * 1024;
        !           412:
        !           413: //#define DEBUG
        !           414: #ifdef DEBUG
        !           415:        printf("initarm: Configuring system ...\n");
        !           416: #endif
        !           417:
        !           418:        /* Fake bootconfig structure for the benefit of pmap.c */
        !           419:        /* XXX must make the memory description h/w independant */
        !           420:        bootconfig.dramblocks = 1;
        !           421:        bootconfig.dram[0].address = memstart;
        !           422:        bootconfig.dram[0].pages = memsize / PAGE_SIZE;
        !           423:
        !           424:        /*
        !           425:         * Set up the variables that define the availablilty of
        !           426:         * physical memory.  For now, we're going to set
        !           427:         * physical_freestart to 0xc0200000 (where the kernel
        !           428:         * was loaded), and allocate the memory we need downwards.
        !           429:         * We will update physical_freestart and physical_freeend
        !           430:         * later to reflect what pmap_bootstrap() wants to see.
        !           431:         *
        !           432:         * XXX pmap_bootstrap() needs an enema.
        !           433:         */
        !           434:        physical_start = bootconfig.dram[0].address;
        !           435:        physical_end = physical_start + (bootconfig.dram[0].pages * PAGE_SIZE);
        !           436:
        !           437:        physical_freestart = 0xc0200000UL;
        !           438:        physical_freeend = physical_end;
        !           439:
        !           440:        physmem = (physical_end - physical_start) / PAGE_SIZE;
        !           441:
        !           442: #if defined(DEBUG) || defined(VERBOSE_INIT_ARM)
        !           443:        /* Tell the user about the memory */
        !           444:        printf("physmemory: %d pages at 0x%08lx -> 0x%08lx\n", physmem,
        !           445:            physical_start, physical_end - 1);
        !           446: #endif
        !           447:
        !           448:        /*
        !           449:         * Okay, the kernel starts 2MB in from the bottom of physical
        !           450:         * memory.  We are going to allocate our bootstrap pages downwards
        !           451:         * from there.
        !           452:         *
        !           453:         * We need to allocate some fixed page tables to get the kernel
        !           454:         * going.  We allocate one page directory and a number of page
        !           455:         * tables and store the physical addresses in the kernel_pt_table
        !           456:         * array.
        !           457:         *
        !           458:         * The kernel page directory must be on a 16K boundary.  The page
        !           459:         * tables must be on 4K boundaries.  What we do is allocate the
        !           460:         * page directory on the first 16K boundary that we encounter, and
        !           461:         * the page tables on 4K boundaries otherwise.  Since we allocate
        !           462:         * at least 3 L2 page tables, we are guaranteed to encounter at
        !           463:         * least one 16K aligned region.
        !           464:         */
        !           465:
        !           466: #ifdef VERBOSE_INIT_ARM
        !           467:        printf("Allocating page tables\n");
        !           468: #endif
        !           469:
        !           470:        free_pages = (physical_freeend - physical_freestart) / PAGE_SIZE;
        !           471:
        !           472: #ifdef VERBOSE_INIT_ARM
        !           473:        printf("freestart = 0x%08lx, free_pages = %d (0x%08x)\n",
        !           474:               physical_freestart, free_pages, free_pages);
        !           475: #endif
        !           476:
        !           477:        /* Define a macro to simplify memory allocation */
        !           478: #define        valloc_pages(var, np)                           \
        !           479:        alloc_pages((var).pv_pa, (np));                 \
        !           480:        (var).pv_va = KERNEL_BASE + (var).pv_pa - physical_start;
        !           481:
        !           482: #define alloc_pages(var, np)                           \
        !           483:        physical_freeend -= ((np) * PAGE_SIZE);         \
        !           484:        if (physical_freeend < physical_freestart)      \
        !           485:                panic("initarm: out of memory");        \
        !           486:        (var) = physical_freeend;                       \
        !           487:        free_pages -= (np);                             \
        !           488:        memset((char *)(var), 0, ((np) * PAGE_SIZE));
        !           489:
        !           490:        loop1 = 0;
        !           491:        kernel_l1pt.pv_pa = 0;
        !           492:        for (loop = 0; loop <= NUM_KERNEL_PTS; ++loop) {
        !           493:                /* Are we 16KB aligned for an L1 ? */
        !           494:                if (((physical_freeend - L1_TABLE_SIZE) & (L1_TABLE_SIZE - 1)) == 0
        !           495:                    && kernel_l1pt.pv_pa == 0) {
        !           496:                        valloc_pages(kernel_l1pt, L1_TABLE_SIZE / PAGE_SIZE);
        !           497:                } else {
        !           498:                        valloc_pages(kernel_pt_table[loop1],
        !           499:                            L2_TABLE_SIZE / PAGE_SIZE);
        !           500:                        ++loop1;
        !           501:                }
        !           502:        }
        !           503:
        !           504:        /* This should never be able to happen but better confirm that. */
        !           505:        if (!kernel_l1pt.pv_pa || (kernel_l1pt.pv_pa & (L1_TABLE_SIZE-1)) != 0)
        !           506:                panic("initarm: Failed to align the kernel page directory");
        !           507:
        !           508:        /*
        !           509:         * Allocate a page for the system page mapped to V0x00000000
        !           510:         * This page will just contain the system vectors and can be
        !           511:         * shared by all processes.
        !           512:         */
        !           513:        alloc_pages(systempage.pv_pa, 1);
        !           514:
        !           515:        /* Allocate stacks for all modes */
        !           516:        valloc_pages(irqstack, IRQ_STACK_SIZE);
        !           517:        valloc_pages(abtstack, ABT_STACK_SIZE);
        !           518:        valloc_pages(undstack, UND_STACK_SIZE);
        !           519:        valloc_pages(kernelstack, UPAGES);
        !           520:
        !           521: #ifdef VERBOSE_INIT_ARM
        !           522:        printf("IRQ stack: p0x%08lx v0x%08lx\n", irqstack.pv_pa,
        !           523:            irqstack.pv_va);
        !           524:        printf("ABT stack: p0x%08lx v0x%08lx\n", abtstack.pv_pa,
        !           525:            abtstack.pv_va);
        !           526:        printf("UND stack: p0x%08lx v0x%08lx\n", undstack.pv_pa,
        !           527:            undstack.pv_va);
        !           528:        printf("SVC stack: p0x%08lx v0x%08lx\n", kernelstack.pv_pa,
        !           529:            kernelstack.pv_va);
        !           530: #endif
        !           531:
        !           532:        /*
        !           533:         * XXX Defer this to later so that we can reclaim the memory
        !           534:         * XXX used by the RedBoot page tables.
        !           535:         */
        !           536:        alloc_pages(msgbufphys, round_page(MSGBUFSIZE) / PAGE_SIZE);
        !           537:
        !           538:        /*
        !           539:         * XXX Actually, we only need virtual space and don't need
        !           540:         * XXX physical memory for sa110_cc_base and sa11x0_idle_mem.
        !           541:         */
        !           542:        /*
        !           543:         * XXX totally stuffed hack to work round problems introduced
        !           544:         * in recent versions of the pmap code. Due to the calls used there
        !           545:         * we cannot allocate virtual memory during bootstrap.
        !           546:         */
        !           547:        for (;;) {
        !           548:                alloc_pages(sa1_cc_base, 1);
        !           549:                if (!(sa1_cc_base & (CPU_SA110_CACHE_CLEAN_SIZE - 1)))
        !           550:                        break;
        !           551:        }
        !           552:        {
        !           553:                vaddr_t dummy;
        !           554:                alloc_pages(dummy, CPU_SA110_CACHE_CLEAN_SIZE / PAGE_SIZE - 1);
        !           555:        }
        !           556:        sa1_cache_clean_addr = sa1_cc_base;
        !           557:        sa1_cache_clean_size = CPU_SA110_CACHE_CLEAN_SIZE / 2;
        !           558:
        !           559:
        !           560:        /*
        !           561:         * Ok we have allocated physical pages for the primary kernel
        !           562:         * page tables
        !           563:         */
        !           564:
        !           565: #ifdef VERBOSE_INIT_ARM
        !           566:        printf("Creating L1 page table at 0x%08lx\n", kernel_l1pt.pv_pa);
        !           567: #endif
        !           568:
        !           569:        /*
        !           570:         * Now we start construction of the L1 page table
        !           571:         * We start by mapping the L2 page tables into the L1.
        !           572:         * This means that we can replace L1 mappings later on if necessary
        !           573:         */
        !           574:        l1pagetable = kernel_l1pt.pv_pa;
        !           575:
        !           576: #ifdef HIGH_VECT
        !           577:        /* Map the L2 pages tables in the L1 page table */
        !           578:        pmap_link_l2pt(l1pagetable, ARM_VECTORS_HIGH & ~(0x00400000 - 1),
        !           579:            &kernel_pt_table[KERNEL_PT_SYS]);
        !           580: #else
        !           581:        /* Map the L2 pages tables in the L1 page table */
        !           582:        pmap_link_l2pt(l1pagetable, 0x00000000,
        !           583:            &kernel_pt_table[KERNEL_PT_SYS]);
        !           584: #endif
        !           585:        for (loop = 0; loop < KERNEL_PT_KERNEL_NUM; loop++)
        !           586:                pmap_link_l2pt(l1pagetable, KERNEL_BASE + loop * 0x00400000,
        !           587:                    &kernel_pt_table[KERNEL_PT_KERNEL + loop]);
        !           588:
        !           589:        for (loop = 0; loop < KERNEL_PT_VMDATA_NUM; loop++)
        !           590:                pmap_link_l2pt(l1pagetable, KERNEL_VM_BASE + loop * 0x00400000,
        !           591:                    &kernel_pt_table[KERNEL_PT_VMDATA + loop]);
        !           592:
        !           593:        /* link devices */
        !           594:        pmap_link_l2pt(l1pagetable, 0xfd000000/* XXX XXX */,
        !           595:            &kernel_pt_table[KERNEL_PT_IO]);
        !           596:
        !           597:        /* update the top of the kernel VM */
        !           598:        pmap_curmaxkvaddr =
        !           599:            KERNEL_VM_BASE + (KERNEL_PT_VMDATA_NUM * 0x00400000);
        !           600:
        !           601: #ifdef VERBOSE_INIT_ARM
        !           602:        printf("Mapping kernel\n");
        !           603: #endif
        !           604:
        !           605:        /* Now we fill in the L2 pagetable for the kernel static code/data
        !           606:         * and the symbol table. */
        !           607:        {
        !           608:                extern char etext[];
        !           609: #ifdef VERBOSE_INIT_ARM
        !           610:                extern char _end[];
        !           611: #endif
        !           612:                size_t textsize = (u_int32_t) etext - KERNEL_TEXT_BASE;
        !           613:                size_t totalsize = esym - KERNEL_TEXT_BASE;
        !           614:                u_int logical;
        !           615:
        !           616: #ifdef VERBOSE_INIT_ARM
        !           617:                printf("kernelsize text %x total %x end %x esym %x\n",
        !           618:                    textsize, totalsize, _end, esym);
        !           619: #endif
        !           620:
        !           621:                textsize = round_page(textsize);
        !           622:                totalsize = round_page(totalsize);
        !           623:
        !           624:                logical = 0x00200000;   /* offset of kernel in RAM */
        !           625:
        !           626:                /* Update dump information */
        !           627:                cpu_kcore_hdr.kernelbase = KERNEL_BASE;
        !           628:                cpu_kcore_hdr.kerneloffs = logical;
        !           629:                cpu_kcore_hdr.staticsize = totalsize;
        !           630:
        !           631:                logical += pmap_map_chunk(l1pagetable, KERNEL_BASE + logical,
        !           632:                    physical_start + logical, textsize,
        !           633:                    VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
        !           634:                pmap_map_chunk(l1pagetable, KERNEL_BASE + logical,
        !           635:                    physical_start + logical, totalsize - textsize,
        !           636:                    VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
        !           637:        }
        !           638:
        !           639: #ifdef VERBOSE_INIT_ARM
        !           640:        printf("Constructing L2 page tables\n");
        !           641: #endif
        !           642:
        !           643:        /* Map the stack pages */
        !           644:        pmap_map_chunk(l1pagetable, irqstack.pv_va, irqstack.pv_pa,
        !           645:            IRQ_STACK_SIZE * PAGE_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
        !           646:        pmap_map_chunk(l1pagetable, abtstack.pv_va, abtstack.pv_pa,
        !           647:            ABT_STACK_SIZE * PAGE_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
        !           648:        pmap_map_chunk(l1pagetable, undstack.pv_va, undstack.pv_pa,
        !           649:            UND_STACK_SIZE * PAGE_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
        !           650:        pmap_map_chunk(l1pagetable, kernelstack.pv_va, kernelstack.pv_pa,
        !           651:            UPAGES * PAGE_SIZE, VM_PROT_READ | VM_PROT_WRITE, PTE_CACHE);
        !           652:
        !           653:        pmap_map_chunk(l1pagetable, kernel_l1pt.pv_va, kernel_l1pt.pv_pa,
        !           654:            L1_TABLE_SIZE, VM_PROT_READ | VM_PROT_WRITE, PTE_PAGETABLE);
        !           655:
        !           656:        for (loop = 0; loop < NUM_KERNEL_PTS; ++loop) {
        !           657:                pmap_map_chunk(l1pagetable, kernel_pt_table[loop].pv_va,
        !           658:                    kernel_pt_table[loop].pv_pa, L2_TABLE_SIZE,
        !           659:                    VM_PROT_READ|VM_PROT_WRITE, PTE_PAGETABLE);
        !           660:        }
        !           661:
        !           662:        pmap_map_chunk(l1pagetable, sa1_cache_clean_addr, 0xe0000000,
        !           663:            CPU_SA110_CACHE_CLEAN_SIZE, VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
        !           664:
        !           665:        /* Map the vector page. */
        !           666: #ifdef HIGH_VECT
        !           667:        pmap_map_entry(l1pagetable, ARM_VECTORS_HIGH, systempage.pv_pa,
        !           668:            VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
        !           669: #else
        !           670:         pmap_map_entry(l1pagetable, vector_page, systempage.pv_pa,
        !           671:            VM_PROT_READ|VM_PROT_WRITE, PTE_CACHE);
        !           672: #endif
        !           673:
        !           674:        /* XXX XXX */
        !           675:        pmap_devmap_bootstrap(l1pagetable, jornada_devmap);
        !           676:
        !           677:        /*
        !           678:         * Now we have the real page tables in place so we can switch to them.
        !           679:         * Once this is done we will be running with the REAL kernel page
        !           680:         * tables.
        !           681:         */
        !           682:
        !           683:        /*
        !           684:         * Update the physical_freestart/physical_freeend/free_pages
        !           685:         * variables.
        !           686:         */
        !           687:        {
        !           688:                physical_freestart = physical_start - KERNEL_BASE +
        !           689:                    round_page(esym);
        !           690:                physical_freeend = physical_end;
        !           691:                free_pages =
        !           692:                    (physical_freeend - physical_freestart) / PAGE_SIZE;
        !           693:        }
        !           694: #ifdef VERBOSE_INIT_ARM
        !           695:        printf("physical_freestart %x end %x\n", physical_freestart,
        !           696:            physical_freeend);
        !           697: #endif
        !           698:
        !           699:        /* be a client to all domains */
        !           700:        cpu_domains(0x55555555);
        !           701:        /* Switch tables */
        !           702: #ifdef VERBOSE_INIT_ARM
        !           703:        printf("freestart = 0x%08lx, free_pages = %d (0x%x)\n",
        !           704:               physical_freestart, free_pages, free_pages);
        !           705:        printf("switching to new L1 page table  @%#lx...", kernel_l1pt.pv_pa);
        !           706: #endif
        !           707:
        !           708:        /* set new intc register address so that splfoo() doesn't
        !           709:                touch illegal address.  */
        !           710:        sa11x0_intr_bootstrap(SAIPIC_VBASE);
        !           711:
        !           712:        cpu_domains((DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL*2)) | DOMAIN_CLIENT);
        !           713:        setttb(kernel_l1pt.pv_pa);
        !           714:        cpu_tlb_flushID();
        !           715:        cpu_domains(DOMAIN_CLIENT << (PMAP_DOMAIN_KERNEL*2));
        !           716:
        !           717:        /* update with our virtual address */
        !           718: #ifdef BOOTCONSOLE_COM
        !           719:        fakecninit(SACOM3_BASE);
        !           720: #else
        !           721:        fakecninit(JFB_VBASE);
        !           722: #endif /* BOOTCONSOLE_COM */
        !           723:        /*
        !           724:         * Moved from cpu_startup() as data_abort_handler() references
        !           725:         * this during uvm init
        !           726:         */
        !           727:        proc0paddr = (struct user *)kernelstack.pv_va;
        !           728:        proc0.p_addr = proc0paddr;
        !           729:
        !           730: #ifdef VERBOSE_INIT_ARM
        !           731:        printf("bootstrap done.\n");
        !           732: #endif
        !           733:
        !           734: #ifdef HIGH_VECT
        !           735:        arm32_vector_init(ARM_VECTORS_HIGH, ARM_VEC_ALL);
        !           736: #else
        !           737:        arm32_vector_init(ARM_VECTORS_LOW, ARM_VEC_ALL);
        !           738: #endif
        !           739:
        !           740:        /*
        !           741:         * Pages were allocated during the secondary bootstrap for the
        !           742:         * stacks for different CPU modes.
        !           743:         * We must now set the r13 registers in the different CPU modes to
        !           744:         * point to these stacks.
        !           745:         * Since the ARM stacks use STMFD etc. we must set r13 to the top end
        !           746:         * of the stack memory.
        !           747:         */
        !           748: #ifdef VERBOSE_INIT_ARM
        !           749:        printf("init subsystems: stacks ");
        !           750: #endif
        !           751:
        !           752:        set_stackptr(PSR_IRQ32_MODE,
        !           753:            irqstack.pv_va + IRQ_STACK_SIZE * PAGE_SIZE);
        !           754:        set_stackptr(PSR_ABT32_MODE,
        !           755:            abtstack.pv_va + ABT_STACK_SIZE * PAGE_SIZE);
        !           756:        set_stackptr(PSR_UND32_MODE,
        !           757:            undstack.pv_va + UND_STACK_SIZE * PAGE_SIZE);
        !           758:
        !           759:        /*
        !           760:         * Well we should set a data abort handler.
        !           761:         * Once things get going this will change as we will need a proper
        !           762:         * handler.
        !           763:         * Until then we will use a handler that just panics but tells us
        !           764:         * why.
        !           765:         * Initialisation of the vectors will just panic on a data abort.
        !           766:         * This just fills in a slightly better one.
        !           767:         */
        !           768: #ifdef VERBOSE_INIT_ARM
        !           769:        printf("vectors ");
        !           770: #endif
        !           771:        data_abort_handler_address = (u_int)data_abort_handler;
        !           772:        prefetch_abort_handler_address = (u_int)prefetch_abort_handler;
        !           773:        undefined_handler_address = (u_int)undefinedinstruction_bounce;
        !           774:
        !           775:        /* Initialise the undefined instruction handlers */
        !           776: #ifdef VERBOSE_INIT_ARM
        !           777:        printf("undefined ");
        !           778: #endif
        !           779:        undefined_init();
        !           780:
        !           781:        /* Load memory into UVM. */
        !           782: #ifdef VERBOSE_INIT_ARM
        !           783:        printf("page ");
        !           784: #endif
        !           785:        uvm_setpagesize();      /* initialize PAGE_SIZE-dependent variables */
        !           786:        uvm_page_physload(atop(physical_freestart), atop(physical_freeend),
        !           787:            atop(physical_freestart), atop(physical_freeend),
        !           788:            VM_FREELIST_DEFAULT);
        !           789:
        !           790:        /* Boot strap pmap telling it where the kernel page table is */
        !           791: #ifdef VERBOSE_INIT_ARM
        !           792:        printf("pmap ");
        !           793: #endif
        !           794:        pmap_bootstrap((pd_entry_t *)kernel_l1pt.pv_va, KERNEL_VM_BASE,
        !           795:            KERNEL_VM_BASE + KERNEL_VM_SIZE);
        !           796:
        !           797:        /* Update dump information */
        !           798:        cpu_kcore_hdr.pmap_kernel_l1 = (u_int32_t)pmap_kernel()->pm_l1;
        !           799:        cpu_kcore_hdr.pmap_kernel_l2 = (u_int32_t)&(pmap_kernel()->pm_l2);
        !           800:
        !           801:        /* Setup the IRQ system */
        !           802: #ifdef VERBOSE_INIT_ARM
        !           803:        printf("irq ");
        !           804: #endif
        !           805:        sa11x0_init_interrupt_masks();
        !           806:
        !           807: #ifdef VERBOSE_INIT_ARM
        !           808:        printf("done.\n");
        !           809: #endif
        !           810:
        !           811: #ifdef DDB
        !           812:        db_machine_init();
        !           813:
        !           814:        /* Firmware doesn't load symbols. */
        !           815:        ddb_init();
        !           816:
        !           817:        if (boothowto & RB_KDB)
        !           818:                Debugger();
        !           819: #endif
        !           820:
        !           821:        /* We return the new stack pointer address */
        !           822:        return(kernelstack.pv_va + USPACE_SVC_STACK_TOP);
        !           823: }
        !           824:
        !           825: void
        !           826: process_kernel_args(char *args)
        !           827: {
        !           828:        char *cp = args;
        !           829:
        !           830:        if (cp == NULL || *(int *)cp != BOOT_STRING_MAGIC) {
        !           831:                boothowto = RB_AUTOBOOT;
        !           832:                return;
        !           833:        }
        !           834:
        !           835:        /* Eat the cookie */
        !           836:        *(int *)cp = 0;
        !           837:        cp += sizeof(int);
        !           838:
        !           839:        boothowto = 0;
        !           840:
        !           841:        /* Make a local copy of the bootargs */
        !           842:        strncpy(bootargs, cp, MAX_BOOT_STRING - sizeof(int));
        !           843:
        !           844:        cp = bootargs;
        !           845:        boot_file = bootargs;
        !           846:
        !           847:        /* Skip the kernel image filename */
        !           848:        while (*cp != ' ' && *cp != 0)
        !           849:                ++cp;
        !           850:
        !           851:        if (*cp != 0)
        !           852:                *cp++ = 0;
        !           853:
        !           854:        while (*cp == ' ')
        !           855:                ++cp;
        !           856:
        !           857:        boot_args = cp;
        !           858:
        !           859: #if 0
        !           860:        printf("bootfile: %s\n", boot_file);
        !           861:        printf("bootargs: %s\n", boot_args);
        !           862: #endif
        !           863:
        !           864:        /* Setup pointer to boot flags */
        !           865:        while (*cp != '-')
        !           866:                if (*cp++ == '\0')
        !           867:                        return;
        !           868:
        !           869:        for (;*++cp;) {
        !           870:                int fl;
        !           871:
        !           872:                fl = 0;
        !           873:                switch(*cp) {
        !           874:                case 'a':
        !           875:                        fl |= RB_ASKNAME;
        !           876:                        break;
        !           877:                case 'c':
        !           878:                        fl |= RB_CONFIG;
        !           879:                        break;
        !           880:                case 'd':
        !           881:                        fl |= RB_KDB;
        !           882:                        break;
        !           883:                case 's':
        !           884:                        fl |= RB_SINGLE;
        !           885:                        break;
        !           886:                default:
        !           887:                        printf("unknown option `%c'\n", *cp);
        !           888:                        break;
        !           889:                }
        !           890:                boothowto |= fl;
        !           891:        }
        !           892: }
        !           893:
        !           894:
        !           895: void
        !           896: consinit(void)
        !           897: {
        !           898:        /* XXX defer console attachment to autoconf */
        !           899:        return;
        !           900: }
        !           901:
        !           902: void
        !           903: fakecninit(bus_addr_t addr)
        !           904: {
        !           905:        /*
        !           906:         * Early console initialization.
        !           907:         * XXX cn_getc stuff
        !           908:         */
        !           909:        switch(addr) {
        !           910: #ifdef BOOTCONSOLE_COM
        !           911:                case SACOM3_HW_BASE:
        !           912:                case SACOM3_BASE:
        !           913:                        sacomfakecnattach(addr);
        !           914:                        break;
        !           915: #else
        !           916:                case JFB_BASE:
        !           917:                case JFB_VBASE:
        !           918:                        jfbfakecnattach(addr);
        !           919:                        break;
        !           920: #endif /* BOOTCONSOLE_COM */
        !           921:                default:
        !           922:                        panic("serial console not configured");
        !           923:        }
        !           924: }
        !           925:
        !           926: void
        !           927: board_startup(void)
        !           928: {
        !           929:         if (boothowto & RB_CONFIG) {
        !           930: #ifdef BOOT_CONFIG
        !           931:                user_config();
        !           932: #else
        !           933:                printf("kernel does not support -c; continuing..\n");
        !           934: #endif
        !           935:        }
        !           936: }

CVSweb