/*	$NetBSD: bsdstart.S,v 1.3 2009/10/20 19:10:11 snj Exp $	*/

/*
 * Copyright (c) 1995 L. Weppelman
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

/*
 * This function sets up the registers according to the kernel parameter block,
 * disables the MMU and jumps to the kernel.
 *
 * bsd_startup(struct kparamb *)
 */

#ifndef TOSTOOLS
#include <machine/asm.h>
#endif

#ifdef TOSTOOLS
	.globl _bsd_startup
_bsd_startup:
#else
ENTRY_NOPROFILE(bsd_startup)
#endif
	movw	#0x2700,%sr

	| the BSD kernel wants values into the following registers:
	| d0:  ttmem-size
	| d1:  stmem-size
	| d2:  cputype
	| d3:  boothowto
	| d4:  length of loaded kernel
	| d5:  start of fastram
	| a0:  start of loaded kernel
	| a1:  end of symbols (esym)
	| All other registers zeroed for possible future requirements.

	movl	%sp@(4),%a3		| a3 points to parameter block
#ifdef	TOSTOOLS
	lea	_bsd_startup,%sp	| make sure we have a good stack ***
#endif
	movl	%a3@,%a0		| loaded kernel
	movl	%a3@(8),%d0		| kernel entry point
	addl	%a0,%d0			| added makes our absolute entry point
	movl	%d0,%sp@-		| push entry point		***
	movl	%a3@(12),%d1		| stmem-size
	movl	%a3@(16),%d0		| ttmem-size
	movl	%a3@(20),%d2		| bootflags
	movl	%a3@(24),%d3		| boothowto
	movl	%a3@(4),%d4		| length of loaded kernel
	movl	%a3@(28),%d5		| start of fastram
	movl	%a3@(32),%a1		| end of symbols
	subl	%a5,%a5			| target, load to 0
	movl	%d2,%d6
	andb	#0x50,%d6		| Is this an 68040/68060?
	beqs	0f

	| Turn off 68040 type MMU
	.word 0x4e7b,0xd003		| movec a5,tc
	.word 0x4e7b,0xd806		| movec a5,urp
	.word 0x4e7b,0xd807		| movec a5,srp
	.word 0x4e7b,0xd004		| movec a5,itt0
	.word 0x4e7b,0xd005		| movec a5,itt1
	.word 0x4e7b,0xd006		| movec a5,dtt0
	.word 0x4e7b,0xd007		| movec a5,dtt1
	.word	0xf4f8			|  cpusha bc - push and inval caches
	bras	1f

0:	lea	%pc@(zero),%a3
	pmove	%a3@,%tc		| Turn off MMU
	pmove	%a3@(-4),%crp		| crp = nullrp
	pmove	%a3@(-4),%srp		| srp = nullrp
	btst	#3,%d2			| Is this an 68030?
	beqs	1f

	| Turn off 68030 TT registers
	.word	0xf013,0x0800		| pmove	a3@,tt0
	.word	0xf013,0x0c00		| pmove	a3@,tt1

1:	movq	#0,%d6			|  would have known contents
	movc	%d6,%cacr		|  turn off the caches
	movl	%d6,%d7
	movl	%d6,%a2
	movl	%d6,%a3
	movl	%d6,%a4
	movl	%d6,%a5
	movl	%d6,%a6
	rts				| enter kernel at address on stack ***

| A do-nothing MMU root pointer (includes the following long as well)
| Note that the above code makes assumptions about the order of the following
| items.

nullrp:	.long	0x80000202
zero:	.long	0