原创 cordic verilog 程序及仿真结果 8级流水线

 2008-6-20 12:29  8190 13 26 分类: FPGA/CPLD

module cordic(clk,rst_n,in,out);

parameter DATA_WIDTH=16;

input     clk;

input     rst_n;

input  [DATA_WIDTH-1:0]  in;

output [DATA_WIDTH-1:0] out;

reg    [DATA_WIDTH-1:0] out;

reg    [DATA_WIDTH-1:0] x0,y0,z0;

reg    [DATA_WIDTH-1:0] x1,y1,z1;

reg    [DATA_WIDTH-1:0] x2,y2,z2;

reg    [DATA_WIDTH-1:0] x3,y3,z3;

reg    [DATA_WIDTH-1:0] x4,y4,z4;

reg    [DATA_WIDTH-1:0] x5,y5,z5;

reg    [DATA_WIDTH-1:0] x6,y6,z6;

reg    [DATA_WIDTH-1:0] x7,y7,z7;

reg    [DATA_WIDTH-1:0] x8,y8,z8;

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)

      begin

         x0<=16'b0000_0000_0000_0000;

         y0<=16'b0000_0000_0000_0000;

         z0<=16'b0000_0000_0000_0000;

      end

   else

       begin

            x0 <= 16'h4DBA;

            y0 <= 16'h0000;

            z0 <= in;

         end

end

