001-CORDIC实现除法

function div_res = cordic_div(frac_up, frac_down, loops)
% INTIAL 
div_res = 0;
value = 1;

% CORDIC
for i = 0:loops - 1
   if((frac_down * frac_up) < 0) 
       x_new = frac_down;
       y_new = (frac_up + frac_down) * 2;
       frac_down = x_new;
       frac_up = y_new;
       div_res = div_res - value * 2 ^-i;
   else
       x_new = frac_down;
       y_new = (frac_up - frac_down) * 2;
       frac_down = x_new;
       frac_up = y_new;
       div_res = div_res + value * 2 ^-i;
   end
end
end 

`timescale 1ns / 1ps

module tb;
/************* PARAMETER ******************/
parameter LOOPS = 15;
parameter DATWIDTH = 16;
parameter RESWIDTH = 12;
/**************** INPUT OUTOUT ************/
logic    signed    [DATWIDTH - 1:0]    fracDown;
logic    signed    [DATWIDTH - 1:0]    fracUp;
logic    signed    [RESWIDTH - 1:0]    divRes;
/**************** INITIAL *****************/
logic    clk;
logic    rst;

initial begin
clk = 0;
rst = 1‘b1;
fracDown = 0;
fracUp = 0;
#20
rst = 1‘b0;
#200
fracDown = 16‘d200;
fracUp = -16‘d40;

#1000
$stop;
end
always #2 clk = !clk;
/**************** CORDIV ******************/
cordic_div #(
	.LOOPS(LOOPS),
	.DATWIDTH(DATWIDTH),
	.RESWIDTH(RESWIDTH)
)
Ucordic_div(
	.clk(clk), 
	.rst(rst), 
	.fracDown(fracDown), 
	.fracUp(fracUp), 
	.divRes(divRes)
);

glbl glbl();
endmodule

module cordic_div(clk, rst, fracDown, fracUp, divRes);
/********** PARAMETER **************/
parameter LOOPS = 15;
parameter DATWIDTH = 16;
parameter RESWIDTH = 12;
/********** INPUT OUTPUT ***********/
input    clk;
input    rst;
input    signed    [DATWIDTH - 1:0]    fracDown;
input    signed    [DATWIDTH - 1:0]    fracUp;

output    wire    signed    [RESWIDTH - 1:0]    divRes;
/********** CORDIC *****************/
// PIPE LINE
wire    signed    [LOOPS:0][DATWIDTH - 1:0]    fracDown1;
wire    signed    [LOOPS:0][DATWIDTH - 1:0]    fracUp1;
wire    signed    [LOOPS:0][RESWIDTH - 1:0]    divRes1;
// INITIAL
assign fracDown1[0] = fracDown;
assign fracUp1[0] = fracUp;
assign divRes1[0] = {RESWIDTH{1‘b0}};

genvar ii;
generate 
for (ii = 0; ii < LOOPS; ii = ii + 1)
begin: cordic_ii
	cordiv_unit #(
	.DATWIDTH(DATWIDTH),
	.RESWIDTH(RESWIDTH),
	.STAGE(ii)
	)
	Ucordiv_unit(
	.clk(clk), 
	.rst(rst), 
	.xin(fracDown1[ii]), 
	.yin(fracUp1[ii]), 
	.zin(divRes1[ii]), 
	.xout(fracDown1[ii + 1]), 
	.yout(fracUp1[ii + 1]), 
	.zout(divRes1[ii + 1])
	);
end
endgenerate

assign divRes = divRes1[LOOPS];

endmodule

module cordiv_unit(clk, rst, xin, yin, zin, xout, yout, zout);
/*************** PARAMETER ********************/
parameter DATWIDTH = 16;
parameter RESWIDTH = 12;
parameter STAGE = 0;
parameter VALUE = 12‘h400;
/************** INPUT OUTPUT ******************/
input    clk;
input    rst;
input    signed    [DATWIDTH - 1:0]    xin;
input    signed    [DATWIDTH - 1:0]    yin;
input    signed    [RESWIDTH - 1:0]    zin;

output    reg    signed    [DATWIDTH - 1:0]    xout; 
output    wire    signed    [DATWIDTH - 1:0]    yout; 
output    reg    signed    [RESWIDTH - 1:0]    zout;

/************** CORDIC UINIT *******************/
reg    [DATWIDTH - 1:0]    yout1;

always @(posedge clk) begin
	if(rst) begin
		xout <= {DATWIDTH{1‘b0}};
		yout1 <= {DATWIDTH{1‘b0}};
		zout <= {RESWIDTH{1‘b0}};
	end
	else begin
		xout <= xin;
		if(xin[DATWIDTH - 1]^yin[DATWIDTH - 1]) begin
			yout1 <= yin + xin;
			zout <= zin - (VALUE >> STAGE);
		end
		else  begin
			yout1 <= yin - xin;
			zout <= zin + (VALUE >> STAGE);			
		end
	end
end

assign yout = {yout1[DATWIDTH - 1], yout1[DATWIDTH - 3:0], 1‘b0};

endmodule