`timescale 1ns/1ps

module interrupt_controller_tb();

logic r_clk_cpu;

localparam BITS_128 = 128'hffffffffffffffffffffffffffffffff;
// clk_cpu
initial begin
    r_clk_cpu <= '1;
    forever begin
        #125 r_clk_cpu <= ~r_clk_cpu;
    end
end

logic reset;
logic addr;
logic [7:0] i_data;
logic [7:0] o_data;
logic cs;
logic rwb;

logic [127:0] int_in;
logic int_out;

interrupt_controller #(
    .N_INTERRUPTS(128)
) u_interrupt_controller (
    .clk(r_clk_cpu),
    .reset(reset),
    .i_data(i_data),
    .o_data(o_data),
    .addr(addr),
    .cs(cs),
    .rwb(rwb),
    .int_in(int_in),
    .int_out(int_out)
);

/* Test Level triggered IRQ by triggering IRQ0
 * and then clearing it, 
 */
task test_edge_irq();
    $display("Testing Edge IRQ");
    do_reset();
    set_enable(128'hff);
    set_edge_type(128'h0);
    set_interrupts(1);
    assert (int_out == 1) else begin
        errors = errors + 1;
        $error("Interrupt should be high!");
    end
    send_eoi();
    assert (int_out == 0) else begin
        errors = errors + 1;
        $error("Interrupt should be low!");
    end
    set_interrupts(0);
    assert (int_out == 0) else begin
        errors = errors + 1;
        $error("Interrupt should be low!");
    end
endtask

task test_level_irq();
    $display("Testing level IRQ");
    do_reset();
    set_enable(128'hff);
    set_edge_type(128'hff);
    set_interrupts(1);
    assert (int_out == 1) else begin
        errors = errors + 1;
        $error("Interrupt should be high!");
    end
    send_eoi();
    assert (int_out == 1) else begin
        errors = errors + 1;
        $error("Interrupt should be high!");
    end
    set_interrupts(0);
    send_eoi();
    assert (int_out == 0) else begin
        errors = errors + 1;
        $error("Interrupt should be low!");
    end
endtask


task test_irq_val();
    int irq_val = -1;
    $display("Testing IRQ val output");
    do_reset();
    set_enable('1);
    set_edge_type('1);
    for (int i = 127; i >= 0; i--) begin
        set_interrupts(BITS_128 << i);
        read_irqval(irq_val);
        assert(i == irq_val) else begin
            errors = errors + 1;
            $display("Expected %d got %d", i, irq_val);
        end
    end

    for (int i = 0; i < 128; i++) begin
        set_interrupts(BITS_128 >> i);
        read_irqval(irq_val);
        assert(int_out == 1) else begin
            errors = errors + 1;
            $display("int_out should be asserted!");
        end
        assert(0 == irq_val) else begin
            errors = errors + 1;
            $display("Expected %d got %d", i, irq_val);
        end
    end

endtask

int errors;
initial begin
    errors = 0;
    test_edge_irq();
    test_level_irq();
    test_irq_val();
    if (errors > 0)
        $finish_and_return(-1);
    else
        $finish();
end

initial
begin
    $dumpfile("interrupt_controller_tb.vcd");
    $dumpvars(0,interrupt_controller_tb);
end

/* These should be shared */
task write_reg(input logic [4:0] _addr, input logic [7:0] _data);
    @(negedge r_clk_cpu);
    cs <= '1;
    addr <= _addr;
    rwb <= '0;
    i_data <= '1;
    @(posedge r_clk_cpu);
    i_data <= _data;
    @(negedge r_clk_cpu);
    cs <= '0;
    rwb <= '1;
    @(posedge r_clk_cpu);
endtask

task read_reg(input logic [2:0] _addr, output logic [7:0] _data);
    @(negedge r_clk_cpu);
    cs <= '1;
    addr <= _addr;
    rwb <= '1;
    i_data <= '1;
    @(posedge r_clk_cpu);
    _data <= o_data;
    @(negedge r_clk_cpu);
    cs <= '0;
    rwb <= '1;
    @(posedge r_clk_cpu);
endtask

task do_reset();
    repeat (5) @(posedge r_clk_cpu);
    reset = 1;
    cs = 0;
    rwb = 1;
    addr = '0;
    i_data = '0;
    int_in = '0;
    repeat (5) @(posedge r_clk_cpu);
    reset = 0;
    repeat (5) @(posedge r_clk_cpu);
endtask

task set_enable(input logic [127:0] en);
    for (int i = 0; i < 16; i++) begin
        write_reg(0, 8'h20 | i);
        write_reg(1, en[8*i +: 8]);
    end
endtask

task set_edge_type(input logic [127:0] edge_type);
    for (int i = 0; i < 16; i++) begin
        write_reg(0, 8'h40 | i);
        write_reg(1, edge_type[8*i +: 8]);
    end
endtask

task set_interrupts(logic [127:0] ints);
    int_in = ints;
    @(posedge r_clk_cpu);
endtask

task send_eoi();
    write_reg(0, 8'hff);
    write_reg(1, 8'h01);
endtask

task read_irqval(output logic [7:0] _irq_val);
    write_reg(0, 8'h00);
    read_reg(1, _irq_val);
endtask


endmodule