Subversion Repositories t6507lp

////////////////////////////////////////////////////////////////////////////
////                                                                    ////
//// T6507LP IP Core                                                    ////
////                                                                    ////
//// This file is part of the T6507LP project                           ////
//// http://www.opencores.org/cores/t6507lp/                            ////
////                                                                    ////
//// Description                                                        ////
//// 6507 ALU                                                           ////
////                                                                    ////
//// To Do:                                                             ////
//// - Search for TODO                                                  ////
////                                                                    ////
//// Author(s):                                                         ////
//// - Gabriel Oshiro Zardo, gabrieloshiro@gmail.com                    ////
//// - Samuel Nascimento Pagliarini (creep), snpagliarini@gmail.com     ////
////                                                                    ////
////////////////////////////////////////////////////////////////////////////
////                                                                    ////
//// Copyright (C) 2001 Authors and OPENCORES.ORG                       ////
////                                                                    ////
//// This source file may be used and distributed without               ////
//// restriction provided that this copyright statement is not          ////
//// removed from the file and that any derivative work contains        ////
//// the original copyright notice and the associated disclaimer.       ////
////                                                                    ////
//// This source file is free software; you can redistribute it         ////
//// and/or modify it under the terms of the GNU Lesser General         ////
//// Public License as published by the Free Software Foundation;       ////
//// either version 2.1 of the License, or (at your option) any         ////
//// later version.                                                     ////
////                                                                    ////
//// This source is distributed in the hope that it will be             ////
//// useful, but WITHOUT ANY WARRANTY; without even the implied         ////
//// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR            ////
//// PURPOSE. See the GNU Lesser General Public License for more        ////
//// details.                                                           ////
////                                                                    ////
//// You should have received a copy of the GNU Lesser General          ////
//// Public License along with this source; if not, download it         ////
//// from http://www.opencores.org/lgpl.shtml                           ////
////                                                                    ////
////////////////////////////////////////////////////////////////////////////
 
`include "timescale.v"
 
// TODO: verify code identation
 
module t6507lp_alu( clk, reset_n, alu_enable, alu_result, alu_status, alu_opcode, alu_a, alu_x, alu_y );
 
input wire       clk;
input wire       reset_n;
input wire       alu_enable;
input wire [7:0] alu_opcode;
input wire [7:0] alu_a;
output reg [7:0] alu_result;
output reg [7:0] alu_status;
output reg [7:0] alu_x;
output reg [7:0] alu_y;
 
reg [7:0] A;
//reg [7:0] X;
//reg [7:0] Y;
 
reg [7:0] STATUS;
reg [7:0] result;
reg [7:0] op1;
reg [7:0] op2;
reg [7:0] bcdl;
reg [7:0] bcdh;
reg [7:0] bcdh2;
reg [7:0] AL;
reg [7:0] AH;
//reg C_aux;
reg sign;
 
`include "t6507lp_package.v"
 
