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

Subversion Repositories openrisc

[/] [openrisc/] [trunk/] [orpsocv2/] [rtl/] [verilog/] [dbg_if/] [dbg_cpu.v] - Blame information for rev 363

Details | Compare with Previous | View Log

Line No. Rev Author Line
1 6 julius
//////////////////////////////////////////////////////////////////////
2
////                                                              ////
3
////  dbg_cpu.v                                                   ////
4
////                                                              ////
5
////                                                              ////
6
////  This file is part of the SoC Debug Interface.               ////
7
////  http://www.opencores.org/projects/DebugInterface/           ////
8
////                                                              ////
9
////  Author(s):                                                  ////
10
////       Igor Mohor (igorm@opencores.org)                       ////
11
////                                                              ////
12
////                                                              ////
13
////  All additional information is avaliable in the README.txt   ////
14
////  file.                                                       ////
15
////                                                              ////
16
//////////////////////////////////////////////////////////////////////
17
////                                                              ////
18
//// Copyright (C) 2000 - 2004 Authors                            ////
19
////                                                              ////
20
//// This source file may be used and distributed without         ////
21
//// restriction provided that this copyright statement is not    ////
22
//// removed from the file and that any derivative work contains  ////
23
//// the original copyright notice and the associated disclaimer. ////
24
////                                                              ////
25
//// This source file is free software; you can redistribute it   ////
26
//// and/or modify it under the terms of the GNU Lesser General   ////
27
//// Public License as published by the Free Software Foundation; ////
28
//// either version 2.1 of the License, or (at your option) any   ////
29
//// later version.                                               ////
30
////                                                              ////
31
//// This source is distributed in the hope that it will be       ////
32
//// useful, but WITHOUT ANY WARRANTY; without even the implied   ////
33
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      ////
34
//// PURPOSE.  See the GNU Lesser General Public License for more ////
35
//// details.                                                     ////
36
////                                                              ////
37
//// You should have received a copy of the GNU Lesser General    ////
38
//// Public License along with this source; if not, download it   ////
39
//// from http://www.opencores.org/lgpl.shtml                     ////
40
////                                                              ////
41
//////////////////////////////////////////////////////////////////////
42 363 julius
 
43 6 julius
// synopsys translate_off
44
`include "timescale.v"
45
// synopsys translate_on
46
`include "dbg_cpu_defines.v"
47
 
48
// Top module
49
module dbg_cpu(
50
                // JTAG signals
51
                tck_i,
52
                tdi_i,
53
                tdo_o,
54
 
55
                // TAP states
56
                shift_dr_i,
57
                pause_dr_i,
58
                update_dr_i,
59
 
60
                cpu_ce_i,
61
                crc_match_i,
62
                crc_en_o,
63
                shift_crc_o,
64
                rst_i,
65
 
66
                // CPU
67
                cpu_clk_i,
68
                cpu_addr_o, cpu_data_i, cpu_data_o, cpu_bp_i, cpu_stall_o,
69
                cpu_stb_o,
70
                cpu_we_o, cpu_ack_i, cpu_rst_o
71
 
72
              );
73
 
74
// JTAG signals
75
input         tck_i;
76
input         tdi_i;
77
output        tdo_o;
78
 
79
// TAP states
80
input         shift_dr_i;
81
input         pause_dr_i;
82
input         update_dr_i;
83
 
84
input         cpu_ce_i;
85
input         crc_match_i;
86
output        crc_en_o;
87
output        shift_crc_o;
88
input         rst_i;
89
 
90
// CPU
91
input         cpu_clk_i;
92
output [31:0] cpu_addr_o;
93
output [31:0] cpu_data_o;
94
input         cpu_bp_i;
95
output        cpu_stall_o;
96
input  [31:0] cpu_data_i;
97
output        cpu_stb_o;
98
output        cpu_we_o;
99
input         cpu_ack_i;
100
output        cpu_rst_o;
101
 
102
reg           cpu_stb_o;
103
wire          cpu_reg_stall;
104
reg           tdo_o;
105
reg           cpu_ack_q;
106
reg           cpu_ack_csff;
107
reg           cpu_ack_tck;
108
 
