#include <basic.h>
#include <tk/tkernel.h>
#include <tm/tmonitor.h>

LOCAL ID tskid;
LOCAL ID flgid;

/* 各プッシュボタンに対応するフラグパターンの定義 */
#define FLGPTN_SW1 (0x01)
#define FLGPTN_SW2 (0x02)
#define FLGPTN_SW3 (0x04)
#define FLGPTN_SW4 (0x08)
#define FLGPTN_ALL (FLGPTN_SW1 | FLGPTN_SW2 | FLGPTN_SW3 | FLGPTN_SW4)
/* プッシュボタンの数 */
#define NUM_SW     (4)

/*
 * 各プッシュボタンに対応する割込みハンドラ
 */
LOCAL void inthdr_sw1(UINT dintno)
{
	tk_set_flg(flgid, FLGPTN_SW1);
	ClearInt(dintno);
}
LOCAL void inthdr_sw2(UINT dintno)
{
	tk_set_flg(flgid, FLGPTN_SW2);
	ClearInt(dintno);
}
LOCAL void inthdr_sw3(UINT dintno)
{
	tk_set_flg(flgid, FLGPTN_SW3);
	ClearInt(dintno);
}
LOCAL void inthdr_sw4(UINT dintno)
{
	tk_set_flg(flgid, FLGPTN_SW4);
	ClearInt(dintno);
}

/*
 * コンソール出力用のタスク
 */
LOCAL void task(INT stacd, void *exinf)
{
	UINT flgptn;
	UB num[2];
	INT i;
	ER ercd;
	ID tskid = stacd;

	num[1] = '\0';
	for(;;) {
		/* 割込みが発生するまで待機 */
		ercd = tk_wai_flg(flgid, FLGPTN_ALL, TWF_ORW | TWF_BITCLR,
				  &flgptn, TMO_FEVR);
		if (ercd < 0) {
			break;
		}

		/* 押されたプッシュボタンを表示 */
		for (i=0; i<NUM_SW; i++) {
			if (flgptn & (1 << i)) {
				tm_putstring((UB*)"SW");
				num[0] = '1' + i;
				tm_putstring(num);
				tm_putstring((UB*)" was pushed.\n");
			}
		}

		/* SW4が押されたなら終了 */
		if (flgptn & FLGPTN_SW4) {
			break;
		}
	}

	/* usermainのタスクを起床して終了 */
	tk_wup_tsk(tskid);
	tk_exd_tsk();
}

/* 割込みハンドラを登録する関数 */
LOCAL void define_inthdr(UINT dintno, FP inthdr)
{
	T_DINT dint;

	dint.intatr = TA_HLNG;
	dint.inthdr = inthdr;
	tk_def_int(dintno, &dint);
}

/* 割込みを許可する関数 */
LOCAL void enable_int(INTVEC intvec)
{
	SetIntMode(intvec, IM_ENA | IM_EDGE | IM_HI);
	ClearInt(intvec);
	EnableInt(intvec);
}

/* イベントフラグを生成する関数 */
LOCAL void create_eventflag(void)
{
	T_CFLG cflg;

	cflg.exinf = NULL;
	cflg.flgatr = TA_TFIFO | TA_WSGL;
	cflg.iflgptn = 0;
	flgid = tk_cre_flg(&cflg);
}

/* タスクを生成して実行する関数 */
LOCAL void run_task(ID tid)
{
	T_CTSK ctsk;

	ctsk.exinf = NULL;
	ctsk.task = task;
	ctsk.itskpri = 1;
	ctsk.stksz = 2048;
	ctsk.tskatr = TA_HLNG | TA_RNG0;
	tskid = tk_cre_tsk(&ctsk);
	tk_sta_tsk(tskid, tid);
}

/* 終了時に資源を開放する関数 */
LOCAL void finish(void)
{
	tk_del_flg(flgid);
}

EXPORT INT usermain(void)
{
	create_eventflag();
	run_task(tk_get_tid());

	/* 各プッシュボタンの割込みハンドラの登録 */
	define_inthdr(DINTNO(IV_GPIO(8)), inthdr_sw1);
	define_inthdr(DINTNO(IV_GPIO(7)), inthdr_sw2);
	define_inthdr(DINTNO(IV_GPIO(6)), inthdr_sw3);
	define_inthdr(DINTNO(IV_GPIO(4)), inthdr_sw4);

	/* 各プッシュボタンの割込みの許可 */
	enable_int(IV_GPIO(8));
	enable_int(IV_GPIO(7));
	enable_int(IV_GPIO(6));
	enable_int(IV_GPIO(4));

	tm_putstring((UB*)"Sample program for interrupts.\n");
	tm_putstring((UB*)"  Push SW1, SW2, SW3.\n");
	tm_putstring((UB*)"  Push SW4 to halt the program.\n");

	tk_slp_tsk(TMO_FEVR);

	/* 終了処理 */
	finish();
	tm_putstring((UB*)"Halted.\n");

	return 0;
}