always @ (posedge clk or negedge reset_n)
begin
	if (reset_n == 0) begin
		alu_result <= 0;
		alu_status[C] <= 0;
		alu_status[N] <= 0;
		alu_status[V] <= 0;
		alu_status[5] <= 1;
		alu_status[Z] <= 1;
		alu_status[I] <= 0;
		alu_status[B] <= 0;
		alu_status[D] <= 0;
		A <= 0;
		//X <= 0;
		//Y <= 0;
		alu_x <= 0;
		alu_y <= 0;
	end
	else if ( alu_enable == 1 ) begin
		case (alu_opcode)
			ADC_IMM, ADC_ZPG, ADC_ZPX, ADC_ABS, ADC_ABX, ADC_ABY, ADC_IDX, ADC_IDY,
			AND_IMM, AND_ZPG, AND_ZPX, AND_ABS, AND_ABX, AND_ABY, AND_IDX, AND_IDY,
			ASL_ACC, EOR_IMM, EOR_ZPG, EOR_ZPX, EOR_ABS, EOR_ABX, EOR_ABY, EOR_IDX,
			EOR_IDY, LSR_ACC, ORA_IMM, ORA_ZPG, ORA_ZPX, ORA_ABS, ORA_ABX, ORA_ABY,
			ORA_IDX, ORA_IDY, ROL_ACC, ROR_ACC, SBC_IMM, SBC_ZPG, SBC_ZPX, SBC_ABS,
			SBC_ABX, SBC_ABY, SBC_IDX, SBC_IDY, LDA_IMM, LDA_ZPG, LDA_ZPX, LDA_ABS,
			LDA_ABX, LDA_ABY, LDA_IDX, LDA_IDY, PLA_IMP :
			begin
				A          <= result;
				alu_result <= result;
				alu_status <= STATUS;
			end
			LDX_IMM, LDX_ZPG, LDX_ZPY, LDX_ABS, LDX_ABY, TAX_IMP, TSX_IMP, INX_IMP, DEX_IMP :
			begin
				//X          <= result;
				alu_x      <= result;
				alu_status <= STATUS;
			end
			TXS_IMP :
			begin
				//X          <= result;
				alu_x      <= result;
			end
			TXA_IMP, TYA_IMP :
			begin
				A          <= result;
				alu_status <= STATUS;
			end
			LDY_IMM, LDY_ZPG, LDY_ZPX, LDY_ABS, LDY_ABX, TAY_IMP, INY_IMP, DEY_IMP :
			begin
				//Y          <= result;
				alu_y      <= result;
				alu_status <= STATUS;
			end
			CMP_IMM, CMP_ZPG, CMP_ZPX, CMP_ABS, CMP_ABX, CMP_ABY, CMP_IDX, CMP_IDY,
			CPX_IMM, CPX_ZPG, CPX_ABS, CPY_IMM, CPY_ZPG, CPY_ABS :
			begin
				alu_status <= STATUS;
			end
			PHA_IMP, STA_ZPG, STA_ZPX, STA_ABS, STA_ABX, STA_ABY, STA_IDX, STA_IDY : begin
				alu_result <= result;
			end
			STX_ZPG, STX_ZPY, STX_ABS : begin
				alu_x <= result;
			end
			STY_ZPG, STY_ZPX, STY_ABS : begin
				alu_y <= result;
			end
			SEC_IMP :
			begin
				alu_status[C] <= 1;
			end
			SED_IMP :
			begin
				alu_status[D] <= 1;
			end
			SEI_IMP :
			begin
				alu_status[I] <= 1;
			end
			CLC_IMP :
			begin
				alu_status[C] <= 0;
			end
			CLD_IMP :
			begin
				alu_status[D] <= 0;
			end
			CLI_IMP :
			begin
				alu_status[I] <= 0;
			end
			CLV_IMP : 
			begin
				alu_status[V] <= 0;
			end
			BRK_IMP :
			begin
				alu_status[B] <= 1;
			end
			PLP_IMP, RTI_IMP :
			begin
				alu_status[C] <= alu_a[C];
				alu_status[Z] <= alu_a[Z];
				alu_status[I] <= alu_a[I];
				alu_status[D] <= alu_a[D];
				alu_status[B] <= alu_a[B];
				alu_status[V] <= alu_a[V];
				alu_status[N] <= alu_a[N];
				alu_status[5] <= 1;
			end
			BIT_ZPG, BIT_ABS :
			begin
				alu_status[Z] <= STATUS[Z];
				alu_status[V] <= alu_a[6];
				alu_status[N] <= alu_a[7];
			end
			INC_ZPG, INC_ZPX, INC_ABS, INC_ABX, DEC_ZPG, DEC_ZPX, DEC_ABS, DEC_ABX,
			ASL_ZPG, ASL_ZPX, ASL_ABS, ASL_ABX, LSR_ZPG, LSR_ZPX, LSR_ABS, LSR_ABX,
			ROL_ZPG, ROL_ZPX, ROL_ABS, ROL_ABX, ROR_ZPG, ROR_ZPX, ROR_ABS, ROR_ABX :
			begin
				alu_result <= result;
				alu_status <= STATUS;
			end
			//PHP_IMP : begin
			//end
			default : begin
				//$display("ERROR");
			end
		endcase
	end
end
 
