Files
Archie_MiSTer/rtl/ioc.v
2021-07-24 16:29:34 +08:00

263 lines
7.2 KiB
Verilog

`timescale 1ns / 1ps
/* ioc.v
Copyright (c) 2012-2015, Stephen J. Leary
All rights reserved.
Redistribution and use in source and binary forms, with or without
modification, are permitted provided that the following conditions are met:
* Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* * Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* * Neither the name of the <organization> nor the
* names of its contributors may be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
* DISCLAIMED. IN NO EVENT SHALL <COPYRIGHT HOLDER> BE LIABLE FOR ANY
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
module ioc
(
input clkcpu, // cpu bus clock domain
output reg clk2m_en,
output reg clk7m_en,
input por, // power on reset signal.
input [5:0] c_in,
output[5:0] c_out,
output [7:1] select, // perhiperhal select lines
output sext, // external perhiperhal select
input [1:0] fh, // fast high interrupt.
input [7:0] il, // active low interrupt lines
input ir, //
// "wishbone" bus
input wb_we,
input wb_stb,
input wb_cyc,
input [6:2] wb_adr,
input [7:0] wb_dat_i,
output [7:0] wb_dat_o,
// perhaps rename but its part of an IOC bus cycle.
input [2:0] wb_bank,
// interrupts
output irq,
output firq,
// keyboard interface to arm controller. Data is valid
// in rising edge of strobe
output reg [7:0] kbd_out_data,
output reg kbd_out_strobe,
input [7:0] kbd_in_data,
input kbd_in_strobe
);
reg [4:0] clk2en_counter = 0;
reg [2:0] clk7en_counter = 0;
wire [7:0] irqa_dout, irqb_dout, firq_dout;
wire irqa_req, irqb_req, firq_req;
wire irqa_selected, irqb_selected, firq_selected;
wire ctrl_selected = wb_adr[6:2] == 5'd0 /* synthesis keep */;
wire [7:0] ctrl_dout;
reg [5:0] ctrl_state;
wire serial_selected = wb_adr[6:2] == 5'd1 /* synthesis keep */;
wire write_request = (wb_bank == 3'b000) & wb_stb & wb_cyc & wb_we;
wire read_request = (wb_bank == 3'b000) & wb_stb & wb_cyc & !wb_we;
// keyboard input is valid on rising edge of kbd_in_strobe. Latch data then
// and set irq
reg [7:0] kbd_in_data_latch;
reg kbd_in_irq_ack;
reg kbd_in_irq;
// input data irq is cleared when cpu reads input port
always @(posedge clkcpu or posedge kbd_in_irq_ack) begin
if (kbd_in_irq_ack) kbd_in_irq <= 0;
else if (kbd_in_strobe) begin
kbd_in_data_latch <= kbd_in_data;
kbd_in_irq <= 1;
end
end
// faked kbd tx timing
reg[4:0] txcount = 5'd0;
wire txdone = txcount == 5'd0 /* synthesis keep */;
// edge detect for IR
reg ir_r;
wire ir_edge;
// Instantiate the Unit Under Test (UUT)
ioc_irq #(.ADDRESS(2'b01), .PERMBITS(8'h80), .CANCLEAR(8'b01111111)) IRQA
(
.clkcpu ( clkcpu ),
.reset ( por ),
.i ( {timer[2].reload, timer[1].reload, timer[0].reload, por, ir_edge, 3'b000}),
.irq ( irqa_req ),
.c ( 8'h00 ),
.addr ( wb_adr[6:2] ),
.din ( wb_dat_i ),
.dout ( irqa_dout ),
.sel ( irqa_selected ),
.write ( write_request )
);
// Instantiate the Unit Under Test (UUT)
ioc_irq #(.ADDRESS(2'b10), .CANCLEAR(8'b00000000)) IRQB
(
.clkcpu ( clkcpu ),
.reset ( por ),
.i ( { kbd_in_irq, txdone, ~il[5:0]}),
.c ( {!kbd_in_irq, ~txdone, il[5:0]}),
.irq ( irqb_req ),
.addr ( wb_adr[6:2] ),
.din ( wb_dat_i ),
.dout ( irqb_dout ),
.sel ( irqb_selected ),
.write ( write_request )
);
ioc_irq #(.ADDRESS(2'b11), .CANCLEAR(8'd0)) FIRQ
(
.clkcpu ( clkcpu ),
.reset ( por ),
.i ( {6'h00, fh[1:0]} ),
.c ( {6'h00, ~fh[1:0]}),
.irq ( firq_req ),
.addr ( wb_adr[6:2] ),
.din ( wb_dat_i ),
.dout ( firq_dout ),
.sel ( firq_selected ),
.write ( write_request )
);
generate
genvar c;
for (c = 0; c < 4; c = c + 1) begin: timer
reg [15:0] latch_i;
reg [15:0] counter;
reg [15:0] latch_o;
reg reload;
wire selected = wb_adr[6] & (c[1:0] == wb_adr[5:4]);
wire [7:0] out = wb_adr[2] ? latch_o[15:8] : latch_o[7:0];
initial begin
latch_i = 16'd0;
counter = 16'd0;
latch_o = 16'd0;
reload = 1'b0;
end
always @(posedge clkcpu) begin
reload <= 1'b0;
if (write_request & selected) begin
case (wb_adr[3:2])
2'b00: latch_i[7:0] <= wb_dat_i;
2'b01: latch_i[15:8] <= wb_dat_i;
2'b10: counter <= {latch_i[15:4],4'd0};
2'b11: latch_o <= counter;
endcase
end else if (clk2m_en) begin
counter <= counter - 15'd1;
if (~|counter) begin
reload <= 1'b1;
counter <= {latch_i[15:4],4'd0};
end
end
end
end
endgenerate
// here we generate the ack signal and the 2mhz enable.
always @(posedge clkcpu) begin
if (por) begin
ctrl_state <= 6'h3F;
ir_r <= 1'b1;
clk2en_counter <= 0;
clk7en_counter <= 0;
clk2m_en <= 0;
clk7m_en <= 0;
end else begin
// generate strobe one clock cycle after data has been latched
kbd_out_strobe <= !txdone;
kbd_in_irq_ack <= serial_selected && read_request;
ir_r <= ir;
if (!txdone && timer[3].reload) begin
txcount <= txcount - 4'd1;
end
// increment the clock counter. 42 MHz clkcpu assumed.
clk2en_counter <= clk2en_counter + 1'd1;
if (clk2en_counter == 20) clk2en_counter <= 0;
clk2m_en <= !clk2en_counter;
clk7en_counter <= clk7en_counter + 1'd1;
if (clk7en_counter == 5) clk7en_counter <= 0;
clk7m_en <= !clk7en_counter;
if (write_request & ctrl_selected) begin
ctrl_state <= wb_dat_i[5:0];
end
if (write_request & serial_selected) begin
// simulate a serial port write to the console.
kbd_out_strobe <= 1'b0;
kbd_out_data <= wb_dat_i[7:0];
txcount <= 5'd20;
end
end
end
// external perhiperhal stuff.
assign {select, sext} = wb_bank ? ((8'd1 << wb_bank) | 8'd1) : 8'd0;
assign c_out = ctrl_state;
assign ctrl_dout = { ir, 1'b1, c_in & c_out };
assign ir_edge = ~ir_r & ir;
assign wb_dat_o =
~read_request ? 8'hFF :
ctrl_selected ? ctrl_dout :
serial_selected ? kbd_in_data_latch :
irqa_selected ? irqa_dout :
irqb_selected ? irqb_dout :
firq_selected ? firq_dout :
timer[0].selected ? timer[0].out :
timer[1].selected ? timer[1].out :
timer[2].selected ? timer[2].out :
timer[3].selected ? timer[3].out : 8'hFF;
assign irq = irqa_req | irqb_req;
assign firq = firq_req;
// sext is high if any bits of select are high
endmodule