Home | History | Annotate | Line # | Download | only in pbsdboot 
      1 /*	$NetBSD: mips.c,v 1.4 2007/03/04 05:59:53 christos Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 1999 Shin Takemura.
      5  * All rights reserved.
      6  *
      7  * This software is part of the PocketBSD.
      8  *
      9  * Redistribution and use in source and binary forms, with or without
     10  * modification, are permitted provided that the following conditions
     11  * are met:
     12  * 1. Redistributions of source code must retain the above copyright
     13  *    notice, this list of conditions and the following disclaimer.
     14  * 2. Redistributions in binary form must reproduce the above copyright
     15  *    notice, this list of conditions and the following disclaimer in the
     16  *    documentation and/or other materials provided with the distribution.
     17  * 3. All advertising materials mentioning features or use of this software
     18  *    must display the following acknowledgement:
     19  *	This product includes software developed by the PocketBSD project
     20  *	and its contributors.
     21  * 4. Neither the name of the project nor the names of its contributors
     22  *    may be used to endorse or promote products derived from this software
     23  *    without specific prior written permission.
     24  *
     25  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     26  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     27  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     28  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     29  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     30  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     31  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     32  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     33  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     34  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     35  * SUCH DAMAGE.
     36  *
     37  */
     38 #include <pbsdboot.h>
     39 
     40 #define DUMMYBUFSIZE	(1024*32)
     41 int dummy_buf[DUMMYBUFSIZE];
     42 
     43 int
     44 mips_boot(void *map)
     45 {
     46 	unsigned char *mem;
     47 	unsigned long jump_instruction, phys_mem;
     48 	int i, j;
     49 
     50 	/*
     51 	 *  allocate physical memory for startup program.
     52 	 */
     53 	if ((mem = (unsigned char*)vmem_alloc()) == NULL) {
     54 		msg_printf(MSG_ERROR, whoami, TEXT("Can't allocate root page.\n"));
     55 		return -1;
     56 	}
     57 
     58 	/*
     59 	 *  copy startup program code
     60 	 */
     61 	memcpy(mem, system_info.si_asmcode, system_info.si_asmcodelen);
     62 
     63 	/*
     64 	 *  set map address (override target field of asmcode
     65 	 *  "lui a0, 0x0; ori a0, 0x0;".
     66 	 */
     67 	*(unsigned short*)&mem[0] = (unsigned short)(((long)map) >> 16);
     68 	*(unsigned short*)&mem[4] = (unsigned short)map;
     69 
     70 	/*
     71 	 *  construct start instruction
     72 	 */
     73 	if (!(phys_mem = (unsigned long)vtophysaddr(mem))) {
     74 		msg_printf(MSG_ERROR, whoami, TEXT("Missing physical page.\n"));
     75 		return -1;
     76 	}
     77 	jump_instruction = (0x08000000 | ((phys_mem >> 2) & 0x03ffffff));
     78 
     79 	/*
     80 	 *  map interrupt vector
     81 	 */
     82 	mem = (unsigned char*)VirtualAlloc(0, 0x400, MEM_RESERVE, PAGE_NOACCESS);
     83 	if (!(VirtualCopy((LPVOID)mem, (LPVOID)(system_info.si_dramstart >> 8), 0x400,
     84 			  PAGE_READWRITE | PAGE_NOCACHE | PAGE_PHYSICAL))) {
     85 		msg_printf(MSG_ERROR, whoami, TEXT("Mapping interrupt vector failed.\n"));
     86 		return -1;
     87 	}
     88 
     89 	/*
     90 	 *  Flush D-cache
     91 	 */
     92 	for (i = 0; i < DUMMYBUFSIZE; i++) {
     93 		dummy_buf[i] = j;
     94 	}
     95 	for (i = 0; i < DUMMYBUFSIZE; i++) {
     96 		j = dummy_buf[i];
     97 		j++;
     98 	}
     99 	/*
    100 	 *  Flush I-cache
    101 	 */
    102 	__asm(".space 32768;");
    103 
    104 	/*
    105 	 *  GO !
    106 	 */
    107 	*(unsigned long*)&mem[system_info.si_intrvec] = jump_instruction;
    108 
    109 	return (0); /* not reachable */
    110 }
    111