copied from quad radio

1 files changed, 54 insertions, 0 deletions

diff --git a/usrp2/control_lib/v5icap_wb.v b/usrp2/control_lib/v5icap_wb.v
new file mode 100644
index 000000000..c8800285a
--- /dev/null
+++ b/usrp2/control_lib/v5icap_wb.v
@@ -0,0 +1,54 @@
+
+
+module v5icap_wb
+  (input clk, input reset,
+   input cyc_i, input stb_i, input we_i, output ack_o,
+   input [31:0] dat_i, output [31:0] dat_o);
+
+   wire 	BUSY, CE, WRITE;
+   
+   reg [2:0] 	icap_state;
+   localparam ICAP_IDLE  = 0;
+   localparam ICAP_WR0 	 = 1;
+   localparam ICAP_WR1 	 = 2;
+   localparam ICAP_RD0 	 = 3;
+   localparam ICAP_RD1 	 = 4;
+
+   always @(posedge clk)
+     if(reset)
+       icap_state 	<= ICAP_IDLE;
+     else
+       case(icap_state)
+	 ICAP_IDLE :
+	   begin
+	      if(stb_i & cyc_i)
+		if(we_i)
+		  icap_state <= ICAP_WR0;
+		else
+		  icap_state <= ICAP_RD0;
+	   end
+	 ICAP_WR0 :
+	   icap_state <= ICAP_WR1;
+	 ICAP_WR1 :
+	   icap_state <= ICAP_IDLE;
+	 ICAP_RD0 :
+	   icap_state <= ICAP_RD1;
+	 ICAP_RD1 :
+	   icap_state <= ICAP_IDLE;
+       endcase // case (icap_state)
+
+   assign WRITE 	 = (icap_state == ICAP_WR0) | (icap_state == ICAP_WR1);
+   assign CE 		 = (icap_state == ICAP_WR1) | (icap_state == ICAP_RD0);
+
+   assign ack_o = (icap_state == ICAP_WR1) | (icap_state == ICAP_RD1);
+   
+   ICAP_VIRTEX5 #(.ICAP_WIDTH("X32")) ICAP_VIRTEX5_inst 
+     (.BUSY(BUSY),          // Busy output
+      .O(dat_o),            // 32-bit data output
+      .CE(~CE),              // Clock enable input
+      .CLK(clk),            // Clock input
+      .I(dat_i),            // 32-bit data input
+      .WRITE(~WRITE)         // Write input
+      );
+
+endmodule // v5icap_wb