Added support for some register indirect addressing modes. Also added documentation comments and did some general cleanup
This commit is contained in:
parent
85bf886223
commit
0901af23db
@ -12,6 +12,12 @@
|
|||||||
`define PROC_DE_LOAD_16_EXTRA_FETCH_SET 4'b0110
|
`define PROC_DE_LOAD_16_EXTRA_FETCH_SET 4'b0110
|
||||||
`define PROC_DE_LOAD_16_EXTRA_FETCH 4'b0111
|
`define PROC_DE_LOAD_16_EXTRA_FETCH 4'b0111
|
||||||
|
|
||||||
|
/*MEM/IO READ*/
|
||||||
|
`define RPOC_MEMIO_READ 4'b1100
|
||||||
|
`define PROC_MEMIO_SETADDR 4'b1101
|
||||||
|
`define PROC_MEMIO_GET_ALIGNED_DATA 4'b1110 /* :) */
|
||||||
|
`define PROC_MEMIO_GET_UNALIGNED_DATA 4'b1010 /* :( */
|
||||||
|
|
||||||
/*EXECUTE STATE*/
|
/*EXECUTE STATE*/
|
||||||
`define PROC_EX_STATE_ENTRY 4'b1000
|
`define PROC_EX_STATE_ENTRY 4'b1000
|
||||||
`define PROC_EX_STATE_EXIT 4'b1001
|
`define PROC_EX_STATE_EXIT 4'b1001
|
||||||
|
175
cpu/processor.v
175
cpu/processor.v
@ -24,6 +24,9 @@ reg [15:0] CIR;
|
|||||||
reg [15:0] PARAM1;
|
reg [15:0] PARAM1;
|
||||||
reg [15:0] PARAM2;
|
reg [15:0] PARAM2;
|
||||||
reg unaligned_access;
|
reg unaligned_access;
|
||||||
|
reg [1:0]IN_MOD;
|
||||||
|
reg [2:0]IN_RM;
|
||||||
|
reg Wbit;
|
||||||
|
|
||||||
// Execution units
|
// Execution units
|
||||||
reg [1:0] in1_sel;
|
reg [1:0] in1_sel;
|
||||||
@ -44,6 +47,7 @@ always @(negedge reset) begin
|
|||||||
@(posedge reset)
|
@(posedge reset)
|
||||||
@(negedge clock);
|
@(negedge clock);
|
||||||
state=`PROC_IF_STATE_ENTRY;
|
state=`PROC_IF_STATE_ENTRY;
|
||||||
|
IN_MOD=2'b11;
|
||||||
end
|
end
|
||||||
end
|
end
|
||||||
|
|
||||||
@ -80,12 +84,13 @@ wire [15:0] ALU_1B;
|
|||||||
wire [15:0] ALU_1O;
|
wire [15:0] ALU_1O;
|
||||||
reg [`ALU_OP_BITS-1:0]ALU_1OP;
|
reg [`ALU_OP_BITS-1:0]ALU_1OP;
|
||||||
reg ALU_1OE;
|
reg ALU_1OE;
|
||||||
//reg [15:0] temp_out;
|
|
||||||
ALU ALU(ALU_1A,ALU_1B,ALU_1OE,ALU_1O,ALU_1OP);
|
ALU ALU(ALU_1A,ALU_1B,ALU_1OE,ALU_1O,ALU_1OP);
|
||||||
|
|
||||||
/*** Processor stages ***/
|
/*** Processor stages ***/
|
||||||
|
|
||||||
`define invalid_instruction state=`PROC_IF_STATE_ENTRY;ERROR=1;
|
`define invalid_instruction state=`PROC_IF_STATE_ENTRY;ERROR=1;IN_MOD=2'b11;
|
||||||
|
`define start_aligning_instruction if(unaligned_access==0)begin ProgCount=ProgCount+1; external_address_bus <= ProgCount; end /*we normally don't advance PC in case of singly byte unaligning instructions leasving us with two instructions in one read so do that here*/
|
||||||
|
`define start_unaligning_instruction unaligned_access=~unaligned_access;
|
||||||
|
|
||||||
always @(negedge clock) begin
|
always @(negedge clock) begin
|
||||||
case(state)
|
case(state)
|
||||||
@ -118,6 +123,10 @@ always @(negedge clock) begin
|
|||||||
external_address_bus = ProgCount;
|
external_address_bus = ProgCount;
|
||||||
state=`PROC_DE_LOAD_16_EXTRA_FETCH;
|
state=`PROC_DE_LOAD_16_EXTRA_FETCH;
|
||||||
end
|
end
|
||||||
|
`PROC_MEMIO_SETADDR:begin
|
||||||
|
external_address_bus = {1'b0,reg_read_data[15:1]};
|
||||||
|
state=reg_read_data[0:0]?`PROC_MEMIO_GET_UNALIGNED_DATA:`PROC_MEMIO_GET_ALIGNED_DATA;
|
||||||
|
end
|
||||||
endcase
|
endcase
|
||||||
end
|
end
|
||||||
|
|
||||||
@ -139,6 +148,7 @@ always @(posedge clock) begin
|
|||||||
external_address_bus <= ProgCount;
|
external_address_bus <= ProgCount;
|
||||||
state=`PROC_IF_STATE_EXTRA_FETCH;
|
state=`PROC_IF_STATE_EXTRA_FETCH;
|
||||||
end
|
end
|
||||||
|
/* 0 0 0 0 0 0 0 0 | 0 0 0 0 0 0 0 0 | 0 0 0 0 0 0 0 0 | 0 0 0 0 0 0 0 0 */
|
||||||
/* AFTER THE IF STAGE WE HAVE THE FRIST BYTE OF THE
|
/* AFTER THE IF STAGE WE HAVE THE FRIST BYTE OF THE
|
||||||
* INSTRUCTION ADN THE ONE FOLLOWING, ALLIGNED CORRECTLY TO
|
* INSTRUCTION ADN THE ONE FOLLOWING, ALLIGNED CORRECTLY TO
|
||||||
* CIR */
|
* CIR */
|
||||||
@ -148,7 +158,13 @@ always @(posedge clock) begin
|
|||||||
/* ADD, ... */
|
/* ADD, ... */
|
||||||
if ( CIR[9:9] == 0 )begin
|
if ( CIR[9:9] == 0 )begin
|
||||||
/* Add Immediate word/byte to accumulator */
|
/* Add Immediate word/byte to accumulator */
|
||||||
unaligned_access=~unaligned_access;
|
/* 0 0 0 0 0 1 0 W | DATA | DATA if W |*/
|
||||||
|
Wbit=CIR[8:8];
|
||||||
|
if(Wbit)
|
||||||
|
`start_unaligning_instruction
|
||||||
|
else
|
||||||
|
`start_aligning_instruction
|
||||||
|
IN_MOD=2'b11;
|
||||||
in1_sel=2'b00;
|
in1_sel=2'b00;
|
||||||
in2_sel=2'b01;
|
in2_sel=2'b01;
|
||||||
out_sel=2'b11;
|
out_sel=2'b11;
|
||||||
@ -171,10 +187,9 @@ always @(posedge clock) begin
|
|||||||
case (CIR[5:3])
|
case (CIR[5:3])
|
||||||
3'b000 : begin
|
3'b000 : begin
|
||||||
/* Add Immediate word/byte to register/memory */
|
/* Add Immediate word/byte to register/memory */
|
||||||
if(unaligned_access==0)begin
|
/* 1 0 0 0 0 0 S W | MOD 0 0 0 R/M | < DISP LO > | < DISP HI > | DATA | DATA if W | */
|
||||||
ProgCount=ProgCount+1;
|
`start_aligning_instruction
|
||||||
external_address_bus <= ProgCount;
|
IN_MOD=2'b11;
|
||||||
end
|
|
||||||
in1_sel=2'b00;
|
in1_sel=2'b00;
|
||||||
in2_sel=2'b01;
|
in2_sel=2'b01;
|
||||||
out_sel=CIR[7:6];
|
out_sel=CIR[7:6];
|
||||||
@ -197,12 +212,14 @@ always @(posedge clock) begin
|
|||||||
end
|
end
|
||||||
6'b101100,
|
6'b101100,
|
||||||
6'b101101:begin
|
6'b101101:begin
|
||||||
/*Move Immediate byte to register*/
|
/* MOV - Move Immediate byte to register */
|
||||||
if(unaligned_access==0)begin
|
/* 1 0 1 1 W REG | DATA | DATA if W |*/
|
||||||
ProgCount=ProgCount+1;
|
Wbit=CIR[11:11];
|
||||||
external_address_bus <= ProgCount;
|
if(Wbit)
|
||||||
end
|
`start_unaligning_instruction
|
||||||
unaligned_access=~unaligned_access;
|
else
|
||||||
|
`start_aligning_instruction
|
||||||
|
IN_MOD=2'b11;
|
||||||
in1_sel=2'b00;
|
in1_sel=2'b00;
|
||||||
in2_sel=2'b00;
|
in2_sel=2'b00;
|
||||||
out_sel=2'b11;
|
out_sel=2'b11;
|
||||||
@ -215,8 +232,13 @@ always @(posedge clock) begin
|
|||||||
end
|
end
|
||||||
6'b101110,
|
6'b101110,
|
||||||
6'b101111 : begin
|
6'b101111 : begin
|
||||||
/*Move Immediate word to register*/
|
/*MOV - Move Immediate word to register*/
|
||||||
unaligned_access=~unaligned_access;
|
Wbit=CIR[11:11];
|
||||||
|
if(Wbit)
|
||||||
|
`start_unaligning_instruction
|
||||||
|
else
|
||||||
|
`start_aligning_instruction
|
||||||
|
IN_MOD=2'b11;
|
||||||
in1_sel=2'b00;
|
in1_sel=2'b00;
|
||||||
in2_sel=2'b00;
|
in2_sel=2'b00;
|
||||||
out_sel=2'b11;
|
out_sel=2'b11;
|
||||||
@ -226,15 +248,52 @@ always @(posedge clock) begin
|
|||||||
PARAM2=0;
|
PARAM2=0;
|
||||||
state=`PROC_DE_LOAD_16_PARAM;
|
state=`PROC_DE_LOAD_16_PARAM;
|
||||||
end
|
end
|
||||||
|
|
||||||
|
6'b100010 : begin
|
||||||
|
/* MOV - Reg/Mem to/from register */
|
||||||
|
/* 1 0 0 0 1 0 D W | MOD REG REG | < DISP LO > | < DISP HI > |*/
|
||||||
|
`start_aligning_instruction
|
||||||
|
IN_MOD=CIR[7:6];
|
||||||
|
IN_RM=CIR[2:0];
|
||||||
|
Wbit=CIR[8:8];
|
||||||
|
if(CIR[9:9] == 1)begin
|
||||||
|
/* to reg */
|
||||||
|
IN_MOD=CIR[7:6];
|
||||||
|
if(IN_MOD==2'b11)begin
|
||||||
|
in1_sel=2'b01;
|
||||||
|
reg_read_addr=CIR[2:0];
|
||||||
|
end else begin
|
||||||
|
in1_sel=2'b00;
|
||||||
|
end
|
||||||
|
in2_sel=2'b00;
|
||||||
|
out_sel=2'b11;
|
||||||
|
reg_write_addr={CIR[8:8],CIR[5:3]};
|
||||||
|
end else begin
|
||||||
|
`invalid_instruction
|
||||||
|
end
|
||||||
|
|
||||||
|
ALU_1OE=0;
|
||||||
|
ALU_1OP=`ALU_OP_ADD;
|
||||||
|
PARAM2=0;
|
||||||
|
state=`PROC_DE_LOAD_16_PARAM;
|
||||||
|
if ( IN_MOD == 2'b11 )
|
||||||
|
state=`PROC_EX_STATE_ENTRY;
|
||||||
|
else
|
||||||
|
state=`RPOC_MEMIO_READ;
|
||||||
|
end
|
||||||
6'b010000,//INC
|
6'b010000,//INC
|
||||||
6'b010001,//INC
|
6'b010001,//INC
|
||||||
6'b010010,//DEC
|
6'b010010,//DEC
|
||||||
6'b010011:begin//DEC
|
6'b010011:begin//DEC
|
||||||
/*INC/DEC Register*/
|
/* DEC - Decrement Register */
|
||||||
unaligned_access=~unaligned_access;
|
/* | 0 1 0 0 1 REG | */
|
||||||
|
/* INC - Increment Register */
|
||||||
|
/* | 0 1 0 0 0 REG | */
|
||||||
|
`start_unaligning_instruction
|
||||||
in1_sel=2'b01;
|
in1_sel=2'b01;
|
||||||
in2_sel=2'b00;
|
in2_sel=2'b00;
|
||||||
out_sel=2'b11;
|
out_sel=2'b11;
|
||||||
|
IN_MOD=2'b11;
|
||||||
PARAM2=1;
|
PARAM2=1;
|
||||||
reg_read_addr={1'b1,CIR[10:8]};
|
reg_read_addr={1'b1,CIR[10:8]};
|
||||||
reg_write_addr={1'b1,CIR[10:8]};
|
reg_write_addr={1'b1,CIR[10:8]};
|
||||||
@ -251,13 +310,12 @@ always @(posedge clock) begin
|
|||||||
if (CIR[9:9] == 1 ) begin
|
if (CIR[9:9] == 1 ) begin
|
||||||
case (CIR[5:3])
|
case (CIR[5:3])
|
||||||
3'b000 :begin
|
3'b000 :begin
|
||||||
/* Increment Register or Memmory */
|
/* INC - Register/Memory */
|
||||||
if(unaligned_access==0)begin
|
/* 1 1 1 1 1 1 1 W | MOD 0 0 0 R/M | < DISP LO> | < DISP HI> */
|
||||||
ProgCount=ProgCount+1;
|
`start_aligning_instruction
|
||||||
external_address_bus <= ProgCount;
|
IN_MOD=CIR[7:6];
|
||||||
end
|
in1_sel=2'b00;/* number 1 */
|
||||||
in1_sel=2'b00;
|
in2_sel=(CIR[7:6]==2'b11)? 2'b01 : 2'b00;
|
||||||
in2_sel=2'b01;
|
|
||||||
out_sel=CIR[7:6];
|
out_sel=CIR[7:6];
|
||||||
PARAM1=1;
|
PARAM1=1;
|
||||||
reg_read_addr={1'b0,CIR[2:0]};
|
reg_read_addr={1'b0,CIR[2:0]};
|
||||||
@ -265,7 +323,10 @@ always @(posedge clock) begin
|
|||||||
reg_read_oe=0;
|
reg_read_oe=0;
|
||||||
ALU_1OE=0;
|
ALU_1OE=0;
|
||||||
ALU_1OP=`ALU_OP_ADD;
|
ALU_1OP=`ALU_OP_ADD;
|
||||||
|
if ( CIR[7:6] == 2'b11 )
|
||||||
state=`PROC_EX_STATE_ENTRY;
|
state=`PROC_EX_STATE_ENTRY;
|
||||||
|
else
|
||||||
|
state=`RPOC_MEMIO_READ;
|
||||||
end
|
end
|
||||||
default:begin
|
default:begin
|
||||||
`invalid_instruction
|
`invalid_instruction
|
||||||
@ -279,8 +340,10 @@ always @(posedge clock) begin
|
|||||||
/*HLT, CMC, TEST, NOT, NEG, MUL, IMUL, .... */
|
/*HLT, CMC, TEST, NOT, NEG, MUL, IMUL, .... */
|
||||||
case (CIR[9:8])
|
case (CIR[9:8])
|
||||||
2'b00:begin
|
2'b00:begin
|
||||||
/* HLT*/
|
/* HLT - Halt */
|
||||||
unaligned_access=~unaligned_access;
|
/* 1 1 1 1 0 1 0 0 | */
|
||||||
|
`start_unaligning_instruction
|
||||||
|
IN_MOD=2'b11;
|
||||||
HALT=1;
|
HALT=1;
|
||||||
state=`PROC_HALT_STATE;
|
state=`PROC_HALT_STATE;
|
||||||
end
|
end
|
||||||
@ -311,6 +374,66 @@ always @(posedge clock) begin
|
|||||||
PARAM1[15:8] = external_data_bus[15:8];
|
PARAM1[15:8] = external_data_bus[15:8];
|
||||||
state=`PROC_EX_STATE_ENTRY;
|
state=`PROC_EX_STATE_ENTRY;
|
||||||
end
|
end
|
||||||
|
`RPOC_MEMIO_READ:begin
|
||||||
|
/*Decode MOD R/M, read the data and place it to PARAM1*/
|
||||||
|
case (IN_RM)
|
||||||
|
3'b000:begin
|
||||||
|
/*[BX]+[SI]*/
|
||||||
|
`invalid_instruction
|
||||||
|
end
|
||||||
|
3'b001:begin
|
||||||
|
/*[BX]+[SI]*/
|
||||||
|
`invalid_instruction
|
||||||
|
end
|
||||||
|
3'b010:begin
|
||||||
|
/*[BP]+[SI]*/
|
||||||
|
`invalid_instruction
|
||||||
|
end
|
||||||
|
3'b011:begin
|
||||||
|
/*[BP]+[DI]*/
|
||||||
|
`invalid_instruction
|
||||||
|
end
|
||||||
|
3'b100:begin
|
||||||
|
/*[SI]*/
|
||||||
|
reg_read_addr=4'b1110;
|
||||||
|
reg_read_oe=0;
|
||||||
|
state=`PROC_MEMIO_SETADDR;
|
||||||
|
end
|
||||||
|
3'b101:begin
|
||||||
|
/*[DI]*/
|
||||||
|
reg_read_addr=4'b1111;
|
||||||
|
reg_read_oe=0;
|
||||||
|
state=`PROC_MEMIO_SETADDR;
|
||||||
|
end
|
||||||
|
3'b110:begin
|
||||||
|
/*d16 */
|
||||||
|
`invalid_instruction
|
||||||
|
end
|
||||||
|
3'b111:begin
|
||||||
|
/*[BX]*/
|
||||||
|
reg_read_addr=4'b1011;
|
||||||
|
reg_read_oe=0;
|
||||||
|
state=`PROC_MEMIO_SETADDR;
|
||||||
|
end
|
||||||
|
endcase
|
||||||
|
if(IN_MOD!=2'b00)begin
|
||||||
|
/*Actually check if 01 and add the 8bits or if 10 add the 16bits ....*/
|
||||||
|
`invalid_instruction;
|
||||||
|
end
|
||||||
|
|
||||||
|
end
|
||||||
|
`PROC_MEMIO_GET_ALIGNED_DATA:begin
|
||||||
|
PARAM1=(Wbit==1)? external_data_bus : {8'b00000000,external_data_bus[15:8]} ;
|
||||||
|
state=`PROC_EX_STATE_ENTRY;
|
||||||
|
end
|
||||||
|
`PROC_MEMIO_GET_UNALIGNED_DATA:begin
|
||||||
|
if(Wbit==1) begin
|
||||||
|
`invalid_instruction //easy to implement, get the other byte from the next address
|
||||||
|
end else begin
|
||||||
|
PARAM1={8'b00000000,external_data_bus[7:0]};
|
||||||
|
state=`PROC_EX_STATE_ENTRY;
|
||||||
|
end
|
||||||
|
end
|
||||||
`PROC_EX_STATE_ENTRY:begin
|
`PROC_EX_STATE_ENTRY:begin
|
||||||
reg_write_data=ALU_1O;
|
reg_write_data=ALU_1O;
|
||||||
state=`PROC_EX_STATE_EXIT;
|
state=`PROC_EX_STATE_EXIT;
|
||||||
|
@ -18,7 +18,6 @@ assign read_port1_data = !read_port1_oe ?
|
|||||||
|
|
||||||
`ifdef DEBUG_REG_WRITES
|
`ifdef DEBUG_REG_WRITES
|
||||||
string debug_name;
|
string debug_name;
|
||||||
logic[15:0] debug_value;
|
|
||||||
`endif
|
`endif
|
||||||
|
|
||||||
always @(negedge write_port1_we) begin
|
always @(negedge write_port1_we) begin
|
||||||
@ -44,7 +43,6 @@ always @(negedge write_port1_we) begin
|
|||||||
2'b10: debug_name="si";
|
2'b10: debug_name="si";
|
||||||
2'b11: debug_name="di";
|
2'b11: debug_name="di";
|
||||||
endcase
|
endcase
|
||||||
debug_value=registers[write_port1_addr[2:0]];
|
|
||||||
end else begin
|
end else begin
|
||||||
case(write_port1_addr[1:0])
|
case(write_port1_addr[1:0])
|
||||||
2'b00: debug_name="ax";
|
2'b00: debug_name="ax";
|
||||||
@ -52,11 +50,9 @@ always @(negedge write_port1_we) begin
|
|||||||
2'b10: debug_name="dx";
|
2'b10: debug_name="dx";
|
||||||
2'b11: debug_name="bx";
|
2'b11: debug_name="bx";
|
||||||
endcase
|
endcase
|
||||||
debug_value=registers[write_port1_addr[2:0]];
|
|
||||||
end
|
end
|
||||||
|
|
||||||
|
$display("register %%%s update to $0x%04x",debug_name,registers[write_port1_addr[2:0]]);
|
||||||
$display("register %%%s update to $0x%04x",debug_name,debug_value);
|
|
||||||
`endif
|
`endif
|
||||||
end
|
end
|
||||||
endmodule
|
endmodule
|
||||||
|
Loading…
Reference in New Issue
Block a user