aboutsummaryrefslogtreecommitdiffstats
path: root/fpga/usrp3/lib/zynq_fifo/zf_slave_readback.v
blob: f7e25deb29571f7dd32dee6b1f2b4d395ef7896f (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
//////////////////////////////////////////////////////////////////////////////////
// Copyright Ettus Research LLC
// The ZYNQ FIFO slave readback:
//  - implements read state machine for 32-bit addressable AXI slave
//  - provides readback for state of per-stream fifo pointers
//////////////////////////////////////////////////////////////////////////////////


module zf_slave_readback
#(
    parameter CONFIG_BASE = 32'h40000000
)
(
    input clk,
    input rst,

    //------------------------------------------------------------------
    //-- control read signals - slave
    //------------------------------------------------------------------
    input [31:0] AXI_ARADDR,
    input AXI_ARVALID,
    output AXI_ARREADY,
    output [31:0] AXI_RDATA,
    output [1:0] AXI_RRESP,
    output AXI_RVALID,
    input AXI_RREADY,

    //------------------------------------------------------------------
    // readback interface
    //------------------------------------------------------------------
    output reg [31:0] addr,
    input [31:0] data,
    output strobe,

    output [31:0] debug
);

////////////////////////////////////////////////////////////////////////
///////////////////////////// Begin R T L //////////////////////////////
////////////////////////////////////////////////////////////////////////

    //------------------------------------------------------------------
    // Control read state machine responds to AXI control reads
    // Used for reading back the state of the various FIFOs
    //------------------------------------------------------------------
    localparam STATE_ADDR = 0;
    localparam STATE_READ = 1;
    localparam STATE_DATA = 2;

    reg [3:0] state;

    always @(posedge clk) begin
        if (rst) begin
            state <= STATE_ADDR;
            addr <= 0;
        end
        else case (state)

        STATE_ADDR: begin
            if (AXI_ARVALID && AXI_ARREADY) begin
                state <= STATE_READ;
                addr <= (AXI_ARADDR - CONFIG_BASE);
            end
        end

        STATE_READ: begin
            state <= STATE_DATA;
        end

        STATE_DATA: begin
            if (AXI_RVALID && AXI_RREADY) begin
                state <= STATE_ADDR;
            end
        end

        default: state <= STATE_ADDR;

        endcase //state
    end

    assign strobe = AXI_RVALID && AXI_RREADY;

    //readback data
    assign AXI_RDATA = data;
    //only acking address reads from the wait state
    assign AXI_ARREADY = (state == STATE_ADDR);
    //when to release outputs from the slave
    assign AXI_RVALID = (state == STATE_DATA);
    assign AXI_RRESP = 0;

endmodule //zf_slave_readback