/*
 * tbiroot.S
 *
 * Copyright (C) 2001, 2002, 2012 Imagination Technologies.
 *
 * This program is free software; you can redistribute it and/or modify it under
 * the terms of the GNU General Public License version 2 as published by the
 * Free Software Foundation.
 *
 * Module that creates and via ___TBI function returns a TBI Root Block for
 * interrupt and background processing on the current thread.
 */

	.file	"tbiroot.S"
#include <asm/metag_regs.h>

/*
 * Get data structures and defines from the TBI C header
 */
#include <asm/tbx.h>


/* If signals need to be exchanged we must create a TBI Root Block */

	.data
	.balign	8
	.global	___pTBIs
	.type	___pTBIs,object
___pTBIs:
	.long	0 /* Bgnd+Int root block ptrs */
	.long	0
	.size	___pTBIs,.-___pTBIs


/*
 * Return ___pTBIs value specific to execution level with promotion/demotion
 *
 * Register Usage: D1Ar1 is Id, D0Re0 is the primary result
 *                 D1Re0 is secondary result (___pTBIs for other exec level)
 */
	.text
	.balign	4
	.global	___TBI
	.type	___TBI,function
___TBI:
	TSTT	D1Ar1,#HI(TBID_ISTAT_BIT)	/* Bgnd or Int level? */
	MOVT	A1LbP,#HI(___pTBIs)
	ADD	A1LbP,A1LbP,#LO(___pTBIs)
	GETL	D0Re0,D1Re0,[A1LbP] /* Base of root block table */
	SWAPNZ	D0Re0,D1Re0			/* Swap if asked */
	MOV	PC,D1RtP
	.size	___TBI,.-___TBI


/*
 * Return identifier of the current thread in TBI segment or signal format with
 * secondary mask to indicate privilege and interrupt level of thread
 */
	.text
	.balign	4
	.global	___TBIThrdPrivId
	.type	___TBIThrdPrivId,function
___TBIThrdPrivId:
	.global	___TBIThreadId
	.type	___TBIThreadId,function
___TBIThreadId:
#ifndef METAC_0_1
	MOV	D1Re0,TXSTATUS			/* Are we privileged or int? */
	MOV	D0Re0,TXENABLE			/* Which thread are we? */
/* Disable privilege adaption for now */
	ANDT	D1Re0,D1Re0,#HI(TXSTATUS_ISTAT_BIT) /* +TXSTATUS_PSTAT_BIT) */
	LSL	D1Re0,D1Re0,#TBID_ISTAT_S-TXSTATUS_ISTAT_S
	AND	D0Re0,D0Re0,#TXENABLE_THREAD_BITS
	LSL	D0Re0,D0Re0,#TBID_THREAD_S-TXENABLE_THREAD_S
#else
/* Thread 0 only */
	XOR	D0Re0,D0Re0,D0Re0
	XOR	D1Re0,D1Re0,D1Re0
#endif
	MOV 	PC,D1RtP			/* Return */
	.size	___TBIThrdPrivId,.-___TBIThrdPrivId
	.size	___TBIThreadId,.-___TBIThreadId 


/*
 * End of tbiroot.S
 */