////////////////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////////////////
|
//
|
//
|
// Filename: ufifo.v
|
// Filename: ufifo.v
|
//
|
//
|
// Project: wbuart32, a full featured UART with simulator
|
// Project: wbuart32, a full featured UART with simulator
|
//
|
//
|
// Purpose:
|
// Purpose:
|
//
|
//
|
// Creator: Dan Gisselquist, Ph.D.
|
// Creator: Dan Gisselquist, Ph.D.
|
// Gisselquist Technology, LLC
|
// Gisselquist Technology, LLC
|
//
|
//
|
////////////////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////////////////
|
//
|
//
|
// Copyright (C) 2015-2016, Gisselquist Technology, LLC
|
// Copyright (C) 2015-2016, Gisselquist Technology, LLC
|
//
|
//
|
// This program is free software (firmware): you can redistribute it and/or
|
// This program is free software (firmware): you can redistribute it and/or
|
// modify it under the terms of the GNU General Public License as published
|
// modify it under the terms of the GNU General Public License as published
|
// by the Free Software Foundation, either version 3 of the License, or (at
|
// by the Free Software Foundation, either version 3 of the License, or (at
|
// your option) any later version.
|
// your option) any later version.
|
//
|
//
|
// This program is distributed in the hope that it will be useful, but WITHOUT
|
// This program is distributed in the hope that it will be useful, but WITHOUT
|
// ANY WARRANTY; without even the implied warranty of MERCHANTIBILITY or
|
// ANY WARRANTY; without even the implied warranty of MERCHANTIBILITY or
|
// FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
// FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
// for more details.
|
// for more details.
|
//
|
//
|
// You should have received a copy of the GNU General Public License along
|
// You should have received a copy of the GNU General Public License along
|
// with this program. (It's in the $(ROOT)/doc directory, run make with no
|
// with this program. (It's in the $(ROOT)/doc directory, run make with no
|
// target there if the PDF file isn't present.) If not, see
|
// target there if the PDF file isn't present.) If not, see
|
// <http://www.gnu.org/licenses/> for a copy.
|
// <http://www.gnu.org/licenses/> for a copy.
|
//
|
//
|
// License: GPL, v3, as defined and found on www.gnu.org,
|
// License: GPL, v3, as defined and found on www.gnu.org,
|
// http://www.gnu.org/licenses/gpl.html
|
// http://www.gnu.org/licenses/gpl.html
|
//
|
//
|
//
|
//
|
////////////////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////////////////
|
//
|
//
|
//
|
//
|
module ufifo(i_clk, i_rst, i_wr, i_data, i_rd, o_data,
|
module ufifo(i_clk, i_rst, i_wr, i_data, i_rd, o_data,
|
o_empty_n, o_half_full, o_status, o_err);
|
o_empty_n, o_half_full, o_status, o_err);
|
parameter BW=8, LGFLEN=4;
|
parameter BW=8, LGFLEN=4;
|
input i_clk, i_rst;
|
input i_clk, i_rst;
|
input i_wr;
|
input i_wr;
|
input [(BW-1):0] i_data;
|
input [(BW-1):0] i_data;
|
input i_rd;
|
input i_rd;
|
output wire [(BW-1):0] o_data;
|
output wire [(BW-1):0] o_data;
|
output reg o_empty_n;
|
output reg o_empty_n;
|
output wire o_half_full;
|
output wire o_half_full;
|
output wire [15:0] o_status;
|
output wire [15:0] o_status;
|
output wire o_err;
|
output wire o_err;
|
|
|
localparam FLEN=(1<<LGFLEN);
|
localparam FLEN=(1<<LGFLEN);
|
|
|
reg [(BW-1):0] fifo[0:(FLEN-1)];
|
reg [(BW-1):0] fifo[0:(FLEN-1)];
|
reg [(LGFLEN-1):0] r_first, r_last;
|
reg [(LGFLEN-1):0] r_first, r_last, r_next;
|
|
|
wire [(LGFLEN-1):0] w_first_plus_one, w_first_plus_two,
|
wire [(LGFLEN-1):0] w_first_plus_one, w_first_plus_two,
|
w_last_plus_one;
|
w_last_plus_one;
|
assign w_first_plus_two = r_first + {{(LGFLEN-2){1'b0}},2'b10};
|
assign w_first_plus_two = r_first + {{(LGFLEN-2){1'b0}},2'b10};
|
assign w_first_plus_one = r_first + {{(LGFLEN-1){1'b0}},1'b1};
|
assign w_first_plus_one = r_first + {{(LGFLEN-1){1'b0}},1'b1};
|
assign w_last_plus_one = r_last + {{(LGFLEN-1){1'b0}},1'b1};
|
assign w_last_plus_one = r_next; // r_last + 1'b1;
|
|
|
reg will_overflow;
|
reg will_overflow;
|
initial will_overflow = 1'b0;
|
initial will_overflow = 1'b0;
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
if (i_rst)
|
if (i_rst)
|
will_overflow <= 1'b0;
|
will_overflow <= 1'b0;
|
else if (i_rd)
|
else if (i_rd)
|
will_overflow <= (will_overflow)&&(i_wr);
|
will_overflow <= (will_overflow)&&(i_wr);
|
else if (i_wr)
|
else if (i_wr)
|
will_overflow <= (w_first_plus_two == r_last);
|
will_overflow <= (w_first_plus_two == r_last);
|
else if (w_first_plus_one == r_last)
|
else if (w_first_plus_one == r_last)
|
will_overflow <= 1'b1;
|
will_overflow <= 1'b1;
|
|
|
// Write
|
// Write
|
reg r_ovfl;
|
reg r_ovfl;
|
initial r_first = 0;
|
initial r_first = 0;
|
initial r_ovfl = 0;
|
initial r_ovfl = 0;
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
if (i_rst)
|
if (i_rst)
|
begin
|
begin
|
r_ovfl <= 1'b0;
|
r_ovfl <= 1'b0;
|
r_first <= { (LGFLEN){1'b0} };
|
r_first <= { (LGFLEN){1'b0} };
|
end else if (i_wr)
|
end else if (i_wr)
|
begin // Cowardly refuse to overflow
|
begin // Cowardly refuse to overflow
|
if ((i_rd)||(!will_overflow)) // (r_first+1 != r_last)
|
if ((i_rd)||(!will_overflow)) // (r_first+1 != r_last)
|
r_first <= w_first_plus_one;
|
r_first <= w_first_plus_one;
|
else
|
else
|
r_ovfl <= 1'b1;
|
r_ovfl <= 1'b1;
|
end
|
end
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
if (i_wr) // Write our new value regardless--on overflow or not
|
if (i_wr) // Write our new value regardless--on overflow or not
|
fifo[r_first] <= i_data;
|
fifo[r_first] <= i_data;
|
|
|
// Reads
|
// Reads
|
// Following a read, the next sample will be available on the
|
// Following a read, the next sample will be available on the
|
// next clock
|
// next clock
|
// Clock ReadCMD ReadAddr Output
|
// Clock ReadCMD ReadAddr Output
|
// 0 0 0 fifo[0]
|
// 0 0 0 fifo[0]
|
// 1 1 0 fifo[0]
|
// 1 1 0 fifo[0]
|
// 2 0 1 fifo[1]
|
// 2 0 1 fifo[1]
|
// 3 0 1 fifo[1]
|
// 3 0 1 fifo[1]
|
// 4 1 1 fifo[1]
|
// 4 1 1 fifo[1]
|
// 5 1 2 fifo[2]
|
// 5 1 2 fifo[2]
|
// 6 0 3 fifo[3]
|
// 6 0 3 fifo[3]
|
// 7 0 3 fifo[3]
|
// 7 0 3 fifo[3]
|
reg will_underflow, r_unfl;
|
reg will_underflow, r_unfl;
|
initial will_underflow = 1'b1;
|
initial will_underflow = 1'b1;
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
if (i_rst)
|
if (i_rst)
|
will_underflow <= 1'b1;
|
will_underflow <= 1'b1;
|
else if (i_wr)
|
else if (i_wr)
|
will_underflow <= (will_underflow)&&(i_rd);
|
will_underflow <= (will_underflow)&&(i_rd);
|
else if (i_rd)
|
else if (i_rd)
|
will_underflow <= (w_last_plus_one == r_first);
|
will_underflow <= (w_last_plus_one == r_first);
|
else
|
else
|
will_underflow <= (r_last == r_first);
|
will_underflow <= (r_last == r_first);
|
|
|
initial r_unfl = 1'b0;
|
initial r_unfl = 1'b0;
|
initial r_last = 0;
|
initial r_last = 0;
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
if (i_rst)
|
if (i_rst)
|
begin
|
begin
|
r_last <= { (LGFLEN){1'b0} };
|
r_last <= 0;
|
|
r_next <= { {(LGFLEN-1){1'b0}}, 1'b1 };
|
r_unfl <= 1'b0;
|
r_unfl <= 1'b0;
|
end else if (i_rd)
|
end else if (i_rd)
|
begin
|
begin
|
if ((i_wr)||(!will_underflow)) // (r_first != r_last)
|
if ((i_wr)||(!will_underflow)) // (r_first != r_last)
|
r_last <= w_last_plus_one;
|
begin
|
|
r_last <= r_next;
|
|
r_next <= r_last +{{(LGFLEN-2){1'b0}},2'b10};
|
// Last chases first
|
// Last chases first
|
// Need to be prepared for a possible two
|
// Need to be prepared for a possible two
|
// reads in quick succession
|
// reads in quick succession
|
// o_data <= fifo[r_last+1];
|
// o_data <= fifo[r_last+1];
|
else
|
end else
|
r_unfl <= 1'b1;
|
r_unfl <= 1'b1;
|
end
|
end
|
|
|
reg [7:0] fifo_here, fifo_next, r_data;
|
reg [7:0] fifo_here, fifo_next, r_data;
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
fifo_here <= fifo[r_last];
|
fifo_here <= fifo[r_last];
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
fifo_next <= fifo[r_last+{{(LGFLEN-1){1'b0}},1'b1}];
|
fifo_next <= fifo[r_next];
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
r_data <= i_data;
|
r_data <= i_data;
|
|
|
reg [1:0] osrc;
|
reg [1:0] osrc;
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
if (will_underflow)
|
if (will_underflow)
|
// o_data <= i_data;
|
// o_data <= i_data;
|
osrc <= 2'b00;
|
osrc <= 2'b00;
|
else if ((i_rd)&&(r_first == w_last_plus_one))
|
else if ((i_rd)&&(r_first == w_last_plus_one))
|
osrc <= 2'b01;
|
osrc <= 2'b01;
|
else if (i_rd)
|
else if (i_rd)
|
osrc <= 2'b11;
|
osrc <= 2'b11;
|
else
|
else
|
osrc <= 2'b10;
|
osrc <= 2'b10;
|
assign o_data = (osrc[1]) ? ((osrc[0])?fifo_next:fifo_here) : r_data;
|
assign o_data = (osrc[1]) ? ((osrc[0])?fifo_next:fifo_here) : r_data;
|
|
|
// wire [(LGFLEN-1):0] current_fill;
|
// wire [(LGFLEN-1):0] current_fill;
|
// assign current_fill = (r_first-r_last);
|
// assign current_fill = (r_first-r_last);
|
|
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
if (i_rst)
|
if (i_rst)
|
o_empty_n <= 1'b0;
|
o_empty_n <= 1'b0;
|
else case({i_wr, i_rd})
|
else case({i_wr, i_rd})
|
2'b00: o_empty_n <= (r_first != r_last);
|
2'b00: o_empty_n <= (r_first != r_last);
|
2'b11: o_empty_n <= (r_first != r_last);
|
2'b11: o_empty_n <= (r_first != r_last);
|
2'b10: o_empty_n <= 1'b1;
|
2'b10: o_empty_n <= 1'b1;
|
2'b01: o_empty_n <= (r_first != w_last_plus_one);
|
2'b01: o_empty_n <= (r_first != w_last_plus_one);
|
endcase
|
endcase
|
|
|
reg [(LGFLEN-1):0] r_fill;
|
reg [(LGFLEN-1):0] r_fill;
|
always @(posedge i_clk)
|
always @(posedge i_clk)
|
if (i_rst)
|
if (i_rst)
|
r_fill <= 0;
|
r_fill <= 0;
|
else if ((i_rd)&&(!i_wr))
|
else if ((i_rd)&&(!i_wr))
|
r_fill <= r_first - r_last - 1'b1;
|
r_fill <= r_first - r_next;
|
else if ((!i_rd)&&(i_wr))
|
else if ((!i_rd)&&(i_wr))
|
r_fill <= r_first - r_last + 1'b1;
|
r_fill <= r_first - r_last + 1'b1;
|
else
|
else
|
r_fill <= r_first - r_last;
|
r_fill <= r_first - r_last;
|
assign o_half_full = r_fill[(LGFLEN-1)];
|
assign o_half_full = r_fill[(LGFLEN-1)];
|
|
|
assign o_err = (r_ovfl) || (r_unfl);
|
assign o_err = (r_ovfl) || (r_unfl);
|
|
|
wire [3:0] lglen;
|
wire [3:0] lglen;
|
assign lglen = LGFLEN;
|
assign lglen = LGFLEN;
|
assign o_status = { lglen, {(16-2-4-LGFLEN){1'b0}}, r_fill, o_half_full, o_empty_n };
|
assign o_status = { lglen, {(16-2-4-LGFLEN){1'b0}}, r_fill, o_half_full, o_empty_n };
|
|
|
endmodule
|
endmodule
|
|
|