romdev-mcp 0.1.1

package/src/platforms/gba/lib/libtonc/src/tonc_irq.c

@@ -0,0 +1,271 @@
+//
+//  Interrupt source code
+//
+//! \file tonc_irq.c
+//! \author J Vijn
+//! \date 20060908 - 20060928
+//
+// === NOTES ===
+// * General note: every irq function should start with 
+//   saving/clearing REG_IME and end with restoring it. If it doesn't 
+//   it's a fair bet that I screwed up :(
+
+#include "tonc_memmap.h"
+#include "tonc_memdef.h"
+#include "tonc_core.h"
+#include "tonc_irq.h"
+
+
+// --------------------------------------------------------------------
+// CLASSES 
+// --------------------------------------------------------------------
+
+
+//! IRQ Sender information
+typedef struct IRQ_SENDER
+{
+	u16 reg_ofs;	//!< sender reg - REG_BASE
+	u16 flag;		//!< irq-bit in sender reg
+} ALIGN4 IRQ_SENDER;
+
+
+// --------------------------------------------------------------------
+// GLOBALS 
+// --------------------------------------------------------------------
+
+
+// One extra entry for guaranteed zero
+IRQ_REC __isr_table[II_MAX+1];
+
+// yeah, yeah, I really should use the registers and defines
+// I have else where.
+// NOTE: haven't really tested this very much; if inaccurate, 
+// plz tell me
+static const IRQ_SENDER __irq_senders[] = 
+{
+	{ 0x0004, 0x0008 },		// REG_DISPSTAT,	DSTAT_VBL_IRQ
+	{ 0x0004, 0x0010 },		// REG_DISPSTAT,	DSTAT_VHB_IRQ
+	{ 0x0004, 0x0020 },		// REG_DISPSTAT,	DSTAT_VCT_IRQ
+	{ 0x0102, 0x0040 },		// REG_TM0CNT,		TM_IRQ
+	{ 0x0106, 0x0040 },		// REG_TM1CNT,		TM_IRQ
+	{ 0x010A, 0x0040 },		// REG_TM2CNT,		TM_IRQ
+	{ 0x010E, 0x0040 },		// REG_TM3CNT,		TM_IRQ
+	{ 0x0128, 0x4000 },		// REG_SIOCNT		SIO_IRQ
+	{ 0x00BA, 0x4000 },		// REG_DMA0CNT_H,	DMA_IRQ>>16
+	{ 0x00C6, 0x4000 },		// REG_DMA1CNT_H,	DMA_IRQ>>16
+	{ 0x00D2, 0x4000 },		// REG_DMA2CNT_H,	DMA_IRQ>>16
+	{ 0x00DE, 0x4000 },		// REG_DMA3CNT_H,	DMA_IRQ>>16
+	{ 0x0132, 0x4000 },		// REG_KEYCNT,		KCNT_IRQ
+	{ 0x0000, 0x0000 },		// cart: none
+};
+
+
+// --------------------------------------------------------------------
+// FUNCTIONS 
+// --------------------------------------------------------------------
+
+
+//! Initialize irq business
+/*! Clears ISR table and sets up a master isr.
+	\param isr	Master ISR. If NULL, \a isr_master_nest is used
+*/
+void irq_init(fnptr isr)
+{
+	REG_IME= 0;	
+
+	// clear interrupt table (just in case)
+	memset32(__isr_table, 0, (II_MAX+1)*sizeof(IRQ_REC)/4);
+
+	REG_ISR_MAIN= (isr) ? isr : (fnptr)isr_master;
+
+	REG_IME= 1;
+}
+
+//! Set a master ISR
+/*!	\param isr	Master ISR. If NULL, \a isr_master_multi is used
+*	\return	Previous master ISR
+*/
+fnptr irq_set_master(fnptr isr)
+{
+	u16 ime= REG_IME;
+	REG_IME= 0;
+
+	fnptr old_isr= REG_ISR_MAIN;
+	REG_ISR_MAIN= (isr) ? isr : (fnptr)isr_master;
+
+	REG_IME= ime;
+
+	return old_isr;
+}
+
+// NOTE could be optimised a little more.
+// and it would actually be a lot cleaner in asm :(
+
+//! General IRQ manager
+/*!	This routine manages the ISRs of interrupts and their priorities.
+	\param irq_id	Index of irq.
+	\param isr	Interrupt service routine for this irq; can be NULL
+	\param opts	ISR options
+	\return	Previous specific ISR
+	\note	\a irq_id is \e NOT a bit-mask, it is an index!
+*/
+fnptr irq_set(enum eIrqIndex irq_id, fnptr isr, u32 opts)
+{
+	u16 ime= REG_IME;
+	REG_IME= 0;
+
+	int ii, slot, prio;
+	u16 irq_flag= BIT(irq_id);
+	fnptr old_isr;
+	IRQ_REC	*pir= __isr_table;
+
+	// Enable irq
+	const IRQ_SENDER *sender= &__irq_senders[irq_id];
+	*(u16*)(REG_BASE+sender->reg_ofs) |= sender->flag;
+	REG_IE |= irq_flag;
+
+	// Search for previous occurance
+	for(slot=0; pir[slot].flag; slot++)
+		if(pir[slot].flag == irq_flag)
+			break;
+	
+	prio= opts&(ISR_LAST|ISR_PRIO_MASK);
+
+	// IRS already exists; replace?
+	if(pir[slot].flag == irq_flag)
+	{
+		// Replace desired -> do so
+		if((prio & ISR_REPLACE) || slot == prio)
+		{
+			old_isr= pir[slot].isr;
+			pir[slot].isr= isr;
+			REG_IME= ime;
+			return old_isr;
+		}
+		else	// No replace: Move rest of isrs up
+		{
+			// NOTE: optimisable
+			while(1)
+			{
+				pir[slot]= pir[slot+1];
+				if(!pir[slot].flag)
+					break;
+				slot++;
+			}
+		}
+	}
+
+	// Priority shuffle; make room
+	if(prio<slot)
+	{
+		for(ii=slot; ii>prio; ii--)
+			pir[ii]= pir[ii-1];
+		slot= ii;
+	}
+
+	old_isr= pir[slot].isr;
+	pir[slot].isr= isr;
+	pir[slot].flag= irq_flag;
+
+	REG_IME= ime;
+	return old_isr;	
+}
+
+
+
+//! Add a specific ISR
+/*! Special case of \c irq_set. If the interrupt has an ISR already
+	it'll be replaced; if not it will add it in the back.
+	\param irq_id	Index of irq.
+	\param isr	Interrupt service routine for this irq; can be NULL
+	\return	Previous ISR
+	\note	\a irq_id is \e NOT a bit-mask, it is an index!
+*/
+fnptr irq_add(enum eIrqIndex irq_id, fnptr isr)
+{
+	u16 ime= REG_IME;
+	REG_IME= 0;
+
+	int ii;
+	u16 irq_flag= BIT(irq_id);
+	fnptr old_isr;
+	IRQ_REC	*pir= __isr_table;
+
+	// Enable irq
+	const IRQ_SENDER *sender= &__irq_senders[irq_id];
+	*(u16*)(REG_BASE+sender->reg_ofs) |= sender->flag;
+	REG_IE |= irq_flag;
+
+	// Search for previous occurance, or empty slot
+	for(ii=0; pir[ii].flag; ii++)
+		if(pir[ii].flag == irq_flag)
+			break;
+	
+	old_isr= pir[ii].isr;
+	pir[ii].isr= isr;
+	pir[ii].flag= irq_flag;
+
+	REG_IME= ime;
+	return old_isr;
+}
+
+//! Remove an ISR
+/*! it'll be replaced; if not it will add it in the back.
+	\param irq_id	Index of irq.
+	\return	Previous ISR
+	\note	\a irq_id is \e NOT a bit-mask, it is an index!
+*/
+fnptr irq_delete(enum eIrqIndex irq_id)
+{
+	u16 ime= REG_IME;
+	REG_IME= 0;
+
+	int ii;
+	u16 irq_flag= BIT(irq_id);
+	fnptr old_isr;
+	IRQ_REC	*pir= __isr_table;
+
+	// Disable irq
+	const IRQ_SENDER *sender= &__irq_senders[irq_id];
+	*(u16*)(REG_BASE+sender->reg_ofs) &= ~sender->flag;
+	REG_IE &= ~irq_flag;
+
+	// Find the ISR
+	for(ii=0; pir[ii].flag; ii++)
+		if(pir[ii].flag == irq_flag)
+			break;
+
+	old_isr= pir[ii].isr;
+	// Found it; move rest up
+	for( ; pir[ii].flag; ii++)
+		pir[ii]= pir[ii+1];
+
+	REG_IME= ime;
+	return old_isr;	
+}
+
+void irq_enable(enum eIrqIndex irq_id)
+{
+	u16 ime= REG_IME;
+	REG_IME= 0;
+
+	const IRQ_SENDER *sender= &__irq_senders[irq_id];
+	*(u16*)(REG_BASE+sender->reg_ofs) |= sender->flag;
+
+	REG_IE |= BIT(irq_id);
+	REG_IME= ime;
+}
+
+void irq_disable(enum eIrqIndex irq_id)
+{
+	u16 ime= REG_IME;
+	REG_IME= 0;
+
+	const IRQ_SENDER *sender= &__irq_senders[irq_id];
+	*(u16*)(REG_BASE+sender->reg_ofs) &= ~sender->flag;
+
+	REG_IE &= ~BIT(irq_id);
+	REG_IME= ime;
+}
+
+// EOF

