diff options
| -rw-r--r-- | usrp2/gpmc/Makefile.srcs | 1 | ||||
| -rw-r--r-- | usrp2/gpmc/fifo_watcher.v | 7 | ||||
| -rw-r--r-- | usrp2/gpmc/gpmc_async.v | 43 | ||||
| -rw-r--r-- | usrp2/gpmc/new_write.v | 82 | ||||
| -rw-r--r-- | usrp2/top/E1x0/u1e.v | 4 | ||||
| -rw-r--r-- | usrp2/top/E1x0/u1e_core.v | 4 | 
6 files changed, 110 insertions, 31 deletions
| diff --git a/usrp2/gpmc/Makefile.srcs b/usrp2/gpmc/Makefile.srcs index bff6ae3e0..1eac25394 100644 --- a/usrp2/gpmc/Makefile.srcs +++ b/usrp2/gpmc/Makefile.srcs @@ -17,4 +17,5 @@ gpmc_to_fifo_async.v \  gpmc_to_fifo_sync.v \  gpmc_wb.v \  ram_to_fifo.v \ +new_write.v \  )) diff --git a/usrp2/gpmc/fifo_watcher.v b/usrp2/gpmc/fifo_watcher.v index b139f5143..3971e3c54 100644 --- a/usrp2/gpmc/fifo_watcher.v +++ b/usrp2/gpmc/fifo_watcher.v @@ -30,10 +30,11 @@ module fifo_watcher     reg [15:0] counter;     wire [4:0] pkt_count;     assign debug = pkt_count; +   wire       space;     fifo_short #(.WIDTH(16)) frame_lengths       (.clk(clk), .reset(reset), .clear(clear), -      .datain(counter), .src_rdy_i(write), .dst_rdy_o(), +      .datain(counter), .src_rdy_i(write), .dst_rdy_o(space),        .dataout(length), .src_rdy_o(have_packet_int), .dst_rdy_i(read),        .occupied(pkt_count), .space()); @@ -53,7 +54,9 @@ module fifo_watcher         bus_error <= 1;       else if(read & ~have_packet_int)         bus_error <= 1; - +     else if(write & ~space) +       bus_error <= 1; +        reg 	      in_packet;     always @(posedge clk)       if(reset | clear) diff --git a/usrp2/gpmc/gpmc_async.v b/usrp2/gpmc/gpmc_async.v index c0bec683a..4270abb5c 100644 --- a/usrp2/gpmc/gpmc_async.v +++ b/usrp2/gpmc/gpmc_async.v @@ -22,7 +22,7 @@ module gpmc_async      parameter RXFIFOSIZE = 11,      parameter BUSDEBUG = 1)     (// GPMC signals -    input arst, +    input arst, input bus_clk,      input EM_CLK, inout [15:0] EM_D, input [10:1] EM_A, input [1:0] EM_NBE,      input EM_WAIT0, input EM_NCS4, input EM_NCS6, input EM_NWE, input EM_NOE, @@ -67,27 +67,21 @@ module gpmc_async     // ////////////////////////////////////////////     // TX Data Path -   wire [17:0] 	  tx18_data, tx18b_data; -   wire 	  tx18_src_rdy, tx18_dst_rdy, tx18b_src_rdy, tx18b_dst_rdy; +   wire [17:0] 	  tx18_data; +   wire 	  tx18_src_rdy, tx18_dst_rdy;     wire [15:0] 	  tx_fifo_space;     wire [35:0] 	  tx36_data, tx_data;     wire 	  tx36_src_rdy, tx36_dst_rdy, tx_src_rdy, tx_dst_rdy; -   gpmc_to_fifo_async gpmc_to_fifo_async +   new_write new_write       (.EM_D(EM_D), .EM_NBE(EM_NBE), .EM_NCS(EM_NCS4), .EM_NWE(EM_NWE), -      .fifo_clk(fifo_clk), .fifo_rst(fifo_rst), .clear(clear_tx), +      .bus_clk(bus_clk), .fifo_clk(fifo_clk), .fifo_rst(fifo_rst), .clear(clear_tx),        .data_o(tx18_data), .src_rdy_o(tx18_src_rdy), .dst_rdy_i(tx18_dst_rdy), -      .frame_len(tx_frame_len), .fifo_space(tx_fifo_space), .fifo_ready(tx_have_space), -      .bus_error(bus_error_tx) ); +      .frame_len(tx_frame_len), .fifo_ready(tx_have_space), .bus_error(bus_error_tx) ); -   fifo_cascade #(.WIDTH(18), .SIZE(10)) tx_fifo -     (.clk(fifo_clk), .reset(fifo_rst), .clear(clear_tx), -      .datain(tx18_data), .src_rdy_i(tx18_src_rdy), .dst_rdy_o(tx18_dst_rdy), .space(tx_fifo_space), -      .dataout(tx18b_data), .src_rdy_o(tx18b_src_rdy), .dst_rdy_i(tx18b_dst_rdy), .occupied()); -     fifo19_to_fifo36 #(.LE(1)) f19_to_f36   // Little endian because ARM is LE       (.clk(fifo_clk), .reset(fifo_rst), .clear(clear_tx), -      .f19_datain({1'b0,tx18b_data}), .f19_src_rdy_i(tx18b_src_rdy), .f19_dst_rdy_o(tx18b_dst_rdy), +      .f19_datain({1'b0,tx18_data}), .f19_src_rdy_i(tx18_src_rdy), .f19_dst_rdy_o(tx18_dst_rdy),        .f36_dataout(tx36_data), .f36_src_rdy_o(tx36_src_rdy), .f36_dst_rdy_i(tx36_dst_rdy));     fifo_cascade #(.WIDTH(36), .SIZE(TXFIFOSIZE)) tx_fifo36 @@ -110,6 +104,9 @@ module gpmc_async        .datain(rx_data), .src_rdy_i(rx_src_rdy), .dst_rdy_o(rx_dst_rdy),        .dataout(rx36_data), .src_rdy_o(rx36_src_rdy), .dst_rdy_i(rx36_dst_rdy)); +   wire [31:0] 	pkt_count; +   wire 	throttle = pkt_count == 16; +        fifo36_to_fifo19 #(.LE(1)) f36_to_f19   // Little endian because ARM is LE       (.clk(fifo_clk), .reset(fifo_rst), .clear(clear_rx),        .f36_datain(rx36_data), .f36_src_rdy_i(rx36_src_rdy), .f36_dst_rdy_o(rx36_dst_rdy), @@ -126,7 +123,6 @@ module gpmc_async        .EM_D(EM_D_fifo), .EM_NCS(EM_NCS4), .EM_NOE(EM_NOE),        .frame_len(rx_frame_len) ); -   wire [31:0] 	pkt_count;     fifo_watcher fifo_watcher       (.clk(fifo_clk), .reset(fifo_rst), .clear(clear_rx), @@ -230,16 +226,13 @@ module gpmc_async     // FIXME -- make sure packet completes before we shutoff     // FIXME -- handle overrun and underrun -wire [0:17] dummy18; - -assign debug = {8'd0, -		test_rate, -		pkt_src_enable, pkt_sink_enable, timedrx_src_rdy_int, timedrx_dst_rdy_int, -		timedrx_src_rdy, timedrx_dst_rdy, -		testrx_src_rdy, testrx_dst_rdy, -		rx_src_rdy, rx_dst_rdy, -		rx36_src_rdy, rx36_dst_rdy, -		rx18_src_rdy, rx18_dst_rdy, -		rx18b_src_rdy, rx18b_dst_rdy}; +   wire [0:17] 	dummy18; + +   assign debug = {rx_overrun, tx_underrun, bus_error_tx, bus_error_rx, tx_have_space, rx_have_data, EM_NCS4, EM_NCS6, +		   6'd0, EM_NOE, EM_NWE, +		   pkt_src_enable, pkt_sink_enable, timedrx_src_rdy_int, timedrx_dst_rdy_int, +		   timedrx_src_rdy, timedrx_dst_rdy, +		   testrx_src_rdy, testrx_dst_rdy, +		   rx_src_rdy, rx_dst_rdy, rx36_src_rdy, rx36_dst_rdy, rx18_src_rdy, rx18_dst_rdy, rx18b_src_rdy, rx18b_dst_rdy};  endmodule // gpmc_async diff --git a/usrp2/gpmc/new_write.v b/usrp2/gpmc/new_write.v new file mode 100644 index 000000000..df0ce19db --- /dev/null +++ b/usrp2/gpmc/new_write.v @@ -0,0 +1,82 @@ +// +// Copyright 2011 Ettus Research LLC +// +// This program is free software: you can redistribute it and/or modify +// it under the terms of the GNU General Public License as published by +// the Free Software Foundation, either version 3 of the License, or +// (at your option) any later version. +// +// This program is distributed in the hope that it will be useful, +// but WITHOUT ANY WARRANTY; without even the implied warranty of +// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the +// GNU General Public License for more details. +// +// You should have received a copy of the GNU General Public License +// along with this program.  If not, see <http://www.gnu.org/licenses/>. +// + + +module new_write +  (input [15:0] EM_D, input [1:0] EM_NBE, input EM_NCS, input EM_NWE, + +   input bus_clk, +   input fifo_clk, input fifo_rst, input clear, +   output [17:0] data_o, output src_rdy_o, input dst_rdy_i, + +   input [15:0] frame_len, output reg fifo_ready, +   output reg bus_error ); + +   wire [15:0] fifo_space; +   reg [15:0]  counter; + +   // Synchronize the async control signals +   reg [1:0] 	cs_del, we_del; +   reg [15:0] 	data_del[0:1]; +    +   always @(posedge bus_clk) +     if(fifo_rst) +       begin +	  cs_del <= 2'b11; +	  we_del <= 2'b11; +       end +     else +       begin +	  cs_del <= { cs_del[0], EM_NCS }; +	  we_del <= { we_del[0], EM_NWE }; +	  data_del[1] <= data_del[0]; +	  data_del[0] <= EM_D; +       end + +   wire first_write = (counter == 0); +   wire last_write = ((counter+1) == frame_len); + +   wire [17:0] data_int = {last_write,first_write,data_del[1]}; +   wire        src_rdy_int = (~cs_del[1] & ~we_del[1] & we_del[0]); // rising edge +   wire        dst_rdy_int; +    +   always @(posedge bus_clk) +     if(fifo_rst | clear) +       counter <= 0; +     else if(src_rdy_int) +       if(last_write) +	 counter <= 0; +       else +	 counter <= counter + 1; + +   always @(posedge bus_clk) +     if(fifo_rst | clear) +       fifo_ready <= 0; +     else +       fifo_ready <= /* first_write & */ (fifo_space > 16'd1023); + +   always @(posedge bus_clk) +     if(fifo_rst | clear) +       bus_error <= 0; +     else if(src_rdy_int & ~dst_rdy_int) +       bus_error <= 1; + +   fifo_2clock_cascade #(.WIDTH(18), .SIZE(10)) tx_fifo +     (.wclk(bus_clk), .datain(data_int), .src_rdy_i(src_rdy_int), .dst_rdy_o(dst_rdy_int), .space(fifo_space), +      .rclk(fifo_clk), .dataout(data_o), .src_rdy_o(src_rdy_o), .dst_rdy_i(dst_rdy_i), .occupied(), .arst(fifo_rst)); + +endmodule // new_write diff --git a/usrp2/top/E1x0/u1e.v b/usrp2/top/E1x0/u1e.v index adf42fd07..92915814c 100644 --- a/usrp2/top/E1x0/u1e.v +++ b/usrp2/top/E1x0/u1e.v @@ -75,7 +75,7 @@ module u1e     clk_doubler (.CLKFB(clk_fb), .CLKIN(clk_fpga_in), .RST(dcm_rst),                   .DSSEN(0), .PSCLK(0), .PSEN(0), .PSINCDEC(0), .PSDONE(),   		.CLKDV(), .CLKFX(), .CLKFX180(),  -                .CLK2X(), .CLK2X180(),  +                .CLK2X(clk_2x), .CLK2X180(),                   .CLK0(clk_fb), .CLK90(clk_fpga), .CLK180(), .CLK270(),                   .LOCKED(dcm_locked), .STATUS()); @@ -130,7 +130,7 @@ module u1e     // /////////////////////////////////////////////////////////////////////////     // Main U1E Core -   u1e_core u1e_core(.clk_fpga(clk_fpga), .rst_fpga(~debug_pb), +   u1e_core u1e_core(.clk_fpga(clk_fpga), .bus_clk(clk_2x), .rst_fpga(~debug_pb),  		     .debug_led(debug_led), .debug(debug), .debug_clk(debug_clk),  		     .debug_txd(FPGA_TXD), .debug_rxd(FPGA_RXD),  		     .EM_CLK(EM_CLK), .EM_D(EM_D), .EM_A(EM_A), .EM_NBE(EM_NBE), diff --git a/usrp2/top/E1x0/u1e_core.v b/usrp2/top/E1x0/u1e_core.v index 4c513587b..00335d118 100644 --- a/usrp2/top/E1x0/u1e_core.v +++ b/usrp2/top/E1x0/u1e_core.v @@ -18,7 +18,7 @@  module u1e_core -  (input clk_fpga, input rst_fpga, +  (input clk_fpga, input bus_clk, input rst_fpga,     output [3:0] debug_led, output [31:0] debug, output [1:0] debug_clk,     output debug_txd, input debug_rxd, @@ -110,7 +110,7 @@ module u1e_core        .in(set_data),.out(),.changed(clear_tx));     gpmc_async #(.TXFIFOSIZE(TXFIFOSIZE), .RXFIFOSIZE(RXFIFOSIZE)) -   gpmc (.arst(wb_rst), +   gpmc (.arst(wb_rst), .bus_clk(bus_clk),  	 .EM_CLK(EM_CLK), .EM_D(EM_D), .EM_A(EM_A), .EM_NBE(EM_NBE),  	 .EM_WAIT0(EM_WAIT0), .EM_NCS4(EM_NCS4), .EM_NCS6(EM_NCS6), .EM_NWE(EM_NWE),   	 .EM_NOE(EM_NOE), | 
