1 | module analyser
|
---|
2 | (
|
---|
3 | input wire clk, reset,
|
---|
4 | input wire data_ready,
|
---|
5 | input wire [1:0] uwt_flag,
|
---|
6 | input wire [11:0] uwt_data,
|
---|
7 | output wire peak_ready,
|
---|
8 | output wire [11:0] peak
|
---|
9 | );
|
---|
10 |
|
---|
11 | reg [1:0] state_reg, state_next;
|
---|
12 | reg [3:0] counter_reg, counter_next;
|
---|
13 | reg peak_ready_reg, peak_ready_next;
|
---|
14 | reg [11:0] peak_reg, peak_next;
|
---|
15 | reg [15:0] buffer [15:0];
|
---|
16 | wire [15:0] sample;
|
---|
17 | wire [11:0] baseline;
|
---|
18 |
|
---|
19 | integer i;
|
---|
20 |
|
---|
21 | assign sample = {4'd0, uwt_data};
|
---|
22 | assign baseline = buffer[15][15:4];
|
---|
23 |
|
---|
24 | always @(posedge clk)
|
---|
25 | begin
|
---|
26 | if (reset)
|
---|
27 | begin
|
---|
28 | state_reg <= 2'd0;
|
---|
29 | counter_reg <= 4'd0;
|
---|
30 | peak_ready_reg <= 1'b0;
|
---|
31 | peak_reg <= 12'd0;
|
---|
32 |
|
---|
33 | for(i = 0; i <= 15; i = i + 1)
|
---|
34 | begin
|
---|
35 | buffer[i] <= 12'd0;
|
---|
36 | end
|
---|
37 | end
|
---|
38 | else
|
---|
39 | begin
|
---|
40 | state_reg <= state_next;
|
---|
41 | counter_reg <= counter_next;
|
---|
42 | peak_ready_reg <= peak_ready_next;
|
---|
43 | peak_reg <= peak_next;
|
---|
44 |
|
---|
45 | if (data_ready & uwt_flag[1])
|
---|
46 | begin
|
---|
47 | for(i = 0; i < 15; i = i + 1)
|
---|
48 | begin
|
---|
49 | buffer[i+1] <= buffer[i] + sample;
|
---|
50 | end
|
---|
51 | buffer[0] <= sample;
|
---|
52 | end
|
---|
53 | end
|
---|
54 | end
|
---|
55 |
|
---|
56 | always @*
|
---|
57 | begin
|
---|
58 | state_next = state_reg;
|
---|
59 | counter_next = counter_reg;
|
---|
60 | peak_ready_next = 1'b0;
|
---|
61 | peak_next = 12'd0;
|
---|
62 | case (state_reg)
|
---|
63 | 0: // skip first 16 samples
|
---|
64 | begin
|
---|
65 | if (data_ready)
|
---|
66 | begin
|
---|
67 | counter_next = counter_reg + 4'd1;
|
---|
68 | if (&counter_reg)
|
---|
69 | begin
|
---|
70 | state_next = 2'd1;
|
---|
71 | end
|
---|
72 | end
|
---|
73 | end
|
---|
74 |
|
---|
75 | 1: // skip first 16 minima
|
---|
76 | begin
|
---|
77 | if (data_ready & uwt_flag[1])
|
---|
78 | begin
|
---|
79 | counter_next = counter_reg + 4'd1;
|
---|
80 | if (&counter_reg)
|
---|
81 | begin
|
---|
82 | state_next = 2'd2;
|
---|
83 | end
|
---|
84 | end
|
---|
85 | end
|
---|
86 |
|
---|
87 | 2: // calculate peak height
|
---|
88 | begin
|
---|
89 | if (data_ready & uwt_flag[0])
|
---|
90 | begin
|
---|
91 | peak_next = uwt_data - baseline;
|
---|
92 | peak_ready_next = 1'b1;
|
---|
93 | end
|
---|
94 | end
|
---|
95 |
|
---|
96 | default:
|
---|
97 | begin
|
---|
98 | state_next = 2'd0;
|
---|
99 | end
|
---|
100 | endcase
|
---|
101 | end
|
---|
102 |
|
---|
103 | assign peak_ready = peak_ready_reg;
|
---|
104 | assign peak = peak_reg;
|
---|
105 | endmodule
|
---|