/*******************************************************************************
*   モジュール名称      ：アプリケーション07                                   *
*   モジュールラベル    ：dpu_app07                                            *
*   タスク区分          ：アプリケーションタスク                               *
*   機能                ：                                                     *
*   コーリングシーケンス：void dpu_app07(int mode)                             *
*   引数                ：int mode  冗長機能 - SPIN-PULSE & EWO COLLECT        *
*   戻り値              ：void                                                 *
*   使用上の注意        ：なし                                                 *
*   エラー処理          ：なし                                                 *
*   作成日・作成者      ：2014/7/20     Y.K.                                   *
********************************************************************************/
#include "dpu_api.h"
#include "dpu_api_proto.h"
#include "app_rdn_core.h"

// *** Macro ***
int		app07_Rdn_EWOclct();
void	app07_Rdn_EWOclct_work( unsigned char, unsigned int	);

void 	dpu_app07(int mode)
{
#ifdef  _APP_RDN_ 
	int				i;
	int				i_flag;

	dpu_waitProcessingSlot(32);
    // ******************************************************
    // *** EXECUTE @ RDN: Sun Pulse & EWO-mission collect ***
    // ******************************************************
	if (Guc_dpuRdn) {
	    for (;;) {
			// dpu_delay(1000);			// 1-sec wait
			dpu_waitSunpulse(1);		// 1-spin pulse wait

			if (Guc_dpuRdn==2) {
				if (Guc_dpuNo==0) {
					for (i=Gd_N_MGFI; i<=Gd_N_MWE; i++)		if (i!=0x11 && Guc_HK_link[i]) 	i_flag = rap_sv_sendRdnSunpulseTime( i );
					if ( (Guc_RDN_MemDump_NID & 0x80) ==0 && 
						 (Guc_RDN_MemLoad_NID & 0x80) ==0 && 
						  Guc_HK_link[Gd_N_EWO]) {
						dpu_waitProcessingSlot(1);
						i_flag = app07_Rdn_EWOclct();
					}
				} else {
					for (i=Gd_N_MEA1; i<=Gd_N_MGFO; i++)	if ( Guc_HK_link[i] )			i_flag = rap_sv_sendRdnSunpulseTime( i );
				}
			}

			// *** CMD-buffer clear (for BroadCast) ***
			if (Guc_WDTena)	{ dpu_setWDT( 800 ); dpu_WDTEna(1); }	else 	dpu_WDTEna(0);		// WDT: ENA(64sec) / DIS
			dpu_getCommand( Guc_cmdDummy, &i_flag);
		}
	}
    dpu_WDTEna(0);		// WDT: DIS
#endif // _APP_RDN_ 
    dpu_appStop();		// *** End ***
}




#ifdef  _APP_RDN_ 

