dsp: testbench for gc_cordic

52d3800a · Tomasz Wlostowski · 362fa2fc · 52d3800a · 52d3800a · 52d3800a
Commit 52d3800a authored Feb 17, 2022 by Tomasz Wlostowski
Showing with 325 additions and 0 deletions

Manifest.py testbench/dsp/gc_cordic/Manifest.py +24 -0

main.sv testbench/dsp/gc_cordic/main.sv +280 -0

run.do testbench/dsp/gc_cordic/run.do +6 -0

wave.do testbench/dsp/gc_cordic/wave.do +15 -0

No files found.
--- a/testbench/dsp/gc_cordic/Manifest.py
+++ b/testbench/dsp/gc_cordic/Manifest.py
+action   = "simulation"
+sim_tool = "modelsim"
+
+vcom_opt = "-mixedsvvh l"
+
+target      = "xilinx"
+syn_device  = "xc6slx45t"
+
+top_module = "main" # for hdlmake2
+sim_top    = "main" # for hdlmake3
+
+include_dirs = [
+    "../../../sim/"
+]
+
+modules = {
+    "local" :  [
+        "../../../",
+    ],
+}
+
+files = [
+    "main.sv",
+]
--- a/testbench/dsp/gc_cordic/main.sv
+++ b/testbench/dsp/gc_cordic/main.sv
+`timescale 1ns/1ps
+
+
+import gc_cordic_pkg::*;
+
+const bit[0:0] MODE_VECTOR =1'b0;
+const bit[0:0] MODE_ROTATE =1'b1;
+
+const bit[1:0] SUBMODE_CIRCULAR = 2'b00;
+const bit[1:0] SUBMODE_LINEAR  = 2'b01;
+const bit[1:0] SUBMODE_HYPERBOLIC = 2'b11;
+
+const real M_PI = 3.14159265358;
+const real AN = 1.6467602581210656483661780066297;
+
+
+module main;
+
+   reg rst_n = 0;
+   reg clk= 0;
+   
+   parameter time g_clk_period = 10.0ns; 
+
+
+   always #(g_clk_period/2) clk <= ~clk;
+   initial #200ns rst_n <= 1;
+
+   logic signed [15:0] x0=0, y0=0, z0=0;
+   wire signed [15:0]  xn, yn, zn;
+
+//   ROTATE/CIRCULAR -> mag/phase -> sin/cos
+//   VECTOR/CIRCULAR -> sin/soc -> mag/phase
+
+   logic [0:0] 	       cor_mode = MODE_ROTATE;
+   logic [1:0] 	       cor_submode = SUBMODE_CIRCULAR;
+
+   const int 	       c_PHASE_BITS = 16;
+   const int 	       c_PIPELINE_DELAY = 17;
+   
+   typedef struct {
+      real 	  phase;
+      real 	  mag;
+      logic signed [15:0] x, y, z;
+   } cordic_data_t;
+
+   cordic_data_t cor_in, cor_out;
+
+
+  
+   
+   gc_cordic #(
+	       .g_N(16),
+	       .g_M(16),
+	       .g_ANGLE_FORMAT(1) //c_ANGLE_FORMAT_FULL_SCALE_180)
+	       )
+   DUT 
+     (
+      .clk_i(clk),
+      .rst_i(~rst_n),
+
+      .cor_mode_i    ( cor_mode ),
+      .cor_submode_i ( cor_submode ),
+      
+      .lim_x_i(1'b0),
+      .lim_y_i(1'b0),
+
+      .x0_i(cor_in.x),
+      .y0_i(cor_in.y),
+      .z0_i(cor_in.z),
+
+      .xn_o(cor_out.x),
+      .yn_o(cor_out.y),
+      .zn_o(cor_out.z),
+
+      .lim_x_o(),
+      .lim_y_o(),
+
+      .rst_o()
+      );
+
+    `ifdef disabled
+    CoRDICPipeHD
+      #(
+	    
+           .N(16),
+           .M(16)
+         //  .AngleMode(1'b1)
+           )
+   DUT2
+    (
+     .Clk(clk),
+     .RstO(),
+     .Rst(~rst_n),
+     .LimXin(1'b0),
+     .LimX(),
+     .LimY(),
+
+     .X0(cor_in.x),
+      .Y0(cor_in.y),
+      .Z0(cor_in.z),
+
+//      .Xn(cor_out.x),
+//      .Yn(cor_out.y),
+//      .Zn(cor_out.z),
+     
+//     .CorMode : in CoRDiCMode;
+     .LimYin(1'b0)
+        );
+
+    `endif //  `ifdef disabled
+   
+    function int abs(int x);
+      if(x<0)
+	x=-x;
+      return x;
+   endfunction // abs
+   
+
+   task automatic run_cordic_testcase( cordic_data_t in [$], cordic_data_t exp_out[$], int latency, int max_error, bit check_x, bit check_y, bit check_z, output int err_count );
+      automatic int j;
+      
+      cordic_data_t out[$];
+      
+      fork
+	 begin : din
+	    foreach( in[i] )
+	      begin
+		 cor_in <= in[i];
+		 @(posedge clk);
+	      end
+	 end
+	 begin : dout
+	    repeat(latency) @(posedge clk);
+	    for(j=0; j < in.size(); j++)
+	      begin
+		 @(posedge clk);
+		 out.push_back(cor_out);
+	      end
+	 end
+      join
+      
+      for(j=0;j<in.size();j++)
+	begin
+	   cordic_data_t e = exp_out[j];
+	   cordic_data_t o = out[j];
+	   cordic_data_t err = e;
+
+	   err.x = abs(e.x-o.x);
+	   err.y = abs(e.y-o.y);
+	   err.z = abs(e.z-o.z);
+	   if(check_x && err.x > max_error)
+	     begin
+		$error("Sample %d: X expected = %d, actual = %d", j, e.x, o.x);
+		err_count++;
+	     end
+	   
+	   if(check_y && err.y > max_error)
+	     begin
+		$error("Sample %f: Y expected = %d, actual = %d", j, e.y, o.y);
+		err_count++;
+	     end
+	   
+	   if(check_z && err.z > max_error)
+	     begin
+		$error("Sample %d: Z expected = %d, actual = %d", j, e.z, o.z);
+		err_count++;
+	     end
+	   
+	end
+
+      
+   endtask // run_cordic_testcase
+
+  
+      
+      
+
+   function int phase2fix( real phase );
+      int rv;
+      
+      while( phase > M_PI )
+	phase -= 2.0*M_PI;
+      while (phase < -M_PI )
+	phase += 2.0*M_PI;
+      
+      rv= int' ( real'((1 << (c_PHASE_BITS-1) ) - 1) * phase / M_PI );
+
+//      $display("ph %f %d\n", phase, rv);
+
+      
+      return rv;
+      
+   endfunction // phase2fix
+
+   function real rand_real(real a, real b);
+      return a + (b-a)*(real'($urandom())/32'hffffffff);
+   endfunction // rand_real
+   
+  
+   task automatic run_testcase_sincos( int nsamples );
+      cordic_data_t in[$], expected[$], tmp, result;
+      int i, err_cnt=0;
+
+      cor_mode = MODE_ROTATE;
+      cor_submode = SUBMODE_CIRCULAR;
+
+      for(i=0; i < nsamples; i++)
+	begin
+	   tmp.mag = $random()%15000;
+	   tmp.phase = rand_real(-M_PI, M_PI); //  -M_PI + (2*M_PI*real'(i)/real'(nsamples) );//rand_real(-M_PI, M_PI);
+	   in.push_back(tmp);
+	end
+    
+      
+      foreach (in[i])
+	begin
+	   real mag = in[i].mag * AN;
+
+	   in[i].x = int'(in[i].mag);
+	   in[i].y = 0;
+	   in[i].z = phase2fix( in[i].phase );
+	   		    
+	   result.x = int'( mag * $cos( in[i].phase ) );
+	   result.y = int'( mag * $sin( in[i].phase ) );
+	   
+	   result.z = 0;
+	   expected.push_back(result);
+	   
+	end
+
+      run_cordic_testcase( in, expected, c_PIPELINE_DELAY, 20, 1, 1, 0, err_cnt );
+      $display("Mag/Phase->Sin/Cos: %d errors", err_cnt);
+      
+   endtask // run_testcase_sincos
+
+    task automatic run_testcase_angle_mag( int nsamples );
+      cordic_data_t in[$], expected[$], tmp, result;
+      int i, err_cnt=0;
+
+      cor_mode = MODE_VECTOR;
+      cor_submode = SUBMODE_CIRCULAR;
+
+      for(i=0; i < nsamples; i++)
+	begin
+	   tmp.mag = 10000+ ( $urandom()%5000 );
+	   tmp.phase =  rand_real(-M_PI, M_PI);
+
+	   tmp.x = int'( tmp.mag * $cos( tmp.phase ) );
+	   tmp.y = int'( tmp.mag * $sin( tmp.phase ) );
+	   tmp.z = 0;
+	   
+
+	   in.push_back(tmp);
+
+	   result.x = int'( real'(tmp.mag) * AN );
+	   
+	   result.z = phase2fix(tmp.phase);
+	   expected.push_back(result);
+	end
+
+      run_cordic_testcase( in, expected, c_PIPELINE_DELAY, 20, 1, 0, 1, err_cnt );
+      $display("Sin/Cos->Mag/Phase: %d errors", err_cnt);
+
+   endtask
+	
+   
+   initial begin
+      while(!rst_n) @(posedge clk);
+
+      @(posedge clk);
+
+      run_testcase_sincos( 10000 );
+      run_testcase_angle_mag( 10000 );
+      $stop;
+      
+      
+   end
+   
+   
+endmodule
--- a/testbench/dsp/gc_cordic/run.do
+++ b/testbench/dsp/gc_cordic/run.do
+vsim work.main -voptargs="+acc"
+
+do wave.do
+run 30ms
+wave zoomfull
+radix -hex
\ No newline at end of file
--- a/testbench/dsp/gc_cordic/wave.do
+++ b/testbench/dsp/gc_cordic/wave.do
+onerror {resume}
+quietly WaveActivateNextPane {} 0
+add wave -noupdate -radix decimal /main/DUT/g_num_pins
+add wave -noupdate -radix decimal /main/DUT/c_NUM_BANKS
+add wave -noupdate -radix hexadecimal /main/DUT/clk_sys_i
+add wave -noupdate -radix hexadecimal /main/DUT/rst_n_i
+add wave -noupdate -radix hexadecimal /main/DUT/wb_*
+add wave -noupdate -radix hexadecimal /main/DUT/gpio_in_i
+add wave -noupdate -radix hexadecimal /main/DUT/gpio_out_o
+add wave -noupdate -radix hexadecimal /main/DUT/gpio_oen_o
+add wave -noupdate -radix hexadecimal /main/DUT/sor_wr
+add wave -noupdate -radix hexadecimal /main/DUT/cor_wr
+add wave -noupdate -radix hexadecimal /main/DUT/ddr_wr
+TreeUpdate [SetDefaultTree]
+update