OpenCores
URL https://opencores.org/ocsvn/versatile_library/versatile_library/trunk

Subversion Repositories versatile_library

[/] [versatile_library/] [trunk/] [rtl/] [verilog/] [versatile_library_altera.v] - Blame information for rev 90

Go to most recent revision | Details | Compare with Previous | View Log

Line No. Rev Author Line
1 60 unneback
// default SYN_KEEP definition
2 6 unneback
//////////////////////////////////////////////////////////////////////
3
////                                                              ////
4
////  Versatile library, clock and reset                          ////
5
////                                                              ////
6
////  Description                                                 ////
7
////  Logic related to clock and reset                            ////
8
////                                                              ////
9
////                                                              ////
10
////  To Do:                                                      ////
11
////   - add more different registers                             ////
12
////                                                              ////
13
////  Author(s):                                                  ////
14
////      - Michael Unneback, unneback@opencores.org              ////
15
////        ORSoC AB                                              ////
16
////                                                              ////
17
//////////////////////////////////////////////////////////////////////
18
////                                                              ////
19
//// Copyright (C) 2010 Authors and OPENCORES.ORG                 ////
20
////                                                              ////
21
//// This source file may be used and distributed without         ////
22
//// restriction provided that this copyright statement is not    ////
23
//// removed from the file and that any derivative work contains  ////
24
//// the original copyright notice and the associated disclaimer. ////
25
////                                                              ////
26
//// This source file is free software; you can redistribute it   ////
27
//// and/or modify it under the terms of the GNU Lesser General   ////
28
//// Public License as published by the Free Software Foundation; ////
29
//// either version 2.1 of the License, or (at your option) any   ////
30
//// later version.                                               ////
31
////                                                              ////
32
//// This source is distributed in the hope that it will be       ////
33
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
34
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
35
//// PURPOSE.  See the GNU Lesser General Public License for more ////
36
//// details.                                                     ////
37
////                                                              ////
38
//// You should have received a copy of the GNU Lesser General    ////
39
//// Public License along with this source; if not, download it   ////
40
//// from http://www.opencores.org/lgpl.shtml                     ////
41
////                                                              ////
42
//////////////////////////////////////////////////////////////////////
43 21 unneback
//altera
44 33 unneback
module vl_gbuf ( i, o);
45
input i;
46
output o;
47
assign o = i;
48
endmodule
49 6 unneback
 // ALTERA
50
 //ACTEL
51
// sync reset
52 17 unneback
// input active lo async reset, normally from external reset generator and/or switch
53 6 unneback
// output active high global reset sync with two DFFs 
54
`timescale 1 ns/100 ps
55
module vl_sync_rst ( rst_n_i, rst_o, clk);
56
input rst_n_i, clk;
57
output rst_o;
58 18 unneback
reg [1:0] tmp;
59 6 unneback
always @ (posedge clk or negedge rst_n_i)
60
if (!rst_n_i)
61 17 unneback
        tmp <= 2'b11;
62 6 unneback
else
63 33 unneback
        tmp <= {1'b0,tmp[1]};
64 17 unneback
vl_gbuf buf_i0( .i(tmp[0]), .o(rst_o));
65 6 unneback
endmodule
66
// vl_pll
67 32 unneback
///////////////////////////////////////////////////////////////////////////////
68
`timescale 1 ps/1 ps
69
module vl_pll ( clk_i, rst_n_i, lock, clk_o, rst_o);
70
parameter index = 0;
71
parameter number_of_clk = 1;
72
parameter period_time_0 = 20000;
73
parameter period_time_1 = 20000;
74
parameter period_time_2 = 20000;
75
parameter period_time_3 = 20000;
76
parameter period_time_4 = 20000;
77
parameter lock_delay = 2000000;
78
input clk_i, rst_n_i;
79
output lock;
80
output reg [0:number_of_clk-1] clk_o;
81
output [0:number_of_clk-1] rst_o;
82 33 unneback
`ifdef SIM_PLL
83 32 unneback
always
84
     #((period_time_0)/2) clk_o[0] <=  (!rst_n_i) ? 0 : ~clk_o[0];
85
generate if (number_of_clk > 1)
86
always
87
     #((period_time_1)/2) clk_o[1] <=  (!rst_n_i) ? 0 : ~clk_o[1];
88
endgenerate
89
generate if (number_of_clk > 2)
90
always
91
     #((period_time_2)/2) clk_o[2] <=  (!rst_n_i) ? 0 : ~clk_o[2];
92
endgenerate
93 33 unneback
generate if (number_of_clk > 3)
94 32 unneback
always
95
     #((period_time_3)/2) clk_o[3] <=  (!rst_n_i) ? 0 : ~clk_o[3];
96
endgenerate
97 33 unneback
generate if (number_of_clk > 4)
98 32 unneback
always
99
     #((period_time_4)/2) clk_o[4] <=  (!rst_n_i) ? 0 : ~clk_o[4];
100
endgenerate
101
genvar i;
102
generate for (i=0;i<number_of_clk;i=i+1) begin: clock
103
     vl_sync_rst rst_i0 ( .rst_n_i(rst_n_i | lock), .rst_o(rst_o[i]), .clk(clk_o[i]));
104
end
105
endgenerate
106 33 unneback
//assign #lock_delay lock = rst_n_i;
107
assign lock = rst_n_i;
108 32 unneback
endmodule
109 33 unneback
`else
110
`ifdef VL_PLL0
111
`ifdef VL_PLL0_CLK1
112
    pll0 pll0_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]));
113
`endif
114
`ifdef VL_PLL0_CLK2
115
    pll0 pll0_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]));
116
`endif
117
`ifdef VL_PLL0_CLK3
118
    pll0 pll0_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]));
119
`endif
120
`ifdef VL_PLL0_CLK4
121
    pll0 pll0_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]), .c3(clk_o[3]));
122
`endif
123
`ifdef VL_PLL0_CLK5
124
    pll0 pll0_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]), .c3(clk_o[3]), .c4(clk_o[4]));
125
`endif
126
`endif
127
`ifdef VL_PLL1
128
`ifdef VL_PLL1_CLK1
129
    pll1 pll1_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]));
130
`endif
131
`ifdef VL_PLL1_CLK2
132
    pll1 pll1_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]));
133
`endif
134
`ifdef VL_PLL1_CLK3
135
    pll1 pll1_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]));
136
`endif
137
`ifdef VL_PLL1_CLK4
138
    pll1 pll1_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]), .c3(clk_o[3]));
139
`endif
140
`ifdef VL_PLL1_CLK5
141
    pll1 pll1_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]), .c3(clk_o[3]), .c4(clk_o[4]));
142
`endif
143
`endif
144
`ifdef VL_PLL2
145
`ifdef VL_PLL2_CLK1
146
    pll2 pll2_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]));
147
`endif
148
`ifdef VL_PLL2_CLK2
149
    pll2 pll2_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]));
150
`endif
151
`ifdef VL_PLL2_CLK3
152
    pll2 pll2_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]));
153
`endif
154
`ifdef VL_PLL2_CLK4
155
    pll2 pll2_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]), .c3(clk_o[3]));
156
`endif
157
`ifdef VL_PLL2_CLK5
158
    pll2 pll2_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]), .c3(clk_o[3]), .c4(clk_o[4]));
159
`endif
160
`endif
161
`ifdef VL_PLL3
162
`ifdef VL_PLL3_CLK1
163
    pll3 pll3_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]));
164
`endif
165
`ifdef VL_PLL3_CLK2
166
    pll3 pll3_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]));
167
`endif
168
`ifdef VL_PLL3_CLK3
169
    pll3 pll3_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]));
170
`endif
171
`ifdef VL_PLL3_CLK4
172
    pll3 pll3_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]), .c3(clk_o[3]));
173
`endif
174
`ifdef VL_PLL3_CLK5
175
    pll3 pll3_i0 (.areset(rst_n_i), .inclk0(clk_i), .locked(lock), .c0(clk_o[0]), .c1(clk_o[1]), .c2(clk_o[2]), .c3(clk_o[3]), .c4(clk_o[4]));
176
`endif
177
`endif
178 32 unneback
genvar i;
179
generate for (i=0;i<number_of_clk;i=i+1) begin: clock
180 40 unneback
        vl_sync_rst rst_i0 ( .rst_n_i(rst_n_i | lock), .rst_o(rst_o[i]), .clk(clk_o[i]));
181 32 unneback
end
182
endgenerate
183
endmodule
184 33 unneback
`endif
185 32 unneback
///////////////////////////////////////////////////////////////////////////////
186 6 unneback
 //altera
187
 //actel
188
//////////////////////////////////////////////////////////////////////
189
////                                                              ////
190
////  Versatile library, registers                                ////
191
////                                                              ////
192
////  Description                                                 ////
193
////  Different type of registers                                 ////
194
////                                                              ////
195
////                                                              ////
196
////  To Do:                                                      ////
197
////   - add more different registers                             ////
198
////                                                              ////
199
////  Author(s):                                                  ////
200
////      - Michael Unneback, unneback@opencores.org              ////
201
////        ORSoC AB                                              ////
202
////                                                              ////
203
//////////////////////////////////////////////////////////////////////
204
////                                                              ////
205
//// Copyright (C) 2010 Authors and OPENCORES.ORG                 ////
206
////                                                              ////
207
//// This source file may be used and distributed without         ////
208
//// restriction provided that this copyright statement is not    ////
209
//// removed from the file and that any derivative work contains  ////
210
//// the original copyright notice and the associated disclaimer. ////
211
////                                                              ////
212
//// This source file is free software; you can redistribute it   ////
213
//// and/or modify it under the terms of the GNU Lesser General   ////
214
//// Public License as published by the Free Software Foundation; ////
215
//// either version 2.1 of the License, or (at your option) any   ////
216
//// later version.                                               ////
217
////                                                              ////
218
//// This source is distributed in the hope that it will be       ////
219
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
220
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
221
//// PURPOSE.  See the GNU Lesser General Public License for more ////
222
//// details.                                                     ////
223
////                                                              ////
224
//// You should have received a copy of the GNU Lesser General    ////
225
//// Public License along with this source; if not, download it   ////
226
//// from http://www.opencores.org/lgpl.shtml                     ////
227
////                                                              ////
228
//////////////////////////////////////////////////////////////////////
229 18 unneback
module vl_dff ( d, q, clk, rst);
230 6 unneback
        parameter width = 1;
231
        parameter reset_value = 0;
232
        input [width-1:0] d;
233
        input clk, rst;
234
        output reg [width-1:0] q;
235
        always @ (posedge clk or posedge rst)
236
        if (rst)
237
                q <= reset_value;
238
        else
239
                q <= d;
240
endmodule
241 18 unneback
module vl_dff_array ( d, q, clk, rst);
242 6 unneback
        parameter width = 1;
243
        parameter depth = 2;
244
        parameter reset_value = 1'b0;
245
        input [width-1:0] d;
246
        input clk, rst;
247
        output [width-1:0] q;
248
        reg  [0:depth-1] q_tmp [width-1:0];
249
        integer i;
250
        always @ (posedge clk or posedge rst)
251
        if (rst) begin
252
            for (i=0;i<depth;i=i+1)
253
                q_tmp[i] <= {width{reset_value}};
254
        end else begin
255
            q_tmp[0] <= d;
256
            for (i=1;i<depth;i=i+1)
257
                q_tmp[i] <= q_tmp[i-1];
258
        end
259
    assign q = q_tmp[depth-1];
260
endmodule
261 18 unneback
module vl_dff_ce ( d, ce, q, clk, rst);
262 6 unneback
        parameter width = 1;
263
        parameter reset_value = 0;
264
        input [width-1:0] d;
265
        input ce, clk, rst;
266
        output reg [width-1:0] q;
267
        always @ (posedge clk or posedge rst)
268
        if (rst)
269
                q <= reset_value;
270
        else
271
                if (ce)
272
                        q <= d;
273
endmodule
274 18 unneback
module vl_dff_ce_clear ( d, ce, clear, q, clk, rst);
275 8 unneback
        parameter width = 1;
276
        parameter reset_value = 0;
277
        input [width-1:0] d;
278 10 unneback
        input ce, clear, clk, rst;
279 8 unneback
        output reg [width-1:0] q;
280
        always @ (posedge clk or posedge rst)
281
        if (rst)
282
            q <= reset_value;
283
        else
284
            if (ce)
285
                if (clear)
286
                    q <= {width{1'b0}};
287
                else
288
                    q <= d;
289
endmodule
290 24 unneback
module vl_dff_ce_set ( d, ce, set, q, clk, rst);
291
        parameter width = 1;
292
        parameter reset_value = 0;
293
        input [width-1:0] d;
294
        input ce, set, clk, rst;
295
        output reg [width-1:0] q;
296
        always @ (posedge clk or posedge rst)
297
        if (rst)
298
            q <= reset_value;
299
        else
300
            if (ce)
301
                if (set)
302
                    q <= {width{1'b1}};
303
                else
304
                    q <= d;
305
endmodule
306 29 unneback
module vl_spr ( sp, r, q, clk, rst);
307 64 unneback
        //parameter width = 1;
308
        parameter reset_value = 1'b0;
309 29 unneback
        input sp, r;
310
        output reg q;
311
        input clk, rst;
312
        always @ (posedge clk or posedge rst)
313
        if (rst)
314
            q <= reset_value;
315
        else
316
            if (sp)
317
                q <= 1'b1;
318
            else if (r)
319
                q <= 1'b0;
320
endmodule
321
module vl_srp ( s, rp, q, clk, rst);
322
        parameter width = 1;
323
        parameter reset_value = 0;
324
        input s, rp;
325
        output reg q;
326
        input clk, rst;
327
        always @ (posedge clk or posedge rst)
328
        if (rst)
329
            q <= reset_value;
330
        else
331
            if (rp)
332
                q <= 1'b0;
333
            else if (s)
334
                q <= 1'b1;
335
endmodule
336 6 unneback
// megafunction wizard: %LPM_FF%
337
// GENERATION: STANDARD
338
// VERSION: WM1.0
339
// MODULE: lpm_ff 
340
// ============================================================
341
// File Name: dff_sr.v
342
// Megafunction Name(s):
343
//                      lpm_ff
344
//
345
// Simulation Library Files(s):
346
//                      lpm
347
// ============================================================
348
// ************************************************************
349
// THIS IS A WIZARD-GENERATED FILE. DO NOT EDIT THIS FILE!
350
//
351
// 9.1 Build 304 01/25/2010 SP 1 SJ Full Version
352
// ************************************************************
353
//Copyright (C) 1991-2010 Altera Corporation
354
//Your use of Altera Corporation's design tools, logic functions 
355
//and other software and tools, and its AMPP partner logic 
356
//functions, and any output files from any of the foregoing 
357
//(including device programming or simulation files), and any 
358
//associated documentation or information are expressly subject 
359
//to the terms and conditions of the Altera Program License 
360
//Subscription Agreement, Altera MegaCore Function License 
361
//Agreement, or other applicable license agreement, including, 
362
//without limitation, that your use is for the sole purpose of 
363
//programming logic devices manufactured by Altera and sold by 
364
//Altera or its authorized distributors.  Please refer to the 
365
//applicable agreement for further details.
366
// synopsys translate_off
367
`timescale 1 ps / 1 ps
368
// synopsys translate_on
369 18 unneback
module vl_dff_sr (
370 6 unneback
        aclr,
371
        aset,
372
        clock,
373
        data,
374
        q);
375
        input     aclr;
376
        input     aset;
377
        input     clock;
378
        input     data;
379
        output    q;
380
        wire [0:0] sub_wire0;
381
        wire [0:0] sub_wire1 = sub_wire0[0:0];
382
        wire  q = sub_wire1;
383
        wire  sub_wire2 = data;
384
        wire  sub_wire3 = sub_wire2;
385
        lpm_ff  lpm_ff_component (
386
                                .aclr (aclr),
387
                                .clock (clock),
388
                                .data (sub_wire3),
389
                                .aset (aset),
390
                                .q (sub_wire0)
391
                                // synopsys translate_off
392
                                ,
393
                                .aload (),
394
                                .enable (),
395
                                .sclr (),
396
                                .sload (),
397
                                .sset ()
398
                                // synopsys translate_on
399
                                );
400
        defparam
401
                lpm_ff_component.lpm_fftype = "DFF",
402
                lpm_ff_component.lpm_type = "LPM_FF",
403
                lpm_ff_component.lpm_width = 1;