// **********************
// *** EWO @ SunPulse ***
// **********************
// (2) dpu_waitSunpulse(1)をコールし、EWO からのミッションデータ書込み開始の同期を取る。
// (3) dpu_waitSunpulse(1)をコールする。
// (4) rap_sv_getRdnData()をコールし EWO DS 書込み情報を取得し、ブロックへの書込みパケット数を計算する。
// (5) rap_sv_getRdnMisIfStatus()をコールし RMAP 受信ステータスを取得し、ミッションデータが正常に書き込まれたかチェックする。
void	app07_Rdn_EWOclct_work( unsigned char	uc_nodeId,	
								unsigned int	ui_WriteAddress ) 
{
	// int					i_flag;
	int					i_NumBlock;
	int					i_NumPacket = 0;
	M_T_TIME_INFO		t_timeInfo;


	//	======================================================================================================
	// ---- 要ＩＮＰＵＴ：
	//	unsigned int		ui_createTime[Gd_rdn_MaxBlock];			// TI				of each Block		***
	//	int					i_replyNum   [Gd_rdn_MaxBlock];			// Reply Num		of each Block		***
	//	char				c_invalidFlg [Gd_rdn_MaxBlock];			// Invalid Flag		of each Block		****
	//
	//	unsigned int		ui_AddStart;							// Block address	of each Block
	//	unsigned char		uc_BlockNumMax;							// Max    block num						初期設定
	//
	//	unsigned char		uc_BlockLatest;							// Latest block num						***
	//	unsigned char		uc_BlockOldest;							// Oldest block num						***
	//	unsigned char		uc_BlockWrite;							// Write  block num						***
	//	======================================================================================================
	// **** BLOCK ****
	if ( ui_WriteAddress >= Gt_rdnBLOCK[uc_nodeId].ui_AddStart ) {
		i_NumBlock = (ui_WriteAddress - Gt_rdnBLOCK[uc_nodeId].ui_AddStart) / Gi_SizeBlk[uc_nodeId];
		if ( ( (ui_WriteAddress - Gt_rdnBLOCK[uc_nodeId].ui_AddStart) % Gi_SizeBlk[uc_nodeId] ) == 0 )  if ( i_NumBlock )  i_NumBlock --;
		if      ( i_NumBlock <  Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax) {
			// Num Packet
			i_NumPacket = ui_WriteAddress - Gt_rdnBLOCK[uc_nodeId].ui_AddStart - i_NumBlock * Gi_SizeBlk[uc_nodeId];
			i_NumPacket = i_NumPacket / Gus_SizePac[uc_nodeId];

			// ---- STATUS ----
			// i_flag = i_NumBlock;
			dpu_getTime( &t_timeInfo );
			Gt_rdnBLOCK[uc_nodeId].ui_createTime    [ i_NumBlock ] = t_timeInfo.ui_currentTime2;
			Gt_rdnBLOCK[uc_nodeId].i_replyNum       [ i_NumBlock ] = i_NumPacket;
			if ( i_NumPacket > Gt_rdnBLOCK[uc_nodeId].us_BlockPacNum || i_NumPacket < (Gt_rdnBLOCK[uc_nodeId].us_BlockPacNum) * 4 / 5) {
				Gt_rdnBLOCK[uc_nodeId].c_invalidFlg [ i_NumBlock ] = 1;
			}   else  {
				Gt_rdnBLOCK[uc_nodeId].c_invalidFlg [ i_NumBlock ] = 0;
			}
			if ( uc_nodeId == 0x10) {
				if ( i_NumPacket <= 0x212 && i_NumPacket >= 0x1A8 ) {
					Gt_rdnBLOCK[uc_nodeId].c_invalidFlg [ i_NumBlock ] = 0;
				}
			}

			// Latest Block (WROTE) & Oldest Block (Writing)
				Gt_rdnBLOCK[uc_nodeId].uc_BlockLatest = i_NumBlock;																// WROTE   BLOCK
			if (Gt_rdnBLOCK[uc_nodeId].uc_BlockOldest != 0 || 
				 i_NumBlock >= Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax - 2 ) {
	    		Gt_rdnBLOCK[uc_nodeId].uc_BlockOldest = ( i_NumBlock + 2 ) % Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax;				// OLDEST  BLOCK
	    	}
		}
	}

	/*
	// **** NumPacket correction ****
	int					i;
	int					j;
	unsigned char		uc_data[16];
	unsigned int		ui_time, ui_time0, ui_time1;
	for (i=0; i<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax; i++) {
		// Gt_rdnBLOCK[uc_nodeId].i_replyNum   [ i ] = 2;
		// if (uc_nodeId != 1)	{
			if (i<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax-1)	i_NumPacket =  Gt_rdnBLOCK[uc_nodeId].ui_createTime[i+1] - Gt_rdnBLOCK[uc_nodeId].ui_createTime[i];
			else 											i_NumPacket =  Gt_rdnBLOCK[uc_nodeId].ui_createTime[0]   - Gt_rdnBLOCK[uc_nodeId].ui_createTime[i];
			if (uc_nodeId == 1)	{
				i_NumPacket = ((i_NumPacket/4+7)/8) * 8;
			} else {
				if (i_NumPacket > 0)	i_NumPacket =  2;
				else					i_NumPacket = -2;
			}
			if ( i_NumPacket > Gt_rdnBLOCK[uc_nodeId].us_BlockPacNum || i_NumPacket < (Gt_rdnBLOCK[uc_nodeId].us_BlockPacNum) * 4 / 5) {
				Gt_rdnBLOCK[uc_nodeId].c_invalidFlg [ i ] = 1;
				// i_NumPacket = 0;
			}
			if ( Gt_rdnBLOCK[uc_nodeId].i_replyNum[i] != i_NumPacket ) {
				Gt_rdnBLOCK[uc_nodeId].i_replyNum[i] = i_NumPacket;
			}
		// }
	}
	*/
	
	/*
	// ---------TMP: MONITOR-PACKET---------
	// ---------TMP: MONITOR-PACKET---------
	// ---------TMP: MONITOR-PACKET---------
	if ( Gt_rdnBLOCK[uc_nodeId].uc_BlockLatest != Gt_rdnBLOCK[uc_nodeId].uc_BlockOldest) {
		for (j=0; j<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax; j++) {
			G5uc_data[j*66 + 0] =  uc_nodeId;
			G5uc_data[j*66 + 1] =  j;
			G5uc_data[j*66 + 2] =  Gt_rdnBLOCK[uc_nodeId].uc_BlockLatest;
			G5uc_data[j*66 + 3] =  Gt_rdnBLOCK[uc_nodeId].uc_BlockOldest;
			G5uc_data[j*66 + 4] = (Gt_rdnBLOCK[uc_nodeId].i_replyNum[j])/0x100;
			G5uc_data[j*66 + 5] = (Gt_rdnBLOCK[uc_nodeId].i_replyNum[j]) &0xFF;
			for (i=0; i<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax; i++) {
				i_flag  = app_Rdn_getData  ( Gt_rdnBLOCK[uc_nodeId].ui_AddStart + Gi_SizeBlk[uc_nodeId]*j + 
										     16 +  Gus_SizePac[uc_nodeId]*i, 16, uc_data );
				memcpy( &(G5uc_data[j*66 + 6 + i*6]),        &(uc_data[0]), 6);
			}
			for (i=0; i<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax; i++) {
				i_flag  = app_Rdn_getData  ( Gt_rdnBLOCK[uc_nodeId].ui_AddStart + Gi_SizeBlk[uc_nodeId]*j + 
										     16 +  Gus_SizePac[uc_nodeId] * (Gt_rdnBLOCK[uc_nodeId].i_replyNum[j] - 2 + i), 16, uc_data );
				memcpy( &(G5uc_data[j*66 + 6 + 30 + i*6]),   &(uc_data[0]), 6);
			}
		}
		i = j*66;
		app07_putDPU ( Gd_N_DPU1, 0, Gd_N_DPU1, uc_nodeId, Gt_rdnBLOCK[uc_nodeId].ui_createTime[j], 4, G5uc_data, i );
	}
	// ---------TMP: MONITOR-PACKET---------
	// ---------TMP: MONITOR-PACKET---------
	// ---------TMP: MONITOR-PACKET---------
	*/



/*
// **************
// *****TMP *****
// ************** 
	unsigned short		us_spin;

// Gt_rdnBLOCK2[uc_nodeId].uc_BlockOldest = 
// Gt_rdnBLOCK2[uc_nodeId].uc_BlockLatest = 0;
ui_time0 = Gt_rdnBLOCK2[uc_nodeId].ui_createTime    [ Gt_rdnBLOCK2[uc_nodeId].uc_BlockOldest ];		// 0xFFFFFF;
ui_time1 = Gt_rdnBLOCK2[uc_nodeId].ui_createTime    [ Gt_rdnBLOCK2[uc_nodeId].uc_BlockLatest ];		// 0;
for (i=0; i<Gt_rdnBLOCK2[uc_nodeId].uc_BlockNumMax; i++) {
	i_flag  = app_Rdn_getData  ( Gt_rdnBLOCK[uc_nodeId].ui_AddStart + Gi_SizeBlk[uc_nodeId]*i + 16, 16, uc_data );
	memcpy( &ui_time,  &(uc_data[0]), 4);									// B0-3: TI (LSB:2msec)
	memcpy( &us_spin,  &(uc_data[4]), 2);									// B4-5: SunPulse (LSB:122usec)
	if (ui_time != 0xFFFFFFFF && us_spin < 0xA000) {
		ui_time += (us_spin >> 4);
		Gt_rdnBLOCK2[uc_nodeId].ui_createTime    [ i ] = ui_time;
		if ( ui_time0 > ui_time )	{ ui_time0 = ui_time;  Gt_rdnBLOCK2[uc_nodeId].uc_BlockOldest = i; }
		if ( ui_time1 < ui_time )	{ ui_time1 = ui_time;  Gt_rdnBLOCK2[uc_nodeId].uc_BlockLatest = i; }
		Gt_rdnBLOCK2[uc_nodeId].c_invalidFlg [ i ] = 0;
	} else {
		Gt_rdnBLOCK2[uc_nodeId].ui_createTime[ i ] = 0;
		Gt_rdnBLOCK2[uc_nodeId].c_invalidFlg [ i ] = 1;
	}
}
if (Gt_rdnBLOCK2[uc_nodeId].uc_BlockOldest != Gt_rdnBLOCK2[uc_nodeId].uc_BlockLatest ) {
	if (Gt_rdnBLOCK2[uc_nodeId].uc_BlockLatest == 0)
		Gt_rdnBLOCK2[uc_nodeId].uc_BlockLatest = Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax - 1;
	else
		Gt_rdnBLOCK2[uc_nodeId].uc_BlockLatest--;
}

for (i=0; i<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax; i++) {
	if (i<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax-1)	i_NumPacket =  Gt_rdnBLOCK2[uc_nodeId].ui_createTime[i+1] - Gt_rdnBLOCK2[uc_nodeId].ui_createTime[i];
	else 											i_NumPacket =  Gt_rdnBLOCK2[uc_nodeId].ui_createTime[0]   - Gt_rdnBLOCK2[uc_nodeId].ui_createTime[i];
	if (uc_nodeId == 1)	{
		i_NumPacket = ((i_NumPacket/4+7)/8) * 8;
	} else {
		if (i_NumPacket > 0)	i_NumPacket =  2;
		else					i_NumPacket = -2;
	}
	if ( i_NumPacket > Gt_rdnBLOCK[uc_nodeId].us_BlockPacNum || i_NumPacket < (Gt_rdnBLOCK[uc_nodeId].us_BlockPacNum) * 4 / 5) {
		Gt_rdnBLOCK2[uc_nodeId].c_invalidFlg [ i ] = 1;
		// i_NumPacket = 0;
	}
	if ( Gt_rdnBLOCK2[uc_nodeId].i_replyNum[i] != i_NumPacket ) {
		Gt_rdnBLOCK2[uc_nodeId].i_replyNum[i] = i_NumPacket;
	}
}

if ( Gt_rdnBLOCK2[uc_nodeId].uc_BlockLatest != Gt_rdnBLOCK2[uc_nodeId].uc_BlockOldest) {
	for (j=0; j<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax; j++) {
		G5uc_data[j*66 + 0] =  uc_nodeId+0x80;
		G5uc_data[j*66 + 1] =  j;
		G5uc_data[j*66 + 2] =  Gt_rdnBLOCK2[uc_nodeId].uc_BlockLatest;
		G5uc_data[j*66 + 3] =  Gt_rdnBLOCK2[uc_nodeId].uc_BlockOldest;
		G5uc_data[j*66 + 4] = (Gt_rdnBLOCK2[uc_nodeId].i_replyNum[j])/0x100;
		G5uc_data[j*66 + 5] = (Gt_rdnBLOCK2[uc_nodeId].i_replyNum[j]) &0xFF;
		for (i=0; i<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax; i++) {
			i_flag  = app_Rdn_getData  ( Gt_rdnBLOCK[uc_nodeId].ui_AddStart + Gi_SizeBlk[uc_nodeId]*j + 
									     16 +  Gus_SizePac[uc_nodeId]*i, 16, uc_data );
			memcpy( &(G5uc_data[j*66 + 6 + i*6]),        &(uc_data[0]), 6);
		}
		for (i=0; i<Gt_rdnBLOCK[uc_nodeId].uc_BlockNumMax; i++) {
			i_flag  = app_Rdn_getData  ( Gt_rdnBLOCK[uc_nodeId].ui_AddStart + Gi_SizeBlk[uc_nodeId]*j + 
									     16 +  Gus_SizePac[uc_nodeId] * (Gt_rdnBLOCK2[uc_nodeId].i_replyNum[j] - 2 + i), 16, uc_data );
			memcpy( &(G5uc_data[j*66 + 6 + 30 + i*6]),   &(uc_data[0]), 6);
		}
	}
	i = j*66;
	app07_putDPU ( Gd_N_DPU1, 0, Gd_N_DPU1, uc_nodeId+0x80, Gt_rdnBLOCK2[uc_nodeId].ui_createTime[j], 4, G5uc_data, i );
}
// ---------TMP: MONITOR-PACKET---------
// ---------TMP: MONITOR-PACKET---------
// ---------TMP: MONITOR-PACKET---------
*/
}