always @ (*) begin
if (alu_enable == 1) begin
	//op1      = A;
	op1      = A;
	op2      = alu_a;
	result    = alu_result;
	STATUS[N] = alu_status[N];
	STATUS[C] = alu_status[C];
	STATUS[V] = alu_status[V];
	STATUS[B] = alu_status[B];
	STATUS[I] = alu_status[I];
	STATUS[D] = alu_status[D];
	STATUS[Z] = alu_status[Z];
	STATUS[5] = 1;
 
	bcdl = 0;
	bcdh = 0;
	bcdh2 = 0;
	AL = 0;
	AH = 0;
	sign = op2[7];
 
	case (alu_opcode)
		// BIT - Bit Test
		BIT_ZPG, BIT_ABS: begin
			//result = A & alu_a;
			result = A & alu_a;
		end
 
		// BRK - Force Interrupt
		//BRK_IMP: begin
		//	STATUS[B] = 1'b1;
		//end
 
		// CLC - Clear Carry Flag
		//CLC_IMP: begin
		//	STATUS[C] = 1'b0;
		//end
 
		// CLD - Clear Decimal Flag
		//CLD_IMP: begin
		//	STATUS[D] = 1'b0;
		//end
 
		// CLI - Clear Interrupt Disable
		//CLI_IMP: begin
		//	STATUS[I] = 1'b0;
		//end
 
		// CLV - Clear Overflow Flag
		//CLV_IMP: begin
		//	STATUS[V] = 1'b0;
		//end
 
		// NOP - No Operation
		//NOP_IMP: begin
			// Do nothing :-D
		//end
 
		// PLP - Pull Processor Status Register
		// RTI - Return from Interrupt
		//PLP_IMP, RTI_IMP: begin
		//	STATUS = alu_a;
		//end
 
		PLA_IMP : begin
			result = alu_a;
		end
 
		// STA - Store Accumulator
		// PHA - Push A
		// TAX - Transfer Accumulator to X
		// TAY - Transfer Accumulator to Y
		TAX_IMP, TAY_IMP, PHA_IMP, STA_ZPG, STA_ZPX, STA_ABS, STA_ABX, STA_ABY, STA_IDX, STA_IDY : begin
			//result = A;
			result = A;
		end
 
		// STX - Store X Register
		// TXA - Transfer X to Accumulator
		// TXS - Transfer X to Stack pointer
		STX_ZPG, STX_ZPY, STX_ABS, TXA_IMP, TXS_IMP : begin
			//result = X;
			result = alu_x;
		end
 
		// STY - Store Y Register
		// TYA - Transfer Y to Accumulator
		STY_ZPG, STY_ZPX, STY_ABS, TYA_IMP : begin
			//result = Y;
			result = alu_y;
		end
 
		// SEC - Set Carry Flag
		//SEC_IMP: begin
		//	STATUS[C] = 1'b1;
		//end
 
		// SED - Set Decimal Flag
		//SED_IMP: begin
		//	STATUS[D] = 1'b1;
		//end
 
		// SEI - Set Interrupt Disable
		//SEI_IMP: begin
		//	STATUS[I] = 1'b1;
		//end
 
		// INC - Increment memory
		INC_ZPG, INC_ZPX, INC_ABS, INC_ABX : begin
			result = alu_a + 1;
		end
 
		// INX - Increment X Register
		INX_IMP: begin
			//result = X + 1;
			result = alu_x + 1;
		end
 
		// INY - Increment Y Register
		INY_IMP : begin
			//result = Y + 1;
			result = alu_y + 1;
		end
 
		// DEC - Decrement memory
		DEC_ZPG, DEC_ZPX, DEC_ABS, DEC_ABX : begin
			result = alu_a - 1;
		end
 
		// DEX - Decrement X register
		DEX_IMP: begin
			//result = X - 1;
			result = alu_x - 1;
		end
 
		// DEY - Decrement Y Register
		DEY_IMP: begin
			//result = Y - 1;
			result = alu_y - 1;
		end
 
		// ADC - Add with carry
		// TODO: verify synthesis for % operand
		ADC_IMM, ADC_ZPG, ADC_ZPX, ADC_ABS, ADC_ABX, ADC_ABY, ADC_IDX, ADC_IDY : begin
			if (alu_status[D] == 1) begin
				//$display("MODO DECIMAL");
				//AL = A[3:0] + alu_a[3:0] + alu_status[C];
				AL = op1[3:0] + op2[3:0] + alu_status[C];
				//AH = A[7:4] + alu_a[7:4];
				AH = op1[7:4] + op2[7:4];
				$display("AL = %d", AL);
				$display("AH = %d", AH);
				if (AL > 9) begin
					bcdh = AH + (AL / 10);
					bcdl = AL % 10;
				end
				else begin
					bcdh = AH;
					bcdl = AL;
				end
 
				// ok
 
				if (bcdh > 9) begin
					STATUS[C] = 1;
					bcdh2 = bcdh % 10;
				end
				else begin
					STATUS[C] = 0;
					bcdh2 = bcdh;
				end
				//$display("bcdh2 = %d", bcdh2);
				//$display("bcdl = %d", bcdl);
				result = {bcdh2[3:0],bcdl[3:0]};
			end
			else begin
				//$display("MODO NORMAL");
				{STATUS[C],result} = op1 + op2 + alu_status[C];
			end
 
			if ((op1[7] == op2[7]) && (op1[7] != result[7]))
				STATUS[V] = 1;
			else
				STATUS[V] = 0;
		end
 
		// AND - Logical AND
		AND_IMM, AND_ZPG, AND_ZPX, AND_ABS, AND_ABX, AND_ABY, AND_IDX, AND_IDY : begin
			//result = A & alu_a;
			result = A & alu_a;
		end
 
		// CMP - Compare
		CMP_IMM, CMP_ZPG, CMP_ZPX, CMP_ABS, CMP_ABX, CMP_ABY, CMP_IDX, CMP_IDY : begin
			//result = A - alu_a;
			result = A - alu_a;
			//STATUS[C] = (A >= alu_a) ? 1 : 0;
			STATUS[C] = (A >= alu_a) ? 1 : 0;
		end
 
		// EOR - Exclusive OR
		EOR_IMM, EOR_ZPG, EOR_ZPX, EOR_ABS, EOR_ABX, EOR_ABY, EOR_IDX, EOR_IDY : begin
			result = A ^ alu_a;
			//result = A ^ alu_a;
			//$display("op1 ^ op2 = result");
			//$display("%d  ^ %d  = %d", op1, op2, result);
		end
 
		// LDA - Load Accumulator
		// LDX - Load X Register
		// LDY - Load Y Register
		// TSX - Transfer Stack Pointer to X
		LDA_IMM, LDA_ZPG, LDA_ZPX, LDA_ABS, LDA_ABX, LDA_ABY, LDA_IDX, LDA_IDY,
		LDX_IMM, LDX_ZPG, LDX_ZPY, LDX_ABS, LDX_ABY,
		LDY_IMM, LDY_ZPG, LDY_ZPX, LDY_ABS, LDY_ABX,
		TSX_IMP : begin
			result = alu_a;
		end
 
		// ORA - Logical OR
		ORA_IMM, ORA_ZPG, ORA_ZPX, ORA_ABS, ORA_ABX, ORA_ABY, ORA_IDX, ORA_IDY : begin
			//result = A | alu_a;
			result = A | alu_a;
		end
 
		// SBC - Subtract with Carry
		SBC_IMM, SBC_ZPG, SBC_ZPX, SBC_ABS, SBC_ABX, SBC_ABY, SBC_IDX, SBC_IDY : begin
			if (alu_status[D] == 1) begin