404
endmodule
405
// ============================================================
406
// CNX file retrieval info
407
// ============================================================
408
// Retrieval info: PRIVATE: ACLR NUMERIC "1"
409
// Retrieval info: PRIVATE: ALOAD NUMERIC "0"
410
// Retrieval info: PRIVATE: ASET NUMERIC "1"
411
// Retrieval info: PRIVATE: ASET_ALL1 NUMERIC "1"
412
// Retrieval info: PRIVATE: CLK_EN NUMERIC "0"
413
// Retrieval info: PRIVATE: DFF NUMERIC "1"
414
// Retrieval info: PRIVATE: INTENDED_DEVICE_FAMILY STRING "Cyclone IV E"
415
// Retrieval info: PRIVATE: SCLR NUMERIC "0"
416
// Retrieval info: PRIVATE: SLOAD NUMERIC "0"
417
// Retrieval info: PRIVATE: SSET NUMERIC "0"
418
// Retrieval info: PRIVATE: SSET_ALL1 NUMERIC "1"
419
// Retrieval info: PRIVATE: SYNTH_WRAPPER_GEN_POSTFIX STRING "0"
420
// Retrieval info: PRIVATE: UseTFFdataPort NUMERIC "0"
421
// Retrieval info: PRIVATE: nBit NUMERIC "1"
422
// Retrieval info: CONSTANT: LPM_FFTYPE STRING "DFF"
423
// Retrieval info: CONSTANT: LPM_TYPE STRING "LPM_FF"
424
// Retrieval info: CONSTANT: LPM_WIDTH NUMERIC "1"
425
// Retrieval info: USED_PORT: aclr 0 0 0 0 INPUT NODEFVAL aclr
426
// Retrieval info: USED_PORT: aset 0 0 0 0 INPUT NODEFVAL aset
427
// Retrieval info: USED_PORT: clock 0 0 0 0 INPUT NODEFVAL clock
428
// Retrieval info: USED_PORT: data 0 0 0 0 INPUT NODEFVAL data
429
// Retrieval info: USED_PORT: q 0 0 0 0 OUTPUT NODEFVAL q
430
// Retrieval info: CONNECT: @clock 0 0 0 0 clock 0 0 0 0
431
// Retrieval info: CONNECT: q 0 0 0 0 @q 0 0 1 0
432
// Retrieval info: CONNECT: @aclr 0 0 0 0 aclr 0 0 0 0
433
// Retrieval info: CONNECT: @aset 0 0 0 0 aset 0 0 0 0
434
// Retrieval info: CONNECT: @data 0 0 1 0 data 0 0 0 0
435
// Retrieval info: LIBRARY: lpm lpm.lpm_components.all
436
// Retrieval info: GEN_FILE: TYPE_NORMAL dff_sr.v TRUE
437
// Retrieval info: GEN_FILE: TYPE_NORMAL dff_sr.inc FALSE
438
// Retrieval info: GEN_FILE: TYPE_NORMAL dff_sr.cmp FALSE
439
// Retrieval info: GEN_FILE: TYPE_NORMAL dff_sr.bsf FALSE
440
// Retrieval info: GEN_FILE: TYPE_NORMAL dff_sr_inst.v FALSE
441
// Retrieval info: GEN_FILE: TYPE_NORMAL dff_sr_bb.v FALSE
442
// Retrieval info: LIB_FILE: lpm
443
// LATCH
444
// For targtes not supporting LATCH use dff_sr with clk=1 and data=1
445 18 unneback
module vl_latch ( d, le, q, clk);
446 6 unneback
input d, le;
447
output q;
448
input clk;
449
dff_sr i0 (.aclr(), .aset(), .clock(1'b1), .data(1'b1), .q(q));
450
endmodule
451 18 unneback
module vl_shreg ( d, q, clk, rst);
452 17 unneback
parameter depth = 10;
453
input d;
454
output q;
455
input clk, rst;
456
reg [1:depth] dffs;
457
always @ (posedge clk or posedge rst)
458
if (rst)
459
    dffs <= {depth{1'b0}};
460
else
461
    dffs <= {d,dffs[1:depth-1]};
462
assign q = dffs[depth];
463
endmodule
464 18 unneback
module vl_shreg_ce ( d, ce, q, clk, rst);
465 17 unneback
parameter depth = 10;
466
input d, ce;
467
output q;
468
input clk, rst;
469
reg [1:depth] dffs;
470
always @ (posedge clk or posedge rst)
471
if (rst)
472
    dffs <= {depth{1'b0}};
473
else
474
    if (ce)
475
        dffs <= {d,dffs[1:depth-1]};
476
assign q = dffs[depth];
477
endmodule
478 18 unneback
module vl_delay ( d, q, clk, rst);
479 15 unneback
parameter depth = 10;
480
input d;
481
output q;
482
input clk, rst;
483
reg [1:depth] dffs;
484
always @ (posedge clk or posedge rst)
485
if (rst)
486
    dffs <= {depth{1'b0}};
487
else
488
    dffs <= {d,dffs[1:depth-1]};
489
assign q = dffs[depth];
490
endmodule
491 18 unneback
module vl_delay_emptyflag ( d, q, emptyflag, clk, rst);
492 17 unneback
parameter depth = 10;
493
input d;
494
output q, emptyflag;
495
input clk, rst;
496
reg [1:depth] dffs;
497
always @ (posedge clk or posedge rst)
498
if (rst)
499
    dffs <= {depth{1'b0}};
500
else
501
    dffs <= {d,dffs[1:depth-1]};
502
assign q = dffs[depth];
503
assign emptyflag = !(|dffs);
504
endmodule
505 6 unneback
//////////////////////////////////////////////////////////////////////
506
////                                                              ////
507 18 unneback
////  Logic functions                                             ////
508
////                                                              ////
509
////  Description                                                 ////
510
////  Logic functions such as multiplexers                        ////
511
////                                                              ////
512
////                                                              ////
513
////  To Do:                                                      ////
514
////   -                                                          ////
515
////                                                              ////
516
////  Author(s):                                                  ////
517
////      - Michael Unneback, unneback@opencores.org              ////
518
////        ORSoC AB                                              ////
519
////                                                              ////
520
//////////////////////////////////////////////////////////////////////
521
////                                                              ////
522
//// Copyright (C) 2010 Authors and OPENCORES.ORG                 ////
523
////                                                              ////
524
//// This source file may be used and distributed without         ////
525
//// restriction provided that this copyright statement is not    ////
526
//// removed from the file and that any derivative work contains  ////
527
//// the original copyright notice and the associated disclaimer. ////
528
////                                                              ////
529
//// This source file is free software; you can redistribute it   ////
530
//// and/or modify it under the terms of the GNU Lesser General   ////
531
//// Public License as published by the Free Software Foundation; ////
532
//// either version 2.1 of the License, or (at your option) any   ////
533
//// later version.                                               ////
534
////                                                              ////
535
//// This source is distributed in the hope that it will be       ////
536
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
537
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
538
//// PURPOSE.  See the GNU Lesser General Public License for more ////
539
//// details.                                                     ////
540
////                                                              ////
541
//// You should have received a copy of the GNU Lesser General    ////
542
//// Public License along with this source; if not, download it   ////
543
//// from http://www.opencores.org/lgpl.shtml                     ////
544
////                                                              ////
545
//////////////////////////////////////////////////////////////////////
546 36 unneback
module vl_mux_andor ( a, sel, dout);
547
parameter width = 32;
548
parameter nr_of_ports = 4;
549
input [nr_of_ports*width-1:0] a;
550
input [nr_of_ports-1:0] sel;
551
output reg [width-1:0] dout;
552 38 unneback
integer i,j;
553 36 unneback
always @ (a, sel)
554
begin
555
    dout = a[width-1:0] & {width{sel[0]}};
556 42 unneback
    for (i=1;i<nr_of_ports;i=i+1)
557
        for (j=0;j<width;j=j+1)
558
            dout[j] = (a[i*width + j] & sel[i]) | dout[j];
559 36 unneback
end
560
endmodule
561 34 unneback
module vl_mux2_andor ( a1, a0, sel, dout);
562
parameter width = 32;
563 35 unneback
localparam nr_of_ports = 2;
564 34 unneback
input [width-1:0] a1, a0;
565
input [nr_of_ports-1:0] sel;
566
output [width-1:0] dout;
567 36 unneback
vl_mux_andor
568 38 unneback
    # ( .width(width), .nr_of_ports(nr_of_ports))
569 36 unneback
    mux0( .a({a1,a0}), .sel(sel), .dout(dout));
570 34 unneback
endmodule
571
module vl_mux3_andor ( a2, a1, a0, sel, dout);
572
parameter width = 32;
573 35 unneback
localparam nr_of_ports = 3;
574 34 unneback
input [width-1:0] a2, a1, a0;
575
input [nr_of_ports-1:0] sel;
576
output [width-1:0] dout;
577 36 unneback
vl_mux_andor
578 38 unneback
    # ( .width(width), .nr_of_ports(nr_of_ports))
579 36 unneback
    mux0( .a({a2,a1,a0}), .sel(sel), .dout(dout));
580 34 unneback
endmodule
581 18 unneback
module vl_mux4_andor ( a3, a2, a1, a0, sel, dout);
582
parameter width = 32;
583 35 unneback
localparam nr_of_ports = 4;
584 18 unneback
input [width-1:0] a3, a2, a1, a0;
585
input [nr_of_ports-1:0] sel;
586 22 unneback
output [width-1:0] dout;
587 36 unneback
vl_mux_andor
588 38 unneback
    # ( .width(width), .nr_of_ports(nr_of_ports))
589 36 unneback
    mux0( .a({a3,a2,a1,a0}), .sel(sel), .dout(dout));
590 18 unneback
endmodule
591
module vl_mux5_andor ( a4, a3, a2, a1, a0, sel, dout);
592
parameter width = 32;
593 35 unneback
localparam nr_of_ports = 5;
594 18 unneback
input [width-1:0] a4, a3, a2, a1, a0;
595
input [nr_of_ports-1:0] sel;
596 22 unneback
output [width-1:0] dout;
597 36 unneback
vl_mux_andor
598 38 unneback
    # ( .width(width), .nr_of_ports(nr_of_ports))
599 36 unneback
    mux0( .a({a4,a3,a2,a1,a0}), .sel(sel), .dout(dout));
600 18 unneback
endmodule
601
module vl_mux6_andor ( a5, a4, a3, a2, a1, a0, sel, dout);
602
parameter width = 32;
603 35 unneback
localparam nr_of_ports = 6;
604 18 unneback
input [width-1:0] a5, a4, a3, a2, a1, a0;
605
input [nr_of_ports-1:0] sel;
606 22 unneback
output [width-1:0] dout;
607 36 unneback
vl_mux_andor
608 38 unneback
    # ( .width(width), .nr_of_ports(nr_of_ports))
609 36 unneback
    mux0( .a({a5,a4,a3,a2,a1,a0}), .sel(sel), .dout(dout));
610 18 unneback
endmodule
611 43 unneback
module vl_parity_generate (data, parity);
612
parameter word_size = 32;
613
parameter chunk_size = 8;
614
parameter parity_type = 1'b0; // 0 - even, 1 - odd parity
615
input [word_size-1:0] data;
616
output reg [word_size/chunk_size-1:0] parity;
617
integer i,j;
618
always @ (data)
619
for (i=0;i<word_size/chunk_size;i=i+1) begin
620
    parity[i] = parity_type;
621
    for (j=0;j<chunk_size;j=j+1) begin
622 46 unneback
        parity[i] = data[i*chunk_size+j] ^ parity[i];
623 43 unneback
    end
624
end
625
endmodule
626
module vl_parity_check( data, parity, parity_error);
627
parameter word_size = 32;
628
parameter chunk_size = 8;
629
parameter parity_type = 1'b0; // 0 - even, 1 - odd parity
630
input [word_size-1:0] data;
631
input [word_size/chunk_size-1:0] parity;
632
output parity_error;
633 44 unneback
reg [word_size/chunk_size-1:0] error_flag;
634 43 unneback
integer i,j;
635
always @ (data or parity)
636
for (i=0;i<word_size/chunk_size;i=i+1) begin
637
    error_flag[i] = parity[i] ^ parity_type;
638
    for (j=0;j<chunk_size;j=j+1) begin
639 46 unneback
        error_flag[i] = data[i*chunk_size+j] ^ error_flag[i];
640 43 unneback
    end
641
end
642
assign parity_error = |error_flag;
643
endmodule
644 18 unneback
//////////////////////////////////////////////////////////////////////
645
////                                                              ////
646 44 unneback
////  IO functions                                                ////
647
////                                                              ////
648
////  Description                                                 ////
649
////  IO functions such as IOB flip-flops                         ////
650
////                                                              ////
651
////                                                              ////
652
////  To Do:                                                      ////
653
////   -                                                          ////
654
////                                                              ////
655
////  Author(s):                                                  ////
656
////      - Michael Unneback, unneback@opencores.org              ////
657
////        ORSoC AB                                              ////
658
////                                                              ////
659
//////////////////////////////////////////////////////////////////////
660
////                                                              ////
661
//// Copyright (C) 2010 Authors and OPENCORES.ORG                 ////
662
////                                                              ////
663
//// This source file may be used and distributed without         ////
664
//// restriction provided that this copyright statement is not    ////
665
//// removed from the file and that any derivative work contains  ////
666
//// the original copyright notice and the associated disclaimer. ////
667
////                                                              ////
668
//// This source file is free software; you can redistribute it   ////
669
//// and/or modify it under the terms of the GNU Lesser General   ////
670
//// Public License as published by the Free Software Foundation; ////
671
//// either version 2.1 of the License, or (at your option) any   ////
672
//// later version.                                               ////
673
////                                                              ////
674
//// This source is distributed in the hope that it will be       ////
675
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
676
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
677
//// PURPOSE.  See the GNU Lesser General Public License for more ////
678
//// details.                                                     ////
679
////                                                              ////
680
//// You should have received a copy of the GNU Lesser General    ////
681
//// Public License along with this source; if not, download it   ////
682
//// from http://www.opencores.org/lgpl.shtml                     ////
683
////                                                              ////
684
//////////////////////////////////////////////////////////////////////
685 45 unneback
`timescale 1ns/1ns
686 44 unneback
module vl_o_dff (d_i, o_pad, clk, rst);
687
parameter width = 1;
688 45 unneback
parameter reset_value = {width{1'b0}};
689
input  [width-1:0]  d_i;
690 44 unneback
output [width-1:0] o_pad;
691
input clk, rst;
692 60 unneback
wire [width-1:0] d_i_int /*synthesis syn_keep = 1*/;
693 45 unneback
reg  [width-1:0] o_pad_int;
694 44 unneback
assign d_i_int = d_i;
695
genvar i;
696 45 unneback
generate
697 44 unneback
for (i=0;i<width;i=i+1) begin
698
    always @ (posedge clk or posedge rst)
699
    if (rst)
700 45 unneback
        o_pad_int[i] <= reset_value[i];
701 44 unneback
    else
702 45 unneback
        o_pad_int[i] <= d_i_int[i];
703
    assign #1 o_pad[i] = o_pad_int[i];
704 44 unneback
end
705
endgenerate
706
endmodule
707 45 unneback
`timescale 1ns/1ns
708 44 unneback
module vl_io_dff_oe ( d_i, d_o, oe, io_pad, clk, rst);
709
parameter width = 1;
710
input  [width-1:0] d_o;
711
output reg [width-1:0] d_i;
712
input oe;
713
inout [width-1:0] io_pad;
714
input clk, rst;
715 60 unneback
wire [width-1:0] oe_d /*synthesis syn_keep = 1*/;
716 44 unneback
reg [width-1:0] oe_q;
717
reg [width-1:0] d_o_q;
718
assign oe_d = {width{oe}};
719
genvar i;
720
generate
721
for (i=0;i<width;i=i+1) begin
722
    always @ (posedge clk or posedge rst)
723
    if (rst)
724
        oe_q[i] <= 1'b0;
725
    else
726
        oe_q[i] <= oe_d[i];
727
    always @ (posedge clk or posedge rst)
728
    if (rst)
729
        d_o_q[i] <= 1'b0;
730
    else
731
        d_o_q[i] <= d_o[i];
732
    always @ (posedge clk or posedge rst)
733
    if (rst)
734
        d_i[i] <= 1'b0;
735
    else
736
        d_i[i] <= io_pad[i];
737 45 unneback
    assign #1 io_pad[i] = (oe_q[i]) ? d_o_q[i] : 1'bz;
738 44 unneback
end
739
endgenerate
740
endmodule
741
//////////////////////////////////////////////////////////////////////
742
////                                                              ////
743 6 unneback
////  Versatile counter                                           ////
744
////                                                              ////
745
////  Description                                                 ////
746
////  Versatile counter, a reconfigurable binary, gray or LFSR    ////
747
////  counter                                                     ////
748
////                                                              ////
749
////  To Do:                                                      ////
750
////   - add LFSR with more taps                                  ////
751
////                                                              ////
752
////  Author(s):                                                  ////
753
////      - Michael Unneback, unneback@opencores.org              ////
754
////        ORSoC AB                                              ////
755
////                                                              ////
756
//////////////////////////////////////////////////////////////////////
757
////                                                              ////
758
//// Copyright (C) 2009 Authors and OPENCORES.ORG                 ////
759
////                                                              ////
760
//// This source file may be used and distributed without         ////
761
//// restriction provided that this copyright statement is not    ////
762
//// removed from the file and that any derivative work contains  ////
763
//// the original copyright notice and the associated disclaimer. ////
764
////                                                              ////
765
//// This source file is free software; you can redistribute it   ////
766
//// and/or modify it under the terms of the GNU Lesser General   ////
767
//// Public License as published by the Free Software Foundation; ////
768
//// either version 2.1 of the License, or (at your option) any   ////
769
//// later version.                                               ////
770
////                                                              ////
771
//// This source is distributed in the hope that it will be       ////
772
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
773
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
774
//// PURPOSE.  See the GNU Lesser General Public License for more ////
775
//// details.                                                     ////
776
////                                                              ////
777
//// You should have received a copy of the GNU Lesser General    ////
778
//// Public License along with this source; if not, download it   ////
779
//// from http://www.opencores.org/lgpl.shtml                     ////
780
////                                                              ////
781
//////////////////////////////////////////////////////////////////////
782
// binary counter
783 40 unneback
module vl_cnt_bin_ce (
784
 cke, q, rst, clk);
785 22 unneback
   parameter length = 4;
786 6 unneback
   input cke;
787
   output [length:1] q;
788
   input rst;
789
   input clk;
790
   parameter clear_value = 0;
791
   parameter set_value = 1;
792
   parameter wrap_value = 0;
793
   parameter level1_value = 15;
794
   reg  [length:1] qi;
795
   wire [length:1] q_next;
796
   assign q_next = qi + {{length-1{1'b0}},1'b1};
797
   always @ (posedge clk or posedge rst)
798
     if (rst)
799
       qi <= {length{1'b0}};
800
     else
801
     if (cke)
802
       qi <= q_next;
803
   assign q = qi;
804
endmodule
805
//////////////////////////////////////////////////////////////////////
806
////                                                              ////
807
////  Versatile counter                                           ////
808
////                                                              ////
809
////  Description                                                 ////
810
////  Versatile counter, a reconfigurable binary, gray or LFSR    ////
811
////  counter                                                     ////
812
////                                                              ////
813
////  To Do:                                                      ////
814
////   - add LFSR with more taps                                  ////
815
////                                                              ////
816
////  Author(s):                                                  ////
817
////      - Michael Unneback, unneback@opencores.org              ////
818
////        ORSoC AB                                              ////
819
////                                                              ////
820
//////////////////////////////////////////////////////////////////////
821
////                                                              ////
822
//// Copyright (C) 2009 Authors and OPENCORES.ORG                 ////
823
////                                                              ////
824
//// This source file may be used and distributed without         ////
825
//// restriction provided that this copyright statement is not    ////
826
//// removed from the file and that any derivative work contains  ////
827
//// the original copyright notice and the associated disclaimer. ////
828
////                                                              ////
829
//// This source file is free software; you can redistribute it   ////
830
//// and/or modify it under the terms of the GNU Lesser General   ////
831
//// Public License as published by the Free Software Foundation; ////
832
//// either version 2.1 of the License, or (at your option) any   ////
833
//// later version.                                               ////
834
////                                                              ////
835
//// This source is distributed in the hope that it will be       ////
836
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
837
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
838
//// PURPOSE.  See the GNU Lesser General Public License for more ////
839
//// details.                                                     ////
840
////                                                              ////
841
//// You should have received a copy of the GNU Lesser General    ////
842
//// Public License along with this source; if not, download it   ////
843
//// from http://www.opencores.org/lgpl.shtml                     ////
844
////                                                              ////
845
//////////////////////////////////////////////////////////////////////
846
// binary counter
847 40 unneback
module vl_cnt_bin_ce_rew_zq_l1 (
848
 cke, rew, zq, level1, rst, clk);
849 6 unneback
   parameter length = 4;
850
   input cke;
851
   input rew;
852 25 unneback
   output reg zq;
853
   output reg level1;
854
   input rst;
855
   input clk;
856
   parameter clear_value = 0;
857
   parameter set_value = 1;
858
   parameter wrap_value = 1;
859
   parameter level1_value = 15;
860 29 unneback
   wire clear;
861 30 unneback
   assign clear = 1'b0;
862 25 unneback
   reg  [length:1] qi;
863
   wire  [length:1] q_next, q_next_fw, q_next_rew;
864
   assign q_next_fw  = qi + {{length-1{1'b0}},1'b1};
865
   assign q_next_rew = qi - {{length-1{1'b0}},1'b1};
866
   assign q_next = rew ? q_next_rew : q_next_fw;
867
   always @ (posedge clk or posedge rst)
868
     if (rst)
869
       qi <= {length{1'b0}};
870
     else
871
     if (cke)
872
       qi <= q_next;
873
   always @ (posedge clk or posedge rst)
874
     if (rst)
875
       zq <= 1'b1;
876
     else
877
     if (cke)
878
       zq <= q_next == {length{1'b0}};
879
    always @ (posedge clk or posedge rst)
880
    if (rst)
881
        level1 <= 1'b0;
882
    else
883
    if (cke)
884 29 unneback
    if (clear)
885
        level1 <= 1'b0;
886
    else if (q_next == level1_value)
887 25 unneback
        level1 <= 1'b1;
888
    else if (qi == level1_value & rew)
889
        level1 <= 1'b0;
890
endmodule
891
//////////////////////////////////////////////////////////////////////
892
////                                                              ////
893
////  Versatile counter                                           ////
894
////                                                              ////
895
////  Description                                                 ////
896
////  Versatile counter, a reconfigurable binary, gray or LFSR    ////
897
////  counter                                                     ////
898
////                                                              ////
899
////  To Do:                                                      ////
900
////   - add LFSR with more taps                                  ////
901
////                                                              ////
902
////  Author(s):                                                  ////
903
////      - Michael Unneback, unneback@opencores.org              ////
904
////        ORSoC AB                                              ////
905
////                                                              ////
906
//////////////////////////////////////////////////////////////////////
907
////                                                              ////
908
//// Copyright (C) 2009 Authors and OPENCORES.ORG                 ////
909
////                                                              ////
910
//// This source file may be used and distributed without         ////
911
//// restriction provided that this copyright statement is not    ////
912
//// removed from the file and that any derivative work contains  ////
913
//// the original copyright notice and the associated disclaimer. ////
914
////                                                              ////
915
//// This source file is free software; you can redistribute it   ////
916
//// and/or modify it under the terms of the GNU Lesser General   ////
917
//// Public License as published by the Free Software Foundation; ////
918
//// either version 2.1 of the License, or (at your option) any   ////
919
//// later version.                                               ////
920
////                                                              ////
921
//// This source is distributed in the hope that it will be       ////
922
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
923
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
924
//// PURPOSE.  See the GNU Lesser General Public License for more ////
925
//// details.                                                     ////
926
////                                                              ////
927
//// You should have received a copy of the GNU Lesser General    ////
928
//// Public License along with this source; if not, download it   ////
929
//// from http://www.opencores.org/lgpl.shtml                     ////
930
////                                                              ////
931
//////////////////////////////////////////////////////////////////////
932
// binary counter
933 40 unneback
module vl_cnt_bin_ce_rew_q_zq_l1 (
934
 cke, rew, q, zq, level1, rst, clk);
935 25 unneback
   parameter length = 4;
936
   input cke;
937
   input rew;
938
   output [length:1] q;
939
   output reg zq;
940
   output reg level1;
941
   input rst;
942
   input clk;
943
   parameter clear_value = 0;
944
   parameter set_value = 1;
945
   parameter wrap_value = 1;
946
   parameter level1_value = 15;
947 29 unneback
   wire clear;
948 30 unneback
   assign clear = 1'b0;
949 25 unneback
   reg  [length:1] qi;
950
   wire  [length:1] q_next, q_next_fw, q_next_rew;
951
   assign q_next_fw  = qi + {{length-1{1'b0}},1'b1};
952
   assign q_next_rew = qi - {{length-1{1'b0}},1'b1};
953
   assign q_next = rew ? q_next_rew : q_next_fw;
954
   always @ (posedge clk or posedge rst)
955
     if (rst)
956
       qi <= {length{1'b0}};
957
     else
958
     if (cke)
959
       qi <= q_next;
960
   assign q = qi;
961
   always @ (posedge clk or posedge rst)
962
     if (rst)
963
       zq <= 1'b1;
964
     else
965
     if (cke)
966
       zq <= q_next == {length{1'b0}};
967
    always @ (posedge clk or posedge rst)
968
    if (rst)
969
        level1 <= 1'b0;
970
    else
971
    if (cke)
972 29 unneback
    if (clear)
973
        level1 <= 1'b0;
974
    else if (q_next == level1_value)
975 25 unneback
        level1 <= 1'b1;
976
    else if (qi == level1_value & rew)
977
        level1 <= 1'b0;
978
endmodule
979
//////////////////////////////////////////////////////////////////////
980
////                                                              ////
981
////  Versatile counter                                           ////
982
////                                                              ////
983
////  Description                                                 ////
984
////  Versatile counter, a reconfigurable binary, gray or LFSR    ////
985
////  counter                                                     ////
986
////                                                              ////
987
////  To Do:                                                      ////
988
////   - add LFSR with more taps                                  ////
989
////                                                              ////
990
////  Author(s):                                                  ////
991
////      - Michael Unneback, unneback@opencores.org              ////
992
////        ORSoC AB                                              ////
993
////                                                              ////
994
//////////////////////////////////////////////////////////////////////
995
////                                                              ////
996
//// Copyright (C) 2009 Authors and OPENCORES.ORG                 ////
997
////                                                              ////
998
//// This source file may be used and distributed without         ////
999
//// restriction provided that this copyright statement is not    ////
1000
//// removed from the file and that any derivative work contains  ////
1001
//// the original copyright notice and the associated disclaimer. ////
1002
////                                                              ////
1003
//// This source file is free software; you can redistribute it   ////
1004
//// and/or modify it under the terms of the GNU Lesser General   ////
1005
//// Public License as published by the Free Software Foundation; ////
1006
//// either version 2.1 of the License, or (at your option) any   ////
1007
//// later version.                                               ////
1008
////                                                              ////
1009
//// This source is distributed in the hope that it will be       ////
1010
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
1011
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
1012
//// PURPOSE.  See the GNU Lesser General Public License for more ////
1013
//// details.                                                     ////
1014
////                                                              ////
1015
//// You should have received a copy of the GNU Lesser General    ////
1016
//// Public License along with this source; if not, download it   ////
1017
//// from http://www.opencores.org/lgpl.shtml                     ////
1018
////                                                              ////
1019
//////////////////////////////////////////////////////////////////////
1020 75 unneback
// LFSR counter
1021
module vl_cnt_lfsr_ce (
1022
 cke, zq, rst, clk);
1023
   parameter length = 4;
1024
   input cke;
1025
   output reg zq;
1026
   input rst;
1027
   input clk;
1028
   parameter clear_value = 0;
1029
   parameter set_value = 1;
1030
   parameter wrap_value = 0;
1031
   parameter level1_value = 15;
1032
   reg  [length:1] qi;
1033
   reg lfsr_fb;
1034
   wire [length:1] q_next;
1035
   reg [32:1] polynom;
1036
   integer i;
1037
   always @ (qi)
1038
   begin
1039
        case (length)
1040
         2: polynom = 32'b11;                               // 0x3
1041
         3: polynom = 32'b110;                              // 0x6
1042
         4: polynom = 32'b1100;                             // 0xC
1043
         5: polynom = 32'b10100;                            // 0x14
1044
         6: polynom = 32'b110000;                           // 0x30
1045
         7: polynom = 32'b1100000;                          // 0x60
1046
         8: polynom = 32'b10111000;                         // 0xb8
1047
         9: polynom = 32'b100010000;                        // 0x110
1048
        10: polynom = 32'b1001000000;                       // 0x240
1049
        11: polynom = 32'b10100000000;                      // 0x500
1050
        12: polynom = 32'b100000101001;                     // 0x829
1051
        13: polynom = 32'b1000000001100;                    // 0x100C
1052
        14: polynom = 32'b10000000010101;                   // 0x2015
1053
        15: polynom = 32'b110000000000000;                  // 0x6000
1054
        16: polynom = 32'b1101000000001000;                 // 0xD008
1055
        17: polynom = 32'b10010000000000000;                // 0x12000
1056
        18: polynom = 32'b100000010000000000;               // 0x20400
1057
        19: polynom = 32'b1000000000000100011;              // 0x40023
1058
        20: polynom = 32'b10010000000000000000;             // 0x90000
1059
        21: polynom = 32'b101000000000000000000;            // 0x140000
1060
        22: polynom = 32'b1100000000000000000000;           // 0x300000
1061
        23: polynom = 32'b10000100000000000000000;          // 0x420000
1062
        24: polynom = 32'b111000010000000000000000;         // 0xE10000
1063
        25: polynom = 32'b1001000000000000000000000;        // 0x1200000
1064
        26: polynom = 32'b10000000000000000000100011;       // 0x2000023
1065
        27: polynom = 32'b100000000000000000000010011;      // 0x4000013
1066
        28: polynom = 32'b1100100000000000000000000000;     // 0xC800000
1067
        29: polynom = 32'b10100000000000000000000000000;    // 0x14000000
1068
        30: polynom = 32'b100000000000000000000000101001;   // 0x20000029
1069
        31: polynom = 32'b1001000000000000000000000000000;  // 0x48000000
1070
        32: polynom = 32'b10000000001000000000000000000011; // 0x80200003
1071
        default: polynom = 32'b0;
1072
        endcase
1073
        lfsr_fb = qi[length];
1074
        for (i=length-1; i>=1; i=i-1) begin
1075
            if (polynom[i])
1076
                lfsr_fb = lfsr_fb  ~^ qi[i];
1077
        end
1078
    end
1079
   assign q_next = (qi == wrap_value) ? {length{1'b0}} :{qi[length-1:1],lfsr_fb};
1080
   always @ (posedge clk or posedge rst)
1081
     if (rst)
1082
       qi <= {length{1'b0}};
1083
     else
1084
     if (cke)
1085
       qi <= q_next;
1086
   always @ (posedge clk or posedge rst)
1087
     if (rst)
1088
       zq <= 1'b1;
1089
     else
1090
     if (cke)
1091
       zq <= q_next == {length{1'b0}};
1092
endmodule
1093
//////////////////////////////////////////////////////////////////////
1094
////                                                              ////
1095
////  Versatile counter                                           ////
1096
////                                                              ////
1097
////  Description                                                 ////
1098
////  Versatile counter, a reconfigurable binary, gray or LFSR    ////
1099
////  counter                                                     ////
1100
////                                                              ////
1101
////  To Do:                                                      ////
1102
////   - add LFSR with more taps                                  ////
1103
////                                                              ////
1104
////  Author(s):                                                  ////
1105
////      - Michael Unneback, unneback@opencores.org              ////
1106
////        ORSoC AB                                              ////
1107
////                                                              ////
1108
//////////////////////////////////////////////////////////////////////
1109
////                                                              ////
1110
//// Copyright (C) 2009 Authors and OPENCORES.ORG                 ////
1111
////                                                              ////
1112
//// This source file may be used and distributed without         ////
1113
//// restriction provided that this copyright statement is not    ////
1114
//// removed from the file and that any derivative work contains  ////
1115
//// the original copyright notice and the associated disclaimer. ////
1116
////                                                              ////
1117
//// This source file is free software; you can redistribute it   ////
1118
//// and/or modify it under the terms of the GNU Lesser General   ////
1119
//// Public License as published by the Free Software Foundation; ////
1120
//// either version 2.1 of the License, or (at your option) any   ////
1121
//// later version.                                               ////
1122
////                                                              ////
1123
//// This source is distributed in the hope that it will be       ////
1124
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
1125
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
1126
//// PURPOSE.  See the GNU Lesser General Public License for more ////
1127
//// details.                                                     ////
1128
////                                                              ////
1129
//// You should have received a copy of the GNU Lesser General    ////
1130
//// Public License along with this source; if not, download it   ////
1131
//// from http://www.opencores.org/lgpl.shtml                     ////
1132
////                                                              ////
1133
//////////////////////////////////////////////////////////////////////
1134 6 unneback
// GRAY counter
1135 40 unneback
module vl_cnt_gray_ce_bin (
1136
 cke, q, q_bin, rst, clk);
1137 6 unneback
   parameter length = 4;
1138
   input cke;
1139
   output reg [length:1] q;
1140
   output [length:1] q_bin;
1141
   input rst;
1142
   input clk;
1143
   parameter clear_value = 0;
1144
   parameter set_value = 1;
1145
   parameter wrap_value = 8;
1146
   parameter level1_value = 15;
1147
   reg  [length:1] qi;
1148
   wire [length:1] q_next;
1149
   assign q_next = qi + {{length-1{1'b0}},1'b1};
1150
   always @ (posedge clk or posedge rst)
1151
     if (rst)
1152
       qi <= {length{1'b0}};
1153
     else
1154
     if (cke)
1155
       qi <= q_next;
1156
   always @ (posedge clk or posedge rst)
1157
     if (rst)
1158
       q <= {length{1'b0}};
1159
     else
1160
       if (cke)
1161
         q <= (q_next>>1) ^ q_next;
1162
   assign q_bin = qi;
1163
endmodule
1164
//////////////////////////////////////////////////////////////////////
1165
////                                                              ////
1166
////  Versatile library, counters                                 ////
1167
////                                                              ////
1168
////  Description                                                 ////
1169
////  counters                                                    ////
1170
////                                                              ////
1171
////                                                              ////
1172
////  To Do:                                                      ////
1173
////   - add more counters                                        ////
1174
////                                                              ////
1175
////  Author(s):                                                  ////
1176
////      - Michael Unneback, unneback@opencores.org              ////
1177
////        ORSoC AB                                              ////
1178
////                                                              ////
1179
//////////////////////////////////////////////////////////////////////
1180
////                                                              ////
1181
//// Copyright (C) 2010 Authors and OPENCORES.ORG                 ////
1182
////                                                              ////
1183
//// This source file may be used and distributed without         ////
1184
//// restriction provided that this copyright statement is not    ////
1185
//// removed from the file and that any derivative work contains  ////
1186
//// the original copyright notice and the associated disclaimer. ////
1187
////                                                              ////
1188
//// This source file is free software; you can redistribute it   ////
1189
//// and/or modify it under the terms of the GNU Lesser General   ////
1190
//// Public License as published by the Free Software Foundation; ////
1191
//// either version 2.1 of the License, or (at your option) any   ////
1192
//// later version.                                               ////
1193
////                                                              ////
1194
//// This source is distributed in the hope that it will be       ////
1195
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
1196
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
1197
//// PURPOSE.  See the GNU Lesser General Public License for more ////
1198
//// details.                                                     ////
1199
////                                                              ////
1200
//// You should have received a copy of the GNU Lesser General    ////
1201
//// Public License along with this source; if not, download it   ////
1202
//// from http://www.opencores.org/lgpl.shtml                     ////
1203
////                                                              ////
1204
//////////////////////////////////////////////////////////////////////
1205 18 unneback
module vl_cnt_shreg_wrap ( q, rst, clk);
1206 6 unneback
   parameter length = 4;
1207
   output reg [0:length-1] q;
1208
   input rst;
1209
   input clk;
1210
    always @ (posedge clk or posedge rst)
1211
    if (rst)
1212
        q <= {1'b1,{length-1{1'b0}}};
1213
    else
1214
        q <= {q[length-1],q[0:length-2]};
1215
endmodule
1216 18 unneback
module vl_cnt_shreg_ce_wrap ( cke, q, rst, clk);
1217 6 unneback
   parameter length = 4;
1218
   input cke;
1219
   output reg [0:length-1] q;
1220
   input rst;
1221
   input clk;
1222
    always @ (posedge clk or posedge rst)
1223
    if (rst)
1224
        q <= {1'b1,{length-1{1'b0}}};
1225
    else
1226
        if (cke)
1227
            q <= {q[length-1],q[0:length-2]};
1228
endmodule
1229 18 unneback
module vl_cnt_shreg_ce_clear ( cke, clear, q, rst, clk);
1230 6 unneback
   parameter length = 4;
1231
   input cke, clear;
1232
   output reg [0:length-1] q;
1233
   input rst;
1234
   input clk;
1235
    always @ (posedge clk or posedge rst)
1236
    if (rst)
1237
        q <= {1'b1,{length-1{1'b0}}};
1238
    else
1239
        if (cke)
1240
            if (clear)
1241
                q <= {1'b1,{length-1{1'b0}}};
1242
            else
1243
                q <= q >> 1;
1244
endmodule
1245 18 unneback
module vl_cnt_shreg_ce_clear_wrap ( cke, clear, q, rst, clk);
1246 6 unneback
   parameter length = 4;
1247
   input cke, clear;
1248
   output reg [0:length-1] q;
1249
   input rst;
1250
   input clk;
1251
    always @ (posedge clk or posedge rst)
1252
    if (rst)
1253
        q <= {1'b1,{length-1{1'b0}}};
1254
    else
1255
        if (cke)
1256
            if (clear)
1257
                q <= {1'b1,{length-1{1'b0}}};
1258
            else
1259
            q <= {q[length-1],q[0:length-2]};
1260
endmodule
1261
//////////////////////////////////////////////////////////////////////
1262
////                                                              ////
1263
////  Versatile library, memories                                 ////
1264
////                                                              ////
1265
////  Description                                                 ////
1266
////  memories                                                    ////
1267
////                                                              ////
1268
////                                                              ////
1269
////  To Do:                                                      ////
1270
////   - add more memory types                                    ////
1271
////                                                              ////
1272
////  Author(s):                                                  ////
1273
////      - Michael Unneback, unneback@opencores.org              ////
1274
////        ORSoC AB                                              ////
1275
////                                                              ////
1276
//////////////////////////////////////////////////////////////////////
1277
////                                                              ////
1278
//// Copyright (C) 2010 Authors and OPENCORES.ORG                 ////
1279
////                                                              ////
1280
//// This source file may be used and distributed without         ////
1281
//// restriction provided that this copyright statement is not    ////
1282
//// removed from the file and that any derivative work contains  ////
1283
//// the original copyright notice and the associated disclaimer. ////
1284
////                                                              ////
1285
//// This source file is free software; you can redistribute it   ////
1286
//// and/or modify it under the terms of the GNU Lesser General   ////
1287
//// Public License as published by the Free Software Foundation; ////
1288
//// either version 2.1 of the License, or (at your option) any   ////
1289
//// later version.                                               ////
1290
////                                                              ////
1291
//// This source is distributed in the hope that it will be       ////
1292
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
1293
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
1294
//// PURPOSE.  See the GNU Lesser General Public License for more ////
1295
//// details.                                                     ////
1296
////                                                              ////
1297
//// You should have received a copy of the GNU Lesser General    ////
1298
//// Public License along with this source; if not, download it   ////
1299
//// from http://www.opencores.org/lgpl.shtml                     ////
1300
////                                                              ////
1301
//////////////////////////////////////////////////////////////////////
1302
/// ROM
1303 7 unneback
module vl_rom_init ( adr, q, clk);
1304
   parameter data_width = 32;
1305
   parameter addr_width = 8;
1306 75 unneback
   parameter mem_size = 1<<addr_width;
1307 7 unneback
   input [(addr_width-1):0]       adr;
1308
   output reg [(data_width-1):0] q;
1309
   input                         clk;
1310 75 unneback
   reg [data_width-1:0] rom [mem_size-1:0];
1311 7 unneback
   parameter memory_file = "vl_rom.vmem";
1312
   initial
1313
     begin
1314
        $readmemh(memory_file, rom);
1315
     end
1316
   always @ (posedge clk)
1317
     q <= rom[adr];
1318
endmodule
1319 6 unneback
// Single port RAM
1320
module vl_ram ( d, adr, we, q, clk);
1321
   parameter data_width = 32;
1322
   parameter addr_width = 8;
1323 75 unneback
   parameter mem_size = 1<<addr_width;
1324 6 unneback
   input [(data_width-1):0]      d;
1325
   input [(addr_width-1):0]       adr;
1326
   input                         we;
1327 7 unneback
   output reg [(data_width-1):0] q;
1328 6 unneback
   input                         clk;
1329 75 unneback
   reg [data_width-1:0] ram [mem_szie-1:0];
1330 7 unneback
   parameter init = 0;
1331
   parameter memory_file = "vl_ram.vmem";
1332
   generate if (init) begin : init_mem
1333
   initial
1334
     begin
1335
        $readmemh(memory_file, ram);
1336
     end
1337
   end
1338
   endgenerate
1339 6 unneback
   always @ (posedge clk)
1340
   begin
1341
   if (we)
1342
     ram[adr] <= d;
1343
   q <= ram[adr];
1344
   end
1345
endmodule
1346 90 unneback
module vl_ram_be ( d, adr, be, re, we, q, clk);
1347 7 unneback
   parameter data_width = 32;
1348 72 unneback
   parameter addr_width = 6;
1349 75 unneback
   parameter mem_size = 1<<addr_width;
1350 7 unneback
   input [(data_width-1):0]      d;
1351
   input [(addr_width-1):0]       adr;
1352 73 unneback
   input [(data_width/8)-1:0]    be;
1353 90 unneback
   input                         re;
1354 7 unneback
   input                         we;
1355
   output reg [(data_width-1):0] q;
1356
   input                         clk;
1357 65 unneback
`ifdef SYSTEMVERILOG
1358 68 unneback
   logic [data_width/8-1:0][7:0] ram[0:mem_size-1];// # words = 1 << address width
1359 65 unneback
`else
1360 85 unneback
    reg [data_width-1:0] ram [mem_size-1:0];
1361
    wire [data_width/8-1:0] cke;
1362 65 unneback
`endif
1363 60 unneback
   parameter memory_init = 0;
1364 7 unneback
   parameter memory_file = "vl_ram.vmem";
1365 60 unneback
   generate if (memory_init) begin : init_mem
1366 7 unneback
   initial
1367
     begin
1368
        $readmemh(memory_file, ram);
1369
     end
1370
   end
1371
   endgenerate
1372 60 unneback
`ifdef SYSTEMVERILOG
1373
// use a multi-dimensional packed array
1374
//to model individual bytes within the word
1375
always_ff@(posedge clk)
1376
begin
1377
    if(we) begin // note: we should have a for statement to support any bus width
1378 86 unneback
        if(be[3]) ram[adr][3] <= d[31:24];
1379
        if(be[2]) ram[adr][2] <= d[23:16];
1380
        if(be[1]) ram[adr][1] <= d[15:8];
1381
        if(be[0]) ram[adr][0] <= d[7:0];
1382 60 unneback
    end
1383 90 unneback
    if (re)
1384
        q <= ram[adr];
1385 60 unneback
end
1386
`else
1387 85 unneback
assign cke = {data_width/8{we}} & be;
1388 7 unneback
   genvar i;
1389 85 unneback
   generate for (i=0;i<data_width/8;i=i+1) begin : be_ram
1390 7 unneback
      always @ (posedge clk)
1391 85 unneback
      if (cke[i])
1392 7 unneback
        ram[adr][(i+1)*8-1:i*8] <= d[(i+1)*8-1:i*8];
1393
   end
1394
   endgenerate
1395
   always @ (posedge clk)
1396 90 unneback
    if (re)
1397 7 unneback
      q <= ram[adr];
1398 60 unneback
`endif
1399 85 unneback
   // Function to access RAM (for use by Verilator).
1400
   function [31:0] get_mem;
1401
      // verilator public
1402 90 unneback
      input [addr_width-1:0]             addr;
1403 85 unneback
      get_mem = ram[addr];
1404
   endfunction // get_mem
1405
   // Function to write RAM (for use by Verilator).
1406
   function set_mem;
1407
      // verilator public
1408 90 unneback
      input [addr_width-1:0]             addr;
1409
      input [data_width-1:0]             data;
1410 85 unneback
      ram[addr] = data;
1411
   endfunction // set_mem
1412 7 unneback
endmodule
1413
module vl_dpram_1r1w ( d_a, adr_a, we_a, clk_a, q_b, adr_b, clk_b );
1414 6 unneback
   parameter data_width = 32;
1415
   parameter addr_width = 8;
1416 75 unneback
   parameter mem_size = 1<<addr_width;
1417 6 unneback
   input [(data_width-1):0]      d_a;
1418
   input [(addr_width-1):0]       adr_a;
1419
   input [(addr_width-1):0]       adr_b;
1420
   input                         we_a;
1421
   output [(data_width-1):0]      q_b;
1422
   input                         clk_a, clk_b;
1423
   reg [(addr_width-1):0]         adr_b_reg;
1424 75 unneback
   reg [data_width-1:0] ram [mem_szie-1:0] ;
1425 7 unneback
   parameter init = 0;
1426
   parameter memory_file = "vl_ram.vmem";
1427
   generate if (init) begin : init_mem
1428
   initial
1429
     begin
1430
        $readmemh(memory_file, ram);
1431
     end
1432
   end
1433
   endgenerate
1434 6 unneback
   always @ (posedge clk_a)
1435
   if (we_a)
1436
     ram[adr_a] <= d_a;
1437
   always @ (posedge clk_b)
1438
   adr_b_reg <= adr_b;
1439
   assign q_b = ram[adr_b_reg];
1440
endmodule
1441 7 unneback
module vl_dpram_2r1w ( d_a, q_a, adr_a, we_a, clk_a, q_b, adr_b, clk_b );
1442 6 unneback
   parameter data_width = 32;
1443
   parameter addr_width = 8;
1444 75 unneback
   parameter mem_size = 1<<addr_width;
1445 6 unneback
   input [(data_width-1):0]      d_a;
1446
   input [(addr_width-1):0]       adr_a;
1447
   input [(addr_width-1):0]       adr_b;
1448
   input                         we_a;
1449
   output [(data_width-1):0]      q_b;
1450
   output reg [(data_width-1):0] q_a;
1451
   input                         clk_a, clk_b;
1452
   reg [(data_width-1):0]         q_b;
1453 75 unneback
   reg [data_width-1:0] ram [mem_szie-1:0] ;
1454 7 unneback
   parameter init = 0;
1455
   parameter memory_file = "vl_ram.vmem";
1456
   generate if (init) begin : init_mem
1457
   initial
1458
     begin
1459
        $readmemh(memory_file, ram);
1460
     end
1461
   end
1462
   endgenerate
1463 6 unneback
   always @ (posedge clk_a)
1464
     begin
1465
        q_a <= ram[adr_a];
1466
        if (we_a)
1467
             ram[adr_a] <= d_a;
1468
     end
1469
   always @ (posedge clk_b)
1470
          q_b <= ram[adr_b];
1471
endmodule
1472 7 unneback
module vl_dpram_2r2w ( d_a, q_a, adr_a, we_a, clk_a, d_b, q_b, adr_b, we_b, clk_b );
1473 6 unneback
   parameter data_width = 32;
1474
   parameter addr_width = 8;
1475 75 unneback
   parameter mem_size = 1<<addr_width;
1476 6 unneback
   input [(data_width-1):0]      d_a;
1477
   input [(addr_width-1):0]       adr_a;
1478
   input [(addr_width-1):0]       adr_b;
1479
   input                         we_a;
1480
   output [(data_width-1):0]      q_b;
1481
   input [(data_width-1):0]       d_b;
1482
   output reg [(data_width-1):0] q_a;
1483
   input                         we_b;
1484
   input                         clk_a, clk_b;
1485
   reg [(data_width-1):0]         q_b;
1486 75 unneback
   reg [data_width-1:0] ram [mem_size-1:0] ;
1487 7 unneback
   parameter init = 0;
1488
   parameter memory_file = "vl_ram.vmem";
1489
   generate if (init) begin : init_mem
1490
   initial
1491
     begin
1492
        $readmemh(memory_file, ram);
1493
     end
1494
   end
1495
   endgenerate
1496 6 unneback
   always @ (posedge clk_a)
1497
     begin
1498
        q_a <= ram[adr_a];
1499
        if (we_a)
1500
             ram[adr_a] <= d_a;
1501
     end
1502
   always @ (posedge clk_b)
1503
     begin
1504
        q_b <= ram[adr_b];
1505
        if (we_b)
1506
          ram[adr_b] <= d_b;
1507
     end
1508
endmodule
1509 75 unneback
module vl_dpram_be_2r2w ( d_a, q_a, adr_a, be_a, we_a, clk_a, d_b, q_b, adr_b, be_b, we_b, clk_b );
1510
   parameter a_data_width = 32;
1511
   parameter a_addr_width = 8;
1512
   parameter b_data_width = 64;
1513
   parameter b_addr_width = 7;
1514
   //parameter mem_size = (a_addr_width>b_addr_width) ? (1<<a_addr_width) : (1<<b_addr_width);
1515
   parameter mem_size = 1024;
1516
   input [(a_data_width-1):0]      d_a;
1517
   input [(a_addr_width-1):0]     adr_a;
1518
   input [(b_addr_width-1):0]     adr_b;
1519
   input [(a_data_width/4-1):0]    be_a;
1520
   input                         we_a;
1521
   output [(b_data_width-1):0]    q_b;
1522
   input [(b_data_width-1):0]     d_b;
1523
   output reg [(a_data_width-1):0] q_a;
1524
   input [(b_data_width/4-1):0]    be_b;
1525
   input                         we_b;
1526
   input                         clk_a, clk_b;
1527
   reg [(b_data_width-1):0]       q_b;
1528
generate
1529
if (a_data_width==32 & b_data_width==64) begin : inst32to64
1530 77 unneback
    wire [63:0] tmp;
1531 75 unneback
    vl_dpram_2r2w
1532
    # (.data_width(8), .addr_width(b_addr_width-3))
1533
    ram0 (
1534
        .d_a(d_a[7:0]),
1535
        .q_a(tmp[7:0]),
1536
        .adr_a(adr_a[a_addr_width-3-1:0]),
1537
        .we_a(we_a & be_a[0] & !adr_a[0]),
1538
        .clk_a(clk_a),
1539
        .d_b(d_b[7:0]),
1540
        .q_b(q_b[7:0]),
1541
        .adr_b(adr_b[b_addr_width-3-1:0]),
1542
        .we_b(we_b),
1543
        .clk_b(clk_b) );
1544
    vl_dpram_2r2w
1545
    # (.data_width(8), .addr_width(b_addr_width-3))
1546
    ram1 (
1547
        .d_a(d_a[7:0]),
1548
        .q_a(tmp[7:0]),
1549
        .adr_a(adr_a[a_addr_width-3-1:0]),
1550
        .we_a(we_a),
1551
        .clk_a(clk_a),
1552
        .d_b(d_b[7:0]),
1553
        .q_b(q_b[7:0]),
1554
        .adr_b(adr_b[b_addr_width-3-1:0]),
1555
        .we_b(we_b),
1556
        .clk_b(clk_b) );
1557
    vl_dpram_2r2w
1558
    # (.data_width(8), .addr_width(b_addr_width-3))
1559
    ram2 (
1560
        .d_a(d_a[15:8]),
1561
        .q_a(tmp[7:0]),
1562
        .adr_a(adr_a[a_addr_width-3-1:0]),
1563
        .we_a(we_a),
1564
        .clk_a(clk_a),
1565
        .d_b(d_b[7:0]),
1566
        .q_b(q_b[7:0]),
1567
        .adr_b(adr_b[b_addr_width-3-1:0]),
1568
        .we_b(we_b),
1569
        .clk_b(clk_b) );
1570
    vl_dpram_2r2w
1571
    # (.data_width(8), .addr_width(b_addr_width-3))
1572
    ram3 (
1573
        .d_a(d_a[15:8]),
1574
        .q_a(tmp[7:0]),
1575
        .adr_a(adr_a[a_addr_width-3-1:0]),
1576
        .we_a(we_a),
1577
        .clk_a(clk_a),
1578
        .d_b(d_b[7:0]),
1579
        .q_b(q_b[7:0]),
1580
        .adr_b(adr_b[b_addr_width-3-1:0]),
1581
        .we_b(we_b),
1582
        .clk_b(clk_b) );
1583
    vl_dpram_2r2w
1584
    # (.data_width(8), .addr_width(b_addr_width-3))
1585
    ram4 (
1586
        .d_a(d_a[23:16]),
1587
        .q_a(tmp[7:0]),
1588
        .adr_a(adr_a[a_addr_width-3-1:0]),
1589
        .we_a(we_a),
1590
        .clk_a(clk_a),
1591
        .d_b(d_b[7:0]),
1592
        .q_b(q_b[7:0]),
1593
        .adr_b(adr_b[b_addr_width-3-1:0]),
1594
        .we_b(we_b),
1595
        .clk_b(clk_b) );
1596
    vl_dpram_2r2w
1597
    # (.data_width(8), .addr_width(b_addr_width-3))
1598
    ram5 (
1599
        .d_a(d_a[23:16]),
1600
        .q_a(tmp[7:0]),
1601
        .adr_a(adr_a[a_addr_width-3-1:0]),
1602
        .we_a(we_a),
1603
        .clk_a(clk_a),
1604
        .d_b(d_b[7:0]),
1605
        .q_b(q_b[7:0]),
1606
        .adr_b(adr_b[b_addr_width-3-1:0]),
1607
        .we_b(we_b),
1608
        .clk_b(clk_b) );
1609
    vl_dpram_2r2w
1610
    # (.data_width(8), .addr_width(b_addr_width-3))
1611
    ram6 (
1612
        .d_a(d_a[31:24]),
1613
        .q_a(tmp[7:0]),
1614
        .adr_a(adr_a[a_addr_width-3-1:0]),
1615
        .we_a(we_a),
1616
        .clk_a(clk_a),
1617
        .d_b(d_b[7:0]),
1618
        .q_b(q_b[7:0]),
1619
        .adr_b(adr_b[b_addr_width-3-1:0]),
1620
        .we_b(we_b),
1621
        .clk_b(clk_b) );
1622
    vl_dpram_2r2w
1623
    # (.data_width(8), .addr_width(b_addr_width-3))
1624
    ram7 (
1625
        .d_a(d_a[31:24]),
1626
        .q_a(tmp[7:0]),
1627
        .adr_a(adr_a[a_addr_width-3-1:0]),
1628
        .we_a(we_a),
1629
        .clk_a(clk_a),
1630
        .d_b(d_b[7:0]),
1631
        .q_b(q_b[7:0]),
1632
        .adr_b(adr_b[b_addr_width-3-1:0]),
1633
        .we_b(we_b),
1634
        .clk_b(clk_b) );
1635
/*
1636
   reg [7:0] ram0 [mem_size/8-1:0];
1637
   wire [7:0] wea, web;
1638
   assign wea = we_a & be_a[0];
1639
   assign web = we_b & be_b[0];
1640
   always @ (posedge clk_a)
1641
    if (wea)
1642
        ram0[adr_a] <= d_a[7:0];
1643
    always @ (posedge clk_a)
1644
        q_a[7:0] <= ram0[adr_a];
1645
   always @ (posedge clk_a)
1646
    if (web)
1647
        ram0[adr_b] <= d_b[7:0];
1648
    always @ (posedge clk_b)
1649
        q_b[7:0] <= ram0[adr_b];
1650
*/
1651
end
1652
endgenerate
1653
/*
1654
   generate for (i=0;i<addr_width/4;i=i+1) begin : be_rama
1655
      always @ (posedge clk_a)
1656
      if (we_a & be_a[i])
1657
        ram[adr_a][(i+1)*8-1:i*8] <= d_a[(i+1)*8-1:i*8];
1658
   end
1659
   endgenerate
1660
   always @ (posedge clk_a)
1661
      q_a <= ram[adr_a];
1662
   genvar i;
1663
   generate for (i=0;i<addr_width/4;i=i+1) begin : be_ramb
1664
      always @ (posedge clk_a)
1665
      if (we_b & be_b[i])
1666
        ram[adr_b][(i+1)*8-1:i*8] <= d_b[(i+1)*8-1:i*8];
1667
   end
1668
   endgenerate
1669
   always @ (posedge clk_b)
1670
      q_b <= ram[adr_b];
1671
*/
1672
/*
1673
   always @ (posedge clk_a)
1674
     begin
1675
        q_a <= ram[adr_a];
1676
        if (we_a)
1677
             ram[adr_a] <= d_a;
1678
     end
1679
   always @ (posedge clk_b)
1680
     begin
1681
        q_b <= ram[adr_b];
1682
        if (we_b)
1683
          ram[adr_b] <= d_b;
1684
     end
1685
*/
1686
endmodule
1687 6 unneback
// Content addresable memory, CAM
1688
// FIFO
1689 25 unneback
module vl_fifo_1r1w_fill_level_sync (
1690
    d, wr, fifo_full,
1691
    q, rd, fifo_empty,
1692
    fill_level,
1693
    clk, rst
1694
    );
1695
parameter data_width = 18;
1696
parameter addr_width = 4;
1697
// write side
1698
input  [data_width-1:0] d;
1699
input                   wr;
1700
output                  fifo_full;
1701
// read side
1702
output [data_width-1:0] q;
1703
input                   rd;
1704
output                  fifo_empty;
1705
// common
1706
output [addr_width:0]   fill_level;
1707
input rst, clk;
1708
wire [addr_width:1] wadr, radr;
1709
vl_cnt_bin_ce
1710
    # ( .length(addr_width))
1711
    fifo_wr_adr( .cke(wr), .q(wadr), .rst(rst), .clk(clk));
1712
vl_cnt_bin_ce
1713
    # (.length(addr_width))
1714
    fifo_rd_adr( .cke(rd), .q(radr), .rst(rst), .clk(clk));
1715
vl_dpram_1r1w
1716
    # (.data_width(data_width), .addr_width(addr_width))
1717
    dpram ( .d_a(d), .adr_a(wadr), .we_a(wr), .clk_a(clk), .q_b(q), .adr_b(radr), .clk_b(clk));
1718 31 unneback
vl_cnt_bin_ce_rew_q_zq_l1
1719 27 unneback
    # (.length(addr_width+1), .level1_value(1<<addr_width))
1720 25 unneback
    fill_level_cnt( .cke(rd ^ wr), .rew(rd), .q(fill_level), .zq(fifo_empty), .level1(fifo_full), .rst(rst), .clk(clk));
1721
endmodule
1722 27 unneback
// Intended use is two small FIFOs (RX and TX typically) in one FPGA RAM resource
1723
// RAM is supposed to be larger than the two FIFOs
1724
// LFSR counters used adr pointers
1725
module vl_fifo_2r2w_sync_simplex (
1726
    // a side
1727
    a_d, a_wr, a_fifo_full,
1728
    a_q, a_rd, a_fifo_empty,
1729
    a_fill_level,
1730
    // b side
1731
    b_d, b_wr, b_fifo_full,
1732
    b_q, b_rd, b_fifo_empty,
1733
    b_fill_level,
1734
    // common
1735
    clk, rst
1736
    );
1737
parameter data_width = 8;
1738
parameter addr_width = 5;
1739
parameter fifo_full_level = (1<<addr_width)-1;
1740
// a side
1741
input  [data_width-1:0] a_d;
1742
input                   a_wr;
1743
output                  a_fifo_full;
1744
output [data_width-1:0] a_q;
1745
input                   a_rd;
1746
output                  a_fifo_empty;
1747
output [addr_width-1:0] a_fill_level;
1748
// b side
1749
input  [data_width-1:0] b_d;
1750
input                   b_wr;
1751
output                  b_fifo_full;
1752
output [data_width-1:0] b_q;
1753
input                   b_rd;
1754
output                  b_fifo_empty;
1755
output [addr_width-1:0] b_fill_level;
1756
input                   clk;
1757
input                   rst;
1758
// adr_gen
1759
wire [addr_width:1] a_wadr, a_radr;
1760
wire [addr_width:1] b_wadr, b_radr;
1761
// dpram
1762
wire [addr_width:0] a_dpram_adr, b_dpram_adr;
1763
vl_cnt_lfsr_ce
1764
    # ( .length(addr_width))
1765
    fifo_a_wr_adr( .cke(a_wr), .q(a_wadr), .rst(rst), .clk(clk));
1766
vl_cnt_lfsr_ce
1767
    # (.length(addr_width))
1768
    fifo_a_rd_adr( .cke(a_rd), .q(a_radr), .rst(rst), .clk(clk));
1769
vl_cnt_lfsr_ce
1770
    # ( .length(addr_width))
1771
    fifo_b_wr_adr( .cke(b_wr), .q(b_wadr), .rst(rst), .clk(clk));
1772
vl_cnt_lfsr_ce
1773
    # (.length(addr_width))
1774
    fifo_b_rd_adr( .cke(b_rd), .q(b_radr), .rst(rst), .clk(clk));
1775
// mux read or write adr to DPRAM
1776
assign a_dpram_adr = (a_wr) ? {1'b0,a_wadr} : {1'b1,a_radr};
1777
assign b_dpram_adr = (b_wr) ? {1'b1,b_wadr} : {1'b0,b_radr};
1778
vl_dpram_2r2w
1779
    # (.data_width(data_width), .addr_width(addr_width+1))
1780
    dpram ( .d_a(a_d), .q_a(a_q), .adr_a(a_dpram_adr), .we_a(a_wr), .clk_a(a_clk),
1781
            .d_b(b_d), .q_b(b_q), .adr_b(b_dpram_adr), .we_b(b_wr), .clk_b(b_clk));
1782
vl_cnt_bin_ce_rew_zq_l1
1783 28 unneback
    # (.length(addr_width), .level1_value(fifo_full_level))
1784 27 unneback
    a_fill_level_cnt( .cke(a_rd ^ a_wr), .rew(a_rd), .q(a_fill_level), .zq(a_fifo_empty), .level1(a_fifo_full), .rst(rst), .clk(clk));
1785
vl_cnt_bin_ce_rew_zq_l1
1786 28 unneback
    # (.length(addr_width), .level1_value(fifo_full_level))
1787 27 unneback
    b_fill_level_cnt( .cke(b_rd ^ b_wr), .rew(b_rd), .q(b_fill_level), .zq(b_fifo_empty), .level1(b_fifo_full), .rst(rst), .clk(clk));
1788
endmodule
1789 6 unneback
module vl_fifo_cmp_async ( wptr, rptr, fifo_empty, fifo_full, wclk, rclk, rst );
1790 11 unneback
   parameter addr_width = 4;
1791
   parameter N = addr_width-1;
1792 6 unneback
   parameter Q1 = 2'b00;
1793
   parameter Q2 = 2'b01;
1794
   parameter Q3 = 2'b11;
1795
   parameter Q4 = 2'b10;
1796
   parameter going_empty = 1'b0;
1797
   parameter going_full  = 1'b1;
1798
   input [N:0]  wptr, rptr;
1799 14 unneback
   output       fifo_empty;
1800 6 unneback
   output       fifo_full;
1801
   input        wclk, rclk, rst;
1802
   wire direction;
1803
   reg  direction_set, direction_clr;
1804
   wire async_empty, async_full;
1805
   wire fifo_full2;
1806 14 unneback
   wire fifo_empty2;
1807 6 unneback
   // direction_set
1808
   always @ (wptr[N:N-1] or rptr[N:N-1])
1809
     case ({wptr[N:N-1],rptr[N:N-1]})
1810
       {Q1,Q2} : direction_set <= 1'b1;
1811
       {Q2,Q3} : direction_set <= 1'b1;
1812
       {Q3,Q4} : direction_set <= 1'b1;
1813
       {Q4,Q1} : direction_set <= 1'b1;
1814
       default : direction_set <= 1'b0;
1815
     endcase
1816
   // direction_clear
1817
   always @ (wptr[N:N-1] or rptr[N:N-1] or rst)
1818
     if (rst)
1819
       direction_clr <= 1'b1;
1820
     else
1821
       case ({wptr[N:N-1],rptr[N:N-1]})
1822
         {Q2,Q1} : direction_clr <= 1'b1;
1823
         {Q3,Q2} : direction_clr <= 1'b1;
1824
         {Q4,Q3} : direction_clr <= 1'b1;
1825
         {Q1,Q4} : direction_clr <= 1'b1;
1826
         default : direction_clr <= 1'b0;
1827
       endcase
1828 18 unneback
    vl_dff_sr dff_sr_dir( .aclr(direction_clr), .aset(direction_set), .clock(1'b1), .data(1'b1), .q(direction));
1829 6 unneback
   assign async_empty = (wptr == rptr) && (direction==going_empty);
1830
   assign async_full  = (wptr == rptr) && (direction==going_full);
1831 18 unneback
    vl_dff_sr dff_sr_empty0( .aclr(rst), .aset(async_full), .clock(wclk), .data(async_full), .q(fifo_full2));
1832
    vl_dff_sr dff_sr_empty1( .aclr(rst), .aset(async_full), .clock(wclk), .data(fifo_full2), .q(fifo_full));
1833 6 unneback
/*
1834
   always @ (posedge wclk or posedge rst or posedge async_full)
1835
     if (rst)
1836
       {fifo_full, fifo_full2} <= 2'b00;
1837
     else if (async_full)
1838
       {fifo_full, fifo_full2} <= 2'b11;
1839
     else
1840
       {fifo_full, fifo_full2} <= {fifo_full2, async_full};
1841
*/
1842 14 unneback
/*   always @ (posedge rclk or posedge async_empty)
1843 6 unneback
     if (async_empty)
1844
       {fifo_empty, fifo_empty2} <= 2'b11;
1845
     else
1846 14 unneback
       {fifo_empty,fifo_empty2} <= {fifo_empty2,async_empty}; */
1847 18 unneback
    vl_dff # ( .reset_value(1'b1)) dff0 ( .d(async_empty), .q(fifo_empty2), .clk(rclk), .rst(async_empty));
1848
    vl_dff # ( .reset_value(1'b1)) dff1 ( .d(fifo_empty2), .q(fifo_empty),  .clk(rclk), .rst(async_empty));
1849 27 unneback
endmodule // async_compb
1850 6 unneback
module vl_fifo_1r1w_async (
1851
    d, wr, fifo_full, wr_clk, wr_rst,
1852
    q, rd, fifo_empty, rd_clk, rd_rst
1853
    );
1854
parameter data_width = 18;
1855
parameter addr_width = 4;
1856
// write side
1857
input  [data_width-1:0] d;
1858
input                   wr;
1859
output                  fifo_full;
1860
input                   wr_clk;
1861
input                   wr_rst;
1862
// read side
1863
output [data_width-1:0] q;
1864
input                   rd;
1865
output                  fifo_empty;
1866
input                   rd_clk;
1867
input                   rd_rst;
1868
wire [addr_width:1] wadr, wadr_bin, radr, radr_bin;
1869 18 unneback
vl_cnt_gray_ce_bin
1870 6 unneback
    # ( .length(addr_width))
1871
    fifo_wr_adr( .cke(wr), .q(wadr), .q_bin(wadr_bin), .rst(wr_rst), .clk(wr_clk));
1872 18 unneback
vl_cnt_gray_ce_bin
1873 6 unneback
    # (.length(addr_width))
1874 23 unneback
    fifo_rd_adr( .cke(rd), .q(radr), .q_bin(radr_bin), .rst(rd_rst), .clk(rd_clk));
1875 7 unneback
vl_dpram_1r1w
1876 6 unneback
    # (.data_width(data_width), .addr_width(addr_width))
1877
    dpram ( .d_a(d), .adr_a(wadr_bin), .we_a(wr), .clk_a(wr_clk), .q_b(q), .adr_b(radr_bin), .clk_b(rd_clk));
1878
vl_fifo_cmp_async
1879
    # (.addr_width(addr_width))
1880
    cmp ( .wptr(wadr), .rptr(radr), .fifo_empty(fifo_empty), .fifo_full(fifo_full), .wclk(wr_clk), .rclk(rd_clk), .rst(wr_rst) );
1881
endmodule
1882 8 unneback
module vl_fifo_2r2w_async (
1883 6 unneback
    // a side
1884
    a_d, a_wr, a_fifo_full,
1885
    a_q, a_rd, a_fifo_empty,
1886
    a_clk, a_rst,
1887
    // b side
1888
    b_d, b_wr, b_fifo_full,
1889
    b_q, b_rd, b_fifo_empty,
1890
    b_clk, b_rst
1891
    );
1892
parameter data_width = 18;
1893
parameter addr_width = 4;
1894
// a side
1895
input  [data_width-1:0] a_d;
1896
input                   a_wr;
1897
output                  a_fifo_full;
1898
output [data_width-1:0] a_q;
1899
input                   a_rd;
1900
output                  a_fifo_empty;
1901
input                   a_clk;
1902
input                   a_rst;
1903
// b side
1904
input  [data_width-1:0] b_d;
1905
input                   b_wr;
1906
output                  b_fifo_full;
1907
output [data_width-1:0] b_q;
1908
input                   b_rd;
1909
output                  b_fifo_empty;
1910
input                   b_clk;
1911
input                   b_rst;
1912
vl_fifo_1r1w_async # (.data_width(data_width), .addr_width(addr_width))
1913
vl_fifo_1r1w_async_a (
1914
    .d(a_d), .wr(a_wr), .fifo_full(a_fifo_full), .wr_clk(a_clk), .wr_rst(a_rst),
1915
    .q(b_q), .rd(b_rd), .fifo_empty(b_fifo_empty), .rd_clk(b_clk), .rd_rst(b_rst)
1916
    );
1917
vl_fifo_1r1w_async # (.data_width(data_width), .addr_width(addr_width))
1918
vl_fifo_1r1w_async_b (
1919
    .d(b_d), .wr(b_wr), .fifo_full(b_fifo_full), .wr_clk(b_clk), .wr_rst(b_rst),
1920
    .q(a_q), .rd(a_rd), .fifo_empty(a_fifo_empty), .rd_clk(a_clk), .rd_rst(a_rst)
1921
    );
1922
endmodule
1923 8 unneback
module vl_fifo_2r2w_async_simplex (
1924 6 unneback
    // a side
1925
    a_d, a_wr, a_fifo_full,
1926
    a_q, a_rd, a_fifo_empty,
1927
    a_clk, a_rst,
1928
    // b side
1929
    b_d, b_wr, b_fifo_full,
1930
    b_q, b_rd, b_fifo_empty,
1931
    b_clk, b_rst
1932
    );
1933
parameter data_width = 18;
1934
parameter addr_width = 4;
1935
// a side
1936
input  [data_width-1:0] a_d;
1937
input                   a_wr;
1938
output                  a_fifo_full;
1939
output [data_width-1:0] a_q;
1940
input                   a_rd;
1941
output                  a_fifo_empty;
1942
input                   a_clk;
1943
input                   a_rst;
1944
// b side
1945
input  [data_width-1:0] b_d;
1946
input                   b_wr;
1947
output                  b_fifo_full;
1948
output [data_width-1:0] b_q;
1949
input                   b_rd;
1950
output                  b_fifo_empty;
1951
input                   b_clk;
1952
input                   b_rst;
1953
// adr_gen
1954
wire [addr_width:1] a_wadr, a_wadr_bin, a_radr, a_radr_bin;
1955
wire [addr_width:1] b_wadr, b_wadr_bin, b_radr, b_radr_bin;
1956
// dpram
1957
wire [addr_width:0] a_dpram_adr, b_dpram_adr;
1958 18 unneback
vl_cnt_gray_ce_bin
1959 6 unneback
    # ( .length(addr_width))
1960
    fifo_a_wr_adr( .cke(a_wr), .q(a_wadr), .q_bin(a_wadr_bin), .rst(a_rst), .clk(a_clk));
1961 18 unneback
vl_cnt_gray_ce_bin
1962 6 unneback
    # (.length(addr_width))
1963
    fifo_a_rd_adr( .cke(a_rd), .q(a_radr), .q_bin(a_radr_bin), .rst(a_rst), .clk(a_clk));
1964 18 unneback
vl_cnt_gray_ce_bin
1965 6 unneback
    # ( .length(addr_width))
1966
    fifo_b_wr_adr( .cke(b_wr), .q(b_wadr), .q_bin(b_wadr_bin), .rst(b_rst), .clk(b_clk));
1967 18 unneback
vl_cnt_gray_ce_bin
1968 6 unneback
    # (.length(addr_width))
1969
    fifo_b_rd_adr( .cke(b_rd), .q(b_radr), .q_bin(b_radr_bin), .rst(b_rst), .clk(b_clk));
1970
// mux read or write adr to DPRAM
1971
assign a_dpram_adr = (a_wr) ? {1'b0,a_wadr_bin} : {1'b1,a_radr_bin};
1972
assign b_dpram_adr = (b_wr) ? {1'b1,b_wadr_bin} : {1'b0,b_radr_bin};
1973 11 unneback
vl_dpram_2r2w
1974 6 unneback
    # (.data_width(data_width), .addr_width(addr_width+1))
1975
    dpram ( .d_a(a_d), .q_a(a_q), .adr_a(a_dpram_adr), .we_a(a_wr), .clk_a(a_clk),
1976
            .d_b(b_d), .q_b(b_q), .adr_b(b_dpram_adr), .we_b(b_wr), .clk_b(b_clk));
1977 11 unneback
vl_fifo_cmp_async
1978 6 unneback
    # (.addr_width(addr_width))
1979
    cmp1 ( .wptr(a_wadr), .rptr(b_radr), .fifo_empty(b_fifo_empty), .fifo_full(a_fifo_full), .wclk(a_clk), .rclk(b_clk), .rst(a_rst) );
1980 11 unneback
vl_fifo_cmp_async
1981 6 unneback
    # (.addr_width(addr_width))
1982
    cmp2 ( .wptr(b_wadr), .rptr(a_radr), .fifo_empty(a_fifo_empty), .fifo_full(b_fifo_full), .wclk(b_clk), .rclk(a_clk), .rst(b_rst) );
1983
endmodule
1984 48 unneback
module vl_reg_file (
1985
    a1, a2, a3, wd3, we3, rd1, rd2, clk
1986
);
1987
parameter data_width = 32;
1988
parameter addr_width = 5;
1989
input [addr_width-1:0] a1, a2, a3;
1990
input [data_width-1:0] wd3;
1991
input we3;
1992
output [data_width-1:0] rd1, rd2;
1993
input clk;
1994
vl_dpram_1r1w
1995
    # ( .data_width(data_width), .addr_width(addr_width))
1996
    ram1 (
1997
        .d_a(wd3),
1998
        .adr_a(a3),
1999
        .we_a(we3),
2000
        .clk_a(clk),
2001
        .q_b(rd1),
2002
        .adr_b(a1),
2003
        .clk_b(clk) );
2004
vl_dpram_1r1w
2005
    # ( .data_width(data_width), .addr_width(addr_width))
2006
    ram2 (
2007
        .d_a(wd3),
2008
        .adr_a(a3),
2009
        .we_a(we3),
2010
        .clk_a(clk),
2011
        .q_b(rd2),
2012
        .adr_b(a2),
2013
        .clk_b(clk) );
2014
endmodule
2015 12 unneback
//////////////////////////////////////////////////////////////////////
2016
////                                                              ////
2017
////  Versatile library, wishbone stuff                           ////
2018
////                                                              ////
2019
////  Description                                                 ////
2020
////  Wishbone compliant modules                                  ////
2021
////                                                              ////
2022
////                                                              ////
2023
////  To Do:                                                      ////
2024
////   -                                                          ////
2025
////                                                              ////
2026
////  Author(s):                                                  ////
2027
////      - Michael Unneback, unneback@opencores.org              ////
2028
////        ORSoC AB                                              ////
2029
////                                                              ////
2030
//////////////////////////////////////////////////////////////////////
2031
////                                                              ////
2032
//// Copyright (C) 2010 Authors and OPENCORES.ORG                 ////
2033
////                                                              ////
2034
//// This source file may be used and distributed without         ////
2035
//// restriction provided that this copyright statement is not    ////
2036
//// removed from the file and that any derivative work contains  ////
2037
//// the original copyright notice and the associated disclaimer. ////
2038
////                                                              ////
2039
//// This source file is free software; you can redistribute it   ////
2040
//// and/or modify it under the terms of the GNU Lesser General   ////
2041
//// Public License as published by the Free Software Foundation; ////
2042
//// either version 2.1 of the License, or (at your option) any   ////
2043
//// later version.                                               ////
2044
////                                                              ////
2045
//// This source is distributed in the hope that it will be       ////
2046
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
2047
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
2048
//// PURPOSE.  See the GNU Lesser General Public License for more ////
2049
//// details.                                                     ////
2050
////                                                              ////
2051
//// You should have received a copy of the GNU Lesser General    ////
2052
//// Public License along with this source; if not, download it   ////
2053
//// from http://www.opencores.org/lgpl.shtml                     ////
2054
////                                                              ////
2055
//////////////////////////////////////////////////////////////////////
2056
// async wb3 - wb3 bridge
2057
`timescale 1ns/1ns
2058 85 unneback
module vl_wb_adr_inc ( cyc_i, stb_i, cti_i, bte_i, adr_i, we_i, ack_o, adr_o, clk, rst);
2059 83 unneback
parameter adr_width = 10;
2060
parameter max_burst_width = 4;
2061 85 unneback
input cyc_i, stb_i, we_i;
2062 83 unneback
input [2:0] cti_i;
2063
input [1:0] bte_i;
2064
input [adr_width-1:0] adr_i;
2065
output [adr_width-1:0] adr_o;
2066
output ack_o;
2067
input clk, rst;
2068
reg [adr_width-1:0] adr;
2069 90 unneback
wire [max_burst_width-1:0] to_adr;
2070 83 unneback
generate
2071
if (max_burst_width==0) begin : inst_0
2072
    reg ack_o;
2073
    assign adr_o = adr_i;
2074
    always @ (posedge clk or posedge rst)
2075
    if (rst)
2076
        ack_o <= 1'b0;
2077
    else
2078
        ack_o <= cyc_i & stb_i & !ack_o;
2079
end else begin
2080
    reg [1:0] last_cycle;
2081
    localparam idle = 2'b00;
2082
    localparam cyc  = 2'b01;
2083
    localparam ws   = 2'b10;
2084
    localparam eoc  = 2'b11;
2085
    always @ (posedge clk or posedge rst)
2086
    if (rst)
2087
        last_cycle <= idle;
2088
    else
2089
        last_cycle <= (!cyc_i) ? idle :
2090
                      (cyc_i & ack_o & (cti_i==3'b000 | cti_i==3'b111)) ? eoc :
2091
                      (cyc_i & !stb_i) ? ws :
2092
                      cyc;
2093
    assign to_adr = (last_cycle==idle | last_cycle==eoc) ? adr_i[max_burst_width-1:0] : adr[max_burst_width-1:0];
2094 85 unneback
    assign adr_o[max_burst_width-1:0] = (we_i) ? adr_i[max_burst_width-1:0] :
2095
                                        (last_cycle==idle | last_cycle==eoc) ? adr_i[max_burst_width-1:0] :
2096
                                        adr[max_burst_width-1:0];
2097 90 unneback
    assign ack_o = (last_cycle==cyc | last_cycle==ws) & stb_i;
2098 83 unneback
end
2099
endgenerate
2100
generate
2101
if (max_burst_width==2) begin : inst_2
2102
    always @ (posedge clk or posedge rst)
2103
    if (rst)
2104
        adr <= 2'h0;
2105
    else
2106
        if (cyc_i & stb_i)
2107
            adr[1:0] <= to_adr[1:0] + 2'd1;
2108
        else
2109
            adr <= to_adr[1:0];
2110
end
2111
endgenerate
2112
generate
2113
if (max_burst_width==3) begin : inst_3
2114
    always @ (posedge clk or posedge rst)
2115
    if (rst)
2116
        adr <= 3'h0;
2117
    else
2118
        if (cyc_i & stb_i)
2119
            case (bte_i)
2120
            2'b01: adr[2:0] <= {to_adr[2],to_adr[1:0] + 2'd1};
2121
            default: adr[3:0] <= to_adr[2:0] + 3'd1;
2122
            endcase
2123
        else
2124
            adr <= to_adr[2:0];
2125
end
2126
endgenerate
2127
generate
2128
if (max_burst_width==4) begin : inst_4
2129
    always @ (posedge clk or posedge rst)
2130
    if (rst)
2131
        adr <= 4'h0;
2132
    else
2133
        if (cyc_i & stb_i)
2134
            case (bte_i)
2135
            2'b01: adr[3:0] <= {to_adr[3:2],to_adr[1:0] + 2'd1};
2136
            2'b10: adr[3:0] <= {to_adr[3],to_adr[2:0] + 3'd1};
2137
            default: adr[3:0] <= to_adr + 4'd1;
2138
            endcase
2139
        else
2140
            adr <= to_adr[3:0];
2141
end
2142
endgenerate
2143
generate
2144
if (adr_width > max_burst_width) begin : pass_through
2145
    assign adr_o[adr_width-1:max_burst_width] = adr_i[adr_width-1:max_burst_width];
2146
end
2147
endgenerate
2148
endmodule
2149
// async wb3 - wb3 bridge
2150
`timescale 1ns/1ns
2151 18 unneback
module vl_wb3wb3_bridge (
2152 12 unneback
        // wishbone slave side
2153
        wbs_dat_i, wbs_adr_i, wbs_sel_i, wbs_bte_i, wbs_cti_i, wbs_we_i, wbs_cyc_i, wbs_stb_i, wbs_dat_o, wbs_ack_o, wbs_clk, wbs_rst,
2154
        // wishbone master side
2155
        wbm_dat_o, wbm_adr_o, wbm_sel_o, wbm_bte_o, wbm_cti_o, wbm_we_o, wbm_cyc_o, wbm_stb_o, wbm_dat_i, wbm_ack_i, wbm_clk, wbm_rst);
2156
input [31:0] wbs_dat_i;
2157
input [31:2] wbs_adr_i;
2158
input [3:0]  wbs_sel_i;
2159
input [1:0]  wbs_bte_i;
2160
input [2:0]  wbs_cti_i;
2161
input wbs_we_i, wbs_cyc_i, wbs_stb_i;
2162
output [31:0] wbs_dat_o;
2163 14 unneback
output wbs_ack_o;
2164 12 unneback
input wbs_clk, wbs_rst;
2165
output [31:0] wbm_dat_o;
2166
output reg [31:2] wbm_adr_o;
2167
output [3:0]  wbm_sel_o;
2168
output reg [1:0]  wbm_bte_o;
2169
output reg [2:0]  wbm_cti_o;
2170 14 unneback
output reg wbm_we_o;
2171
output wbm_cyc_o;
2172 12 unneback
output wbm_stb_o;
2173
input [31:0]  wbm_dat_i;
2174
input wbm_ack_i;
2175
input wbm_clk, wbm_rst;
2176
parameter addr_width = 4;
2177
// bte
2178
parameter linear       = 2'b00;
2179
parameter wrap4        = 2'b01;
2180
parameter wrap8        = 2'b10;
2181
parameter wrap16       = 2'b11;
2182
// cti
2183
parameter classic      = 3'b000;
2184
parameter incburst     = 3'b010;
2185
parameter endofburst   = 3'b111;
2186
parameter wbs_adr  = 1'b0;
2187
parameter wbs_data = 1'b1;
2188 33 unneback
parameter wbm_adr0      = 2'b00;
2189
parameter wbm_adr1      = 2'b01;
2190
parameter wbm_data      = 2'b10;
2191
parameter wbm_data_wait = 2'b11;
2192 12 unneback
reg [1:0] wbs_bte_reg;
2193
reg wbs;
2194
wire wbs_eoc_alert, wbm_eoc_alert;
2195
reg wbs_eoc, wbm_eoc;
2196
reg [1:0] wbm;
2197 14 unneback
wire [1:16] wbs_count, wbm_count;
2198 12 unneback
wire [35:0] a_d, a_q, b_d, b_q;
2199
wire a_wr, a_rd, a_fifo_full, a_fifo_empty, b_wr, b_rd, b_fifo_full, b_fifo_empty;
2200
reg a_rd_reg;
2201
wire b_rd_adr, b_rd_data;
2202 14 unneback
wire b_rd_data_reg;
2203
wire [35:0] temp;
2204 12 unneback
assign wbs_eoc_alert = (wbs_bte_reg==wrap4 & wbs_count[3]) | (wbs_bte_reg==wrap8 & wbs_count[7]) | (wbs_bte_reg==wrap16 & wbs_count[15]);
2205
always @ (posedge wbs_clk or posedge wbs_rst)
2206
if (wbs_rst)
2207
        wbs_eoc <= 1'b0;
2208
else
2209
        if (wbs==wbs_adr & wbs_stb_i & !a_fifo_full)
2210 78 unneback
                wbs_eoc <= (wbs_bte_i==linear) | (wbs_cti_i==3'b111);
2211 12 unneback
        else if (wbs_eoc_alert & (a_rd | a_wr))
2212
                wbs_eoc <= 1'b1;
2213 18 unneback
vl_cnt_shreg_ce_clear # ( .length(16))
2214 12 unneback
    cnt0 (
2215
        .cke(wbs_ack_o),
2216
        .clear(wbs_eoc),
2217
        .q(wbs_count),
2218
        .rst(wbs_rst),
2219
        .clk(wbs_clk));
2220
always @ (posedge wbs_clk or posedge wbs_rst)
2221
if (wbs_rst)
2222
        wbs <= wbs_adr;
2223
else
2224 75 unneback
        if ((wbs==wbs_adr) & wbs_cyc_i & wbs_stb_i & a_fifo_empty)
2225 12 unneback
                wbs <= wbs_data;
2226
        else if (wbs_eoc & wbs_ack_o)
2227
                wbs <= wbs_adr;
2228
// wbs FIFO
2229 75 unneback
assign a_d = (wbs==wbs_adr) ? {wbs_adr_i[31:2],wbs_we_i,((wbs_cti_i==3'b111) ? {2'b00,3'b000} : {wbs_bte_i,wbs_cti_i})} : {wbs_dat_i,wbs_sel_i};
2230
assign a_wr = (wbs==wbs_adr)  ? wbs_cyc_i & wbs_stb_i & a_fifo_empty :
2231 12 unneback
              (wbs==wbs_data) ? wbs_we_i  & wbs_stb_i & !a_fifo_full :
2232
              1'b0;
2233
assign a_rd = !a_fifo_empty;
2234
always @ (posedge wbs_clk or posedge wbs_rst)
2235
if (wbs_rst)
2236
        a_rd_reg <= 1'b0;
2237
else
2238
        a_rd_reg <= a_rd;
2239
assign wbs_ack_o = a_rd_reg | (a_wr & wbs==wbs_data);
2240
assign wbs_dat_o = a_q[35:4];
2241
always @ (posedge wbs_clk or posedge wbs_rst)
2242
if (wbs_rst)
2243 13 unneback
        wbs_bte_reg <= 2'b00;
2244 12 unneback
else
2245 13 unneback
        wbs_bte_reg <= wbs_bte_i;
2246 12 unneback
// wbm FIFO
2247
assign wbm_eoc_alert = (wbm_bte_o==wrap4 & wbm_count[3]) | (wbm_bte_o==wrap8 & wbm_count[7]) | (wbm_bte_o==wrap16 & wbm_count[15]);
2248
always @ (posedge wbm_clk or posedge wbm_rst)
2249
if (wbm_rst)
2250
        wbm_eoc <= 1'b0;
2251
else
2252
        if (wbm==wbm_adr0 & !b_fifo_empty)
2253
                wbm_eoc <= b_q[4:3] == linear;
2254
        else if (wbm_eoc_alert & wbm_ack_i)
2255
                wbm_eoc <= 1'b1;
2256
always @ (posedge wbm_clk or posedge wbm_rst)
2257
if (wbm_rst)
2258
        wbm <= wbm_adr0;
2259
else
2260 33 unneback
/*
2261 12 unneback
    if ((wbm==wbm_adr0 & !b_fifo_empty) |
2262
        (wbm==wbm_adr1 & !b_fifo_empty & wbm_we_o) |
2263
        (wbm==wbm_adr1 & !wbm_we_o) |
2264
        (wbm==wbm_data & wbm_ack_i & wbm_eoc))
2265
        wbm <= {wbm[0],!(wbm[1] ^ wbm[0])};  // count sequence 00,01,10
2266 33 unneback
*/
2267
    case (wbm)
2268
    wbm_adr0:
2269
        if (!b_fifo_empty)
2270
            wbm <= wbm_adr1;
2271
    wbm_adr1:
2272
        if (!wbm_we_o | (!b_fifo_empty & wbm_we_o))
2273
            wbm <= wbm_data;
2274
    wbm_data:
2275
        if (wbm_ack_i & wbm_eoc)
2276
            wbm <= wbm_adr0;
2277
        else if (b_fifo_empty & wbm_we_o & wbm_ack_i)
2278
            wbm <= wbm_data_wait;
2279
    wbm_data_wait:
2280
        if (!b_fifo_empty)
2281
            wbm <= wbm_data;
2282
    endcase
2283 12 unneback
assign b_d = {wbm_dat_i,4'b1111};
2284
assign b_wr = !wbm_we_o & wbm_ack_i;
2285
assign b_rd_adr  = (wbm==wbm_adr0 & !b_fifo_empty);
2286
assign b_rd_data = (wbm==wbm_adr1 & !b_fifo_empty & wbm_we_o) ? 1'b1 : // b_q[`WE]
2287
                   (wbm==wbm_data & !b_fifo_empty & wbm_we_o & wbm_ack_i & !wbm_eoc) ? 1'b1 :
2288 33 unneback
                   (wbm==wbm_data_wait & !b_fifo_empty) ? 1'b1 :
2289 12 unneback
                   1'b0;
2290
assign b_rd = b_rd_adr | b_rd_data;
2291 18 unneback
vl_dff dff1 ( .d(b_rd_data), .q(b_rd_data_reg), .clk(wbm_clk), .rst(wbm_rst));
2292
vl_dff_ce # ( .width(36)) dff2 ( .d(b_q), .ce(b_rd_data_reg), .q(temp), .clk(wbm_clk), .rst(wbm_rst));
2293 12 unneback
assign {wbm_dat_o,wbm_sel_o} = (b_rd_data_reg) ? b_q : temp;
2294 18 unneback
vl_cnt_shreg_ce_clear # ( .length(16))
2295 12 unneback
    cnt1 (
2296
        .cke(wbm_ack_i),
2297
        .clear(wbm_eoc),
2298
        .q(wbm_count),
2299
        .rst(wbm_rst),
2300
        .clk(wbm_clk));
2301 33 unneback
assign wbm_cyc_o = (wbm==wbm_data | wbm==wbm_data_wait);
2302
assign wbm_stb_o = (wbm==wbm_data);
2303 12 unneback
always @ (posedge wbm_clk or posedge wbm_rst)
2304
if (wbm_rst)
2305
        {wbm_adr_o,wbm_we_o,wbm_bte_o,wbm_cti_o} <= {30'h0,1'b0,linear,classic};
2306
else begin
2307
        if (wbm==wbm_adr0 & !b_fifo_empty)
2308
                {wbm_adr_o,wbm_we_o,wbm_bte_o,wbm_cti_o} <= b_q;
2309
        else if (wbm_eoc_alert & wbm_ack_i)
2310
                wbm_cti_o <= endofburst;
2311
end
2312
//async_fifo_dw_simplex_top
2313
vl_fifo_2r2w_async_simplex
2314
# ( .data_width(36), .addr_width(addr_width))
2315
fifo (
2316
    // a side
2317
    .a_d(a_d),
2318
    .a_wr(a_wr),
2319
    .a_fifo_full(a_fifo_full),
2320
    .a_q(a_q),
2321
    .a_rd(a_rd),
2322
    .a_fifo_empty(a_fifo_empty),
2323
    .a_clk(wbs_clk),
2324
    .a_rst(wbs_rst),
2325
    // b side
2326
    .b_d(b_d),
2327
    .b_wr(b_wr),
2328
    .b_fifo_full(b_fifo_full),
2329
    .b_q(b_q),
2330
    .b_rd(b_rd),
2331
    .b_fifo_empty(b_fifo_empty),
2332
    .b_clk(wbm_clk),
2333
    .b_rst(wbm_rst)
2334
    );
2335
endmodule
2336 75 unneback
module vl_wb3avalon_bridge (
2337
        // wishbone slave side
2338
        wbs_dat_i, wbs_adr_i, wbs_sel_i, wbs_bte_i, wbs_cti_i, wbs_we_i, wbs_cyc_i, wbs_stb_i, wbs_dat_o, wbs_ack_o, wbs_clk, wbs_rst,
2339 77 unneback
        // avalon master side
2340 75 unneback
        readdata, readdatavalid, address, read, be, write, burstcount, writedata, waitrequest, beginbursttransfer, clk, rst);
2341 85 unneback
parameter linewrapburst = 1'b0;
2342 75 unneback
input [31:0] wbs_dat_i;
2343
input [31:2] wbs_adr_i;
2344
input [3:0]  wbs_sel_i;
2345
input [1:0]  wbs_bte_i;
2346
input [2:0]  wbs_cti_i;
2347 83 unneback
input wbs_we_i;
2348
input wbs_cyc_i;
2349
input wbs_stb_i;
2350 75 unneback
output [31:0] wbs_dat_o;
2351
output wbs_ack_o;
2352
input wbs_clk, wbs_rst;
2353
input [31:0] readdata;
2354
output [31:0] writedata;
2355
output [31:2] address;
2356
output [3:0]  be;
2357
output write;
2358 81 unneback
output read;
2359 75 unneback
output beginbursttransfer;
2360
output [3:0] burstcount;
2361
input readdatavalid;
2362
input waitrequest;
2363
input clk;
2364
input rst;
2365
wire [1:0] wbm_bte_o;
2366
wire [2:0] wbm_cti_o;
2367
wire wbm_we_o, wbm_cyc_o, wbm_stb_o, wbm_ack_i;
2368
reg last_cyc;
2369 79 unneback
reg [3:0] counter;
2370 82 unneback
reg read_busy;
2371 75 unneback
always @ (posedge clk or posedge rst)
2372
if (rst)
2373
    last_cyc <= 1'b0;
2374
else
2375
    last_cyc <= wbm_cyc_o;
2376 79 unneback
always @ (posedge clk or posedge rst)
2377
if (rst)
2378 82 unneback
    read_busy <= 1'b0;
2379 79 unneback
else
2380 82 unneback
    if (read & !waitrequest)
2381
        read_busy <= 1'b1;
2382
    else if (wbm_ack_i & wbm_cti_o!=3'b010)
2383
        read_busy <= 1'b0;
2384
assign read = wbm_cyc_o & wbm_stb_o & !wbm_we_o & !read_busy;
2385 75 unneback
assign beginbursttransfer = (!last_cyc & wbm_cyc_o) & wbm_cti_o==3'b010;
2386
assign burstcount = (wbm_bte_o==2'b01) ? 4'd4 :
2387
                    (wbm_bte_o==2'b10) ? 4'd8 :
2388 78 unneback
                    (wbm_bte_o==2'b11) ? 4'd16:
2389
                    4'd1;
2390 82 unneback
assign wbm_ack_i = (readdatavalid) | (write & !waitrequest);
2391 79 unneback
always @ (posedge clk or posedge rst)
2392
if (rst) begin
2393
    counter <= 4'd0;
2394
end else
2395 80 unneback
    if (wbm_we_o) begin
2396
        if (!waitrequest & !last_cyc & wbm_cyc_o) begin
2397 85 unneback
            counter <= burstcount -4'd1;
2398 80 unneback
        end else if (waitrequest & !last_cyc & wbm_cyc_o) begin
2399
            counter <= burstcount;
2400
        end else if (!waitrequest & wbm_stb_o) begin
2401
            counter <= counter - 4'd1;
2402
        end
2403 82 unneback
    end
2404 81 unneback
assign write = wbm_cyc_o & wbm_stb_o & wbm_we_o & counter!=4'd0;
2405 77 unneback
vl_wb3wb3_bridge wbwb3inst (
2406 75 unneback
    // wishbone slave side
2407
    .wbs_dat_i(wbs_dat_i),
2408
    .wbs_adr_i(wbs_adr_i),
2409
    .wbs_sel_i(wbs_sel_i),
2410
    .wbs_bte_i(wbs_bte_i),
2411
    .wbs_cti_i(wbs_cti_i),
2412
    .wbs_we_i(wbs_we_i),
2413
    .wbs_cyc_i(wbs_cyc_i),
2414
    .wbs_stb_i(wbs_stb_i),
2415
    .wbs_dat_o(wbs_dat_o),
2416
    .wbs_ack_o(wbs_ack_o),
2417
    .wbs_clk(wbs_clk),
2418
    .wbs_rst(wbs_rst),
2419
    // wishbone master side
2420
    .wbm_dat_o(writedata),
2421 78 unneback
    .wbm_adr_o(address),
2422 75 unneback
    .wbm_sel_o(be),
2423
    .wbm_bte_o(wbm_bte_o),
2424
    .wbm_cti_o(wbm_cti_o),
2425
    .wbm_we_o(wbm_we_o),
2426
    .wbm_cyc_o(wbm_cyc_o),
2427
    .wbm_stb_o(wbm_stb_o),
2428
    .wbm_dat_i(readdata),
2429
    .wbm_ack_i(wbm_ack_i),
2430
    .wbm_clk(clk),
2431
    .wbm_rst(rst));
2432
endmodule
2433 39 unneback
module vl_wb3_arbiter_type1 (
2434
    wbm_dat_o, wbm_adr_o, wbm_sel_o, wbm_cti_o, wbm_bte_o, wbm_we_o, wbm_stb_o, wbm_cyc_o,
2435
    wbm_dat_i, wbm_ack_i, wbm_err_i, wbm_rty_i,
2436
    wbs_dat_i, wbs_adr_i, wbs_sel_i, wbs_cti_i, wbs_bte_i, wbs_we_i, wbs_stb_i, wbs_cyc_i,
2437
    wbs_dat_o, wbs_ack_o, wbs_err_o, wbs_rty_o,
2438
    wb_clk, wb_rst
2439
);
2440
parameter nr_of_ports = 3;
2441
parameter adr_size = 26;
2442
parameter adr_lo   = 2;
2443
parameter dat_size = 32;
2444
parameter sel_size = dat_size/8;
2445
localparam aw = (adr_size - adr_lo) * nr_of_ports;
2446
localparam dw = dat_size * nr_of_ports;
2447
localparam sw = sel_size * nr_of_ports;
2448
localparam cw = 3 * nr_of_ports;
2449
localparam bw = 2 * nr_of_ports;
2450
input  [dw-1:0] wbm_dat_o;
2451
input  [aw-1:0] wbm_adr_o;
2452
input  [sw-1:0] wbm_sel_o;
2453
input  [cw-1:0] wbm_cti_o;
2454
input  [bw-1:0] wbm_bte_o;
2455
input  [nr_of_ports-1:0] wbm_we_o, wbm_stb_o, wbm_cyc_o;
2456
output [dw-1:0] wbm_dat_i;
2457
output [nr_of_ports-1:0] wbm_ack_i, wbm_err_i, wbm_rty_i;
2458
output [dat_size-1:0] wbs_dat_i;
2459
output [adr_size-1:adr_lo] wbs_adr_i;
2460
output [sel_size-1:0] wbs_sel_i;
2461
output [2:0] wbs_cti_i;
2462
output [1:0] wbs_bte_i;
2463
output wbs_we_i, wbs_stb_i, wbs_cyc_i;
2464
input  [dat_size-1:0] wbs_dat_o;
2465
input  wbs_ack_o, wbs_err_o, wbs_rty_o;
2466
input wb_clk, wb_rst;
2467 44 unneback
reg  [nr_of_ports-1:0] select;
2468 39 unneback
wire [nr_of_ports-1:0] state;
2469
wire [nr_of_ports-1:0] eoc; // end-of-cycle
2470
wire [nr_of_ports-1:0] sel;
2471
wire idle;
2472
genvar i;
2473
assign idle = !(|state);
2474
generate
2475
if (nr_of_ports == 2) begin
2476
    wire [2:0] wbm1_cti_o, wbm0_cti_o;
2477
    assign {wbm1_cti_o,wbm0_cti_o} = wbm_cti_o;
2478 44 unneback
    //assign select = (idle) ? {wbm_cyc_o[1],!wbm_cyc_o[1] & wbm_cyc_o[0]} : {nr_of_ports{1'b0}};
2479
    always @ (idle or wbm_cyc_o)
2480
    if (idle)
2481
        casex (wbm_cyc_o)
2482
        2'b1x : select = 2'b10;
2483
        2'b01 : select = 2'b01;
2484
        default : select = {nr_of_ports{1'b0}};
2485
        endcase
2486
    else
2487
        select = {nr_of_ports{1'b0}};
2488 39 unneback
    assign eoc[1] = (wbm_ack_i[1] & (wbm1_cti_o == 3'b000 | wbm1_cti_o == 3'b111)) | !wbm_cyc_o[1];
2489
    assign eoc[0] = (wbm_ack_i[0] & (wbm0_cti_o == 3'b000 | wbm0_cti_o == 3'b111)) | !wbm_cyc_o[0];
2490
end
2491
endgenerate
2492
generate
2493
if (nr_of_ports == 3) begin
2494
    wire [2:0] wbm2_cti_o, wbm1_cti_o, wbm0_cti_o;
2495
    assign {wbm2_cti_o,wbm1_cti_o,wbm0_cti_o} = wbm_cti_o;
2496 44 unneback
    always @ (idle or wbm_cyc_o)
2497
    if (idle)
2498
        casex (wbm_cyc_o)
2499
        3'b1xx : select = 3'b100;
2500
        3'b01x : select = 3'b010;
2501
        3'b001 : select = 3'b001;
2502
        default : select = {nr_of_ports{1'b0}};
2503
        endcase
2504
    else
2505
        select = {nr_of_ports{1'b0}};
2506
//    assign select = (idle) ? {wbm_cyc_o[2],!wbm_cyc_o[2] & wbm_cyc_o[1],wbm_cyc_o[2:1]==2'b00 & wbm_cyc_o[0]} : {nr_of_ports{1'b0}};
2507 39 unneback
    assign eoc[2] = (wbm_ack_i[2] & (wbm2_cti_o == 3'b000 | wbm2_cti_o == 3'b111)) | !wbm_cyc_o[2];
2508
    assign eoc[1] = (wbm_ack_i[1] & (wbm1_cti_o == 3'b000 | wbm1_cti_o == 3'b111)) | !wbm_cyc_o[1];
2509
    assign eoc[0] = (wbm_ack_i[0] & (wbm0_cti_o == 3'b000 | wbm0_cti_o == 3'b111)) | !wbm_cyc_o[0];
2510
end
2511
endgenerate
2512
generate
2513 44 unneback
if (nr_of_ports == 4) begin
2514
    wire [2:0] wbm3_cti_o, wbm2_cti_o, wbm1_cti_o, wbm0_cti_o;
2515
    assign {wbm3_cti_o, wbm2_cti_o,wbm1_cti_o,wbm0_cti_o} = wbm_cti_o;
2516
    //assign select = (idle) ? {wbm_cyc_o[3],!wbm_cyc_o[3] & wbm_cyc_o[2],wbm_cyc_o[3:2]==2'b00 & wbm_cyc_o[1],wbm_cyc_o[3:1]==3'b000 & wbm_cyc_o[0]} : {nr_of_ports{1'b0}};
2517
    always @ (idle or wbm_cyc_o)
2518
    if (idle)
2519
        casex (wbm_cyc_o)
2520
        4'b1xxx : select = 4'b1000;
2521
        4'b01xx : select = 4'b0100;
2522
        4'b001x : select = 4'b0010;
2523
        4'b0001 : select = 4'b0001;
2524
        default : select = {nr_of_ports{1'b0}};
2525
        endcase
2526
    else
2527
        select = {nr_of_ports{1'b0}};
2528
    assign eoc[3] = (wbm_ack_i[3] & (wbm3_cti_o == 3'b000 | wbm3_cti_o == 3'b111)) | !wbm_cyc_o[3];
2529
    assign eoc[2] = (wbm_ack_i[2] & (wbm2_cti_o == 3'b000 | wbm2_cti_o == 3'b111)) | !wbm_cyc_o[2];
2530
    assign eoc[1] = (wbm_ack_i[1] & (wbm1_cti_o == 3'b000 | wbm1_cti_o == 3'b111)) | !wbm_cyc_o[1];
2531
    assign eoc[0] = (wbm_ack_i[0] & (wbm0_cti_o == 3'b000 | wbm0_cti_o == 3'b111)) | !wbm_cyc_o[0];
2532
end
2533
endgenerate
2534
generate
2535
if (nr_of_ports == 5) begin
2536
    wire [2:0] wbm4_cti_o, wbm3_cti_o, wbm2_cti_o, wbm1_cti_o, wbm0_cti_o;
2537
    assign {wbm4_cti_o, wbm3_cti_o, wbm2_cti_o,wbm1_cti_o,wbm0_cti_o} = wbm_cti_o;
2538
    //assign select = (idle) ? {wbm_cyc_o[3],!wbm_cyc_o[3] & wbm_cyc_o[2],wbm_cyc_o[3:2]==2'b00 & wbm_cyc_o[1],wbm_cyc_o[3:1]==3'b000 & wbm_cyc_o[0]} : {nr_of_ports{1'b0}};
2539
    always @ (idle or wbm_cyc_o)
2540
    if (idle)
2541
        casex (wbm_cyc_o)
2542
        5'b1xxxx : select = 5'b10000;
2543
        5'b01xxx : select = 5'b01000;
2544
        5'b001xx : select = 5'b00100;
2545
        5'b0001x : select = 5'b00010;
2546
        5'b00001 : select = 5'b00001;
2547
        default : select = {nr_of_ports{1'b0}};
2548
        endcase
2549
    else
2550
        select = {nr_of_ports{1'b0}};
2551
    assign eoc[4] = (wbm_ack_i[4] & (wbm4_cti_o == 3'b000 | wbm4_cti_o == 3'b111)) | !wbm_cyc_o[4];
2552
    assign eoc[3] = (wbm_ack_i[3] & (wbm3_cti_o == 3'b000 | wbm3_cti_o == 3'b111)) | !wbm_cyc_o[3];
2553
    assign eoc[2] = (wbm_ack_i[2] & (wbm2_cti_o == 3'b000 | wbm2_cti_o == 3'b111)) | !wbm_cyc_o[2];
2554
    assign eoc[1] = (wbm_ack_i[1] & (wbm1_cti_o == 3'b000 | wbm1_cti_o == 3'b111)) | !wbm_cyc_o[1];
2555
    assign eoc[0] = (wbm_ack_i[0] & (wbm0_cti_o == 3'b000 | wbm0_cti_o == 3'b111)) | !wbm_cyc_o[0];
2556
end
2557
endgenerate
2558
generate
2559 67 unneback
if (nr_of_ports == 6) begin
2560
    wire [2:0] wbm5_cti_o, wbm4_cti_o, wbm3_cti_o, wbm2_cti_o, wbm1_cti_o, wbm0_cti_o;
2561
    assign {wbm5_cti_o, wbm4_cti_o, wbm3_cti_o, wbm2_cti_o,wbm1_cti_o,wbm0_cti_o} = wbm_cti_o;
2562
    //assign select = (idle) ? {wbm_cyc_o[3],!wbm_cyc_o[3] & wbm_cyc_o[2],wbm_cyc_o[3:2]==2'b00 & wbm_cyc_o[1],wbm_cyc_o[3:1]==3'b000 & wbm_cyc_o[0]} : {nr_of_ports{1'b0}};
2563
    always @ (idle or wbm_cyc_o)
2564
    if (idle)
2565
        casex (wbm_cyc_o)
2566
        6'b1xxxxx : select = 6'b100000;
2567
        6'b01xxxx : select = 6'b010000;
2568
        6'b001xxx : select = 6'b001000;
2569
        6'b0001xx : select = 6'b000100;
2570
        6'b00001x : select = 6'b000010;
2571
        6'b000001 : select = 6'b000001;
2572
        default : select = {nr_of_ports{1'b0}};
2573
        endcase
2574
    else
2575
        select = {nr_of_ports{1'b0}};
2576
    assign eoc[5] = (wbm_ack_i[5] & (wbm5_cti_o == 3'b000 | wbm5_cti_o == 3'b111)) | !wbm_cyc_o[5];
2577
    assign eoc[4] = (wbm_ack_i[4] & (wbm4_cti_o == 3'b000 | wbm4_cti_o == 3'b111)) | !wbm_cyc_o[4];
2578
    assign eoc[3] = (wbm_ack_i[3] & (wbm3_cti_o == 3'b000 | wbm3_cti_o == 3'b111)) | !wbm_cyc_o[3];
2579
    assign eoc[2] = (wbm_ack_i[2] & (wbm2_cti_o == 3'b000 | wbm2_cti_o == 3'b111)) | !wbm_cyc_o[2];
2580
    assign eoc[1] = (wbm_ack_i[1] & (wbm1_cti_o == 3'b000 | wbm1_cti_o == 3'b111)) | !wbm_cyc_o[1];
2581
    assign eoc[0] = (wbm_ack_i[0] & (wbm0_cti_o == 3'b000 | wbm0_cti_o == 3'b111)) | !wbm_cyc_o[0];
2582
end
2583
endgenerate
2584
generate
2585
if (nr_of_ports == 7) begin
2586
    wire [2:0] wbm6_cti_o, wbm5_cti_o, wbm4_cti_o, wbm3_cti_o, wbm2_cti_o, wbm1_cti_o, wbm0_cti_o;
2587
    assign {wbm6_cti_o, wbm5_cti_o, wbm4_cti_o, wbm3_cti_o, wbm2_cti_o,wbm1_cti_o,wbm0_cti_o} = wbm_cti_o;
2588
    //assign select = (idle) ? {wbm_cyc_o[3],!wbm_cyc_o[3] & wbm_cyc_o[2],wbm_cyc_o[3:2]==2'b00 & wbm_cyc_o[1],wbm_cyc_o[3:1]==3'b000 & wbm_cyc_o[0]} : {nr_of_ports{1'b0}};
2589
    always @ (idle or wbm_cyc_o)
2590
    if (idle)
2591
        casex (wbm_cyc_o)
2592
        7'b1xxxxxx : select = 7'b1000000;
2593
        7'b01xxxxx : select = 7'b0100000;
2594
        7'b001xxxx : select = 7'b0010000;
2595
        7'b0001xxx : select = 7'b0001000;
2596
        7'b00001xx : select = 7'b0000100;
2597
        7'b000001x : select = 7'b0000010;
2598
        7'b0000001 : select = 7'b0000001;
2599
        default : select = {nr_of_ports{1'b0}};
2600
        endcase
2601
    else
2602
        select = {nr_of_ports{1'b0}};
2603
    assign eoc[6] = (wbm_ack_i[6] & (wbm6_cti_o == 3'b000 | wbm6_cti_o == 3'b111)) | !wbm_cyc_o[6];
2604
    assign eoc[5] = (wbm_ack_i[5] & (wbm5_cti_o == 3'b000 | wbm5_cti_o == 3'b111)) | !wbm_cyc_o[5];
2605
    assign eoc[4] = (wbm_ack_i[4] & (wbm4_cti_o == 3'b000 | wbm4_cti_o == 3'b111)) | !wbm_cyc_o[4];
2606
    assign eoc[3] = (wbm_ack_i[3] & (wbm3_cti_o == 3'b000 | wbm3_cti_o == 3'b111)) | !wbm_cyc_o[3];
2607
    assign eoc[2] = (wbm_ack_i[2] & (wbm2_cti_o == 3'b000 | wbm2_cti_o == 3'b111)) | !wbm_cyc_o[2];
2608
    assign eoc[1] = (wbm_ack_i[1] & (wbm1_cti_o == 3'b000 | wbm1_cti_o == 3'b111)) | !wbm_cyc_o[1];
2609
    assign eoc[0] = (wbm_ack_i[0] & (wbm0_cti_o == 3'b000 | wbm0_cti_o == 3'b111)) | !wbm_cyc_o[0];
2610
end
2611
endgenerate
2612
generate
2613
if (nr_of_ports == 8) begin
2614
    wire [2:0] wbm7_cti_o, wbm6_cti_o, wbm5_cti_o, wbm4_cti_o, wbm3_cti_o, wbm2_cti_o, wbm1_cti_o, wbm0_cti_o;
2615
    assign {wbm7_cti_o, wbm6_cti_o, wbm5_cti_o, wbm4_cti_o, wbm3_cti_o, wbm2_cti_o,wbm1_cti_o,wbm0_cti_o} = wbm_cti_o;
2616
    //assign select = (idle) ? {wbm_cyc_o[3],!wbm_cyc_o[3] & wbm_cyc_o[2],wbm_cyc_o[3:2]==2'b00 & wbm_cyc_o[1],wbm_cyc_o[3:1]==3'b000 & wbm_cyc_o[0]} : {nr_of_ports{1'b0}};
2617
    always @ (idle or wbm_cyc_o)
2618
    if (idle)
2619
        casex (wbm_cyc_o)
2620
        8'b1xxxxxxx : select = 8'b10000000;
2621
        8'b01xxxxxx : select = 8'b01000000;
2622
        8'b001xxxxx : select = 8'b00100000;
2623
        8'b0001xxxx : select = 8'b00010000;
2624
        8'b00001xxx : select = 8'b00001000;
2625
        8'b000001xx : select = 8'b00000100;
2626
        8'b0000001x : select = 8'b00000010;
2627
        8'b00000001 : select = 8'b00000001;
2628
        default : select = {nr_of_ports{1'b0}};
2629
        endcase
2630
    else
2631
        select = {nr_of_ports{1'b0}};
2632
    assign eoc[7] = (wbm_ack_i[7] & (wbm7_cti_o == 3'b000 | wbm7_cti_o == 3'b111)) | !wbm_cyc_o[7];
2633
    assign eoc[6] = (wbm_ack_i[6] & (wbm6_cti_o == 3'b000 | wbm6_cti_o == 3'b111)) | !wbm_cyc_o[6];
2634
    assign eoc[5] = (wbm_ack_i[5] & (wbm5_cti_o == 3'b000 | wbm5_cti_o == 3'b111)) | !wbm_cyc_o[5];
2635
    assign eoc[4] = (wbm_ack_i[4] & (wbm4_cti_o == 3'b000 | wbm4_cti_o == 3'b111)) | !wbm_cyc_o[4];
2636
    assign eoc[3] = (wbm_ack_i[3] & (wbm3_cti_o == 3'b000 | wbm3_cti_o == 3'b111)) | !wbm_cyc_o[3];
2637
    assign eoc[2] = (wbm_ack_i[2] & (wbm2_cti_o == 3'b000 | wbm2_cti_o == 3'b111)) | !wbm_cyc_o[2];
2638
    assign eoc[1] = (wbm_ack_i[1] & (wbm1_cti_o == 3'b000 | wbm1_cti_o == 3'b111)) | !wbm_cyc_o[1];
2639
    assign eoc[0] = (wbm_ack_i[0] & (wbm0_cti_o == 3'b000 | wbm0_cti_o == 3'b111)) | !wbm_cyc_o[0];
2640
end
2641
endgenerate
2642
generate
2643 63 unneback
for (i=0;i<nr_of_ports;i=i+1) begin : spr0
2644 39 unneback
    vl_spr sr0( .sp(select[i]), .r(eoc[i]), .q(state[i]), .clk(wb_clk), .rst(wb_rst));
2645
end
2646
endgenerate
2647
    assign sel = select | state;
2648
    vl_mux_andor # ( .nr_of_ports(nr_of_ports), .width(32)) mux0 ( .a(wbm_dat_o), .sel(sel), .dout(wbs_dat_i));
2649
    vl_mux_andor # ( .nr_of_ports(nr_of_ports), .width(adr_size-adr_lo)) mux1 ( .a(wbm_adr_o), .sel(sel), .dout(wbs_adr_i));
2650
    vl_mux_andor # ( .nr_of_ports(nr_of_ports), .width(sel_size)) mux2 ( .a(wbm_sel_o), .sel(sel), .dout(wbs_sel_i));
2651
    vl_mux_andor # ( .nr_of_ports(nr_of_ports), .width(3)) mux3 ( .a(wbm_cti_o), .sel(sel), .dout(wbs_cti_i));
2652
    vl_mux_andor # ( .nr_of_ports(nr_of_ports), .width(2)) mux4 ( .a(wbm_bte_o), .sel(sel), .dout(wbs_bte_i));
2653
    vl_mux_andor # ( .nr_of_ports(nr_of_ports), .width(1)) mux5 ( .a(wbm_we_o), .sel(sel), .dout(wbs_we_i));
2654
    vl_mux_andor # ( .nr_of_ports(nr_of_ports), .width(1)) mux6 ( .a(wbm_stb_o), .sel(sel), .dout(wbs_stb_i));
2655
    assign wbs_cyc_i = |sel;
2656
    assign wbm_dat_i = {nr_of_ports{wbs_dat_o}};
2657
    assign wbm_ack_i = {nr_of_ports{wbs_ack_o}} & sel;
2658
    assign wbm_err_i = {nr_of_ports{wbs_err_o}} & sel;
2659
    assign wbm_rty_i = {nr_of_ports{wbs_rty_o}} & sel;
2660
endmodule
2661 49 unneback
// WB RAM with byte enable
2662 59 unneback
module vl_wb_b3_ram_be (
2663 69 unneback
    wbs_dat_i, wbs_adr_i, wbs_cti_i, wbs_bte_i, wbs_sel_i, wbs_we_i, wbs_stb_i, wbs_cyc_i,
2664
    wbs_dat_o, wbs_ack_o, wb_clk, wb_rst);
2665 68 unneback
parameter adr_size = 16;
2666 85 unneback
parameter mem_size = 1<<adr_size;
2667 60 unneback
parameter dat_size = 32;
2668 83 unneback
parameter max_burst_width = 4;
2669 60 unneback
parameter memory_init = 1;
2670
parameter memory_file = "vl_ram.vmem";
2671 85 unneback
localparam aw = (adr_size);
2672 69 unneback
localparam dw = dat_size;
2673
localparam sw = dat_size/8;
2674
localparam cw = 3;
2675
localparam bw = 2;
2676 70 unneback
input [dw-1:0] wbs_dat_i;
2677
input [aw-1:0] wbs_adr_i;
2678
input [cw-1:0] wbs_cti_i;
2679
input [bw-1:0] wbs_bte_i;
2680
input [sw-1:0] wbs_sel_i;
2681
input wbs_we_i, wbs_stb_i, wbs_cyc_i;
2682
output [dw-1:0] wbs_dat_o;
2683
output wbs_ack_o;
2684 71 unneback
input wb_clk, wb_rst;
2685 83 unneback
wire [aw-1:0] adr;
2686 60 unneback
vl_ram_be # (
2687
    .data_width(dat_size),
2688 83 unneback
    .addr_width(aw),
2689 69 unneback
    .mem_size(mem_size),
2690 68 unneback
    .memory_init(memory_init),
2691
    .memory_file(memory_file))
2692 60 unneback
ram0(
2693
    .d(wbs_dat_i),
2694 83 unneback
    .adr(adr),
2695 60 unneback
    .be(wbs_sel_i),
2696 90 unneback
    .re(wbs_stb_i),
2697 86 unneback
    .we(wbs_we_i & wbs_ack_o),
2698 60 unneback
    .q(wbs_dat_o),
2699
    .clk(wb_clk)
2700
);
2701 83 unneback
vl_wb_adr_inc # ( .adr_width(aw), .max_burst_width(max_burst_width)) adr_inc0 (
2702
    .cyc_i(wbs_cyc_i),
2703
    .stb_i(wbs_stb_i),
2704
    .cti_i(wbs_cti_i),
2705
    .bte_i(wbs_bte_i),
2706
    .adr_i(wbs_adr_i),
2707 85 unneback
    .we_i(wbs_we_i),
2708 83 unneback
    .ack_o(wbs_ack_o),
2709
    .adr_o(adr),
2710
    .clk(wb_clk),
2711
    .rst(wb_rst));
2712 59 unneback
endmodule
2713
// WB RAM with byte enable
2714 49 unneback
module vl_wb_b4_ram_be (
2715
    wb_dat_i, wb_adr_i, wb_sel_i, wb_we_i, wb_stb_i, wb_cyc_i,
2716 52 unneback
    wb_dat_o, wb_stall_o, wb_ack_o, wb_clk, wb_rst);
2717 49 unneback
    parameter dat_width = 32;
2718
    parameter adr_width = 8;
2719
input [dat_width-1:0] wb_dat_i;
2720
input [adr_width-1:0] wb_adr_i;
2721
input [dat_width/8-1:0] wb_sel_i;
2722
input wb_we_i, wb_stb_i, wb_cyc_i;
2723
output [dat_width-1:0] wb_dat_o;
2724 51 unneback
reg [dat_width-1:0] wb_dat_o;
2725 52 unneback
output wb_stall_o;
2726 49 unneback
output wb_ack_o;
2727
reg wb_ack_o;
2728
input wb_clk, wb_rst;
2729 56 unneback
wire [dat_width/8-1:0] cke;
2730 49 unneback
generate
2731
if (dat_width==32) begin
2732 51 unneback
reg [7:0] ram3 [1<<(adr_width-2)-1:0];
2733
reg [7:0] ram2 [1<<(adr_width-2)-1:0];
2734
reg [7:0] ram1 [1<<(adr_width-2)-1:0];
2735
reg [7:0] ram0 [1<<(adr_width-2)-1:0];
2736 56 unneback
assign cke = wb_sel_i & {(dat_width/8){wb_we_i}};
2737 49 unneback
    always @ (posedge wb_clk)
2738
    begin
2739 56 unneback
        if (cke[3]) ram3[wb_adr_i[adr_width-1:2]] <= wb_dat_i[31:24];
2740
        if (cke[2]) ram2[wb_adr_i[adr_width-1:2]] <= wb_dat_i[23:16];
2741
        if (cke[1]) ram1[wb_adr_i[adr_width-1:2]] <= wb_dat_i[15:8];
2742
        if (cke[0]) ram0[wb_adr_i[adr_width-1:2]] <= wb_dat_i[7:0];
2743 49 unneback
    end
2744 59 unneback
    always @ (posedge wb_clk or posedge wb_rst)
2745
    begin
2746
        if (wb_rst)
2747
            wb_dat_o <= 32'h0;
2748
        else
2749
            wb_dat_o <= {ram3[wb_adr_i[adr_width-1:2]],ram2[wb_adr_i[adr_width-1:2]],ram1[wb_adr_i[adr_width-1:2]],ram0[wb_adr_i[adr_width-1:2]]};
2750
    end
2751 49 unneback
end
2752
endgenerate
2753 52 unneback
always @ (posedge wb_clk or posedge wb_rst)
2754 55 unneback
if (wb_rst)
2755 52 unneback
    wb_ack_o <= 1'b0;
2756
else
2757 54 unneback
    wb_ack_o <= wb_stb_i & wb_cyc_i;
2758 52 unneback
assign wb_stall_o = 1'b0;
2759 49 unneback
endmodule
2760 17 unneback
// WB ROM
2761 48 unneback
module vl_wb_b4_rom (
2762
    wb_adr_i, wb_stb_i, wb_cyc_i,
2763
    wb_dat_o, stall_o, wb_ack_o, wb_clk, wb_rst);
2764
    parameter dat_width = 32;
2765
    parameter dat_default = 32'h15000000;
2766
    parameter adr_width = 32;
2767
/*
2768
`ifndef ROM
2769
`define ROM "rom.v"
2770
`endif
2771
*/
2772
    input [adr_width-1:2]   wb_adr_i;
2773
    input                   wb_stb_i;
2774
    input                   wb_cyc_i;
2775
    output [dat_width-1:0]  wb_dat_o;
2776
    reg [dat_width-1:0]     wb_dat_o;
2777
    output                  wb_ack_o;
2778
    reg                     wb_ack_o;
2779
    output                  stall_o;
2780
    input                   wb_clk;
2781
    input                   wb_rst;
2782
always @ (posedge wb_clk or posedge wb_rst)
2783
    if (wb_rst)
2784
        wb_dat_o <= {dat_width{1'b0}};
2785
    else
2786
         case (wb_adr_i[adr_width-1:2])
2787
`ifdef ROM
2788
`include `ROM
2789
`endif
2790
           default:
2791
             wb_dat_o <= dat_default;
2792
         endcase // case (wb_adr_i)
2793
always @ (posedge wb_clk or posedge wb_rst)
2794
    if (wb_rst)
2795
        wb_ack_o <= 1'b0;
2796
    else
2797
        wb_ack_o <= wb_stb_i & wb_cyc_i;
2798
assign stall_o = 1'b0;
2799
endmodule
2800
// WB ROM
2801 18 unneback
module vl_wb_boot_rom (
2802 17 unneback
    wb_adr_i, wb_stb_i, wb_cyc_i,
2803 18 unneback
    wb_dat_o, wb_ack_o, hit_o, wb_clk, wb_rst);
2804
    parameter adr_hi = 31;
2805
    parameter adr_lo = 28;
2806
    parameter adr_sel = 4'hf;
2807
    parameter addr_width = 5;
2808 33 unneback
/*
2809
`ifndef BOOT_ROM
2810
`define BOOT_ROM "boot_rom.v"
2811
`endif
2812
*/
2813 18 unneback
    input [adr_hi:2]    wb_adr_i;
2814
    input               wb_stb_i;
2815
    input               wb_cyc_i;
2816
    output [31:0]        wb_dat_o;
2817
    output              wb_ack_o;
2818
    output              hit_o;
2819
    input               wb_clk;
2820
    input               wb_rst;
2821
    wire hit;
2822
    reg [31:0] wb_dat;
2823
    reg wb_ack;
2824
assign hit = wb_adr_i[adr_hi:adr_lo] == adr_sel;
2825 17 unneback
always @ (posedge wb_clk or posedge wb_rst)
2826
    if (wb_rst)
2827 18 unneback
        wb_dat <= 32'h15000000;
2828 17 unneback
    else
2829 18 unneback
         case (wb_adr_i[addr_width-1:2])
2830 33 unneback
`ifdef BOOT_ROM
2831
`include `BOOT_ROM
2832
`endif
2833 17 unneback
           /*
2834
            // Zero r0 and jump to 0x00000100
2835 18 unneback
 
2836
            1 : wb_dat <= 32'hA8200000;
2837
            2 : wb_dat <= 32'hA8C00100;
2838
            3 : wb_dat <= 32'h44003000;
2839
            4 : wb_dat <= 32'h15000000;
2840 17 unneback
            */
2841
           default:
2842 18 unneback
             wb_dat <= 32'h00000000;
2843 17 unneback
         endcase // case (wb_adr_i)
2844
always @ (posedge wb_clk or posedge wb_rst)
2845
    if (wb_rst)
2846 18 unneback
        wb_ack <= 1'b0;
2847 17 unneback
    else
2848 18 unneback
        wb_ack <= wb_stb_i & wb_cyc_i & hit & !wb_ack;
2849
assign hit_o = hit;
2850
assign wb_dat_o = wb_dat & {32{wb_ack}};
2851
assign wb_ack_o = wb_ack;
2852 17 unneback
endmodule
2853 32 unneback
module vl_wb_dpram (
2854
        // wishbone slave side a
2855
        wbsa_dat_i, wbsa_adr_i, wbsa_we_i, wbsa_cyc_i, wbsa_stb_i, wbsa_dat_o, wbsa_ack_o,
2856
        wbsa_clk, wbsa_rst,
2857
        // wishbone slave side a
2858
        wbsb_dat_i, wbsb_adr_i, wbsb_we_i, wbsb_cyc_i, wbsb_stb_i, wbsb_dat_o, wbsb_ack_o,
2859
        wbsb_clk, wbsb_rst);
2860
parameter data_width = 32;
2861
parameter addr_width = 8;
2862
parameter dat_o_mask_a = 1;
2863
parameter dat_o_mask_b = 1;
2864
input [31:0] wbsa_dat_i;
2865
input [addr_width-1:2] wbsa_adr_i;
2866
input wbsa_we_i, wbsa_cyc_i, wbsa_stb_i;
2867
output [31:0] wbsa_dat_o;
2868
output wbsa_ack_o;
2869
input wbsa_clk, wbsa_rst;
2870
input [31:0] wbsb_dat_i;
2871
input [addr_width-1:2] wbsb_adr_i;
2872
input wbsb_we_i, wbsb_cyc_i, wbsb_stb_i;
2873
output [31:0] wbsb_dat_o;
2874
output wbsb_ack_o;
2875
input wbsb_clk, wbsb_rst;
2876
wire wbsa_dat_tmp, wbsb_dat_tmp;
2877
vl_dpram_2r2w # (
2878 33 unneback
    .data_width(data_width), .addr_width(addr_width) )
2879 32 unneback
dpram0(
2880
    .d_a(wbsa_dat_i),
2881
    .q_a(wbsa_dat_tmp),
2882
    .adr_a(wbsa_adr_i),
2883
    .we_a(wbsa_we_i),
2884
    .clk_a(wbsa_clk),
2885
    .d_b(wbsb_dat_i),
2886
    .q_b(wbsb_dat_tmp),
2887
    .adr_b(wbsb_adr_i),
2888
    .we_b(wbsb_we_i),
2889
    .clk_b(wbsb_clk) );
2890 33 unneback
generate if (dat_o_mask_a==1)
2891 32 unneback
    assign wbsa_dat_o = wbsa_dat_tmp & {data_width{wbsa_ack_o}};
2892
endgenerate
2893 33 unneback
generate if (dat_o_mask_a==0)
2894 32 unneback
    assign wbsa_dat_o = wbsa_dat_tmp;
2895
endgenerate
2896 33 unneback
generate if (dat_o_mask_b==1)
2897 32 unneback
    assign wbsb_dat_o = wbsb_dat_tmp & {data_width{wbsb_ack_o}};
2898
endgenerate
2899 33 unneback
generate if (dat_o_mask_b==0)
2900 32 unneback
    assign wbsb_dat_o = wbsb_dat_tmp;
2901
endgenerate
2902
vl_spr ack_a( .sp(wbsa_cyc_i & wbsa_stb_i & !wbsa_ack_o), .r(1'b1), .q(wbsa_ack_o), .clk(wbsa_clk), .rst(wbsa_rst));
2903
vl_spr ack_b( .sp(wbsb_cyc_i & wbsb_stb_i & !wbsb_ack_o), .r(1'b1), .q(wbsb_ack_o), .clk(wbsb_clk), .rst(wbsb_rst));
2904
endmodule
2905 18 unneback
//////////////////////////////////////////////////////////////////////
2906
////                                                              ////
2907
////  Arithmetic functions                                        ////
2908
////                                                              ////
2909
////  Description                                                 ////
2910
////  Arithmetic functions for ALU and DSP                        ////
2911
////                                                              ////
2912
////                                                              ////
2913
////  To Do:                                                      ////
2914
////   -                                                          ////
2915
////                                                              ////
2916
////  Author(s):                                                  ////
2917
////      - Michael Unneback, unneback@opencores.org              ////
2918
////        ORSoC AB                                              ////
2919
////                                                              ////
2920
//////////////////////////////////////////////////////////////////////
2921
////                                                              ////
2922
//// Copyright (C) 2010 Authors and OPENCORES.ORG                 ////
2923
////                                                              ////
2924
//// This source file may be used and distributed without         ////
2925
//// restriction provided that this copyright statement is not    ////
2926
//// removed from the file and that any derivative work contains  ////
2927
//// the original copyright notice and the associated disclaimer. ////
2928
////                                                              ////
2929
//// This source file is free software; you can redistribute it   ////
2930
//// and/or modify it under the terms of the GNU Lesser General   ////
2931
//// Public License as published by the Free Software Foundation; ////
2932
//// either version 2.1 of the License, or (at your option) any   ////
2933
//// later version.                                               ////
2934
////                                                              ////
2935
//// This source is distributed in the hope that it will be       ////
2936
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
2937
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
2938
//// PURPOSE.  See the GNU Lesser General Public License for more ////
2939
//// details.                                                     ////
2940
////                                                              ////
2941
//// You should have received a copy of the GNU Lesser General    ////
2942
//// Public License along with this source; if not, download it   ////
2943
//// from http://www.opencores.org/lgpl.shtml                     ////
2944
////                                                              ////
2945
//////////////////////////////////////////////////////////////////////
2946
// signed multiplication
2947
module vl_mults (a,b,p);
2948
parameter operand_a_width = 18;
2949
parameter operand_b_width = 18;
2950
parameter result_hi = 35;
2951
parameter result_lo = 0;
2952
input [operand_a_width-1:0] a;
2953
input [operand_b_width-1:0] b;
2954
output [result_hi:result_lo] p;
2955
wire signed [operand_a_width-1:0] ai;
2956
wire signed [operand_b_width-1:0] bi;
2957
wire signed [operand_a_width+operand_b_width-1:0] result;
2958
    assign ai = a;
2959
    assign bi = b;
2960
    assign result = ai * bi;
2961
    assign p = result[result_hi:result_lo];
2962
endmodule
2963
module vl_mults18x18 (a,b,p);
2964
input [17:0] a,b;
2965
output [35:0] p;
2966
vl_mult
2967
    # (.operand_a_width(18), .operand_b_width(18))
2968
    mult0 (.a(a), .b(b), .p(p));
2969
endmodule
2970
// unsigned multiplication
2971
module vl_mult (a,b,p);
2972
parameter operand_a_width = 18;
2973
parameter operand_b_width = 18;
2974
parameter result_hi = 35;
2975
parameter result_lo = 0;
2976
input [operand_a_width-1:0] a;
2977
input [operand_b_width-1:0] b;
2978
output [result_hi:result_hi] p;
2979
wire [operand_a_width+operand_b_width-1:0] result;
2980
    assign result = a * b;
2981
    assign p = result[result_hi:result_lo];
2982
endmodule
2983
// shift unit
2984
// supporting the following shift functions
2985
//   SLL
2986
//   SRL
2987
//   SRA
2988
module vl_shift_unit_32( din, s, dout, opcode);
2989
input [31:0] din; // data in operand
2990
input [4:0] s; // shift operand
2991
input [1:0] opcode;
2992
output [31:0] dout;
2993
parameter opcode_sll = 2'b00;
2994
//parameter opcode_srl = 2'b01;
2995
parameter opcode_sra = 2'b10;
2996
//parameter opcode_ror = 2'b11;
2997
wire sll, sra;
2998
assign sll = opcode == opcode_sll;
2999
assign sra = opcode == opcode_sra;
3000
wire [15:1] s1;
3001
wire [3:0] sign;
3002
wire [7:0] tmp [0:3];
3003
// first stage is multiplier based
3004
// shift operand as fractional 8.7
3005
assign s1[15] = sll & s[2:0]==3'd7;
3006
assign s1[14] = sll & s[2:0]==3'd6;
3007
assign s1[13] = sll & s[2:0]==3'd5;
3008
assign s1[12] = sll & s[2:0]==3'd4;
3009
assign s1[11] = sll & s[2:0]==3'd3;
3010
assign s1[10] = sll & s[2:0]==3'd2;
3011
assign s1[ 9] = sll & s[2:0]==3'd1;
3012
assign s1[ 8] = s[2:0]==3'd0;
3013
assign s1[ 7] = !sll & s[2:0]==3'd1;
3014
assign s1[ 6] = !sll & s[2:0]==3'd2;
3015
assign s1[ 5] = !sll & s[2:0]==3'd3;
3016
assign s1[ 4] = !sll & s[2:0]==3'd4;
3017
assign s1[ 3] = !sll & s[2:0]==3'd5;
3018
assign s1[ 2] = !sll & s[2:0]==3'd6;
3019
assign s1[ 1] = !sll & s[2:0]==3'd7;
3020
assign sign[3] = din[31] & sra;
3021
assign sign[2] = sign[3] & (&din[31:24]);
3022
assign sign[1] = sign[2] & (&din[23:16]);
3023
assign sign[0] = sign[1] & (&din[15:8]);
3024
vl_mults # ( .operand_a_width(25), .operand_b_width(16), .result_hi(14), .result_lo(7)) mult_byte3 ( .a({sign[3], {8{sign[3]}},din[31:24], din[23:16]}), .b({1'b0,s1}), .p(tmp[3]));
3025
vl_mults # ( .operand_a_width(25), .operand_b_width(16), .result_hi(14), .result_lo(7)) mult_byte2 ( .a({sign[2], din[31:24]  ,din[23:16],  din[15:8]}), .b({1'b0,s1}), .p(tmp[2]));
3026
vl_mults # ( .operand_a_width(25), .operand_b_width(16), .result_hi(14), .result_lo(7)) mult_byte1 ( .a({sign[1], din[23:16]  ,din[15:8],   din[7:0]}), .b({1'b0,s1}), .p(tmp[1]));
3027
vl_mults # ( .operand_a_width(25), .operand_b_width(16), .result_hi(14), .result_lo(7)) mult_byte0 ( .a({sign[0], din[15:8]   ,din[7:0],    8'h00}),      .b({1'b0,s1}), .p(tmp[0]));
3028
// second stage is multiplexer based
3029
// shift on byte level
3030
// mux byte 3
3031
assign dout[31:24] = (s[4:3]==2'b00) ? tmp[3] :
3032
                     (sll & s[4:3]==2'b01) ? tmp[2] :
3033
                     (sll & s[4:3]==2'b10) ? tmp[1] :
3034
                     (sll & s[4:3]==2'b11) ? tmp[0] :
3035
                     {8{sign[3]}};
3036
// mux byte 2
3037
assign dout[23:16] = (s[4:3]==2'b00) ? tmp[2] :
3038
                     (sll & s[4:3]==2'b01) ? tmp[1] :
3039
                     (sll & s[4:3]==2'b10) ? tmp[0] :
3040
                     (sll & s[4:3]==2'b11) ? {8{1'b0}} :
3041
                     (s[4:3]==2'b01) ? tmp[3] :
3042
                     {8{sign[3]}};
3043
// mux byte 1
3044
assign dout[15:8]  = (s[4:3]==2'b00) ? tmp[1] :
3045
                     (sll & s[4:3]==2'b01) ? tmp[0] :
3046
                     (sll & s[4:3]==2'b10) ? {8{1'b0}} :
3047
                     (sll & s[4:3]==2'b11) ? {8{1'b0}} :
3048
                     (s[4:3]==2'b01) ? tmp[2] :
3049
                     (s[4:3]==2'b10) ? tmp[3] :
3050
                     {8{sign[3]}};
3051
// mux byte 0
3052
assign dout[7:0]   = (s[4:3]==2'b00) ? tmp[0] :
3053
                     (sll) ?  {8{1'b0}}:
3054
                     (s[4:3]==2'b01) ? tmp[1] :
3055
                     (s[4:3]==2'b10) ? tmp[2] :
3056
                     tmp[3];
3057
endmodule
3058
// logic unit
3059
// supporting the following logic functions
3060
//    a and b
3061
//    a or  b
3062
//    a xor b
3063
//    not b
3064
module vl_logic_unit( a, b, result, opcode);
3065
parameter width = 32;
3066
parameter opcode_and = 2'b00;
3067
parameter opcode_or  = 2'b01;
3068
parameter opcode_xor = 2'b10;
3069
input [width-1:0] a,b;
3070
output [width-1:0] result;
3071
input [1:0] opcode;
3072
assign result = (opcode==opcode_and) ? a & b :
3073
                (opcode==opcode_or)  ? a | b :
3074
                (opcode==opcode_xor) ? a ^ b :
3075
                b;
3076
endmodule

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.