109
reg    [31:0] cpu_dat_tmp, cpu_data_dsff;
110
reg    [31:0] cpu_addr_dsff;
111
reg           cpu_we_dsff;
112
reg    [`DBG_CPU_DR_LEN -1 :0] dr;
113
wire          enable;
114
wire          cmd_cnt_en;
115
reg     [`DBG_CPU_CMD_CNT_WIDTH -1:0] cmd_cnt;
116
wire          cmd_cnt_end;
117
reg           cmd_cnt_end_q;
118
reg           addr_len_cnt_en;
119
reg     [5:0] addr_len_cnt;
120
wire          addr_len_cnt_end;
121
reg           addr_len_cnt_end_q;
122
reg           crc_cnt_en;
123
reg     [`DBG_CPU_CRC_CNT_WIDTH -1:0] crc_cnt;
124
wire          crc_cnt_end;
125
reg           crc_cnt_end_q;
126
reg           data_cnt_en;
127
reg    [`DBG_CPU_DATA_CNT_WIDTH:0] data_cnt;
128
reg    [`DBG_CPU_DATA_CNT_LIM_WIDTH:0] data_cnt_limit;
129
wire          data_cnt_end;
130
reg           data_cnt_end_q;
131
reg           crc_match_reg;
132
 
133
reg    [`DBG_CPU_ACC_TYPE_LEN -1:0] acc_type;
134
reg    [`DBG_CPU_ADR_LEN -1:0] adr;
135
reg    [`DBG_CPU_LEN_LEN -1:0] len;
136
reg    [`DBG_CPU_LEN_LEN:0]    len_var;
137
wire   [`DBG_CPU_CTRL_LEN -1:0]ctrl_reg;
138
reg           start_rd_tck;
139
reg           rd_tck_started;
140
reg           start_rd_csff;
141
reg           start_cpu_rd;
142
reg           start_cpu_rd_q;
143
reg           start_wr_tck;
144
reg           start_wr_csff;
145
reg           start_cpu_wr;
146
reg           start_cpu_wr_q;
147
 
148
reg           status_cnt_en;
149
wire          status_cnt_end;
150
 
151
wire          half, long;
152
reg           half_q, long_q;
153
 
154
reg [`DBG_CPU_STATUS_CNT_WIDTH -1:0] status_cnt;
155
 
156
reg [`DBG_CPU_STATUS_LEN -1:0] status;
157
 
158
reg           cpu_overrun, cpu_overrun_csff, cpu_overrun_tck;
159
reg           underrun_tck;
160
 
161
reg           busy_cpu;
162
reg           busy_tck;
163
reg           cpu_end;
164
reg           cpu_end_rst;
165
reg           cpu_end_rst_csff;
166
reg           cpu_end_csff;
167
reg           cpu_end_tck, cpu_end_tck_q;
168
reg           busy_csff;
169
reg           latch_data;
170
reg           update_dr_csff, update_dr_cpu;
171
wire [`DBG_CPU_CTRL_LEN -1:0] cpu_reg_data_i;
172
wire                          cpu_reg_we;
173
 
174
reg           set_addr, set_addr_csff, set_addr_cpu, set_addr_cpu_q;
175
wire   [31:0] input_data;
176
 
177
wire          len_eq_0;
178
wire          crc_cnt_31;
179
 
180
reg           fifo_full;
181
reg     [7:0] mem [0:3];
182
reg           cpu_ce_csff;
183
reg           mem_ptr_init;
184
reg [`DBG_CPU_CMD_LEN -1: 0] curr_cmd;
185
wire          curr_cmd_go;
186
reg           curr_cmd_go_q;
187
wire          curr_cmd_wr_comm;
188
wire          curr_cmd_wr_ctrl;
189
wire          curr_cmd_rd_comm;
190
wire          curr_cmd_rd_ctrl;
191
wire          acc_type_read;
192
wire          acc_type_write;
193
 
194
 
195
assign enable = cpu_ce_i & shift_dr_i;
196
assign crc_en_o = enable & crc_cnt_end & (~status_cnt_end);
197
assign shift_crc_o = enable & status_cnt_end;  // Signals dbg module to shift out the CRC
198
 
