S5443/S5443_M/S5443.srcs/sources_1/new/S5443TopPulseProfileTb.v

`timescale 1ns / 1ps

//=============================================================================================================

//	Тестовая конфигурация:
//
//	Режим измерения "Точка в импульсе".
//	Количество измерений = 1.
//	Выбраный фильтр = 2МГц.
//
//	PG1	->	Reference Sequense Generator.	|	Шаблон 1 имп.
//	PG2	->	модулятор.						|	Шаблон 1 имп.
//	PG3	->	Sample Strobe Generator.		|	Шаблон 1 имп.
//	PG4	->	Gating Generator.				|	Шаблон 1 имп.
//	
//	Настройки мультиплексоров генераторов:
//	PG1MUX_OUT	->	INT_TRIG.
//	PG2MUX_OUT	->	PG1. Для всех генераторов кроме PG1 сигналом начала работы является выход PG1.
//	PG3MUX_OUT	->	PG1.
//	PG4MUX_OUT	->	PG1.
//	PG5MUX_OUT	->	PG1.
//	PG6MUX_OUT	->	PG1.
//	PG7MUX_OUT	->	PG1.
//	
//	Настройки остальных мультиплексоров:
//	MODMUX_OUT			->	PG2.
//	GATINGMUX_OUT		->	PG4.
//	SAMPLSTROBEMUX_OUT	->	PG3.
//	EXTSTARTMUX			->	DSPSTART.

//=============================================================================================================
module S5443TopPulseProfileTb;
	
	localparam	[4:0]	EP1MUXCMD	=	5'd14;
	localparam	[4:0]	EP2MUXCMD	=	5'd1;
	localparam	[4:0]	EP3MUXCMD	=	5'd1;
	localparam	[4:0]	EP4MUXCMD	=	5'd1;
	localparam	[4:0]	EP5MUXCMD	=	5'd1;
	localparam	[4:0]	EP6MUXCMD	=	5'd1;
	
	localparam	[4:0]	PG1MUXCMD	=	5'd13;
	localparam	[4:0]	PG2MUXCMD	=	5'd0;
	localparam	[4:0]	PG3MUXCMD	=	5'd18;
	localparam	[4:0]	PG4MUXCMD	=	5'd18;
	localparam	[4:0]	PG5MUXCMD	=	5'd0;
	localparam	[4:0]	PG6MUXCMD	=	5'd0;
	localparam	[4:0]	PG7MUXCMD	=	5'd0;
	
	localparam	[2:0]	PG1MODE	=	3'd5;
	localparam	[2:0]	PG2MODE	=	3'd1;
	localparam	[2:0]	PG3MODE	=	3'd3;
	localparam	[2:0]	PG4MODE	=	3'd4;
	localparam	[2:0]	PG5MODE	=	3'd0;
	localparam	[2:0]	PG6MODE	=	3'd0;
	localparam	[2:0]	PG7MODE	=	3'd3;
	
	localparam	PG1POL	=	1'b0;
	localparam	PG2POL	=	1'b0;
	localparam	PG3POL	=	1'b0;
	localparam	PG4POL	=	1'b0;
	localparam	PG5POL	=	1'b0;
	localparam	PG6POL	=	1'b0;
	localparam	PG7POL	=	1'b0;
	
	localparam	[4:0]	EXTTRIGMUXCMD	=	5'd7;
	localparam	[4:0]	DSPTRIGINCMD	=	5'h8;
	localparam	[4:0]	MUXSLOWMODCMD	=	5'd1;
	localparam	[4:0]	MUXFASTMODCMD	=	5'd1;
	localparam	[4:0]	GATINGMUXCMD	=	5'd2;
	localparam	[4:0]	SMPLSTRBMUXCMD	=	5'd8;
	
	//COMMANDS	FOR REG_MAP
	parameter	[31:0]	MeasCmdBypass	=	{8'h11,8'h0,8'h63,8'h1};
	parameter	[31:0]	MeasCmdFft 		=	{8'h11,8'h0,8'h63,7'h5,1'b1};
	parameter	[31:0]	MeasCmd 		=	{8'h11,8'hff,8'h53,8'h0};
	// parameter	[31:0]	MeasCmd =	{8'h11,8'h3e,8'h63,8'h0};
	parameter	[31:0]	AdcCtrl =	{8'h12,24'h2};
	parameter	[31:0]	SensCtrlCmd =	{1'b0,27'h0,4'b1};
	// parameter	[31:0]	DitherCmd 	= {8'h0E,24'h100192};
	parameter	[31:0]	DitherCmd 	= {8'h0E,8'd9,4'h0,4'h1,4'd11,4'h3};
	parameter	[31:0]	IfFtwH 	=	{8'h15,16'h0,8'h40};
	parameter	[31:0]	IfFtwL 	=	{8'h16,24'h000000};
	parameter	[31:0]	FilterCorrCmdH 		=	{8'h17,24'hD70A3D};
	parameter	[31:0]	FilterCorrCmdL 		=	{8'h18,24'hD70A3D};
	
	//PG7 Cmd
	parameter	[31:0]	PG7P1DelayRegCmd	=	{8'h20,24'd0};
	parameter	[31:0]	PG7P2DelayRegCmd	=	{8'h21,24'd1};
	parameter	[31:0]	PG7P3DelayRegCmd	=	{8'h22,24'd5};
	parameter	[31:0]	PG7P123DelayRegCmd	=	{8'h23,24'd15};
	parameter	[31:0]	PG7P1WidthRegCmd	=	{8'h24,24'd1};
	parameter	[31:0]	PG7P2WidthRegCmd	=	{8'h25,24'd3};
	parameter	[31:0]	PG7P3WidthRegCmd	=	{8'h26,24'd5};
	parameter	[31:0]	PG7P123WidthRegCmd	=	{8'h27,24'd0};

	//PG1 Cmd
	parameter	[31:0]	PG1P1DelayRegCmd	=	{8'h28,24'd0};
	parameter	[31:0]	PG1P2DelayRegCmd	=	{8'h29,24'd400};
	parameter	[31:0]	PG1P3DelayRegCmd	=	{8'h2a,24'd0};
	parameter	[31:0]	PG1P123DelayRegCmd	=	{8'h2b,24'd0};
	parameter	[31:0]	PG1P1WidthRegCmd	=	{8'h2c,24'd1};
	parameter	[31:0]	PG1P2WidthRegCmd	=	{8'h2d,24'd0};
	parameter	[31:0]	PG1P3WidthRegCmd	=	{8'h2e,24'd0};
	parameter	[31:0]	PG1P123WidthRegCmd	=	{8'h2f,24'd0};
	
	//PG2 Cmd
	parameter	[31:0]	PG2P1DelayRegCmd	=	{8'h20,24'd0};
	parameter	[31:0]	PG2P2DelayRegCmd	=	{8'h21,24'd1};
	parameter	[31:0]	PG2P3DelayRegCmd	=	{8'h22,24'd5};
	parameter	[31:0]	PG2P123DelayRegCmd	=	{8'h23,24'd15};
	parameter	[31:0]	PG2P1WidthRegCmd	=	{8'h24,24'd1};
	parameter	[31:0]	PG2P2WidthRegCmd	=	{8'h25,24'd3};
	parameter	[31:0]	PG2P3WidthRegCmd	=	{8'h26,24'd5};
	parameter	[31:0]	PG2P123WidthRegCmd	=	{8'h27,24'd0};
	
	//PG3 Cmd
	parameter	[31:0]	PG3P1DelayRegCmd	=	{8'h20,24'd0};
	parameter	[31:0]	PG3P2DelayRegCmd	=	{8'h21,24'd1};
	parameter	[31:0]	PG3P3DelayRegCmd	=	{8'h22,24'd5};
	parameter	[31:0]	PG3P123DelayRegCmd	=	{8'h23,24'd15};
	parameter	[31:0]	PG3P1WidthRegCmd	=	{8'h24,24'd1};
	parameter	[31:0]	PG3P2WidthRegCmd	=	{8'h25,24'd3};
	parameter	[31:0]	PG3P3WidthRegCmd	=	{8'h26,24'd5};
	parameter	[31:0]	PG3P123WidthRegCmd	=	{8'h27,24'd0};
	
	//PG4 Cmd
	parameter	[31:0]	PG4P1DelayRegCmd	=	{8'h40,24'd0};
	parameter	[31:0]	PG4P2DelayRegCmd	=	{8'h41,24'd18};
	parameter	[31:0]	PG4P3DelayRegCmd	=	{8'h42,24'd0};
	parameter	[31:0]	PG4P123DelayRegCmd	=	{8'h43,24'd0};
	parameter	[31:0]	PG4P1WidthRegCmd	=	{8'h44,24'd1};
	parameter	[31:0]	PG4P2WidthRegCmd	=	{8'h45,24'd10};
	parameter	[31:0]	PG4P3WidthRegCmd	=	{8'h46,24'd7};
	parameter	[31:0]	PG4P123WidthRegCmd	=	{8'h47,24'd0};
	
	//PG5 Cmd
	parameter	[31:0]	PG5P1DelayRegCmd	=	{8'h48,24'd0};
	parameter	[31:0]	PG5P2DelayRegCmd	=	{8'h49,24'd0};
	parameter	[31:0]	PG5P3DelayRegCmd	=	{8'h4a,24'd0};
	parameter	[31:0]	PG5P123DelayRegCmd	=	{8'h4b,24'd0};
	parameter	[31:0]	PG5P1WidthRegCmd	=	{8'h4c,24'd0};
	parameter	[31:0]	PG5P2WidthRegCmd	=	{8'h4d,24'd0};
	parameter	[31:0]	PG5P3WidthRegCmd	=	{8'h4e,24'd0};
	parameter	[31:0]	PG5P123WidthRegCmd	=	{8'h4f,24'd0};
	
	//PG6 Cmd
	parameter	[31:0]	PG6P1DelayRegCmd	=	{8'h50,24'd0};
	parameter	[31:0]	PG6P2DelayRegCmd	=	{8'h51,24'd5};
	parameter	[31:0]	PG6P3DelayRegCmd	=	{8'h52,24'd15};
	parameter	[31:0]	PG6P123DelayRegCmd	=	{8'h53,24'd0};
	parameter	[31:0]	PG6P1WidthRegCmd	=	{8'h54,24'd1};
	parameter	[31:0]	PG6P2WidthRegCmd	=	{8'h55,24'd3};
	parameter	[31:0]	PG6P3WidthRegCmd	=	{8'h56,24'd5};
	parameter	[31:0]	PG6P123WidthRegCmd	=	{8'h57,24'd0};
	
	parameter	[31:0]	MeasNum0RegCmd		=	{8'h58,24'd10};
	parameter	[31:0]	MeasNum1RegCmd		=	{8'h59,MUXSLOWMODCMD,MUXFASTMODCMD,DSPTRIGINCMD,25'd0};
	parameter	[31:0]	PGMode0RegCmd		=	{8'h0b,3'b0,PG7MODE,PG6MODE,PG5MODE,PG4MODE,PG3MODE,PG2MODE,PG1MODE};
	parameter	[31:0]	PGMode1RegCmd		=	{8'h1b,7'b0000000,PG7POL,PG6POL,PG5POL,PG4POL,PG3POL,PG2POL,PG1POL,10'h0};
	
	parameter	[31:0]	MuxCtrl1RegCmd	=	{8'h1c,4'h0,PG7MUXCMD,PG6MUXCMD,PG5MUXCMD,PG4MUXCMD};
	parameter	[31:0]	MuxCtrl2RegCmd	=	{8'h1d,4'h0,PG3MUXCMD,PG2MUXCMD,PG1MUXCMD,SMPLSTRBMUXCMD};
	parameter	[31:0]	MuxCtrl3RegCmd	=	{8'h1e,4'h0,GATINGMUXCMD,EXTTRIGMUXCMD,EP2MUXCMD,EP1MUXCMD};
	parameter	[31:0]	MuxCtrl4RegCmd	=	{8'h1f,4'h0,EP6MUXCMD,EP5MUXCMD,EP4MUXCMD,EP3MUXCMD};
	
	//=================================================================================================================================================================================================================
	
	reg		Clk41;
	reg		Clk50;
	reg		Clk70;
	
	reg	[31:0]	tb_cnt=4'd0;
	reg	rst;
	reg	mosi_i	=	1'b0;
	reg	Miso_i	=	1'b0;
	reg	ss_i;
	reg	clk_i	=	1'b0;
	
	
	reg	[31:0]	DspSpiData;
	reg		startCalcCmdReg;
						
	wire	[17:0]	cos_value;	
	wire	[17:0]	sin_value;				

	wire	ExtDspTrigPos0	=	(tb_cnt	>=	180	&&	tb_cnt	<=	181)?	1'b1:1'b0;
	wire	ExtDspTrigNeg0	=	(tb_cnt	>=	180	&&	tb_cnt	<=	181)?	1'b0:1'b1;
	
	wire	ExtTrigger0		=	ExtDspTrigNeg0;
	
	wire	TrigFromDsp		=	(tb_cnt	>=	1100	&&	tb_cnt	<=	1101)?	1'b1:1'b0;
	wire	endMeas;
	reg	[31:0]	cmdCnt;
	
	reg	trig0;
	reg	trig1;
	
	wire	trig0R;
    wire	trig1R;
	
	assign	trig0R	=	trig0;
    assign	trig1R	=	trig1;
	
	reg	[32:0]	extPulseTrigCnt;
	wire	extPulseTrig	=	extPulseTrigCnt==32'd500;
	
	wire	[5:0]	extTrigBus;
	wire	[5:0]	extTrigDir;
//==========================================================================================
//clocks gen
	always	#10 Clk50	=	~Clk50;
	always	#(14.285714285714/2) Clk70	=	~Clk70;
	always	#10 clk_i	=	~clk_i;
	always	#(24.390243902439/2)	Clk41	=	~Clk41;
	
	wire	sck_i;	
	
	assign	extTrigDir	[0]	=	!MeasCmd[16];
	assign	extTrigDir	[1]	=	!MeasCmd[17];
	assign	extTrigDir	[2]	=	!MeasCmd[18];
	assign	extTrigDir	[3]	=	!MeasCmd[19];
	assign	extTrigDir	[4]	=	!MeasCmd[20];
	assign	extTrigDir	[5]	=	!MeasCmd[21];
	
	assign	extTrigBus	[0]	=	(MeasCmd[16])	?	extPulseTrig:1'bz;	//1 - in, 0 - out
	assign	extTrigBus	[1]	=	(MeasCmd[17])	?	0:1'bz;	//1 - in, 0 - out
	assign	extTrigBus	[2]	=	(MeasCmd[18])	?	extPulseTrig:1'bz;	//1 - in, 0 - out
	assign	extTrigBus	[3]	=	(MeasCmd[19])	?	0:1'bz;	//1 - in, 0 - out
	assign	extTrigBus	[4]	=	(MeasCmd[20])	?	0:1'bz;	//1 - in, 0 - out
	assign	extTrigBus	[5]	=	(MeasCmd[21])	?	0:1'bz;	//1 - in, 0 - out
	
//==========================================================================================
initial begin
	Clk50	=	1'b1;
	Clk70	=	1'b1;
	rst		=	1'b1;
	Clk41	=	1'b0;
	trig0	=	1'b0;
	trig1	=	1'b0;
#100;
	rst		=	1'b0;
#400;
	Clk41	=	1'b0;
end		
	
always	@(posedge	Clk50)	begin
	if	(!rst)	begin
		if	(extPulseTrigCnt!=32'd500)	begin
			extPulseTrigCnt	<=	extPulseTrigCnt+32'd1;
		end	else	begin
			extPulseTrigCnt	<=	32'd0;
		end
	end	else	begin
		extPulseTrigCnt	<=	32'd0;
	end
end

reg	endMeasReg;
always	@(posedge	Clk41)	begin
	endMeasReg	<=	endMeas;
end

wire	endMeasNeg	=	!endMeas&endMeasReg;

always	@(posedge	Clk70)	begin
	if	(!rst)	begin
		if	(!endMeas)	begin
			if	(tb_cnt	==	3550	|	tb_cnt	==	3950	|tb_cnt	==	4505)	begin
				startCalcCmdReg	<=	1'b1;
			end	
		end	else	begin
			startCalcCmdReg	<=	1'b0;
		end
	end	else	begin
		startCalcCmdReg	<=	1'b0;
	end
end

always	@(negedge	Clk41)	begin
	if	(!rst)		begin
		tb_cnt	<=	tb_cnt+1;
	end	else	begin
		tb_cnt	<=	0;
	end
end

wire	Adc1DataDa0P;
wire	Adc1DataDa1P;

// wire	[31:0]	test	=	32'h2351eb85;
wire	[31:0]	test	=	32'h40000000;
CordicNco		
#(	.ODatWidth	(18),
	.PhIncWidth	(32),
	.IterNum	(10),
	.EnSinN		(0))
ncoInst
(
	.Clk_i				(Clk50),
	.Rst_i				(rst),
	.Val_i				(1'b1),
	.PhaseInc_i			(test),
	.WindVal_i			(1'b1),
	.WinType_i			(),
	.Wind_o				(),
	.Sin_o				(sin_value),
	.Cos_o				(cos_value),
	.Val_o				()
);


S5243Top MasterFpga 
(
	.ClkP_i				(Clk50),
	.ClkN_i				(~Clk50),
	.Led_o				(),
//------------------------------------------	
    .Adc1FclkP_i		(),		
    .Adc1FclkN_i		(),		

    .Adc1DataDa0P_i		(Adc1DataDa0P),
	.Adc1DataDa0N_i		(~Adc1DataDa0P),		
    .Adc1DataDa1P_i		(Adc1DataDa1P),
    .Adc1DataDa1N_i		(~Adc1DataDa1P),

	.Adc1DataDb0P_i		(Adc1DataDa0P),
    .Adc1DataDb0N_i		(~Adc1DataDa0P),		
    .Adc1DataDb1P_i		(Adc1DataDa1P),
    .Adc1DataDb1N_i		(~Adc1DataDa1P),
//------------------------------------------	
    .Adc2FclkP_i		(),		
    .Adc2FclkN_i		(),		

    .Adc2DataDa0P_i		(1'b1),
    .Adc2DataDa0N_i		(1'b0),		
    .Adc2DataDa1P_i		(1'b1),
    .Adc2DataDa1N_i		(1'b0),
  
	.Adc2DataDb0P_i		(1'b1),
    .Adc2DataDb0N_i		(1'b0),		
    .Adc2DataDb1P_i		(1'b1),
    .Adc2DataDb1N_i		(1'b0),
//------------------------------------------
	// .AdcInitMosi_o		(),
	// .AdcInitClk_o		(),			
	.Adc1InitCs_o		(),
	.Adc2InitCs_o		(),
	// .AdcInitRst_o		(),
//------------------------------------------	
	
	.Mosi_i				(mosi_i),
	.Sck_i				(~sck_i),
	.Ss_i				(ss_i),

	.LpOutClk_o			(),
	.LpOutFs_o			(),			
	.LpOutData_o		(),
	
	//fpga-dsp signals
	.StartMeas_i		(startCalcCmdReg),
	// .StartMeasEvent_o	(startMeasS),
	.EndMeas_o			(endMeas),
	.TimersClk_o		(),
	
	.Trig6to1_io		(extTrigBus),	
	.Trig6to1Dir_o		(extTrigDir),	
	
	.DspTrigOut_i		(Clk41),				//Trig from DSP
	.DspTrigIn_o		(),				//Trig To DSP
	
	// .OverloadS_i		(1'b0),
	.Overload_o			(),
	
	.PortSel_o			(),
	// .PortSelDir_o		(),
	
	//mod out line
	
	.Mod_o				(),	
	
	//gain lines
	.DspReadyForRx_i		(1'b0),
	// .DspReadyForRxToFpgaS_o	(),
	.AmpEn_o				(),	//	0-adc1ChA 1-adc1ChB 2-adc2ChA 3-adc2ChB
	.AdcData_i				(sin_value[17-:14])
	// .AdcData_i			(Data_i)
);

parameter	IDLE	=	2'h0;
parameter	CMD		=	2'h1;
parameter	TX		=	2'h2;
parameter	PAUSE	=	2'h3;

reg	[1:0]	txCurrState;
reg	[1:0]	txNextState;

wire	txWork	=	tb_cnt	>=	23;
// wire	txStop	=	(cmdCnt	>=	90)	&	(cmdCnt	>=	70)	&	(cmdCnt	>=	71);
wire	txStop	=	(cmdCnt	>=	251);


reg	[6:0]	txCnt;
reg	[3:0]	pauseCnt;

always	@(posedge	Clk41)	begin
	if	(!rst)	begin
		if	(txCurrState	==	CMD)	begin
			if	(!txStop)	begin
				cmdCnt	<=	cmdCnt+1;
			end
		end
	end	else	begin
		cmdCnt	<=	0;
	end
end

always	@(posedge	Clk41)	begin
	if	(!rst)	begin
		if	(txCurrState	==	TX)	begin
			txCnt	<=	txCnt+1;
		end	else	begin
			txCnt	<=	0;
		end
	end	else	begin
		txCnt	<=	0;
	end
end

always	@(posedge	Clk41)	begin
	if	(!rst)	begin
		if	(txCurrState	==	PAUSE)	begin
			pauseCnt	<=	pauseCnt+1;
		end	else	begin
			pauseCnt	<=	0;
		end
	end	else	begin
		pauseCnt	<=	0;
	end
end
	

always	@(posedge	Clk41)	begin
	if	(txCurrState	==	CMD)	begin
		if	(cmdCnt	==	0)	begin
			DspSpiData		<=	MeasCmd;
		end	else	if	(cmdCnt	==	1)	begin
			DspSpiData		<=	IfFtwH;
		end	else	if	(cmdCnt	==	2)	begin
			DspSpiData		<=	IfFtwL;
		end	else	if	(cmdCnt	==	3)	begin
			DspSpiData		<=	FilterCorrCmdH;
		end	else	if	(cmdCnt	==	4)	begin
			DspSpiData		<=	FilterCorrCmdL;
		end	else	if	(cmdCnt	==	5)	begin
			DspSpiData		<=	PG1P1DelayRegCmd;
		end	else	if	(cmdCnt	==	6)	begin
			DspSpiData		<=	PG1P2DelayRegCmd;
		end	else	if	(cmdCnt	==	7)	begin
			DspSpiData		<=	PG1P3DelayRegCmd;
		end	else	if	(cmdCnt	==	8)	begin
			DspSpiData		<=	PG1P123DelayRegCmd;
		end	else	if	(cmdCnt	==	9)	begin
			DspSpiData		<=	PG1P1WidthRegCmd;
		end	else	if	(cmdCnt	==	10)	begin
			DspSpiData		<=	PG1P2WidthRegCmd;
		end	else	if	(cmdCnt	==	11)	begin
			DspSpiData		<=	PG1P3WidthRegCmd;
		end	else	if	(cmdCnt	==	12)	begin
			DspSpiData		<=	PG1P123WidthRegCmd;
		end	else	if	(cmdCnt	==	13)	begin
			DspSpiData		<=	PG2P1DelayRegCmd;
		end	else	if	(cmdCnt	==	14)	begin
			DspSpiData		<=	PG2P2DelayRegCmd;
		end	else	if	(cmdCnt	==	15)	begin
			DspSpiData		<=	PG2P3DelayRegCmd;	
		end	else	if	(cmdCnt	==	16)	begin
			DspSpiData		<=	PG2P123DelayRegCmd;
		end	else	if	(cmdCnt	==	17)	begin
			DspSpiData		<=	PG2P1WidthRegCmd;
		end	else	if	(cmdCnt	==	18)	begin
			DspSpiData		<=	PG2P2WidthRegCmd;
		end	else	if	(cmdCnt	==	19)	begin
			DspSpiData		<=	PG2P3WidthRegCmd;
		end	else	if	(cmdCnt	==	20)	begin
			DspSpiData		<=	PG2P123WidthRegCmd;
		end	else	if	(cmdCnt	==	21)	begin
			DspSpiData		<=	PG3P1DelayRegCmd;
		end	else	if	(cmdCnt	==	22)	begin
			DspSpiData		<=	PG3P2DelayRegCmd;
		end	else	if	(cmdCnt	==	23)	begin
			DspSpiData		<=	PG3P3DelayRegCmd;	
		end	else	if	(cmdCnt	==	24)	begin
			DspSpiData		<=	PG3P123DelayRegCmd;
		end	else	if	(cmdCnt	==	25)	begin
			DspSpiData		<=	PG3P1WidthRegCmd;
		end	else	if	(cmdCnt	==	26)	begin
			DspSpiData		<=	PG3P2WidthRegCmd;
		end	else	if	(cmdCnt	==	27)	begin
			DspSpiData		<=	PG3P3WidthRegCmd;
		end	else	if	(cmdCnt	==	28)	begin
			DspSpiData		<=	PG3P123WidthRegCmd;
		end	else	if	(cmdCnt	==	29)	begin
			DspSpiData		<=	PG4P1DelayRegCmd;
		end	else	if	(cmdCnt	==	30)	begin
			DspSpiData		<=	PG4P2DelayRegCmd;
		end	else	if	(cmdCnt	==	31)	begin
			DspSpiData		<=	PG4P3DelayRegCmd;	
		end	else	if	(cmdCnt	==	32)	begin
			DspSpiData		<=	PG4P123DelayRegCmd;
		end	else	if	(cmdCnt	==	33)	begin
			DspSpiData		<=	PG4P1WidthRegCmd;
		end	else	if	(cmdCnt	==	34)	begin
			DspSpiData		<=	PG4P2WidthRegCmd;
		end	else	if	(cmdCnt	==	35)	begin
			DspSpiData		<=	PG4P3WidthRegCmd;
		end	else	if	(cmdCnt	==	36)	begin
			DspSpiData		<=	PG4P123WidthRegCmd;
		end	else	if	(cmdCnt	==	37)	begin
			DspSpiData		<=	PG5P1DelayRegCmd;
		end	else	if	(cmdCnt	==	38)	begin
			DspSpiData		<=	PG5P2DelayRegCmd;
		end	else	if	(cmdCnt	==	39)	begin
			DspSpiData		<=	PG5P3DelayRegCmd;	
		end	else	if	(cmdCnt	==	40)	begin
			DspSpiData		<=	PG5P123DelayRegCmd;
		end	else	if	(cmdCnt	==	41)	begin
			DspSpiData		<=	PG5P1WidthRegCmd;
		end	else	if	(cmdCnt	==	42)	begin
			DspSpiData		<=	PG5P2WidthRegCmd;
		end	else	if	(cmdCnt	==	43)	begin
			DspSpiData		<=	PG5P3WidthRegCmd;
		end	else	if	(cmdCnt	==	44)	begin
			DspSpiData		<=	PG5P123WidthRegCmd;
		end	else	if	(cmdCnt	==	45)	begin
			DspSpiData		<=	PG6P1DelayRegCmd;
		end	else	if	(cmdCnt	==	46)	begin
			DspSpiData		<=	PG6P2DelayRegCmd;
		end	else	if	(cmdCnt	==	47)	begin
			DspSpiData		<=	PG6P3DelayRegCmd;	
		end	else	if	(cmdCnt	==	48)	begin
			DspSpiData		<=	PG6P123DelayRegCmd;
		end	else	if	(cmdCnt	==	49)	begin
			DspSpiData		<=	PG6P1WidthRegCmd;
		end	else	if	(cmdCnt	==	50)	begin
			DspSpiData		<=	PG6P2WidthRegCmd;
		end	else	if	(cmdCnt	==	51)	begin
			DspSpiData		<=	PG6P3WidthRegCmd;
		end	else	if	(cmdCnt	==	52)	begin
			DspSpiData		<=	PG6P123WidthRegCmd;
		end	else	if	(cmdCnt	==	53)	begin
			DspSpiData		<=	PG7P1DelayRegCmd;
		end	else	if	(cmdCnt	==	54)	begin
			DspSpiData		<=	PG7P2DelayRegCmd;
		end	else	if	(cmdCnt	==	55)	begin
			DspSpiData		<=	PG7P3DelayRegCmd;	
		end	else	if	(cmdCnt	==	56)	begin
			DspSpiData		<=	PG7P123DelayRegCmd;
		end	else	if	(cmdCnt	==	57)	begin
			DspSpiData		<=	PG7P1WidthRegCmd;
		end	else	if	(cmdCnt	==	58)	begin
			DspSpiData		<=	PG7P2WidthRegCmd;
		end	else	if	(cmdCnt	==	59)	begin
			DspSpiData		<=	PG7P3WidthRegCmd;
		end	else	if	(cmdCnt	==	60)	begin
			DspSpiData		<=	DitherCmd;
		end	else	if	(cmdCnt	==	61)	begin
			DspSpiData		<=	MeasNum0RegCmd;
		end else	if	(cmdCnt	==	62)	begin
			DspSpiData		<=	MeasNum1RegCmd;
		end else	if	(cmdCnt	==	63)	begin
			DspSpiData		<=	PGMode0RegCmd;
		end	else	if	(cmdCnt	==	64)	begin
			DspSpiData		<=	PGMode1RegCmd;
		end	else	if	(cmdCnt	==	65)	begin
			DspSpiData		<=	MuxCtrl1RegCmd;
		end	else	if	(cmdCnt	==	66)	begin
			DspSpiData		<=	MuxCtrl2RegCmd;
		end	else	if	(cmdCnt	==	67)	begin
			DspSpiData		<=	MuxCtrl3RegCmd;
		end	else	if	(cmdCnt	==	68)	begin
			DspSpiData		<=	AdcCtrl;
		end	else	if	(cmdCnt	==	99)	begin
			DspSpiData		<=	{8'h58,24'd100};
		end	else	if	(cmdCnt	==	100)	begin
			DspSpiData		<=	MeasCmdFft;
		end else	begin
			DspSpiData	<=	32'hfffffff;
		end
	end	else	if	(txCurrState	==	TX)	begin
		DspSpiData	<=	DspSpiData<<1;
	end
end

always	@(posedge Clk41)	begin
	if	(txCurrState	==	TX)	begin
		if	(txCnt	>=	7'd0)	begin
			mosi_i	<=	DspSpiData[31];
		end	else	begin
			mosi_i	<=	1'b1;
		end
	end	else	begin
		mosi_i	<=	1'b1;
	end
end

always	@(posedge	Clk41)	begin
	if	(txCurrState	==	TX)	begin
		ss_i	<=	1'b0;
	end	else	begin
		ss_i	<=	1'b1;
	end
end

assign	sck_i	=	Clk41;

always	@(posedge	Clk41)	begin
	if	(rst)	begin
		txCurrState	<=	IDLE;
	end	else	begin
		txCurrState	<=	txNextState;
	end
end


always @(*) begin
	txNextState	=	IDLE;
	case(txCurrState)
	IDLE	:	begin
					if (txWork)	begin
						txNextState = CMD;
					end	else begin
						txNextState = IDLE;
					end
				end
				
	CMD	:		begin
					if (!txStop)	begin
						txNextState = TX;
					end	else begin
						txNextState = IDLE;
					end
				end

	TX		:	begin
					if (txCnt==6'd31) begin
						txNextState  = PAUSE;
					end	else begin
						txNextState  = TX;
					end
				end
        
	PAUSE	:	begin
					if (pauseCnt==4'd10) begin
						txNextState  = CMD;
					end	else begin
						txNextState  = PAUSE;
					end
				end
	endcase
end

	reg [13:0] Data_i;
	real pi = 3.14159265358;
	real phase = 0;
	real phaseInc = 0.001;
	real signal;
	always @ (posedge Clk50)
		begin
			if (tb_cnt >= 4505)
				begin
					phase = phase + phaseInc;
					phaseInc <= phaseInc + 0.0005;
					signal = $sin(2*pi*phase);
					Data_i = 2**12 * signal;
				end
			else
				Data_i = 0;
		end
		
endmodule