// ---------------------------------------------------------------------------------------------------------
int		app07_Rdn_EWOclct() 
{
	int						i;
	int						i_flag;
	unsigned int			ui_WriteAddress;
	M_T_RDN_MIS_IF_STATUS 	t_misIfStatus;
	M_T_TIME_INFO			t_timeInfo;			// unsigned int ui_currentTime;  ：衛星時刻(1LSB=1.953ms)

	// --- CLCT? ---
	if ( Guc_rdn_missionClct[Gd_N_EWO] == 0 ) return(0xFF);
	// i_flag = rap_sv_resetRdnMisIf ( Gd_N_EWO,  Gd_EWO_RdnAdr,  Gd_SOR_RdnAdr  );		// 0x8A-A0 00000	EWOE:8A-90 AM2P:90-96 EFD:96-98 EWOB:98-A0	

	// (4) rap_sv_getRdnData()をコールし EWO DS 書込み情報を取得し、ブロックへの書込みパケット数を計算する。
	i_flag = app_Rdn_getData  ( Gd_DPU_EWOLogAdr, 80, Guc_rdn_EWOClctStatus );			// 頭12BはSKIP //
																						// *************** FORMAT ******************
																						// 0-12			RMAP-read header
																						// -----------------------------------------
																						// 0x10-0x13	EWOE	WRITE-POINTER
																						// 0x20-0x23	AM2P	WRITE-POINTER
																						// 0x30-0x33	EFD		WRITE-POINTER
																						// 0x40-0x43	EWOB	WRITE-POINTER
	if (i_flag) 	{
		return( i_flag );
	}

	// *************
	// *****TMP*****
	// *************
	// (5) rap_sv_getRdnMisIfStatus()をコールし RMAP 受信ステータスを取得し、ミッションデータが正常に書き込まれたかチェックする。
	i_flag = rap_sv_getRdnMisIfStatus( Gd_N_EWO, &t_misIfStatus );
	if (i_flag) 	{
		return( i_flag );
	}

	// ************ EWO-CLCT! ***********
	i_flag = dpu_getTime( &t_timeInfo );
  	    memcpy( &ui_WriteAddress, &(Guc_rdn_EWOClctStatus[0x10]),         4);   ui_WriteAddress += 0x08000000;	app07_Rdn_EWOclct_work( Gd_N_EWOE, ui_WriteAddress );
		Gus_rdn_TlmCnt[Gd_N_EWO] ++;																			//	Mission Collect counter
		Gus_rdn_TlmDT [Gd_N_EWO] =  t_timeInfo.ui_currentTime2 - Gui_rdn_TlmTi [Gd_N_EWO];						//	Mission Collect TI interval (min:1/32sec)
		Gui_rdn_TlmTi [Gd_N_EWO] =  t_timeInfo.ui_currentTime2;													//	Mission Collect TI          (min:1/32sec)
	for  (i=Gd_N_EFD;  i<=Gd_N_EWOB; i++) {
		memcpy( &ui_WriteAddress, &(Guc_rdn_EWOClctStatus[0x10 * (i+2)]), 4);   ui_WriteAddress += 0x08000000;	app07_Rdn_EWOclct_work( i,         ui_WriteAddress );
		Gus_rdn_TlmCnt[i]        ++;																			//	Mission Collect counter
		Gus_rdn_TlmDT [i]        =  t_timeInfo.ui_currentTime2 - Gui_rdn_TlmTi [i];								//	Mission Collect TI interval (min:1/32sec)
		Gui_rdn_TlmTi [i]        =  t_timeInfo.ui_currentTime2;													//	Mission Collect TI          (min:1/32sec)
	}

	return( i_flag );
}