package/src/platforms/gba/lib/libtonc/src/tonc_math.c

@@ -0,0 +1,54 @@
+//
+//  Basic math functions
+//
+//! \file tonc_math.c
+//! \author J Vijn
+//! \date 20060508 - 20060508
+//
+// === NOTES ===
+
+#include "tonc_memmap.h"
+#include "tonc_core.h"
+#include "tonc_math.h"
+
+
+// --------------------------------------------------------------------
+// FUNCTIONS 
+// --------------------------------------------------------------------
+
+
+// --- Geometry -------------------------------------------------------
+
+// --- Point functions ---
+
+//! Is a point inside a rectangle
+int pt_in_rect(const POINT *pt, const RECT *rc)
+{
+	if(pt->x < rc->left || pt->x >= rc->right)
+		return 0;
+	if(pt->y < rc->top || pt->y >= rc->bottom)
+		return 0;
+	return 1;
+}
+
+// --- Vector functions ---
+
+VECTOR *vec_cross(VECTOR *vd, const VECTOR *va, const VECTOR *vb)
+{
+	vd->x= fxmul(va->y, vb->z) - fxmul(va->z,vb->y);
+	vd->y= fxmul(va->y, vb->z) - fxmul(va->z,vb->y);
+	vd->z= fxmul(va->y, vb->z) - fxmul(va->z,vb->y);
+	return vd;
+}
+
+// --- Rect functions ---
+
+RECT *rc_normalize(RECT *rc)
+{
+	int tmp;
+	if(rc->left > rc->right) 
+		SWAP3(rc->left, rc->right, tmp);
+	if(rc->top > rc->bottom) 
+		SWAP3(rc->top, rc->bottom, tmp);
+	return rc;
+}

