-
Notifications
You must be signed in to change notification settings - Fork 2
/
Copy pathSlave_4K.v
175 lines (141 loc) · 3.09 KB
/
Slave_4K.v
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
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
`timescale 1ns / 1ps
`define IDLE 1'b0
`define START 1'b1
// Responses
`define OKAY 2'b00
`define ERROR 2'b01
`define RETRY 2'b10
module Slave_4K(SEL,HADDR,HWDATA,HRDATA,HRESP,CLK,HREADY,RST,MLOCK,AB);
input [15:0] HADDR;
input [31:0] HWDATA;
input SEL;
input RST,CLK;
input MLOCK;
//input HWRITE;
output reg [31:0] HRDATA;
output reg [1:0] HRESP;
output reg HREADY;
output reg AB;
// Slave States
parameter IDLE = 3'd0;
parameter ACTIVE = 3'd1;
parameter WRITE = 3'd2;
parameter READ = 3'd3;
parameter MSB_ADDR = 11; // MSB for 2K Address
reg [2:0] state;
reg [10:0] S_ADDR;
reg HWRITE;
reg TRANS;
// 4K Memory Addresses
reg [31:0] S_REG [4095:0]; //4K, 32-bit registers
initial begin
AB = 1'bz;
HREADY <= 1'bz;
end
always @ (posedge CLK or posedge RST )
begin
if(RST == 1)
begin
HRDATA <= 32'bx;
HRESP <= `OKAY;
HREADY <= 1'bz;
S_ADDR <= 11'bx;
HWRITE <= 1'bx;
TRANS <= 1'bx;
state <= IDLE;
end
else
begin
state <= IDLE;
case(state)
IDLE:begin
HRESP <= `OKAY;
HREADY <= 1'bz;
state <= (SEL == 1)?ACTIVE:IDLE;
end
ACTIVE:begin
HRESP <= `OKAY;
HREADY <= 1'b1;
S_ADDR <= HADDR[MSB_ADDR:0];
HWRITE <= HADDR[12];
TRANS <= HADDR[15];
if(TRANS == 1'b1)
begin
HREADY <= 1'b1; // toggles the HREADY line only if selected as active device
HRESP <= `OKAY;
state <= (HWRITE == 1)?WRITE:READ;
end
else
begin
HRESP <= `ERROR;
state <= (SEL == 1)?ACTIVE:IDLE;
end
end
WRITE:begin
S_ADDR <= HADDR[MSB_ADDR:0];
HWRITE <= HADDR[12];
TRANS <= HADDR[15];
if(TRANS == `START)
begin
S_REG[S_ADDR] <= HWDATA;
if(HWDATA == S_REG[S_ADDR])
begin
HRESP <= `OKAY;
HREADY <= 1'b1;
state <= ACTIVE;
end
else if(HWDATA !== S_REG[S_ADDR] && MLOCK == 1)
begin
HRESP <= `RETRY;
HREADY <= 1'b0;
state <= WRITE;
end
else
begin
HRESP <= `ERROR;
HREADY <= 1'b0;
state <= ACTIVE;
end
end
else
begin
HRESP <= `RETRY;
state <= ACTIVE;
end
end
READ:begin
S_ADDR <= HADDR[MSB_ADDR:0];
HWRITE <= HADDR[12];
TRANS <= HADDR[15];
if(TRANS == `START)
begin
HRDATA <= S_REG[S_ADDR];
end
else
begin
HRESP <= `RETRY;
state <= ACTIVE;
end
if(HRDATA == S_REG[S_ADDR])
begin
HRESP <= `OKAY;
HREADY <= 1'b1;
state <= ACTIVE;
end
else if(HRDATA != S_REG[S_ADDR] && MLOCK == 1)
begin
HRESP <= `RETRY;
HREADY <= 1'b0;
state <= READ;
end
else
begin
HRESP <= `ERROR;
HREADY <= 1'b0;
state <= ACTIVE;
end
end
endcase
end
end
endmodule