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
|
// Join vita packets longer than one GPIF frame, drop padding on short frames
module packet_reframer
(input clk, input reset, input clear,
input [18:0] data_i,
input src_rdy_i,
output dst_rdy_o,
output [18:0] data_o,
output src_rdy_o,
input dst_rdy_i);
reg [1:0] state;
reg [15:0] length;
localparam RF_IDLE = 0;
localparam RF_PKT = 1;
localparam RF_DUMP = 2;
always @(posedge clk)
if(reset | clear)
state <= 0;
else
if(src_rdy_i & dst_rdy_i)
case(state)
RF_IDLE :
begin
length <= {data_i[14:0],1'b0};
state <= RF_PKT;
end
RF_PKT :
begin
if(length == 2)
if(data_i[17])
state <= RF_IDLE;
else
state <= RF_DUMP;
else
length <= length - 1;
end
RF_DUMP :
if(data_i[17])
state <= RF_IDLE;
default :
state<= RF_IDLE;
endcase // case (state)
assign dst_rdy_o = dst_rdy_i; // this is a little pessimistic but ok
assign src_rdy_o = src_rdy_i & (state != RF_DUMP);
wire occ_out = 0;
wire eof_out = (state == RF_PKT) & (length == 2);
wire sof_out = (state == RF_IDLE);
wire [15:0] data_out = data_i[15:0];
assign data_o = {occ_out, eof_out, sof_out, data_out};
endmodule // packet_reframer
|
