49 lines
903 B
Systemverilog
49 lines
903 B
Systemverilog
module mapper(
|
|
input i_reset,
|
|
input i_clk,
|
|
input i_cs,
|
|
input i_we,
|
|
input [7:0] i_data,
|
|
output logic [7:0] o_data,
|
|
input [15:0] i_cpu_addr,
|
|
output logic [24:0] o_mapped_addr
|
|
);
|
|
|
|
logic [15:0] mm [16];
|
|
|
|
logic [31:0] we;
|
|
|
|
|
|
// TODO These have basically the same name.
|
|
logic [15:0] mm_sel;
|
|
|
|
logic [15:0] selected_mm;
|
|
|
|
always_comb begin
|
|
we = ((i_we & i_cs) << i_cpu_addr[4:0]);
|
|
|
|
mm_sel = (1 << i_cpu_addr[4:1]);
|
|
o_data = mm_sel[8*i_cpu_addr[0] +: 8];
|
|
|
|
selected_mm = mm[i_cpu_addr[15:12]];
|
|
o_mapped_addr = {selected_mm[12:0], i_cpu_addr[11:0]};
|
|
end
|
|
|
|
always_ff @(negedge i_clk or posedge i_reset) begin
|
|
if (i_reset) begin
|
|
for (int i = 0; i < 16; i++) begin
|
|
mm[i] <= i;
|
|
end
|
|
end
|
|
|
|
for (int i = 0; i < 32; i++) begin
|
|
if (we[i]) begin
|
|
mm[i/2][(i%2)*8 +: 8] <= i_data;
|
|
end
|
|
end
|
|
|
|
|
|
end
|
|
|
|
endmodule
|