package/src/platforms/gba/lib/libtonc/src/tonc_oam.c

@@ -0,0 +1,76 @@
+//
+//  OAM functions
+//
+//! \file tonc_oam.c
+//! \author J Vijn
+//! \date 20060604 - 20060604
+//
+// === NOTES ===
+
+#include "tonc_memmap.h"
+#include "tonc_memdef.h"
+#include "tonc_oam.h"
+
+
+// --------------------------------------------------------------------
+// FUNCTIONS 
+// --------------------------------------------------------------------
+
+
+// 01 23 45 67 89 ab cd ef
+// -- -1 -- -0 -- -0 -- -1
+
+//! Initialize an array of \a count OBJ_ATTRs with with safe values.
+void oam_init(OBJ_ATTR *obj, uint count)
+{
+	u32 nn= (count+3)>>2;
+	u32 *dst= (u32*)obj;
+
+	// Hide all and set OBJ_AFFINEs to I
+	while(nn--)
+	{
+		*dst++= ATTR0_HIDE;
+		*dst++= 0x0100<<16;
+		*dst++= ATTR0_HIDE;
+		*dst++= 0;
+		*dst++= ATTR0_HIDE;
+		*dst++= 0;
+		*dst++= ATTR0_HIDE;
+		*dst++= 0x0100<<16;
+	}
+	// init oam
+	oam_copy(oam_mem, obj, count);
+}
+
+//! Copy attributes 0-2 in  \a count OBJ_ATTRs.
+void obj_copy(OBJ_ATTR *dst, const OBJ_ATTR *src, uint count)
+{
+	int ii;
+	for(ii=0; ii<count; ii++)
+	{
+		dst[ii].attr0= src[ii].attr0;
+		dst[ii].attr1= src[ii].attr1;
+		dst[ii].attr2= src[ii].attr2;
+	}
+}
+
+//! Hide an array of OBJ_ATTRs
+void obj_hide_multi(OBJ_ATTR *obj, uint count)
+{
+	while(count--)
+	{
+		obj_hide(obj);
+		obj++;
+	}
+}
+
+
+void obj_unhide_multi(OBJ_ATTR *obj, u16 mode, uint count)
+{
+	while(count--)
+	{
+		obj_unhide(obj, mode);
+		obj++;
+	}
+}
+