//level 1

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)

      begin

         x1<=16'b0000_0000_0000_0000;

         y1<=16'b0000_0000_0000_0000;

         z1<=16'b0000_0000_0000_0000;

      end

   else

        if(z0[15]==1'b0)

            begin

               x1 <= x0 - y0;

               y1 <= y0 + x0;

               z1 <= z0 - 16'h4000;  //45deg

            end

         else

            begin

               x1 <= x0 + y0;

               y1 <= y0 - x0;

               z1 <= z0 + 16'h4000;  //45deg

            end

end

//level2

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)

      begin

         x2<=16'h0000 ;

         y2<=16'h0000 ;

         z2<=16'h0000 ;

      end

   else



         if(z1[15]==1'b0)

            begin

               x2 <= x1 - {y1[DATA_WIDTH-1],y1[DATA_WIDTH-1:1]};

               y2 <= y1 + {x1[DATA_WIDTH-1],x1[DATA_WIDTH-1:1]};

               z2 <= z1 - 16'h25c8;  //26.5651deg

            end

         else

            begin

               x2 <= x1 + {y1[DATA_WIDTH-1],y1[DATA_WIDTH-1:1]};

               y2 <= y1 - {x1[DATA_WIDTH-1],x1[DATA_WIDTH-1:1]};

               z2 <= z1 + 16'h25c8;  //26.5651deg

            end

end

//level3

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)

      begin

         x3<=16'b0000_0000_0000_0000;

         y3<=16'b0000_0000_0000_0000;

         z3<=16'b0000_0000_0000_0000;

      end

   else



         if(z2[15]==1'b0)

            begin

               x3 <= x2 - {{2{y2[DATA_WIDTH-1]}},y2[DATA_WIDTH-1:2]};

               y3 <= y2 + {{2{x2[DATA_WIDTH-1]}},x2[DATA_WIDTH-1:2]};

               z3 <= z2 - 16'h13f6;  //14.0362deg

            end

         else

            begin

              x3 <= x2 + {{2{y2[DATA_WIDTH-1]}},y2[DATA_WIDTH-1:2]};

              y3 <= y2 - {{2{x2[DATA_WIDTH-1]}},x2[DATA_WIDTH-1:2]};

              z3 <= z2 + 16'h13f6;  //14.0362deg

            end

end



//level4

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)

      begin

         x4<=16'b0000_0000_0000_0000;

         y4<=16'b0000_0000_0000_0000;

         z4<=16'b0000_0000_0000_0000;

      end

   else



         if(z3[15]==1'b0)

            begin

               x4 <= x3 - {{3{y3[DATA_WIDTH-1]}},y3[DATA_WIDTH-1:3]};

               y4 <= y3 + {{3{x3[DATA_WIDTH-1]}},x3[DATA_WIDTH-1:3]};

               z4 <= z3 - 16'h0A22;  //7.1250deg

            end

         else

            begin

               x4 <= x3 + {{3{y3[DATA_WIDTH-1]}},y3[DATA_WIDTH-1:3]};

               y4 <= y3 - {{3{x3[DATA_WIDTH-1]}},x3[DATA_WIDTH-1:3]};

               z4 <= z3 + 16'h0A22;  //7.1250deg

            end

end

//level5

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)

      begin

         x5<=16'b0000_0000_0000_0000;

         y5<=16'b0000_0000_0000_0000;

         z5<=16'b0000_0000_0000_0000;

      end

   else



         if(z4[15]==1'b0)

            begin

               x5 <= x4 - {{4{y4[DATA_WIDTH-1]}},y4[DATA_WIDTH-1:4]};

               y5 <= y4 + {{4{x4[DATA_WIDTH-1]}},x4[DATA_WIDTH-1:4]};

               z5 <= z4 - 16'h0516;  // 3.5763 deg

            end

         else

            begin

               x5 <= x4 + {{4{y4[DATA_WIDTH-1]}},y4[DATA_WIDTH-1:4]};

               y5 <= y4 - {{4{x4[DATA_WIDTH-1]}},x4[DATA_WIDTH-1:4]};

               z5 <= z4 + 16'h0516;  // 3.5763 deg

            end

end

//level6

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)

      begin

         x6<=16'b0000_0000_0000_0000;

         y6<=16'b0000_0000_0000_0000;

         z6<=16'b0000_0000_0000_0000;

      end

   else

         if(z5[15]==1'b0)

            begin

               x6 <= x5 - {{5{y5[DATA_WIDTH-1]}},y5[DATA_WIDTH-1:5]};

               y6 <= y5 + {{5{x5[DATA_WIDTH-1]}},x5[DATA_WIDTH-1:5]};

               z6 <= z5 - 16'h028C;  //1.7899deg

            end

         else

            begin

               x6 <= x5 + {{5{y5[DATA_WIDTH-1]}},y5[DATA_WIDTH-1:5]};

               y6 <= y5 - {{5{x5[DATA_WIDTH-1]}},x5[DATA_WIDTH-1:5]};

               z6 <= z5 + 16'h028C;  //1.7899deg

            end

end

//level7

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)

      begin

         x7<=16'b0000_0000_0000_0000;

         y7<=16'b0000_0000_0000_0000;

         z7<=16'b0000_0000_0000_0000;

      end

   else



         if(z6[15]==1'b0)

            begin

               x7 <= x6 - {{6{y6[DATA_WIDTH-1]}},y6[DATA_WIDTH-1:6]};

               y7 <= y6 + {{6{x6[DATA_WIDTH-1]}},x6[DATA_WIDTH-1:6]};

               z7 <= z6 - 16'h0146;  // 0.8952deg

            end

         else

            begin

               x7 <= x6 + {{6{y6[DATA_WIDTH-1]}},y6[DATA_WIDTH-1:6]};

               y7 <= y6 - {{6{x6[DATA_WIDTH-1]}},x6[DATA_WIDTH-1:6]};

               z7 <= z6 + 16'h0146;  // 0.8952deg

            end

end

//level8

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)

      begin

         x8<=16'b0000_0000_0000_0000;

         y8<=16'b0000_0000_0000_0000;

         z8<=16'b0000_0000_0000_0000;

      end

   else



         if(z7[15]==1'b0)

            begin

               x8 <= x7 - {{7{y7[DATA_WIDTH-1]}},y7[DATA_WIDTH-1:7]};

               y8 <= y7 + {{7{x7[DATA_WIDTH-1]}},x7[DATA_WIDTH-1:7]};

               z8 <= z7 - 16'h00A3;  // 0.4476deg

            end

         else

            begin

               x8 <= x7 + {{7{y6[DATA_WIDTH-1]}},y7[DATA_WIDTH-1:7]};

               y8 <= y7 - {{7{x7[DATA_WIDTH-1]}},x7[DATA_WIDTH-1:7]};

               z8 <= z7 + 16'h00A3;  // 0.4476deg

            end

end

always @(posedge clk or negedge rst_n)

begin

   if(!rst_n)



          out <= 16'b0000_0000_0000_0000;



     else



        out <= y8;
end

endmodule
仿真结果
仿真结果 8级流水线误差还不小

角度

10        20         30       40        50        60       70         80

输入

5690      11207     16384     21063     25102     28378    30792     32270

输出

5794      11436     16513     21080     25087     28302    30706     32251

正弦值

0.1736    0.3420    0.5000    0.6428    0.7660    0.8660   0.9397    0.9848

仿真正弦值

0.1768    0.3490    0.5039    0.6433    0.7656    0.8637   0.9371    0.9842

写原创有奖励！2024面包板原创奖励正在进行中