`timescale 1ns / 1ps

`include "soc_irq_config.svh"

module soc_irq_topology_tb;
  logic [     `SOC_IRQ_VECTOR_WIDTH-1:0] s_irq;
  logic [`SOC_IRQ_APB4_PERIPH_WIDTH-1:0] s_apb4_periph_irq;
  logic [`SOC_IRQ_APB4_SYSTEM_WIDTH-1:0] s_apb4_system_irq;

  `include "soc_irq_wiring.svh"

  task automatic expect_irq(input logic [`SOC_IRQ_VECTOR_WIDTH-1:0] expected);
    begin
      #1;
      if (s_irq !== expected) begin
        $fatal(1, "unexpected IRQ vector: got %h, expected %h", s_irq, expected);
      end
    end
  endtask

  initial begin
    s_apb4_periph_irq = '0;
    s_apb4_system_irq = '0;
    expect_irq('0);

    for (int bit_index = 0; bit_index < 10; bit_index++) begin
      s_apb4_periph_irq            = '0;
      s_apb4_periph_irq[bit_index] = 1'b1;
      s_apb4_system_irq            = '0;
      expect_irq(32'd1 << bit_index);
    end

    for (int bit_index = 10; bit_index < `SOC_IRQ_APB4_PERIPH_WIDTH; bit_index++) begin
      s_apb4_periph_irq            = '0;
      s_apb4_periph_irq[bit_index] = 1'b1;
      case (bit_index)
        13:      expect_irq(32'd1 << 15);
        14:      expect_irq(32'd1 << 20);
        16:      expect_irq(32'd1 << 10);
        17:      expect_irq(32'd1 << 21);
        18:      expect_irq(32'd1 << 23);
        19:      expect_irq(32'd1 << 24);
        20:      expect_irq(32'd1 << 25);
        21:      expect_irq(32'd1 << 26);
        22:      expect_irq(32'd1 << 30);
        23:      expect_irq(32'd1 << 31);
        default: expect_irq(32'd1 << (bit_index + 7));
      endcase
    end

    for (int bit_index = 0; bit_index < `SOC_IRQ_APB4_SYSTEM_WIDTH; bit_index++) begin
      s_apb4_periph_irq            = '0;
      s_apb4_system_irq            = '0;
      s_apb4_system_irq[bit_index] = 1'b1;
      case (bit_index)
        0:       expect_irq(32'd1 << 11);
        1:       expect_irq(32'd1 << 12);
        2:       expect_irq(32'd1 << 13);
        3:       expect_irq(32'd1 << 14);
        4:       expect_irq(32'd1 << 16);
        5:       expect_irq(32'd1 << 27);
        6:       expect_irq(32'd1 << 28);
        7:       expect_irq(32'd1 << 29);
        default: $fatal(1, "unexpected APB IRQ bit %0d", bit_index);
      endcase
    end

    s_apb4_system_irq = '0;
    expect_irq('0);
    if ((s_irq[10] !== 1'b0) || (s_irq[21] !== 1'b0)) begin
      $fatal(1, "SDIO core IRQ bits are not low when sources are low: IRQ10=%b IRQ21=%b",
             s_irq[10], s_irq[21]);
    end
    if (s_irq[19:18] !== '0) begin
      $fatal(1, "unallocated core IRQ bits are not low: %h", s_irq);
    end

    $display("SoC topology IRQ routing test passed");
    $finish;
  end
endmodule