1 `include "ARM_Constants.v"
8 output reg [31:0] busaddr,
12 output reg [31:0] wr_data,
15 /* regfile interface */
16 output reg [3:0] st_read,
29 input [3:0] write_num,
30 input [31:0] write_data,
35 output reg [31:0] outpc,
36 output reg [31:0] outinsn,
37 output reg out_write_reg = 1'b0,
38 output reg [3:0] out_write_num = 4'bxxxx,
39 output reg [31:0] out_write_data = 32'hxxxxxxxx,
40 output reg [31:0] out_spsr = 32'hxxxxxxxx,
41 output reg [31:0] out_cpsr = 32'hxxxxxxxx
44 reg [31:0] addr, raddr, prev_raddr, next_regdata, next_outcpsr;
45 reg [3:0] next_regsel, cur_reg, prev_reg;
47 reg [31:0] align_s1, align_s2, align_rddata;
51 wire [3:0] next_write_num;
52 wire [31:0] next_write_data;
54 reg [1:0] lsr_state = 2'b01, next_lsr_state;
56 reg [15:0] regs, next_regs;
57 reg [2:0] lsm_state = 3'b001, next_lsm_state;
58 reg [5:0] offset, prev_offset, offset_sel;
60 reg [31:0] swp_oldval, next_swp_oldval;
61 reg [1:0] swp_state = 2'b01, next_swp_state;
67 outbubble <= next_outbubble;
68 out_write_reg <= next_write_reg;
69 out_write_num <= next_write_num;
70 out_write_data <= next_write_data;
73 prev_offset <= offset;
75 out_cpsr <= next_outcpsr;
77 swp_state <= next_swp_state;
86 wr_data = 32'hxxxxxxxx;
87 busaddr = 32'hxxxxxxxx;
89 next_write_reg = write_reg;
90 next_write_num = write_num;
91 next_write_data = write_data;
92 next_outbubble = inbubble;
96 next_outcpsr = lsm_state == 3'b010 ? out_cpsr : cpsr;
97 next_lsm_state = lsm_state;
98 next_lsr_state = lsr_state;
99 next_swp_oldval = swp_oldval;
100 next_swp_state = swp_state;
104 `DECODE_ALU_SWP: begin
107 next_outbubble = rw_wait;
108 busaddr = {op0[31:2], 2'b0};
114 next_swp_state = 2'b10;
115 next_swp_oldval = rd_data;
121 next_write_reg = 1'b1;
122 next_write_num = insn[15:12];
123 next_write_data = swp_oldval;
125 next_swp_state = 2'b01;
131 `DECODE_LDRSTR_UNDEFINED: begin end
132 `DECODE_LDRSTR: begin
134 next_outbubble = rw_wait;
136 addr = insn[23] ? op0 + op1 : op0 - op1; /* up/down select */
137 raddr = insn[24] ? op0 : addr; /* pre/post increment */
138 busaddr = {raddr[31:2], 2'b0};
140 /* rotate to correct position */
141 align_s1 = raddr[1] ? {rd_data[15:0], rd_data[31:16]} : rd_data;
142 align_s2 = raddr[0] ? {align_s1[7:0], align_s1[31:8]} : align_s1;
143 /* select byte or word */
144 align_rddata = insn[22] ? {24'b0, align_s2[7:0]} : align_s2;
146 wr_data = insn[22] ? {4{op2[7:0]}} : op2; /* XXX need to actually store just a byte */
154 next_write_reg = 1'b1;
155 next_write_num = insn[15:12];
156 next_write_data = align_rddata;
162 next_lsr_state = 2'b10;
166 next_write_reg = 1'b1;
167 next_write_num = insn[19:16];
168 next_write_data = addr;
169 next_lsr_state = 2'b10;
175 `DECODE_LDMSTM: begin
177 next_outbubble = rw_wait;
180 // next_regs = insn[23] ? op1[15:0] : op1[0:15];
181 /** verilator can suck my dick */
182 next_regs = insn[23] ? op1[15:0] : {op1[0], op1[1], op1[2], op1[3], op1[4], op1[5], op1[6], op1[7],
183 op1[8], op1[9], op1[10], op1[11], op1[12], op1[13], op1[14], op1[15]};
186 next_lsm_state = 3'b010;
192 16'b???????????????1: begin
194 next_regs = {regs[15:1], 1'b0};
196 16'b??????????????10: begin
198 next_regs = {regs[15:2], 2'b0};
200 16'b?????????????100: begin
202 next_regs = {regs[15:3], 3'b0};
204 16'b????????????1000: begin
206 next_regs = {regs[15:4], 4'b0};
208 16'b???????????10000: begin
210 next_regs = {regs[15:5], 5'b0};
212 16'b??????????100000: begin
214 next_regs = {regs[15:6], 6'b0};
216 16'b?????????1000000: begin
218 next_regs = {regs[15:7], 7'b0};
220 16'b????????10000000: begin
222 next_regs = {regs[15:8], 8'b0};
224 16'b???????100000000: begin
226 next_regs = {regs[15:9], 9'b0};
228 16'b??????1000000000: begin
230 next_regs = {regs[15:10], 10'b0};
232 16'b?????10000000000: begin
234 next_regs = {regs[15:11], 11'b0};
236 16'b????100000000000: begin
238 next_regs = {regs[15:12], 12'b0};
240 16'b???1000000000000: begin
242 next_regs = {regs[15:13], 13'b0};
244 16'b??10000000000000: begin
246 next_regs = {regs[15:14], 14'b0};
248 16'b?100000000000000: begin
250 next_regs = {regs[15], 15'b0};
252 16'b1000000000000000: begin
261 cur_reg = insn[23] ? 4'hF - cur_reg : cur_reg;
262 if(cur_reg == 4'hF && insn[22]) begin
272 offset = prev_offset + 6'h4;
273 offset_sel = insn[24] ? offset : prev_offset;
274 raddr = insn[23] ? op0 + {26'b0, offset_sel} : op0 - {26'b0, offset_sel};
276 next_write_reg = 1'b1;
277 next_write_num = cur_reg;
278 next_write_data = rd_data;
284 busaddr = {raddr[31:2], 2'b0};
288 if(next_regs == 16'b0) begin
289 next_lsm_state = 3'b100;
293 next_write_reg = 1'b1;
294 next_write_num = insn[19:16];
295 next_write_data = insn[23] ? op0 + {26'b0, prev_offset} : op0 - {26'b0, prev_offset};
296 next_lsm_state = 3'b001;