/**
 * interrupt.c
 * SPE プロセスマネージャ spe_manager
 * 割り込みハンドラ
 */

#include <linux/module.h>      // カーネルモジュール全般
#include <linux/kernel.h>      // printk
#include <linux/slab.h>        // kmalloc, kfree
#include <linux/interrupt.h>   // request_irq, free_irq
#include <asm/ps3.h>           // ps3_irq_plug_setup, ps3_irq_plug_destroy
#include <asm/io.h>            // ioremap, iounmap, in_xx, out_xx

#include <asm/pgtable-ppc64.h> // 暫定
#include <asm/mmu-hash64.h>    // 暫定

#include "../include/hvcalls/spe.h"
#include "interrupt.h"
#include "lspe.h"
#include "main.h"
#include "critical.h"
#include "process_list.h"








//================================================================================================== interrupt_handler()
/**
 * interrupt_handler
 * 割り込みハンドラ
 *
 * @param  int     irq
 * @param  void *  dev_id
 * @return irqreturn_t
 */
irqreturn_t interrupt_handler(int irq, void *dev_id)
{
	int           i, lspe_count = get_lspe_count();
	unsigned long int_stat;


	for (i = 0; i < lspe_count; i++)
	{
		lspe_data_t *lspe = get_lspe_data(i);
		if (lspe == NULL) continue;

		if (lspe->virq[0] == (unsigned int)irq)
		{
			/**
			 *  クラス 0 割り込み
			 *  (エラー)
			 */

			// 割り込みステータスを取得
			hvc_get_spe_int_stat(lspe->spe_id, 0, &int_stat);
			int_stat &= spe_int_mask[0];
			printk(KERN_INFO "[%s] INT_Stat_class0 = 0x%016lx\n", SPE_MANAGER_MODULE_NAME, int_stat);


			/*
			 * とりあえず今はやることなし
			 */


			// 割り込みステータスをクリア
			hvc_clear_spe_int_stat(lspe->spe_id, 0, int_stat);
			break;
		}

		if (lspe->virq[1] == (unsigned int)irq)
		{
			/**
			 *  クラス 1 割り込み
			 *  (変換)
			 */
			unsigned long mfc_dsisr, mfc_dar;

			// 割り込みステータスを取得
			hvc_get_spe_int_stat(lspe->spe_id, 1, &int_stat);
			int_stat &= spe_int_mask[1];
//			printk(KERN_INFO "[%s] INT_Stat_class1 = 0x%016lx\n", SPE_MANAGER_MODULE_NAME, int_stat);


			// MFC データ・ストレージ割り込みステータス・レジスタおよび
			// MFC データ・アドレス・レジスタの値を取得
			mfc_dsisr = in_be64(lspe->shadow + 0x0610 /*MFC_DSISR*/);
			mfc_dar   = in_be64(lspe->shadow + 0x0620 /*MFC_DAR*/);
//			printk(KERN_INFO "  MFC_DSISR = 0x%016lx\n", mfc_dsisr);
//			printk(KERN_INFO "  MFC_DAR   = 0x%016lx\n", mfc_dar);






			if (int_stat & 1)   // MFC データ・セグメントエラー
			{
				unsigned long esid = (mfc_dar & 0xFFFFFFFFF0000000UL) | 0x8000000UL /*[V]*/;

				if (REGION_ID(mfc_dar) == USER_REGION_ID)
				{
					unsigned long vsid = get_vsid(lspe->mm->context.id, mfc_dar, MMU_SEGSIZE_256M);

					// vsid を SLB エントリに登録
					out_be64(lspe->priv2 + 0x01108 /*SLB_Index*/, lspe->slb_index);
					out_be64(lspe->priv2 + 0x01118 /*SLB_VSID*/, vsid << 12 | 0xc00 /*Ks|Kp*/ | 0x80 /*C*/ | 0x000 /*L|LP*/);
					out_be64(lspe->priv2 + 0x01110 /*SLB_ESID*/, esid);

					lspe->slb_index++;
					if (lspe->slb_index >= 8) lspe->slb_index = 2;

					// MFC コマンドの再始動
					out_be64(lspe->priv2 + 0x03000 /*MFC_Cntl*/, 1UL<<32 /*[R]*/);
				}
			}









#if 0
			// 割り込みステータスをクリア
			if (int_stat & 2)
			{
				lv1_set_spe_privilege_state_area_1_register(lspe->spe_id, 0x0610UL /*MFC_DSISR*/, 0UL);
			}
			hvc_clear_spe_int_stat(lspe->spe_id, 1, int_stat);


			if (int_stat & 2)   // MFC データ・ストレージエラー
			{
				if (mfc_dsisr & 0x40000000 /*MFC_DSISR[M]*/)
				{
					if (REGION_ID(mfc_dar) != USER_REGION_ID)
					{
						int ret = hash_page(mfc_dar, _PAGE_PRESENT, 0x300);
//						printk(KERN_INFO "hash_page() [kernel side] = %d\n", ret);
						if (!ret)
						{
							// MFC コマンドの再始動
							out_be64(lspe->priv2 + 0x03000 /*MFC_Cntl*/, 1UL<<32 /*[R]*/);
						}
					}
				}
			}
#endif








			// 割り込みステータスをクリア
			if (int_stat & 2)
				lv1_set_spe_privilege_state_area_1_register(lspe->spe_id, 0x0610UL /*MFC_DSISR*/, 0UL);
			hvc_clear_spe_int_stat(lspe->spe_id, 1, int_stat);
			break;
		}

		if (lspe->virq[2] == (unsigned int)irq)
		{
			/**
			 *  クラス 2 割り込み
			 *  (アプリケーション)
			 */
			unsigned int spu_status, spu_npc, spu_stop_code;

			// 割り込みステータスを取得
			hvc_get_spe_int_stat(lspe->spe_id, 2, &int_stat);
			int_stat &= spe_int_mask[2];
//			printk(KERN_INFO "[%s] INT_Stat_class2 = 0x%016lx\n", SPE_MANAGER_MODULE_NAME, int_stat);


			// SPU ステータスおよびネクスト・プログラム・カウンタを取得
			asm volatile("eieio");   // cf. Cell Broadband Engine アーキテクチャ version 1.01 (p.93)
			spu_status    = in_be32(lspe->problem + 0x04024UL /*SPU_Status*/);
			spu_stop_code = spu_status >> 16;
			spu_npc       = in_be32(lspe->problem + 0x04034UL /*SPU_NPC*/);
//			printk(KERN_INFO "  SPU_Status = 0x%08x\n", spu_status);
//			printk(KERN_INFO "  StopCode   = 0x%04x\n", spu_stop_code);
//			printk(KERN_INFO "  SPU_NPC    = 0x%08x\n", spu_npc);


			if (spu_status & 1<<1 /*[P]*/)
			{
				switch (spu_stop_code)
				{
				case SPE_PROCESS_STOP_CODE_FINISH:
					{
						spe_process_context_list_t *this_process = get_running_process(i), *next_process = NULL;
						spinlock_t                 *spinlock_for_process_list = get_spinlock_for_process_list();


//						Critical Section (spinlock) >>>
						spin_lock(spinlock_for_process_list);
						{
							next_process = get_next_waiting_process();

/*
							unsigned long addr;
							for (addr = 0x0; addr < 0x0 + 0x60; addr+= 0x10)
							{
								printk(KERN_INFO "0x%04lx | %016lx %016lx\n", addr, in_be64(lspe->ls + addr), in_be64(lspe->ls + addr + 8));
							}
*/

							// 実行プロセスコンテキストをクリア
							clear_running_process(i);

							// このプロセスのコンテキストを更新
							this_process->context.read.status = SPE_PROCESS_CONTEXT_STATUS_NOT_RELEASED;
							increment_not_released();

							// 実行待ちプロセスがあるか
							if (next_process != NULL)
							{
								// このプロセスを実行中にする
								remove_process_from_waiting(next_process);
//								next_process->context.read.spe_no = i;
								next_process->context.read.status = SPE_PROCESS_CONTEXT_STATUS_RUNNING;

								set_running_process(i, next_process);
							}
						}
						spin_unlock(spinlock_for_process_list);
//						<<< Critical Section (spinlock)


						// SPE プロセス開始
						if (next_process != NULL) start_spe_process(i, next_process);
					}
				}
			}

			// 割り込みステータスをクリア
			hvc_clear_spe_int_stat(lspe->spe_id, 2, int_stat);
			break;
		}
	}

	return IRQ_HANDLED;
//	return int_stat ? IRQ_HANDLED : IRQ_NONE;
}