Memory: Do not progress LSM state machine if rw_wait.

[firearm.git] / Memory.v

diff --git a/Memory.v b/Memory.v
index b7710b0aae5aac3a78e418be7530fc77f197878d..6b529897d14fede7ab173916aaadfd3abb3450b6 100644 (file)
--- a/Memory.v
+++ b/Memory.v
@@ -254,11 +254,11 @@ module Memory(
                        end
                        `LSM_MEMIO: begin
                                outstall = 1'b1;
                        end
                        `LSM_MEMIO: begin
                                outstall = 1'b1;

-                               if(next_regs == 16'b0) begin
+                               if(next_regs == 16'b0 && !rw_wait) begin

                                        next_lsm_state = `LSM_BASEWB;
                                end
                                
                                        next_lsm_state = `LSM_BASEWB;
                                end
                                

-                               $display("LDMSTM: Stage 2: Writing: regs %b, next_regs %b, reg %d, wr_data %08x, addr %08x", regs, next_regs, cur_reg, wr_data, busaddr);
+                               $display("LDMSTM: Stage 2: Writing: regs %b, next_regs %b, reg %d, wr_data %08x, addr %08x", regs, next_regs, cur_reg, st_data, busaddr);

                        end
                        `LSM_BASEWB: begin
                                outstall = 1;
                        end
                        `LSM_BASEWB: begin
                                outstall = 1;


@@ -402,7 +402,7 @@ module Memory(
                        `LSM_SETUP:
                                next_write_reg = 1'b0;
                        `LSM_MEMIO: begin
                        `LSM_SETUP:
                                next_write_reg = 1'b0;
                        `LSM_MEMIO: begin

-                               if(insn[20]) begin
+                               if(insn[20] /* L */) begin

                                        next_write_reg = !rw_wait;
                                        next_write_num = cur_reg;
                                        next_write_data = rd_data;
                                        next_write_reg = !rw_wait;
                                        next_write_num = cur_reg;
                                        next_write_data = rd_data;


@@ -480,7 +480,6 @@ module Memory(
                        2'b11: /* signed half */
                                data_size = 3'b010;
                        default: begin
                        2'b11: /* signed half */
                                data_size = 3'b010;
                        default: begin

-                               wr_data = 32'hxxxxxxxx;

                                data_size = 3'bxxx;
                        end
                        endcase
                                data_size = 3'bxxx;
                        end
                        endcase


@@ -500,7 +499,6 @@ module Memory(
                        addr = insn[23] ? op0 + op1 : op0 - op1; /* up/down select */
                        raddr = insn[24] ? addr : op0; /* pre/post increment */
                        busaddr = raddr;
                        addr = insn[23] ? op0 + op1 : op0 - op1; /* up/down select */
                        raddr = insn[24] ? addr : op0; /* pre/post increment */
                        busaddr = raddr;

-                       wr_data = insn[22] ? {24'h0, {op2[7:0]}} : op2;

                        data_size = insn[22] ? 3'b001 : 3'b100;
                        case (lsr_state)
                        `LSR_MEMIO: begin
                        data_size = insn[22] ? 3'b001 : 3'b100;
                        case (lsr_state)
                        `LSR_MEMIO: begin


@@ -572,7 +570,7 @@ module Memory(
                                endcase
                end
                `DECODE_LDMSTM: if (!inbubble)
                                endcase
                end
                `DECODE_LDMSTM: if (!inbubble)

-                       if (lsr_state == `LSM_MEMIO)
+                       if (lsm_state == `LSM_MEMIO)

                                wr_data = (cur_reg == 4'hF) ? (pc + 12) : st_data;
                `DECODE_LDCSTC: begin end
                `DECODE_CDP: begin end
                                wr_data = (cur_reg == 4'hF) ? (pc + 12) : st_data;
                `DECODE_LDCSTC: begin end
                `DECODE_CDP: begin end


@@ -591,7 +589,7 @@ module Memory(
        
        always @(*)
        begin
        
        always @(*)
        begin

-               offset = prev_offset;
+               st_read = 4'hx;

                cur_reg = prev_reg;
                next_regs = regs;
                
                cur_reg = prev_reg;
                next_regs = regs;
                


@@ -686,7 +684,6 @@ module Memory(
        
        always @(*)
        begin
        
        always @(*)
        begin

-               st_read = 4'hx;

                do_rd_data_latch = 0;
                
                next_outbubble = inbubble;
                do_rd_data_latch = 0;
                
                next_outbubble = inbubble;