/*				//AL = A[3:0] + alu_a[3:0] + alu_status[C];
				AL = op1[3:0] + op2[3:0] + alu_status[C];
				//AH = A[7:4] + alu_a[7:4];
				AH = op1[7:4] + op2[7:4];
				if (AL > 9) begin
					bcdh = AH + (AL / 10);
					bcdl = AL % 10;
				end
				else begin
					bcdh = AH;
					bcdl = AL;
				end
				if (bcdh > 9) begin
					STATUS[C] = 1;
					bcdh2 = bcdh % 10;
				end
				else begin
					STATUS[C] = 0;
					bcdh2 = bcdh;
				end
				result = {bcdh2[3:0],bcdl[3:0]};*/
	//C := P_In(Flag_C) or not Op(0);
				AL = {op1[3:0],alu_status[C]} - {op2[3:0],1'b1};
				AH = {op1[7:4],1'b0} - {op2[7:4],AL[5]};
 
				if (AL[5] == 1) begin
					bcdl[5:1] = AL[5:1] - 6;
				end
				AH = {op1[7:4],1'b0} - {op2[7:4],bcdl[6]};
				if (AH[5] == 1) begin
					bcdh[5:1] = AH[5:1] - 6;
				end
				result = {bcdh[4:1],bcdl[4:1]};
				STATUS[C] = ~result[7];
			end
			else begin
				op2 = ~op2;
				//$display("MODO NORMAL");
				result = op1 + op2 + alu_status[C];
				STATUS[C] = ~result[7];
			end
/*			if (alu_status[D] == 1) begin
				bcdl = op1[3:0] - op2[3:0] - (1 - alu_status[C]);
				bcdh = op1[7:4] - op2[7:4];
				if (bcdl > 9) begin
					bcdh = bcdh + bcdl[5:4];
					bcdl = bcdl % 10;
				end
				if (bcdh > 9) begin
					STATUS[C] = 1;
					bcdh = bcdh % 10;
				end
				result = {bcdh[3:0],bcdl[3:0]};
			end
			else begin
				op2 = ~alu_a;
				result = op1 + op2 + alu_status[C];
				STATUS[C] = ~result[7];
			end
*/				
 
			if ((op1[7] == sign) && (op1[7] != result[7]))
				STATUS[V] = 1;
			else
				STATUS[V] = 0;
 
		end
 
		// ASL - Arithmetic Shift Left
		ASL_ACC : begin
			//{STATUS[C],result} = A << 1;
			//{STATUS[C],result} = {A,1'b0};
			{STATUS[C],result} = {A,1'b0};
		end
		ASL_ZPG, ASL_ZPX, ASL_ABS, ASL_ABX : begin
			//{STATUS[C],result} = alu_a << 1;
			{STATUS[C],result} = {alu_a,1'b0};
		end
 
		// LSR - Logical Shift Right
		LSR_ACC: begin
			//{result, STATUS[C]} = A >> 1;
			//{result,STATUS[C]} = {1'b0,A};
			{result,STATUS[C]} = {1'b0,A};
		end
		LSR_ZPG, LSR_ZPX, LSR_ABS, LSR_ABX : begin
			//{result, STATUS[C]} = alu_a >> 1;
			{result,STATUS[C]} = {1'b0,alu_a};
		end
 
		// ROL - Rotate Left
		ROL_ACC : begin
			//{STATUS[C],result} = {A,alu_status[C]};
			{STATUS[C],result} = {A,alu_status[C]};
		end
		ROL_ZPG, ROL_ZPX, ROL_ABS, ROL_ABX : begin
			{STATUS[C],result} = {alu_a,alu_status[C]};
		end
 
		// ROR - Rotate Right
		ROR_ACC : begin
			//{result,STATUS[C]} = {alu_status[C],A};
			{result,STATUS[C]} = {alu_status[C],A};
		end
		ROR_ZPG, ROR_ZPX, ROR_ABS, ROR_ABX : begin
			{result, STATUS[C]} = {alu_status[C], alu_a};
		end
 
		// CPX - Compare X Register
		CPX_IMM, CPX_ZPG, CPX_ABS : begin
			//result = X - alu_a;
			result = alu_x - alu_a;
			//STATUS[C] = (X >= alu_a) ? 1 : 0;
			STATUS[C] = (alu_x >= alu_a) ? 1 : 0;
		end
 
		// CPY - Compare Y Register
		CPY_IMM, CPY_ZPG, CPY_ABS : begin
			//result = Y - alu_a;
			result = alu_y - alu_a;
			//STATUS[C] = (Y >= alu_a) ? 1 : 0;
			STATUS[C] = (alu_y >= alu_a) ? 1 : 0;
		end
 
		default: begin // NON-DEFAULT OPCODES FALL HERE
		end
	endcase
	STATUS[Z] = (result == 0) ? 1 : 0;
	STATUS[N] = result[7];
end
end
endmodule