196 lines
5.3 KiB
Systemverilog
196 lines
5.3 KiB
Systemverilog
|
// SPDX-License-Identifier: Apache-2.0
|
||
|
// Copyright 2019 Western Digital Corporation or its affiliates.
|
||
|
//
|
||
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
||
|
// you may not use this file except in compliance with the License.
|
||
|
// You may obtain a copy of the License at
|
||
|
//
|
||
|
// http://www.apache.org/licenses/LICENSE-2.0
|
||
|
//
|
||
|
// Unless required by applicable law or agreed to in writing, software
|
||
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
||
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||
|
// See the License for the specific language governing permissions and
|
||
|
// limitations under the License.
|
||
|
//
|
||
|
`ifdef RV_BUILD_AHB_LITE
|
||
|
|
||
|
module ahb_sif (
|
||
|
input logic [63:0] HWDATA,
|
||
|
input logic HCLK,
|
||
|
input logic HSEL,
|
||
|
input logic [3:0] HPROT,
|
||
|
input logic HWRITE,
|
||
|
input logic [1:0] HTRANS,
|
||
|
input logic [2:0] HSIZE,
|
||
|
input logic HREADY,
|
||
|
input logic HRESETn,
|
||
|
input logic [31:0] HADDR,
|
||
|
input logic [2:0] HBURST,
|
||
|
|
||
|
output logic HREADYOUT,
|
||
|
output logic HRESP,
|
||
|
output logic [63:0] HRDATA
|
||
|
);
|
||
|
|
||
|
parameter MEM_SIZE_DW = 8192;
|
||
|
parameter MAILBOX_ADDR = 32'hD0580000;
|
||
|
localparam MEM_SIZE = MEM_SIZE_DW*8;
|
||
|
|
||
|
logic Write;
|
||
|
logic [31:0] Last_HADDR;
|
||
|
logic [7:0] strb_lat;
|
||
|
|
||
|
bit [7:0] mem [0:MEM_SIZE-1];
|
||
|
//bit [7:0] mem [int];
|
||
|
//int kuku[int];
|
||
|
|
||
|
// Wires
|
||
|
wire [63:0] WriteData = HWDATA;
|
||
|
wire [7:0] strb = HSIZE == 3'b000 ? 8'h1 << HADDR[2:0] :
|
||
|
HSIZE == 3'b001 ? 8'h3 << {HADDR[2:1],1'b0} :
|
||
|
HSIZE == 3'b010 ? 8'hf << {HADDR[2],2'b0} : 8'hff;
|
||
|
|
||
|
wire[31:0] addr = HADDR & (MEM_SIZE-1);
|
||
|
wire[31:0] laddr = Last_HADDR & (MEM_SIZE-1);
|
||
|
|
||
|
wire mailbox_write = Write && Last_HADDR==MAILBOX_ADDR;
|
||
|
|
||
|
wire [63:0] mem_dout = {mem[{addr[31:3],3'd7}],
|
||
|
mem[{addr[31:3],3'd6}],
|
||
|
mem[{addr[31:3],3'd5}],
|
||
|
mem[{addr[31:3],3'd4}],
|
||
|
mem[{addr[31:3],3'd3}],
|
||
|
mem[{addr[31:3],3'd2}],
|
||
|
mem[{addr[31:3],3'd1}],
|
||
|
mem[{addr[31:3],3'd0}]};
|
||
|
|
||
|
|
||
|
always @ (negedge HCLK ) begin
|
||
|
if (Write) begin
|
||
|
if(strb_lat[7]) mem[{laddr[31:3],3'd7}] = HWDATA[63:56];
|
||
|
if(strb_lat[6]) mem[{laddr[31:3],3'd6}] = HWDATA[55:48];
|
||
|
if(strb_lat[5]) mem[{laddr[31:3],3'd5}] = HWDATA[47:40];
|
||
|
if(strb_lat[4]) mem[{laddr[31:3],3'd4}] = HWDATA[39:32];
|
||
|
if(strb_lat[3]) mem[{laddr[31:3],3'd3}] = HWDATA[31:24];
|
||
|
if(strb_lat[2]) mem[{laddr[31:3],3'd2}] = HWDATA[23:16];
|
||
|
if(strb_lat[1]) mem[{laddr[31:3],3'd1}] = HWDATA[15:08];
|
||
|
if(strb_lat[0]) mem[{laddr[31:3],3'd0}] = HWDATA[07:00];
|
||
|
end
|
||
|
end
|
||
|
|
||
|
|
||
|
assign HREADYOUT = 1;
|
||
|
assign HRESP = 0;
|
||
|
|
||
|
always @(posedge HCLK or negedge HRESETn) begin
|
||
|
if(~HRESETn) begin
|
||
|
Last_HADDR <= 32'b0;
|
||
|
Write <= 1'b0;
|
||
|
HRDATA <= '0;
|
||
|
end else begin
|
||
|
Last_HADDR <= HADDR;
|
||
|
Write <= HWRITE & |HTRANS;
|
||
|
if(|HTRANS & ~HWRITE)
|
||
|
HRDATA <= mem_dout;
|
||
|
strb_lat <= strb;
|
||
|
end
|
||
|
end
|
||
|
|
||
|
|
||
|
endmodule
|
||
|
`endif
|
||
|
|
||
|
`ifdef RV_BUILD_AXI4
|
||
|
module axi_slv #(TAGW=1) (
|
||
|
input aclk,
|
||
|
input rst_l,
|
||
|
input arvalid,
|
||
|
output reg arready,
|
||
|
input [31:0] araddr,
|
||
|
input [TAGW-1:0] arid,
|
||
|
input [7:0] arlen,
|
||
|
input [1:0] arburst,
|
||
|
input [2:0] arsize,
|
||
|
|
||
|
output reg rvalid,
|
||
|
input rready,
|
||
|
output reg [63:0] rdata,
|
||
|
output reg [1:0] rresp,
|
||
|
output reg [TAGW-1:0] rid,
|
||
|
output rlast,
|
||
|
|
||
|
input awvalid,
|
||
|
output awready,
|
||
|
input [31:0] awaddr,
|
||
|
input [TAGW-1:0] awid,
|
||
|
input [7:0] awlen,
|
||
|
input [1:0] awburst,
|
||
|
input [2:0] awsize,
|
||
|
|
||
|
input [63:0] wdata,
|
||
|
input [7:0] wstrb,
|
||
|
input wvalid,
|
||
|
output wready,
|
||
|
|
||
|
output reg bvalid,
|
||
|
input bready,
|
||
|
output reg [1:0] bresp,
|
||
|
output reg [TAGW-1:0] bid
|
||
|
);
|
||
|
|
||
|
parameter MAILBOX_ADDR = 32'hD0580000;
|
||
|
parameter MEM_SIZE_DW = 8192;
|
||
|
|
||
|
bit [7:0] mem [0:MEM_SIZE_DW*8-1];
|
||
|
bit [63:0] memdata;
|
||
|
wire [31:0] waddr, raddr;
|
||
|
wire [63:0] WriteData;
|
||
|
wire mailbox_write;
|
||
|
|
||
|
assign raddr = araddr & (MEM_SIZE_DW*8-1);
|
||
|
assign waddr = awaddr & (MEM_SIZE_DW*8-1);
|
||
|
|
||
|
assign mailbox_write = awvalid && awaddr==MAILBOX_ADDR && rst_l;
|
||
|
assign WriteData = wdata;
|
||
|
|
||
|
always @ ( posedge aclk or negedge rst_l) begin
|
||
|
if(!rst_l) begin
|
||
|
rvalid <= 0;
|
||
|
bvalid <= 0;
|
||
|
end
|
||
|
else begin
|
||
|
bid <= awid;
|
||
|
rid <= arid;
|
||
|
rvalid <= arvalid;
|
||
|
bvalid <= awvalid;
|
||
|
rdata <= memdata;
|
||
|
end
|
||
|
end
|
||
|
|
||
|
always @ ( negedge aclk) begin
|
||
|
if(arvalid) memdata <= {mem[raddr+7], mem[raddr+6], mem[raddr+5], mem[raddr+4],
|
||
|
mem[raddr+3], mem[raddr+2], mem[raddr+1], mem[raddr]};
|
||
|
if(awvalid) begin
|
||
|
if(wstrb[7]) mem[waddr+7] = wdata[63:56];
|
||
|
if(wstrb[6]) mem[waddr+6] = wdata[55:48];
|
||
|
if(wstrb[5]) mem[waddr+5] = wdata[47:40];
|
||
|
if(wstrb[4]) mem[waddr+4] = wdata[39:32];
|
||
|
if(wstrb[3]) mem[waddr+3] = wdata[31:24];
|
||
|
if(wstrb[2]) mem[waddr+2] = wdata[23:16];
|
||
|
if(wstrb[1]) mem[waddr+1] = wdata[15:08];
|
||
|
if(wstrb[0]) mem[waddr+0] = wdata[07:00];
|
||
|
end
|
||
|
end
|
||
|
|
||
|
|
||
|
assign arready = 1'b1;
|
||
|
assign awready = 1'b1;
|
||
|
assign wready = 1'b1;
|
||
|
assign rresp = 2'b0;
|
||
|
assign bresp = 2'b0;
|
||
|
assign rlast = 1'b1;
|
||
|
|
||
|
endmodule
|
||
|
`endif
|