tkdev_init.c

使用广泛的日本著名的开源嵌入式实时操作系统T-Kernel的源码

/*
 *----------------------------------------------------------------------
 *    T-Kernel
 *
 *    Copyright (C) 2004-2006 by Ken Sakamura. All rights reserved.
 *    T-Kernel is distributed under the T-License.
 *----------------------------------------------------------------------
 *
 *    Version:   1.02.02
 *    Released by T-Engine Forum(http://www.t-engine.org) at 2006/8/9.
 *
 *----------------------------------------------------------------------
 */

/*
 *	tkdev_init.c (MB87Q1100)
 *	T-Kernel Device-Dependent Initialization/Finalization
 */

#include "kernel.h"
#include <tk/sysdef.h>
#include <tk/syslib.h>
#include <tm/tmonitor.h>

/*
 * Target system-dependent initialization
 */
EXPORT ER tkdev_initialize( void )
{
	INT	i;

	/* Disable all interrupt */
	for ( i = 0; i < 32; i++ ) {
		out_w(AICR(i), 15);
	}
	out_w(ASWIR0, 0);
	out_w(ASWIR1, 0);

	out_b(TINT_MSK, ~0x00);		/* Disable CPLD */

	out_b(IRQ_MASK1, 0);		/* Disable FPGA IRQ_STR1 */

	/* Disable FPGA IRQ_STR2 (except for abort/power switch)
	   Abort/power switch is used by T-Monitor */
	out_b(IRQ_MASK2, in_b(IRQ_MASK2) & 0x05);
	out_b(IRQ_STR2, 0);

	/* Enable interrupt controller */
	out_w(AILM, 15);
	out_w(AIRQF, 0);
	out_w(AIRQM, 1);

	/* Enable cascade connection */
	SetIntMode(IV_IRQ(10), IM_LEVEL|IM_HI);
	SetIntMode(IV_IRQ(11), IM_LEVEL|IM_HI);
	EnableInt(IV_IRQ(10), 12);
	EnableInt(IV_IRQ(11), 4);

	return E_OK;
}

/*
 * Target system-dependent finalization
 *	Normally jump to ROM monitor.
 *	No return from this function.
 */
EXPORT void tkdev_exit( void )
{
	disint();
	tm_exit(0);	/* Turn off power and exit */

	/* Not suppose to return from 'tm_exit,' but just in case */
	for ( ;; ) {
		tm_monitor();  /* To T-Monitor */
	}
}