199
assign curr_cmd_go      = (curr_cmd == `DBG_CPU_GO) && cmd_cnt_end;
200
assign curr_cmd_wr_comm = (curr_cmd == `DBG_CPU_WR_COMM) && cmd_cnt_end;
201
assign curr_cmd_wr_ctrl = (curr_cmd == `DBG_CPU_WR_CTRL) && cmd_cnt_end;
202
assign curr_cmd_rd_comm = (curr_cmd == `DBG_CPU_RD_COMM) && cmd_cnt_end;
203
assign curr_cmd_rd_ctrl = (curr_cmd == `DBG_CPU_RD_CTRL) && cmd_cnt_end;
204
 
205
assign acc_type_read    = (acc_type == `DBG_CPU_READ);
206
assign acc_type_write   = (acc_type == `DBG_CPU_WRITE);
207
 
208
 
209
 
210
// Shift register for shifting in and out the data
211
always @ (posedge tck_i or posedge rst_i)
212
begin
213
  if (rst_i)
214
    begin
215 360 julius
      latch_data <=  1'b0;
216
      dr <=  {`DBG_CPU_DR_LEN{1'b0}};
217 6 julius
    end
218
  else if (curr_cmd_rd_comm && crc_cnt_31)  // Latching data (from internal regs)
219
    begin
220 360 julius
      dr[`DBG_CPU_DR_LEN -1:0] <=  {acc_type, adr, len};
221 6 julius
    end
222
  else if (curr_cmd_rd_ctrl && crc_cnt_31)  // Latching data (from control regs)
223
    begin
224 360 julius
      dr[`DBG_CPU_DR_LEN -1:0] <=  {ctrl_reg, {`DBG_CPU_DR_LEN -`DBG_CPU_CTRL_LEN{1'b0}}};
225 6 julius
    end
226
  else if (acc_type_read && curr_cmd_go && crc_cnt_31)  // Latchind first data (from WB)
227
    begin
228 360 julius
      dr[31:0] <=  input_data[31:0];
229
      latch_data <=  1'b1;
230 6 julius
    end
231
  else if (acc_type_read && curr_cmd_go && crc_cnt_end) // Latching data (from WB)
232
    begin
233
      case (acc_type)  // synthesis parallel_case full_case
234
        `DBG_CPU_READ: begin
235
                      if(long & (~long_q))
236
                        begin
237 360 julius
                          dr[31:0] <=  input_data[31:0];
238
                          latch_data <=  1'b1;
239 6 julius
                        end
240 63 julius
                      else if (enable)
241 6 julius
                        begin
242 360 julius
                          dr[31:0] <=  {dr[30:0], 1'b0};
243
                          latch_data <=  1'b0;
244 6 julius
                        end
245 363 julius
        end
246
        default: begin
247
 
248
        end
249 6 julius
      endcase
250
    end
251
  else if (enable && (!addr_len_cnt_end))
252
    begin
253 360 julius
      dr <=  {dr[`DBG_CPU_DR_LEN -2:0], tdi_i};
254 6 julius
    end
255
end
256
 
257
 
258
 
259
assign cmd_cnt_en = enable & (~cmd_cnt_end);
260
 
261
 
262
// Command counter
263
always @ (posedge tck_i or posedge rst_i)
264
begin
265
  if (rst_i)
266 360 julius
    cmd_cnt <=  {`DBG_CPU_CMD_CNT_WIDTH{1'b0}};
267 6 julius
  else if (update_dr_i)
268 360 julius
    cmd_cnt <=  {`DBG_CPU_CMD_CNT_WIDTH{1'b0}};
269 6 julius
  else if (cmd_cnt_en)
270 363 julius
    cmd_cnt <=  cmd_cnt + 1;
271 6 julius
end
272
 
273
 
274
// Assigning current command
275
always @ (posedge tck_i or posedge rst_i)
276
begin
277
  if (rst_i)
278 360 julius
    curr_cmd <=  {`DBG_CPU_CMD_LEN{1'b0}};
279 6 julius
  else if (update_dr_i)
280 360 julius
    curr_cmd <=  {`DBG_CPU_CMD_LEN{1'b0}};
281 6 julius
  else if (cmd_cnt == (`DBG_CPU_CMD_LEN -1))
282 360 julius
    curr_cmd <=  {dr[`DBG_CPU_CMD_LEN-2 :0], tdi_i};
283 6 julius
end
284
 
285
 
286
// Assigning current command
287
always @ (posedge tck_i or posedge rst_i)
288
begin
289
  if (rst_i)
290 360 julius
    curr_cmd_go_q <=  1'b0;
291 6 julius
  else
292 360 julius
    curr_cmd_go_q <=  curr_cmd_go;
293 6 julius
end
294
 
295
 
296
always @ (enable or cmd_cnt_end or addr_len_cnt_end or curr_cmd_wr_comm or curr_cmd_wr_ctrl or curr_cmd_rd_comm or curr_cmd_rd_ctrl or crc_cnt_end)
297
begin
298
  if (enable && (!addr_len_cnt_end))
299
    begin
300
      if (cmd_cnt_end && (curr_cmd_wr_comm || curr_cmd_wr_ctrl))
301
        addr_len_cnt_en = 1'b1;
302
      else if (crc_cnt_end && (curr_cmd_rd_comm || curr_cmd_rd_ctrl))
303
        addr_len_cnt_en = 1'b1;
304
      else
305
        addr_len_cnt_en = 1'b0;
306
    end
307
  else
308
    addr_len_cnt_en = 1'b0;
309
end
310
 
311
 
312
// Address/length counter
313
always @ (posedge tck_i or posedge rst_i)
314
begin
315
  if (rst_i)
316 360 julius
    addr_len_cnt <=  6'h0;
317 6 julius
  else if (update_dr_i)
318 360 julius
    addr_len_cnt <=  6'h0;
319 6 julius
  else if (addr_len_cnt_en)
320 363 julius
    addr_len_cnt <=  addr_len_cnt + 1;
321 6 julius
end
322
 
323
 
324
always @ (enable or data_cnt_end or cmd_cnt_end or curr_cmd_go or acc_type_write or acc_type_read or crc_cnt_end)
325
begin
326
  if (enable && (!data_cnt_end))
327
    begin
328
      if (cmd_cnt_end && curr_cmd_go && acc_type_write)
329
        data_cnt_en = 1'b1;
330
      else if (crc_cnt_end && curr_cmd_go && acc_type_read)
331
        data_cnt_en = 1'b1;
332
      else
333
        data_cnt_en = 1'b0;
334
    end
335
  else
336
    data_cnt_en = 1'b0;
337
end
338
 
339
 
340
// Data counter
341
always @ (posedge tck_i or posedge rst_i)
342
begin
343
  if (rst_i)
344 363 julius
    data_cnt <=  {`DBG_CPU_DATA_CNT_WIDTH+1{1'b0}};
345 6 julius
  else if (update_dr_i)
346 363 julius
    data_cnt <=  {`DBG_CPU_DATA_CNT_WIDTH+1{1'b0}};
347 6 julius
  else if (data_cnt_en)
348 363 julius
    data_cnt <=  data_cnt + 1;
349 6 julius
end
350
 
351
 
352
 
353
// Upper limit. Data counter counts until this value is reached.
354
always @ (posedge tck_i or posedge rst_i)
355
begin
356
  if (rst_i)
357 363 julius
    data_cnt_limit <=  {`DBG_CPU_DATA_CNT_LIM_WIDTH+1{1'b0}};
358 6 julius
  else if (update_dr_i)
359 363 julius
    data_cnt_limit <=  len + 1;
360 6 julius
end
361
 
362
 
363
always @ (enable or crc_cnt_end or curr_cmd_rd_comm or curr_cmd_rd_ctrl or curr_cmd_wr_comm or curr_cmd_wr_ctrl or curr_cmd_go or addr_len_cnt_end or data_cnt_end or acc_type_write or acc_type_read or cmd_cnt_end)
364
begin
365
  if (enable && (!crc_cnt_end) && cmd_cnt_end)
366
    begin
367
      if (addr_len_cnt_end && (curr_cmd_wr_comm || curr_cmd_wr_ctrl))
368
        crc_cnt_en = 1'b1;
369
      else if (data_cnt_end && curr_cmd_go && acc_type_write)
370
        crc_cnt_en = 1'b1;
371
      else if (cmd_cnt_end && (curr_cmd_go && acc_type_read || curr_cmd_rd_comm || curr_cmd_rd_ctrl))
372
        crc_cnt_en = 1'b1;
373
      else
374
        crc_cnt_en = 1'b0;
375
    end
376
  else
377
    crc_cnt_en = 1'b0;
378
end
379
 
380
 
381
// crc counter
382
always @ (posedge tck_i or posedge rst_i)
383
begin
384
  if (rst_i)
385 360 julius
    crc_cnt <=  {`DBG_CPU_CRC_CNT_WIDTH{1'b0}};
386 6 julius
  else if(crc_cnt_en)
387 363 julius
    crc_cnt <=  crc_cnt + 1;
388 6 julius
  else if (update_dr_i)
389 360 julius
    crc_cnt <=  {`DBG_CPU_CRC_CNT_WIDTH{1'b0}};
390 6 julius
end
391
 
392
assign cmd_cnt_end      = cmd_cnt      == `DBG_CPU_CMD_LEN;
393
assign addr_len_cnt_end = addr_len_cnt == `DBG_CPU_DR_LEN;
394
assign crc_cnt_end      = crc_cnt      == `DBG_CPU_CRC_CNT_WIDTH'd32;
395
assign crc_cnt_31       = crc_cnt      == `DBG_CPU_CRC_CNT_WIDTH'd31;
396
assign data_cnt_end     = (data_cnt    == {data_cnt_limit, 3'b000});
397
 
398
always @ (posedge tck_i or posedge rst_i)
399
begin
400
  if (rst_i)
401
    begin
402 360 julius
      crc_cnt_end_q       <=  1'b0;
403
      cmd_cnt_end_q       <=  1'b0;
404
      data_cnt_end_q      <=  1'b0;
405
      addr_len_cnt_end_q  <=  1'b0;
406 6 julius
    end
407
  else
408
    begin
409 360 julius
      crc_cnt_end_q       <=  crc_cnt_end;
410
      cmd_cnt_end_q       <=  cmd_cnt_end;
411
      data_cnt_end_q      <=  data_cnt_end;
412
      addr_len_cnt_end_q  <=  addr_len_cnt_end;
413 6 julius
    end
414
end
415
 
416
 
417
// Status counter is made of 4 serialy connected registers
418
always @ (posedge tck_i or posedge rst_i)
419
begin
420
  if (rst_i)
421 360 julius
    status_cnt <=  {`DBG_CPU_STATUS_CNT_WIDTH{1'b0}};
422 6 julius
  else if (update_dr_i)
423 360 julius
    status_cnt <=  {`DBG_CPU_STATUS_CNT_WIDTH{1'b0}};
424 6 julius
  else if (status_cnt_en)
425 363 julius
    status_cnt <=  status_cnt + 1;
426 6 julius
end
427
 
428
 
429
always @ (enable or status_cnt_end or crc_cnt_end or curr_cmd_rd_comm or curr_cmd_rd_ctrl or
430
          curr_cmd_wr_comm or curr_cmd_wr_ctrl or curr_cmd_go or acc_type_write or
431
          acc_type_read or data_cnt_end or addr_len_cnt_end)
432
begin
433
  if (enable && (!status_cnt_end))
434
    begin
435
      if (crc_cnt_end && (curr_cmd_wr_comm || curr_cmd_wr_ctrl))
436
        status_cnt_en = 1'b1;
437
      else if (crc_cnt_end && curr_cmd_go && acc_type_write)
438
        status_cnt_en = 1'b1;
439
      else if (data_cnt_end && curr_cmd_go && acc_type_read)
440
        status_cnt_en = 1'b1;
441
      else if (addr_len_cnt_end && (curr_cmd_rd_comm || curr_cmd_rd_ctrl))
442
        status_cnt_en = 1'b1;
443
      else
444
        status_cnt_en = 1'b0;
445
    end
446
  else
447
    status_cnt_en = 1'b0;
448
end
449
 
450
 
451
assign status_cnt_end = status_cnt == `DBG_CPU_STATUS_LEN;
452
 
453
 
454
// Latching acc_type, address and length
455
always @ (posedge tck_i or posedge rst_i)
456
begin
457
  if (rst_i)
458
    begin
459 360 julius
      acc_type  <=  {`DBG_CPU_ACC_TYPE_LEN{1'b0}};
460
      adr       <=  {`DBG_CPU_ADR_LEN{1'b0}};
461
      len       <=  {`DBG_CPU_LEN_LEN{1'b0}};
462
      set_addr  <=  1'b0;
463 6 julius
    end
464
  else if(crc_cnt_end && (!crc_cnt_end_q) && crc_match_i && curr_cmd_wr_comm)
465
    begin
466 360 julius
      acc_type  <=  dr[`DBG_CPU_ACC_TYPE_LEN + `DBG_CPU_ADR_LEN + `DBG_CPU_LEN_LEN -1 : `DBG_CPU_ADR_LEN + `DBG_CPU_LEN_LEN];
467
      adr       <=  dr[`DBG_CPU_ADR_LEN + `DBG_CPU_LEN_LEN -1 : `DBG_CPU_LEN_LEN];
468
      len       <=  dr[`DBG_CPU_LEN_LEN -1:0];
469
      set_addr  <=  1'b1;
470 6 julius
    end
471
  else if(cpu_end_tck)               // Writing back the address
472
    begin
473 360 julius
      adr  <=  cpu_addr_dsff;
474 6 julius
    end
475
  else
476 360 julius
    set_addr <=  1'b0;
477 6 julius
end
478
 
479
 
480
always @ (posedge tck_i or posedge rst_i)
481
begin
482
  if (rst_i)
483 360 julius
    crc_match_reg <=  1'b0;
484 6 julius
  else if(crc_cnt_end & (~crc_cnt_end_q))
485 360 julius
    crc_match_reg <=  crc_match_i;
486 6 julius
end
487
 
488
 
489
// Length counter
490
always @ (posedge tck_i or posedge rst_i)
491
begin
492
  if (rst_i)
493 360 julius
    len_var <=  {1'b0, {`DBG_CPU_LEN_LEN{1'b0}}};
494 6 julius
  else if(update_dr_i)
495 363 julius
    len_var <=  len + 'd1;
496 6 julius
  else if (start_rd_tck)
497
    begin
498 363 julius
      if (len_var > 4)
499
        len_var <=  len_var - 'd4;
500 6 julius
      else
501 360 julius
        len_var <=  {1'b0, {`DBG_CPU_LEN_LEN{1'b0}}};
502 6 julius
    end
503
end
504
 
505
 
506
assign len_eq_0 = len_var == 'h0;
507
 
508
 
509
assign half = data_cnt[3:0] == 4'd15;
510
assign long = data_cnt[4:0] == 5'd31;
511
 
512
 
513
always @ (posedge tck_i or posedge rst_i)
514
begin
515
  if (rst_i)
516
    begin
517 360 julius
      half_q <=   1'b0;
518
      long_q <=   1'b0;
519 6 julius
    end
520
  else
521
    begin
522 360 julius
      half_q <=  half;
523
      long_q <=  long;
524 6 julius
    end
525
end
526
 
527
 
528
// Start cpu write cycle
529
always @ (posedge tck_i or posedge rst_i)
530
begin
531
  if (rst_i)
532
    begin
533 360 julius
      start_wr_tck <=  1'b0;
534 363 julius
      cpu_dat_tmp <=  32'd0;
535 6 julius
    end
536
  else if (curr_cmd_go && acc_type_write)
537
    begin
538
      if (long_q)
539
        begin
540 360 julius
          start_wr_tck <=  1'b1;
541
          cpu_dat_tmp <=  dr[31:0];
542 6 julius
        end
543
      else
544
        begin
545 360 julius
          start_wr_tck <=  1'b0;
546 6 julius
        end
547
    end
548
  else
549 360 julius
    start_wr_tck <=  1'b0;
550 6 julius
end
551
 
552
 
553
// cpu_data_o in WB clk domain
554
always @ (posedge cpu_clk_i)
555
begin
556 360 julius
  cpu_data_dsff <=  cpu_dat_tmp;
557 6 julius
end
558
 
559
assign cpu_data_o = cpu_data_dsff;
560
 
561
 
562
// Start cpu read cycle
563
always @ (posedge tck_i or posedge rst_i)
564
begin
565
  if (rst_i)
566 360 julius
    start_rd_tck <=  1'b0;
567 6 julius
  else if (curr_cmd_go && (!curr_cmd_go_q) && acc_type_read)              // First read after cmd is entered
568 360 julius
    start_rd_tck <=  1'b1;
569 6 julius
  else if ((!start_rd_tck) && curr_cmd_go && acc_type_read  && (!len_eq_0) && (!fifo_full) && (!rd_tck_started) && (!cpu_ack_tck))
570 360 julius
    start_rd_tck <=  1'b1;
571 6 julius
  else
572 360 julius
    start_rd_tck <=  1'b0;
573 6 julius
end
574
 
575
 
576
always @ (posedge tck_i or posedge rst_i)
577
begin
578
  if (rst_i)
579 360 julius
    rd_tck_started <=  1'b0;
580 6 julius
  else if (update_dr_i || cpu_end_tck && (!cpu_end_tck_q))
581 360 julius
    rd_tck_started <=  1'b0;
582 6 julius
  else if (start_rd_tck)
583 360 julius
    rd_tck_started <=  1'b1;
584 6 julius
end
585
 
586
 
587
 
588
always @ (posedge cpu_clk_i or posedge rst_i)
589
begin
590
  if (rst_i)
591
    begin
592 360 julius
      start_rd_csff   <=  1'b0;
593
      start_cpu_rd    <=  1'b0;
594
      start_cpu_rd_q  <=  1'b0;
595 6 julius
 
596 360 julius
      start_wr_csff   <=  1'b0;
597
      start_cpu_wr    <=  1'b0;
598
      start_cpu_wr_q  <=  1'b0;
599 6 julius
 
600 360 julius
      set_addr_csff   <=  1'b0;
601
      set_addr_cpu    <=  1'b0;
602
      set_addr_cpu_q  <=  1'b0;
603 6 julius
 
604 360 julius
      cpu_ack_q       <=  1'b0;
605 6 julius
    end
606
  else
607
    begin
608 360 julius
      start_rd_csff   <=  start_rd_tck;
609
      start_cpu_rd    <=  start_rd_csff;
610
      start_cpu_rd_q  <=  start_cpu_rd;
611 6 julius
 
612 360 julius
      start_wr_csff   <=  start_wr_tck;
613
      start_cpu_wr    <=  start_wr_csff;
614
      start_cpu_wr_q  <=  start_cpu_wr;
615 6 julius
 
616 360 julius
      set_addr_csff   <=  set_addr;
617
      set_addr_cpu    <=  set_addr_csff;
618
      set_addr_cpu_q  <=  set_addr_cpu;
619 6 julius
 
620 360 julius
      cpu_ack_q       <=  cpu_ack_i;
621 6 julius
    end
622
end
623
 
624
 
625
// cpu_stb_o
626
always @ (posedge cpu_clk_i or posedge rst_i)
627
begin
628
  if (rst_i)
629 360 julius
    cpu_stb_o <=  1'b0;
630 6 julius
  else if (cpu_ack_i)
631 360 julius
    cpu_stb_o <=  1'b0;
632 6 julius
  else if ((start_cpu_wr && (!start_cpu_wr_q)) || (start_cpu_rd && (!start_cpu_rd_q)))
633 360 julius
    cpu_stb_o <=  1'b1;
634 6 julius
end
635
 
636
 
637
assign cpu_stall_o = cpu_stb_o | cpu_reg_stall;
638
 
639
 
640
// cpu_addr_o logic
641
always @ (posedge cpu_clk_i or posedge rst_i)
642
begin
643
  if (rst_i)
644 360 julius
    cpu_addr_dsff <=  32'h0;
645 6 julius
  else if (set_addr_cpu && (!set_addr_cpu_q)) // Setting starting address
646 360 julius
    cpu_addr_dsff <=  adr;
647 6 julius
  else if (cpu_ack_i && (!cpu_ack_q))
648 360 julius
    //cpu_addr_dsff <=  cpu_addr_dsff + 3'd4;
649 363 julius
    // Increment by just 1, to allow block reading -- jb 090901
650
    cpu_addr_dsff <=  cpu_addr_dsff + 'd1;
651 6 julius
end
652
 
653
 
654
assign cpu_addr_o = cpu_addr_dsff;
655
 
656
 
657
always @ (posedge cpu_clk_i)
658
begin
659 360 julius
  cpu_we_dsff <=  curr_cmd_go && acc_type_write;
660 6 julius
end
661
 
662
 
663
assign cpu_we_o = cpu_we_dsff;
664
 
665
 
666
 
667
// Logic for detecting end of transaction
668
always @ (posedge cpu_clk_i or posedge rst_i)
669
begin
670
  if (rst_i)
671 360 julius
    cpu_end <=  1'b0;
672 6 julius
  else if (cpu_ack_i && (!cpu_ack_q))
673 360 julius
    cpu_end <=  1'b1;
674 6 julius
  else if (cpu_end_rst)
675 360 julius
    cpu_end <=  1'b0;
676 6 julius
end
677
 
678
 
679
always @ (posedge tck_i or posedge rst_i)
680
begin
681
  if (rst_i)
682
    begin
683 360 julius
      cpu_end_csff  <=  1'b0;
684
      cpu_end_tck   <=  1'b0;
685
      cpu_end_tck_q <=  1'b0;
686 6 julius
    end
687
  else
688
    begin
689 360 julius
      cpu_end_csff  <=  cpu_end;
690
      cpu_end_tck   <=  cpu_end_csff;
691
      cpu_end_tck_q <=  cpu_end_tck;
692 6 julius
    end
693
end
694
 
695
 
696
always @ (posedge cpu_clk_i or posedge rst_i)
697
begin
698
  if (rst_i)
699
    begin
700 360 julius
      cpu_end_rst_csff <=  1'b0;
701
      cpu_end_rst      <=  1'b0;
702 6 julius
    end
703
  else
704
    begin
705 360 julius
      cpu_end_rst_csff <=  cpu_end_tck;
706
      cpu_end_rst      <=  cpu_end_rst_csff;
707 6 julius
    end
708
end
709
 
710
 
711
always @ (posedge cpu_clk_i or posedge rst_i)
712
begin
713
  if (rst_i)
714 360 julius
    busy_cpu <=  1'b0;
715 6 julius
  else if (cpu_end_rst)
716 360 julius
    busy_cpu <=  1'b0;
717 6 julius
  else if (cpu_stb_o)
718 360 julius
    busy_cpu <=  1'b1;
719 6 julius
end
720
 
721
 
722
always @ (posedge tck_i or posedge rst_i)
723
begin
724
  if (rst_i)
725
    begin
726 360 julius
      busy_csff       <=  1'b0;
727
      busy_tck        <=  1'b0;
728 6 julius
 
729 360 julius
      update_dr_csff  <=  1'b0;
730
      update_dr_cpu   <=  1'b0;
731 6 julius
    end
732
  else
733
    begin
734 360 julius
      busy_csff       <=  busy_cpu;
735
      busy_tck        <=  busy_csff;
736 6 julius
 
737 360 julius
      update_dr_csff  <=  update_dr_i;
738
      update_dr_cpu   <=  update_dr_csff;
739 6 julius
    end
740
end
741
 
742
 
743
// Detecting overrun when write operation.
744
always @ (posedge cpu_clk_i or posedge rst_i)
745
begin
746
  if (rst_i)
747 360 julius
    cpu_overrun <=  1'b0;
748 6 julius
  else if(start_cpu_wr && (!start_cpu_wr_q) && cpu_ack_i)
749 360 julius
    cpu_overrun <=  1'b1;
750 6 julius
  else if(update_dr_cpu) // error remains active until update_dr arrives
751 360 julius
    cpu_overrun <=  1'b0;
752 6 julius
end
753
 
754
 
755
// Detecting underrun when read operation
756
always @ (posedge tck_i or posedge rst_i)
757
begin
758
  if (rst_i)
759 360 julius
    underrun_tck <=  1'b0;
760 6 julius
  else if(latch_data && (!fifo_full) && (!data_cnt_end))
761 360 julius
    underrun_tck <=  1'b1;
762 6 julius
  else if(update_dr_i) // error remains active until update_dr arrives
763 360 julius
    underrun_tck <=  1'b0;
764 6 julius
end
765
 
766
 
767
always @ (posedge tck_i or posedge rst_i)
768
begin
769
  if (rst_i)
770
    begin
771 360 julius
      cpu_overrun_csff <=  1'b0;
772
      cpu_overrun_tck  <=  1'b0;
773 6 julius
 
774 360 julius
      cpu_ack_csff     <=  1'b0;
775
      cpu_ack_tck      <=  1'b0;
776 6 julius
    end
777
  else
778
    begin
779 360 julius
      cpu_overrun_csff <=  cpu_overrun;
780
      cpu_overrun_tck  <=  cpu_overrun_csff;
781 6 julius
 
782 360 julius
      cpu_ack_csff     <=  cpu_ack_i;
783
      cpu_ack_tck      <=  cpu_ack_csff;
784 6 julius
    end
785
end
786
 
787
 
788
 
789
always @ (posedge cpu_clk_i or posedge rst_i)
790
begin
791
  if (rst_i)
792
    begin
793 360 julius
      cpu_ce_csff  <=  1'b0;
794
      mem_ptr_init      <=  1'b0;
795 6 julius
    end
796
  else
797
    begin
798 360 julius
      cpu_ce_csff  <=   cpu_ce_i;
799
      mem_ptr_init      <=  ~cpu_ce_csff;
800 6 julius
    end
801
end
802
 
803
 
804
// Logic for latching data that is read from cpu
805
always @ (posedge cpu_clk_i)
806
begin
807
  if (cpu_ack_i && (!cpu_ack_q))
808
    begin
809 360 julius
      mem[0] <=  cpu_data_i[31:24];
810
      mem[1] <=  cpu_data_i[23:16];
811
      mem[2] <=  cpu_data_i[15:08];
812
      mem[3] <=  cpu_data_i[07:00];
813 6 julius
    end
814
end
815
 
816
 
817
assign input_data = {mem[0], mem[1], mem[2], mem[3]};
818
 
819
 
820
// Fifo counter and empty/full detection
821
always @ (posedge tck_i or posedge rst_i)
822
begin
823
  if (rst_i)
824 360 julius
    fifo_full <=  1'h0;
825 6 julius
  else if (update_dr_i)
826 360 julius
    fifo_full <=  1'h0;
827 6 julius
  else if (cpu_end_tck && (!cpu_end_tck_q) && (!latch_data) && (!fifo_full))  // incrementing
828 360 julius
    fifo_full <=  1'b1;
829 6 julius
  else if (!(cpu_end_tck && (!cpu_end_tck_q)) && latch_data && (fifo_full))  // decrementing
830 360 julius
    fifo_full <=  1'h0;
831 6 julius
end
832
 
833
 
834
 
835
// TDO multiplexer
836
always @ (pause_dr_i or busy_tck or crc_cnt_end or crc_cnt_end_q or curr_cmd_wr_comm or curr_cmd_wr_ctrl or curr_cmd_go or acc_type_write or acc_type_read or crc_match_i or data_cnt_end or dr or data_cnt_end_q or crc_match_reg or status_cnt_en or status or addr_len_cnt_end or addr_len_cnt_end_q or curr_cmd_rd_comm or curr_cmd_rd_ctrl)
837
begin
838
  if (pause_dr_i)
839
    begin
840
    tdo_o = busy_tck;
841
    end
842
  else if (crc_cnt_end && (!crc_cnt_end_q) && (curr_cmd_wr_comm || curr_cmd_wr_ctrl || curr_cmd_go && acc_type_write ))
843
    begin
844
      tdo_o = ~crc_match_i;
845
    end
846
  else if (curr_cmd_go && acc_type_read && crc_cnt_end && (!data_cnt_end))
847
    begin
848
      tdo_o = dr[31];
849
    end
850
  else if (curr_cmd_go && acc_type_read && data_cnt_end && (!data_cnt_end_q))
851
    begin
852
      tdo_o = ~crc_match_reg;
853
    end
854
  else if ((curr_cmd_rd_comm || curr_cmd_rd_ctrl) && addr_len_cnt_end && (!addr_len_cnt_end_q))
855
    begin
856
      tdo_o = ~crc_match_reg;
857
    end
858
  else if ((curr_cmd_rd_comm || curr_cmd_rd_ctrl) && crc_cnt_end && (!addr_len_cnt_end))
859
    begin
860
      tdo_o = dr[`DBG_CPU_ACC_TYPE_LEN + `DBG_CPU_ADR_LEN + `DBG_CPU_LEN_LEN -1];
861
    end
862
  else if (status_cnt_en)
863
    begin
864
      tdo_o = status[3];
865
    end
866
  else
867
    begin
868
      tdo_o = 1'b0;
869
    end
870
end
871
 
872
 
873
// Status register
874
always @ (posedge tck_i or posedge rst_i)
875
begin
876
  if (rst_i)
877
    begin
878 360 julius
    status <=  {`DBG_CPU_STATUS_LEN{1'b0}};
879 6 julius
    end
880
  else if(crc_cnt_end && (!crc_cnt_end_q) && (!(curr_cmd_go && acc_type_read)))
881
    begin
882 360 julius
    status <=  {1'b0, 1'b0, cpu_overrun_tck, crc_match_i};
883 6 julius
    end
884
  else if (data_cnt_end && (!data_cnt_end_q) && curr_cmd_go && acc_type_read)
885
    begin
886 360 julius
    status <=  {1'b0, 1'b0, underrun_tck, crc_match_reg};
887 6 julius
    end
888
  else if (addr_len_cnt_end && (!addr_len_cnt_end) && (curr_cmd_rd_comm || curr_cmd_rd_ctrl))
889
    begin
890 360 julius
    status <=  {1'b0, 1'b0, 1'b0, crc_match_reg};
891 6 julius
    end
892
  else if (shift_dr_i && (!status_cnt_end))
893
    begin
894 360 julius
    status <=  {status[`DBG_CPU_STATUS_LEN -2:0], status[`DBG_CPU_STATUS_LEN -1]};
895 6 julius
    end
896
end
897
// Following status is shifted out (MSB first):
898
// 3. bit:          1 if crc is OK, else 0
899
// 2. bit:          1'b0
900
// 1. bit:          0
901
// 0. bit:          1 if overrun occured during write (data couldn't be written fast enough)
902
//                    or underrun occured during read (data couldn't be read fast enough)
903
 
904
 
905
 
906
// Connecting cpu registers
907
assign cpu_reg_we = crc_cnt_end && (!crc_cnt_end_q) && crc_match_i && curr_cmd_wr_ctrl;
908
assign cpu_reg_data_i = dr[`DBG_CPU_DR_LEN -1:`DBG_CPU_DR_LEN -`DBG_CPU_CTRL_LEN];
909
 
910
dbg_cpu_registers i_dbg_cpu_registers
911
  (
912
    .data_i          (cpu_reg_data_i),
913
    .we_i            (cpu_reg_we),
914
    .tck_i           (tck_i),
915
    .bp_i            (cpu_bp_i),
916
    .rst_i           (rst_i),
917
    .cpu_clk_i       (cpu_clk_i),
918
    .ctrl_reg_o      (ctrl_reg),
919
    .cpu_stall_o     (cpu_reg_stall),
920
    .cpu_rst_o       (cpu_rst_o)
921
  );
922
 
923
 
924
 
925
 
926
 
927
endmodule
928
 

powered by: WebSVN 2.1.0

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