DCache.v

   1 /* 16 cache entries, 64-byte long cache lines */
   2
   3 module DCache(
   4         input clk,
   5
   6         /* ARM core interface */
   7         input [31:0] dc__addr_3a,
   8         input dc__rd_req_3a,
   9         input dc__wr_req_3a,
  10         output reg dc__rw_wait_3a,
  11         input [31:0] dc__wr_data_3a,
  12         output reg [31:0] dc__rd_data_3a,
  13
  14         /* bus interface */
  15         output wire bus_req,
  16         input bus_ack,
  17         output reg [31:0] bus_addr = 0,
  18         input [31:0] bus_rdata,
  19         output reg [31:0] bus_wdata,
  20         output reg bus_rd = 0,
  21         output reg bus_wr = 0,
  22         input bus_ready);
  23
  24         /* [31 tag 10] [9 cache index 6] [5 data index 0]
  25          * so the data index is 6 bits long
  26          * so the cache index is 4 bits long
  27          * so the tag is 22 bits long. c.c
  28          */
  29
  30         reg cache_valid [15:0];
  31         reg [21:0] cache_tags [15:0];
  32         reg [31:0] cache_data [255:0 /* {line,word} */];
  33
  34         integer i;
  35         initial
  36                 for (i = 0; i < 16; i = i + 1)
  37                 begin
  38                         cache_valid[i[3:0]] = 0;
  39                         cache_tags[i[3:0]] = 0;
  40                 end
  41
  42         wire [5:0] didx = dc__addr_3a[5:0];
  43         wire [3:0] didx_word = didx[5:2];
  44         wire [3:0] idx = dc__addr_3a[9:6];
  45         wire [21:0] tag = dc__addr_3a[31:10];
  46
  47         reg [31:0] prev_addr = 32'hFFFFFFFF;
  48
  49         wire cache_hit = cache_valid[idx] && (cache_tags[idx] == tag);
  50
  51         wire [31:0] curdata = cache_data[{idx,didx_word}];
  52         always @(*) begin
  53                 dc__rw_wait_3a = (dc__rd_req_3a && !cache_hit) || (dc__wr_req_3a && (!bus_ack || !bus_ready));
  54                 dc__rd_data_3a = curdata;
  55                 if (!dc__rw_wait_3a && dc__rd_req_3a)
  56                         $display("DCACHE: READ COMPLETE: Addr %08x, data %08x", dc__addr_3a, dc__rd_data_3a);
  57         end
  58
  59         reg [3:0] cache_fill_pos = 0;
  60         assign bus_req = (dc__rd_req_3a && !cache_hit) || dc__wr_req_3a;
  61         always @(*)
  62         begin
  63                 bus_rd = 0;
  64                 bus_wr = 0;
  65                 bus_addr = 0;
  66                 bus_wdata = 0;
  67                 if (dc__rd_req_3a && !cache_hit && bus_ack) begin
  68                         bus_addr = {dc__addr_3a[31:6], cache_fill_pos[3:0], 2'b00 /* reads are 32-bits */};
  69                         bus_rd = 1;
  70                 end else if (dc__wr_req_3a && bus_ack) begin
  71                         $display("DCACHE: WRITE REQUEST: Addr %08x, data %08x", dc__addr_3a, dc__wr_data_3a);
  72                         bus_addr = dc__addr_3a;
  73                         bus_wr = 1;
  74                         bus_wdata = dc__wr_data_3a;
  75                 end
  76         end
  77
  78         always @(posedge clk) begin
  79                 prev_addr <= {dc__addr_3a[31:6], 6'b0};
  80                 if (dc__rd_req_3a && (cache_fill_pos != 0) && ((prev_addr != {dc__addr_3a[31:6], 6'b0}) || cache_hit))  /* If this wasn't from the same line, or we've moved on somehow, reset the fill circuitry. */
  81                         cache_fill_pos <= 0;
  82                 else if (dc__rd_req_3a && !cache_hit && bus_ready && bus_ack) begin     /* Started the fill, and we have data. */
  83                         $display("DCACHE: FILL: rd addr %08x; bus addr %08x; bus data %08x, bus_req %d, bus_ack %d", dc__addr_3a, bus_addr, bus_rdata, bus_req, bus_ack);
  84                         cache_fill_pos <= cache_fill_pos + 1;
  85                         if (cache_fill_pos == 15) begin /* Done? */
  86                                 cache_tags[idx] <= tag;
  87                                 cache_valid[idx] <= 1;
  88                         end else
  89                                 cache_valid[idx] <= 0;
  90                 end
  91
  92                 /* Split this out because XST is kind of silly about this sort of thing. */
  93                 if ((dc__rd_req_3a && !cache_hit && bus_ready && bus_ack) || (dc__wr_req_3a && cache_hit))
  94                         cache_data[dc__wr_req_3a ? {idx,dc__addr_3a[5:2]} : {idx,cache_fill_pos}] <= dc__wr_req_3a ? dc__wr_data_3a : bus_rdata;
  95         end
  96 endmodule