1 files changed, 152 insertions, 0 deletions
diff --git a/fpga/usrp3/lib/vita/chdr_32f_to_16sc_tb.v b/fpga/usrp3/lib/vita/chdr_32f_to_16sc_tb.v
new file mode 100644
index 000000000..7ba06bbc6
--- /dev/null
+++ b/fpga/usrp3/lib/vita/chdr_32f_to_16sc_tb.v
@@ -0,0 +1,152 @@
+`timescale 1ns/1ps
+
+module chdr_32f_to_16sc_tb();
+
+   reg clk = 0;
+   reg reset = 1;
+   //generate clock
+   always #10 clk = ~clk; 
+
+   initial $dumpfile("chdr_32f_to_16sc_tb.vcd");
+   initial $dumpvars(0,chdr_32f_to_16sc_tb);
+   
+
+
+   //tells when to finish
+   initial
+     begin
+   	#50 reset = 0;
+   	#50000; 
+   	$finish;
+     end
+
+   //setting registers and wire
+   reg [63:0] i_tdata;
+   reg        i_tlast = 0;
+   reg        i_tvalid = 0;
+   wire       i_tready;
+
+   wire [63:0] o_tdata;
+   wire        o_tlast;
+   
+   wire	       o_tvalid;
+   reg 	       o_tready;
+
+   reg [7:0] set_addr;
+   reg [31:0] set_data;
+   reg set_stb;
+
+   chdr_32f_to_16sc #(.BASE(89))dut
+     (.clk(clk), .reset(reset),
+      .set_data(set_data), .set_stb(set_stb), .set_addr(set_addr),
+      .i_tdata(i_tdata), .i_tlast(i_tlast), .i_tvalid(i_tvalid), .i_tready(i_tready),
+      .o_tdata(o_tdata), .o_tlast(o_tlast), .o_tvalid(o_tvalid), .o_tready(o_tready), .debug());
+
+
+  reg [31:0]data[0:7];
+  initial $readmemh("iq_to_float_output.txt", data);
+ 
+   
+  task test_packet;
+      input [15:0] len;
+      input [31:0] sid;
+      reg [4:0] index;
+            
+      begin
+
+	index <= 0;
+	 
+	 
+	 @(posedge clk) ;
+	 //send header 
+   	 i_tdata <= {1'b0, 1'b0, 1'b1, 1'b0, 12'h0, (len + 16'd16), sid};
+	 i_tvalid <= 1;
+	 i_tlast <= 0;
+	 @(posedge clk);
+	 while (i_tready != 1)
+	   @(posedge clk);
+	 i_tdata <= {64'b0};
+	
+   	 @(posedge clk);
+	 while (i_tready != 1)
+	   @(posedge clk);
+     //-1 for last bit accounting
+	 repeat (len[15:3] + (len[2]|len[1]|len[0]) - 1)
+	   begin
+	      
+	      i_tdata <= {data[index],data[index+1]};
+   	      index <= index+2;
+	      
+	      @(posedge clk);
+	 while (i_tready != 1)
+	   @(posedge clk);
+	   end
+	 
+
+	 
+   	 i_tlast <= 1'b1;
+	 i_tdata <= {data[index], data[index+1]};
+
+	 
+
+	 @(posedge clk);
+	 while (i_tready != 1)
+	   @(posedge clk);
+	 i_tvalid <= 0;
+      end
+   endtask // test_packet
+
+ task test_destination;
+      input enable;
+      input [15:0] dest_home;
+      
+      
+      begin
+         @(posedge clk);
+            
+         set_data <= {enable,dest_home};
+         set_addr <= 89;
+         set_stb <= 1;
+            
+         @(posedge clk);
+         set_stb <= 0;
+         end
+      endtask
+	
+	
+   initial
+     begin
+	i_tvalid <= 0;
+	o_tready <= 1;
+	
+    	i_tdata <= 0;
+   
+	@(negedge reset);
+	@(posedge clk);
+	@(posedge clk);
+
+
+	test_destination(1,16'hFEED);
+	test_packet(4, 32'hDEAD_BEEF);
+
+	test_destination(1,16'hFEED);
+	test_packet(8, 32'hDEAD_BEEF);
+
+	test_destination(1,16'hFEED);
+	test_packet(16, 32'hDEAD_BEEF);
+
+	test_destination(1,16'hFEED);
+	test_packet(20, 32'hDEAD_BEEF);
+
+	test_destination(1,16'hFEED);
+	test_packet(24, 32'hDEAD_BEEF);
+
+	test_destination(1,16'hFEED);
+	test_packet(28, 32'hDEAD_BEEF);
+	
+     end
+
+ 
+
+
+endmodule