/*
// ===========================================================================
// app07_putDPU
//		[INPUT]		unsigned char	uc_nodeId				Node ID
//					unsigned char	uc_dataId				Data ID
//					unsigned char	uc_headId				Head ID
//					unsigned char	uc_pacId				Packet ID
//					unsigned int	ui_dataTi				Header: TI
//					unsigned char	uc_drId,				DR-ID     = L or H0		(for CAT-ID) [0:HK 1:OS 2:L 3:M 4-9:H(0-5)]
//					unsigned char	uc_data[]				Data
//					int				i_dataSize				Data Size
// ===========================================================================
void	app07_putDPU(		unsigned char 	uc_nodeId, 				// [INPUT]		Node ID
							unsigned char 	uc_dataId, 				// [INPUT]		Data ID
							unsigned char 	uc_headId,				// [INPUT]		Head ID
							unsigned char	uc_pacId,				// [INPUT]		Packet ID	(user defined)
							unsigned int	ui_dataTi,				// [INPUT]		TI
							unsigned char	uc_drId,				// [INPUT]		DR-ID       L/M/H0	(for CAT-ID) [0:HK 1:OS 2:L 3:M 4-9:H(0-5)]
							unsigned char	uc_data[],				// [INPUT]		Data
							int				i_dataSize)				// [INPUT]		Data Size (Byte)
{
	int				i_flag;
	unsigned char	uc_TLMm_cmp = Guc_TLMm_cmp[uc_headId];

	// ---------------------------------------------------
	// --- Non-Comp / JPEG-Rev / Pre-Compressed Packet ---
	// ---------------------------------------------------
	i_flag = app_PutTlm( 	5,							// [INPUT]  APP-NUM = 5
							uc_nodeId,					// [INPUT]	Node-ID
							uc_dataId,					// [INPUT]	Data-ID
							uc_headId,					// [INPUT]	Header-ID (for PID-ID, CAT-ID setting)
							uc_drId,					// [INPUT]	DR-ID     (for CAT-ID) [0:HK 1:OS 2:L 3:M 4-9:H(0-5)]
							uc_TLMm_cmp,			 	// [INPUT]	Comp mode			   [0:non 1:JPEG-rev 2:JPEG-nonrev 3:After-User-COMP]
							uc_pacId, 					// [INPUT]	Packet ID 			<<<< USER-DEF:       0x00-      0xFF >>>>
							ui_dataTi, 					// [INPUT]	Data TI				<<<< USER-DEF: 0x00000000-0xFFFFFFFF >>>>
							Guc_cmdDummy, 				// [INPUT]	Comment				<<<< USER-DEF: <128B                 >>>>
							0, 							// [INPUT]	Comment - Size 		<<<< USER-DEF: <128B                 >>>>
							uc_data, 					// [INPUT]	Data				<<<< USER-DEF: <0x1E00               >>>>
							i_dataSize); 				// [INPUT]	Data - Size			<<<< USER-DEF: <0x1E00               >>>>
	return;
}
*/

#endif // _APP_RDN_