/////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////
|
//// ////
|
//// ////
|
//// WISHBONE Slave Model ////
|
//// WISHBONE Slave Model ////
|
//// ////
|
//// ////
|
//// ////
|
//// ////
|
//// Author: Rudolf Usselmann ////
|
//// Author: Rudolf Usselmann ////
|
//// rudi@asics.ws ////
|
//// rudi@asics.ws ////
|
//// ////
|
//// ////
|
//// ////
|
//// ////
|
//// Downloaded from: http://www.opencores.org/cores/vga_lcd/ ////
|
//// Downloaded from: http://www.opencores.org/cores/vga_lcd/ ////
|
//// ////
|
//// ////
|
/////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////
|
//// ////
|
//// ////
|
//// Copyright (C) 2001 Rudolf Usselmann ////
|
//// Copyright (C) 2001 Rudolf Usselmann ////
|
//// rudi@asics.ws ////
|
//// rudi@asics.ws ////
|
//// ////
|
//// ////
|
//// This source file may be used and distributed without ////
|
//// This source file may be used and distributed without ////
|
//// restriction provided that this copyright statement is not ////
|
//// restriction provided that this copyright statement is not ////
|
//// removed from the file and that any derivative work contains ////
|
//// removed from the file and that any derivative work contains ////
|
//// the original copyright notice and the associated disclaimer.////
|
//// the original copyright notice and the associated disclaimer.////
|
//// ////
|
//// ////
|
//// THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY ////
|
//// THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY ////
|
//// EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED ////
|
//// EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED ////
|
//// TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS ////
|
//// TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS ////
|
//// FOR A PARTICULAR PURPOSE. IN NO EVENT SHALL THE AUTHOR ////
|
//// FOR A PARTICULAR PURPOSE. IN NO EVENT SHALL THE AUTHOR ////
|
//// OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, ////
|
//// OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, ////
|
//// INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES ////
|
//// INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES ////
|
//// (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE ////
|
//// (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE ////
|
//// GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR ////
|
//// GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR ////
|
//// BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF ////
|
//// BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF ////
|
//// LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT ////
|
//// LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT ////
|
//// (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT ////
|
//// (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT ////
|
//// OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE ////
|
//// OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE ////
|
//// POSSIBILITY OF SUCH DAMAGE. ////
|
//// POSSIBILITY OF SUCH DAMAGE. ////
|
//// ////
|
//// ////
|
/////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////
|
|
|
// CVS Log
|
// CVS Log
|
//
|
//
|
// $Id: wb_slv_model.v,v 1.3 2003-05-07 09:45:28 rherveille Exp $
|
// $Id: wb_slv_model.v,v 1.3 2003-05-07 09:45:28 rherveille Exp $
|
//
|
//
|
// $Date: 2003-05-07 09:45:28 $
|
// $Date: 2003-05-07 09:45:28 $
|
// $Revision: 1.3 $
|
// $Revision: 1.3 $
|
// $Author: rherveille $
|
// $Author: rherveille $
|
// $Locker: $
|
// $Locker: $
|
// $State: Exp $
|
// $State: Exp $
|
//
|
//
|
// Change History:
|
// Change History:
|
// $Log: not supported by cvs2svn $
|
// $Log: not supported by cvs2svn $
|
// Revision 1.2 2002/02/07 05:38:32 rherveille
|
// Revision 1.2 2002/02/07 05:38:32 rherveille
|
// Added wb_ack delay section to testbench
|
// Added wb_ack delay section to testbench
|
//
|
//
|
// Revision 1.1 2001/08/21 05:42:32 rudi
|
// Revision 1.1 2001/08/21 05:42:32 rudi
|
//
|
//
|
// - Changed Directory Structure
|
// - Changed Directory Structure
|
// - Added verilog Source Code
|
// - Added verilog Source Code
|
// - Changed IO pin names and defines statements
|
// - Changed IO pin names and defines statements
|
//
|
//
|
//
|
//
|
//
|
//
|
//
|
//
|
|
|
`include "wb_model_defines.v"
|
`include "wb_model_defines.v"
|
|
|
module wb_slv(clk, rst, adr, din, dout, cyc, stb, sel, we, ack, err, rty);
|
module wb_slv(clk, rst, adr, din, dout, cyc, stb, sel, we, ack, err, rty);
|
|
|
input clk, rst;
|
input clk, rst;
|
input [31:0] adr, din;
|
input [31:0] adr, din;
|
output [31:0] dout;
|
output [31:0] dout;
|
input cyc, stb;
|
input cyc, stb;
|
input [3:0] sel;
|
input [3:0] sel;
|
input we;
|
input we;
|
output ack, err, rty;
|
output ack, err, rty;
|
|
|
////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////
|
//
|
//
|
// Local Wires
|
// Local Wires
|
//
|
//
|
|
|
parameter mem_size = 13;
|
parameter mem_size = 13;
|
parameter sz = (1<<mem_size)-1;
|
parameter sz = (1<<mem_size)-1;
|
|
|
reg [31:0] mem[sz:0];
|
reg [31:0] mem[sz:0];
|
wire mem_re, mem_we;
|
wire mem_re, mem_we;
|
wire [31:0] tmp;
|
wire [31:0] tmp;
|
reg [31:0] dout, tmp2;
|
reg [31:0] dout, tmp2;
|
|
|
reg ack, err, rty;
|
reg ack, err, rty;
|
reg [31:0] del_ack;
|
reg [31:0] del_ack;
|
reg [5:0] delay;
|
reg [5:0] delay;
|
|
|
////////////////////////////////////////////////////////////////////
|
////////////////////////////////////////////////////////////////////
|
//
|
//
|
// Memory Logic
|
// Memory Logic
|
//
|
//
|
|
|
initial
|
initial
|
begin
|
begin
|
delay = 0;
|
delay = 0;
|
ack = 0;
|
ack = 0;
|
err = 0;
|
err = 0;
|
rty = 0;
|
rty = 0;
|
#2;
|
#2;
|
$display("\nINFO: WISHBONE MEMORY MODEL INSTANTIATED (%m)");
|
$display("\nINFO: WISHBONE MEMORY MODEL INSTANTIATED (%m)");
|
$display(" Memory Size %0d address lines %0d words\n",
|
$display(" Memory Size %0d address lines %0d words\n",
|
mem_size, sz+1);
|
mem_size, sz+1);
|
end
|
end
|
|
|
assign mem_re = cyc & stb & !we;
|
assign mem_re = cyc & stb & !we;
|
assign mem_we = cyc & stb & we;
|
assign mem_we = cyc & stb & we;
|
|
|
assign tmp = mem[adr[mem_size+1:2]];
|
assign tmp = mem[adr[mem_size+1:2]];
|
|
|
always @(sel or tmp or mem_re or ack)
|
always @(sel or tmp or mem_re or ack)
|
if(mem_re & ack)
|
if(mem_re & ack)
|
begin
|
begin
|
dout[31:24] <= #1 sel[3] ? tmp[31:24] : 8'hxx;
|
dout[31:24] <= #1 sel[3] ? tmp[31:24] : 8'hxx;
|
dout[23:16] <= #1 sel[2] ? tmp[23:16] : 8'hxx;
|
dout[23:16] <= #1 sel[2] ? tmp[23:16] : 8'hxx;
|
dout[15:08] <= #1 sel[1] ? tmp[15:08] : 8'hxx;
|
dout[15:08] <= #1 sel[1] ? tmp[15:08] : 8'hxx;
|
dout[07:00] <= #1 sel[0] ? tmp[07:00] : 8'hxx;
|
dout[07:00] <= #1 sel[0] ? tmp[07:00] : 8'hxx;
|
end
|
end
|
else dout <= #1 32'hzzzz_zzzz;
|
else dout <= #1 32'hzzzz_zzzz;
|
|
|
|
|
always @(sel or tmp or din)
|
always @(sel or tmp or din)
|
begin
|
begin
|
tmp2[31:24] = !sel[3] ? tmp[31:24] : din[31:24];
|
tmp2[31:24] = !sel[3] ? tmp[31:24] : din[31:24];
|
tmp2[23:16] = !sel[2] ? tmp[23:16] : din[23:16];
|
tmp2[23:16] = !sel[2] ? tmp[23:16] : din[23:16];
|
tmp2[15:08] = !sel[1] ? tmp[15:08] : din[15:08];
|
tmp2[15:08] = !sel[1] ? tmp[15:08] : din[15:08];
|
tmp2[07:00] = !sel[0] ? tmp[07:00] : din[07:00];
|
tmp2[07:00] = !sel[0] ? tmp[07:00] : din[07:00];
|
end
|
end
|
|
|
always @(posedge clk)
|
always @(posedge clk)
|
if(mem_we) mem[adr[mem_size+1:2]] <= #1 tmp2;
|
if(mem_we) mem[adr[mem_size+1:2]] <= #1 tmp2;
|
|
|
always @(posedge clk)
|
always @(posedge clk)
|
del_ack = ack ? 0 : {del_ack[30:0], cyc & stb};
|
del_ack = ack ? 0 : {del_ack[30:0], cyc & stb};
|
|
|
always ack = #1 cyc & stb & ((delay==0) ? 1'b1 : del_ack[delay-1]);
|
always ack = #1 cyc & stb & ((delay==0) ? 1'b1 : del_ack[delay-1]);
|
|
|
|
|
task fill_mem;
|
task fill_mem;
|
input mode;
|
input mode;
|
integer n, mode;
|
integer n, mode;
|
|
|
begin
|
begin
|
for(n=0;n<(sz+1);n=n+1)
|
for(n=0;n<(sz+1);n=n+1)
|
begin
|
begin
|
case(mode)
|
case(mode)
|
0: mem[n] = { ~n[15:0], n[15:0] };
|
0: mem[n] = { ~n[15:0], n[15:0] };
|
1: mem[n] = $random;
|
1: mem[n] = $random;
|
2: mem[n] = { n[5:0], 2'h3, n[5:0], 2'h2, n[5:0], 2'h1, n[5:0], 2'h0};
|
2: mem[n] = { n[5:0], 2'h3, n[5:0], 2'h2, n[5:0], 2'h1, n[5:0], 2'h0};
|
endcase
|
endcase
|
end
|
end
|
end
|
end
|
endtask
|
endtask
|
|
|
task set_delay;
|
task set_delay;
|
input dly;
|
input dly;
|
|
|
reg [5:0] dly;
|
reg [5:0] dly;
|
begin
|
begin
|
delay = dly;
|
delay = dly;
|
$display("\n INFO: WISHBONE MEMORY MODEL (%M)");
|
$display("\n INFO: WISHBONE MEMORY MODEL (%M)");
|
$display(" Delay set to %d\n", delay);
|
$display(" Delay set to %d\n", delay);
|
end
|
end
|
endtask
|
endtask
|
|
|
endmodule
|
endmodule
|
|
|
|
|