package/src/platforms/gba/lib/libtonc/src/tonc_obj_affine.c

@@ -0,0 +1,146 @@
+//
+//  Object Affine functions
+//
+//! \file tonc_obj_affine.c
+//! \author J Vijn
+//! \date 20060908 - 20130331
+//
+// === NOTES ===
+
+#include "tonc_memmap.h"
+#include "tonc_core.h"
+
+#include "tonc_bios.h"
+#include "tonc_math.h"
+#include "tonc_oam.h"
+
+
+// --------------------------------------------------------------------
+// FUNCTIONS 
+// --------------------------------------------------------------------
+
+void obj_aff_copy(OBJ_AFFINE *dst, const OBJ_AFFINE *src, uint count)
+{
+	int ii;
+	for(ii=0; ii<count; ii++)
+	{
+		dst->pa= src->pa;
+		dst->pb= src->pb;
+		dst->pc= src->pc;
+		dst->pd= src->pd;
+		src++;
+		dst++;
+	}
+}
+
+
+//! Set obj matrix to counter-clockwise rotation.
+/*! 
+	\param oaff	Object affine struct to set.
+	\param alpha	CCW angle. full-circle is 10000h.
+*/
+void obj_aff_rotate(OBJ_AFFINE *oaff, u16 alpha)
+{
+	int ss= lu_sin(alpha)>>4, cc= lu_cos(alpha)>>4;
+	oaff->pa= cc;	oaff->pb= -ss;
+	oaff->pc= ss;	oaff->pd= cc;
+}
+
+//! Set obj matrix to 2d scaling, then counter-clockwise rotation.
+/*! 
+	\param oaff	Object affine struct to set.
+	\param sx	Horizontal scale (zoom). .8 fixed point.
+	\param sy	Vertical scale (zoom). .8 fixed point.
+	\param alpha	CCW angle. full-circle is 10000h.
+*/
+void obj_aff_rotscale(OBJ_AFFINE *oaff, FIXED sx, FIXED sy, u16 alpha)
+{
+	int ss= lu_sin(alpha), cc= lu_cos(alpha);
+
+	oaff->pa= cc*sx>>12;	oaff->pb=-ss*sx>>12;
+	oaff->pc= ss*sy>>12;	oaff->pd= cc*sy>>12;
+}
+
+//! Pre-multiply \a dst by \a src: D = S*D
+void obj_aff_premul(OBJ_AFFINE *dst, const OBJ_AFFINE *src)
+{
+	FIXED tmp_a, tmp_b, tmp_c, tmp_d;
+	tmp_a= dst->pa; tmp_b= dst->pb;
+	tmp_c= dst->pc; tmp_d= dst->pd;
+
+	dst->pa= (src->pa*tmp_a + src->pb*tmp_c)>>8;
+	dst->pb= (src->pa*tmp_b + src->pb*tmp_d)>>8;
+	dst->pc= (src->pc*tmp_a + src->pd*tmp_c)>>8;
+	dst->pd= (src->pc*tmp_b + src->pd*tmp_d)>>8;
+}
+
+//! Post-multiply \a dst by \a src: D= D*S
+void obj_aff_postmul(OBJ_AFFINE *dst, const OBJ_AFFINE *src)
+{
+	FIXED tmp_a, tmp_b, tmp_c, tmp_d;
+	tmp_a= dst->pa; tmp_b= dst->pb;
+	tmp_c= dst->pc; tmp_d= dst->pd;
+
+	dst->pa= (tmp_a*src->pa + tmp_b*src->pc)>>8;
+	dst->pb= (tmp_a*src->pb + tmp_b*src->pd)>>8;
+	dst->pc= (tmp_c*src->pa + tmp_d*src->pc)>>8;
+	dst->pd= (tmp_c*src->pb + tmp_d*src->pd)>>8;
+}
+
+//! Set obj matrix to 2d scaling, then counter-clockwise rotation.
+/*! 
+	\param oaff	Object affine struct to set.
+	\param as Struct with scales and angle.
+*/
+void obj_aff_rotscale2(OBJ_AFFINE *oaff, const AFF_SRC *as)
+{
+	int ss= lu_sin(as->alpha), cc= lu_cos(as->alpha);
+
+	oaff->pa= cc*as->sx>>12;	oaff->pb=-ss*as->sx>>12;
+	oaff->pc= ss*as->sy>>12;	oaff->pd= cc*as->sy>>12;	
+}
+
+//! Rot/scale an object around an arbitrary point.
+/*!	Sets up \a obj \e and \a oaff for rot/scale transformation
+	around an arbitrary point using the \a asx data.
+	\param obj	Object to set.
+	\param oaff	Object affine data to set.
+	\param asx	Affine source data: screen and texture origins, 
+	  scales and angle.
+*/
+void obj_rotscale_ex(OBJ_ATTR *obj, OBJ_AFFINE *oaff, const AFF_SRC_EX *asx)
+{
+	int sx= asx->sx, sy= asx->sy;
+	int sina= lu_sin(asx->alpha)>>4, cosa= lu_cos(asx->alpha)>>4;
+
+	oaff->pa= sx*cosa>>8;		oaff->pb= -sx*sina>>8;
+	oaff->pc= sy*sina>>8;		oaff->pd=  sy*cosa>>8;
+
+	// sx = 1/sx, sy = 1/sy (.12f)
+	sx= Div(1<<20, sx);
+	if(sx != sy)
+		sy= Div(1<<20, sy);
+	else
+		sy= sx;
+	FIXED aa, ab, ac, ad;
+	aa=  sx*cosa>>12;	ab= sy*sina>>12;	// .8f
+	ac= -sx*sina>>12;	ad= sy*cosa>>12;	// .8f
+
+	sx= oam_sizes[obj->attr0>>14][obj->attr1>>14][0];
+	sy= oam_sizes[obj->attr0>>14][obj->attr1>>14][1];
+
+	int dx= asx->scr_x, dy= asx->scr_y;	// .0f
+	if(obj->attr0&ATTR0_AFF_DBL_BIT)
+	{	dx -= sx;		dy -=sy;		}
+	else
+	{	dx -= sx>>1;	dy -= sy>>1;	}
+
+	sx= asx->tex_x - (sx<<7);		// .8f
+	sy= asx->tex_y - (sy<<7);		// .8f
+	dx -= (aa*sx + ab*sy)>>16;		// .0 + (.8f*.8f/.16f)
+	dy -= (ac*sx + ad*sy)>>16;		// .0 + (.8f*.8f/.16f)
+
+	obj_set_pos(obj, dx, dy);
+}
+
+// EOF