mirror of
https://github.com/sxpert/hp-saturn
synced 2025-01-05 11:01:48 +01:00
265 lines
No EOL
6 KiB
Verilog
265 lines
No EOL
6 KiB
Verilog
/******************************************************************************
|
|
*
|
|
* Instruction decoder module
|
|
*
|
|
*****************************************************************************/
|
|
|
|
module saturn_decoder(
|
|
i_clk,
|
|
i_reset,
|
|
i_cycles,
|
|
i_en_dbg,
|
|
i_en_dec,
|
|
i_stalled,
|
|
i_pc,
|
|
i_nibble,
|
|
o_inc_pc,
|
|
o_dec_error,
|
|
|
|
o_ins_addr,
|
|
o_ins_decoded,
|
|
|
|
o_direction,
|
|
o_ins_rtn,
|
|
o_set_xm,
|
|
o_set_carry,
|
|
o_carry_val,
|
|
o_ins_set_mode,
|
|
o_mode_dec,
|
|
o_ins_rstk_c
|
|
);
|
|
|
|
/*
|
|
* module input / output ports
|
|
*/
|
|
input wire i_clk;
|
|
input wire i_reset;
|
|
input wire [31:0] i_cycles;
|
|
input wire i_en_dbg;
|
|
input wire i_en_dec;
|
|
input wire i_stalled;
|
|
input wire [19:0] i_pc;
|
|
input wire [3:0] i_nibble;
|
|
|
|
output reg o_inc_pc;
|
|
output reg o_dec_error;
|
|
|
|
// instructions related outputs
|
|
output reg [19:0] o_ins_addr;
|
|
output reg o_ins_decoded;
|
|
|
|
// generic
|
|
output reg o_direction;
|
|
|
|
// rtn specific
|
|
output reg o_ins_rtn;
|
|
output reg o_set_xm;
|
|
output reg o_set_carry;
|
|
output reg o_carry_val;
|
|
|
|
// setdec/hex
|
|
output reg o_ins_set_mode;
|
|
output reg o_mode_dec;
|
|
|
|
// rstk and c
|
|
output reg o_ins_rstk_c;
|
|
|
|
|
|
|
|
/*
|
|
* state registers
|
|
*/
|
|
|
|
reg [31:0] instr_ctr;
|
|
|
|
initial begin
|
|
`ifdef SIM
|
|
// $monitor({"i_clk %b | i_reset %b | i_cycles %d | i_en_dec %b | i_en_exec %b |",
|
|
// " continue %b | instr_start %b | i_nibble %h"},
|
|
// i_clk, i_reset, i_cycles, i_en_dec, i_en_exec, continue,
|
|
// instr_start, i_nibble);
|
|
// $monitor("i_en_dec %b | i_cycles %d | nb %h | cont %b | b0x %b | rtn %b | sxm %b | sc %b | cv %b",
|
|
// i_en_dec, i_cycles, i_nibble, continue, block_0x, ins_rtn, set_xm, set_carry, carry_val);
|
|
`endif
|
|
end
|
|
|
|
/*
|
|
* debugger
|
|
*
|
|
*/
|
|
|
|
always @(posedge i_clk) begin
|
|
if (!i_reset && i_en_dbg && !i_stalled)
|
|
if (o_ins_decoded) begin
|
|
`ifdef SIM
|
|
$write("%5h ", o_ins_addr);
|
|
if (o_ins_rtn) begin
|
|
$write("RTN");
|
|
if (o_set_xm) $write("SXM");
|
|
if (o_set_carry) $write("%sC", o_carry_val?"S":"C");
|
|
$display("");
|
|
end
|
|
if (o_ins_set_mode) begin
|
|
$display("SET%s", o_mode_dec?"DEC":"HEX");
|
|
end
|
|
if (o_ins_rstk_c) begin
|
|
$display("%s", o_direction?"C=RSTK":"RSTK=C");
|
|
end
|
|
`endif
|
|
end
|
|
end
|
|
|
|
/******************************************************************************
|
|
*
|
|
* handle decoding of the fist nibble
|
|
* that's pretty simple though, will get tougher later on :-)
|
|
*
|
|
*****************************************************************************/
|
|
|
|
// general variables
|
|
reg continue;
|
|
reg block_0x;
|
|
reg block_0Efx;
|
|
|
|
reg fields_f;
|
|
|
|
|
|
always @(posedge i_clk) begin
|
|
if (i_reset) begin
|
|
continue <= 0;
|
|
o_inc_pc <= 1;
|
|
o_dec_error <= 0;
|
|
o_ins_decoded <= 0;
|
|
|
|
end else begin
|
|
if (i_en_dec && !i_stalled) begin
|
|
|
|
/*
|
|
* stuff that is always done
|
|
*/
|
|
o_inc_pc <= 1; // may be set to 0 later
|
|
|
|
/*
|
|
* cleanup
|
|
*/
|
|
if (!continue) begin
|
|
continue <= 1;
|
|
o_ins_decoded <= 0;
|
|
// store the address where the instruction starts
|
|
o_ins_addr <= i_pc;
|
|
|
|
// cleanup block variables
|
|
block_0x <= 0;
|
|
block_0Efx <= 0;
|
|
|
|
// cleanup fields table variables
|
|
fields_f <= 0;
|
|
|
|
// cleanup
|
|
o_direction <= 0;
|
|
|
|
o_ins_rtn <= 0;
|
|
o_set_xm <= 0;
|
|
o_set_carry <= 0;
|
|
o_carry_val <= 0;
|
|
|
|
o_ins_set_mode <= 0;
|
|
o_mode_dec <= 0;
|
|
|
|
o_ins_rstk_c <= 0;
|
|
end
|
|
|
|
/*
|
|
* x first nibble
|
|
*/
|
|
|
|
if (!continue) begin
|
|
// assign block regs
|
|
case (i_nibble)
|
|
4'h0: block_0x <= 1;
|
|
default: begin
|
|
`ifdef SIM
|
|
$display("new_instruction: nibble %h not handled", i_nibble);
|
|
`endif
|
|
o_dec_error <= 1;
|
|
end
|
|
endcase
|
|
end
|
|
|
|
/******************************************************************************
|
|
*
|
|
* 0x
|
|
*
|
|
* 00 RTNSXM
|
|
* 01 RTN
|
|
* 02 RTNSC
|
|
* 03 RTNCC
|
|
* 04 SETHEX
|
|
* 05 SETDEC
|
|
* 06 RSTK=C
|
|
* 07 C=RSTK
|
|
*
|
|
*****************************************************************************/
|
|
|
|
if (continue && block_0x) begin
|
|
case (i_nibble)
|
|
4'h0, 4'h1, 4'h2, 4'h3: begin
|
|
o_ins_rtn <= 1;
|
|
o_set_xm <= (i_nibble == 4'h0);
|
|
o_set_carry <= (i_nibble[3:1] == 1);
|
|
o_carry_val <= (i_nibble[1] && i_nibble[0]);
|
|
end
|
|
4'h4, 4'h5: begin
|
|
o_ins_set_mode <= 1;
|
|
o_mode_dec <= (i_nibble[0]);
|
|
end
|
|
4'h6, 6'h7: begin
|
|
o_ins_rstk_c <= 1;
|
|
o_direction <= (i_nibble[0]);
|
|
end
|
|
4'hE: begin
|
|
block_0x <= 0;
|
|
end
|
|
default: begin
|
|
`ifdef SIM
|
|
$display("block_0x: nibble %h not handled", i_nibble);
|
|
`endif
|
|
o_dec_error <= 1;
|
|
end
|
|
endcase
|
|
continue <= (i_nibble == 4'hE);
|
|
block_0Efx <= (i_nibble == 4'hE);
|
|
fields_f <= (i_nibble == 4'hE);
|
|
o_ins_decoded <= (i_nibble != 4'hE);
|
|
end
|
|
|
|
/******************************************************************************
|
|
*
|
|
* 0Ex
|
|
*
|
|
*
|
|
*****************************************************************************/
|
|
if (continue && block_0Efx && !fields_f) begin
|
|
$display("block_0Efx: nibble %h not handled", i_nibble);
|
|
continue <= 0;
|
|
o_dec_error <= 1;
|
|
end
|
|
|
|
/******************************************************************************
|
|
*
|
|
* fields f table
|
|
*
|
|
*
|
|
*****************************************************************************/
|
|
if (continue && fields_f) begin
|
|
$display("fields_f: nibble %h not handled", i_nibble);
|
|
fields_f <= 0;
|
|
end
|
|
|
|
|
|
end
|
|
end
|
|
end
|
|
|
|
|
|
endmodule |