[fpgaboy.git] / LCDC.v

`define ADDR_LCDC	16'hFF40
`define ADDR_STAT	16'hFF41
`define ADDR_SCY	16'hFF42
`define ADDR_SCX	16'hFF43
`define ADDR_LY		16'hFF44
`define ADDR_LYC	16'hFF45
`define ADDR_DMA	16'hFF46
`define ADDR_BGP	16'hFF47
`define ADDR_OBP0	16'hFF48
`define ADDR_OBP1	16'hFF49
`define ADDR_WY		16'hFF4A
`define ADDR_WX		16'hFF4B

module LCDC(
	input [15:0] addr,
	inout [7:0] data,
	input clk,	// 8MHz clock
	input wr, rd,
	output wire lcdcirq,
	output wire vblankirq,
	output wire lcdclk, lcdvs, lcdhs,
	output reg [2:0] lcdr, lcdg, output reg [1:0] lcdb);
	
	/***** Needed prototypes *****/
	wire [1:0] pixdata;
	
	/***** Internal clock that is stable and does not depend on CPU in single/double clock mode *****/
	reg clk4 = 0;
	always @(posedge clk)
		clk4 = ~clk4;
	assign lcdclk = clk4;
	
	/***** LCD control registers *****/
	reg [7:0] rLCDC = 8'h91;
	reg [7:0] rSTAT = 8'h00;
	reg [7:0] rSCY = 8'b00;
	reg [7:0] rSCX = 8'b00;
	reg [7:0] rLYC = 8'b00;
	reg [7:0] rDMA = 8'b00;
	reg [7:0] rBGP = 8'b00;
	reg [7:0] rOBP0 = 8'b00;
	reg [7:0] rOBP1 = 8'b00;
	reg [7:0] rWY = 8'b00;
	reg [7:0] rWX = 8'b00;
	
	/***** Sync generation *****/
	
	/* A complete cycle takes 456 clocks.
	 * VBlank lasts 4560 clocks (10 scanlines) -- LY = 144 - 153.
	 *
	 * Modes: 0 -> in hblank and OAM/VRAM available - present 207 clks
	 *        1 -> in vblank and OAM/VRAM available
	 *        2 -> OAM in use - present 86 clks
	 *        3 -> OAM/VRAM in use - present 163 clks
	 * So, X = 0~162 is HActive,
	 * X = 163-369 is HBlank,
	 * X = 370-455 is HWhirrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrr.
	 * [02:15:10] <Judge_> LY is updated near the 0 -> 2 transition
	 * [02:15:38] <Judge_> it seems to be updated internally first before it is visible in the LY register itself
	 * [02:15:40] <Judge_> some kind of delay
	 * [02:16:19] <Judge_> iirc it is updated about 4 cycles prior to mode 2
	 */
	reg [8:0] posx = 9'h000;
	reg [7:0] posy = 8'h00;
	
	wire vraminuse = (posx < 163) && (posy < 144);
	wire oaminuse = (posx > 369) && (posy < 144);
	
	wire display = (posx > 2) && (posx < 163) && (posy < 144);
	
	wire [1:0] mode = (posy < 144) ?
				(vraminuse ? 2'b11 :
				 oaminuse ? 2'b10 :
				 2'b00)
				: 2'b01;
	
	wire [7:0] vxpos = rSCX + posx - 3;
	wire [7:0] vypos = rSCY + posy;
	
	assign lcdvs = (posy == 153) && (posx == 2);
	assign lcdhs = (posx == 2);
	
	wire [2:0] lcdr_ = display ? {pixdata[1] ? 3'b111 : 3'b000} : 3'b000;
	wire [2:0] lcdg_ = display ? {pixdata[0] ? 3'b111 : 3'b000} : 3'b000;
	wire [1:0] lcdb_ = display ? {(vypos < 8 || vxpos < 8) ? 2'b11 : 2'b00} : 2'b00;
	
	reg mode00irq = 0, mode01irq = 0, mode10irq = 0, lycirq = 0;
	assign lcdcirq = (rSTAT[3] & mode00irq) | (rSTAT[4] & mode01irq) | (rSTAT[5] & mode10irq) | (rSTAT[6] & lycirq);
	assign vblankirq = (posx == 0 && posy == 153);
	
	always @(posedge clk4)
	begin
		if (posx == 455) begin
			posx <= 0;
			if (posy == 153) begin
				posy <= 0;
				if (0 == rLYC)
					lycirq <= 1;
			end else begin
				posy <= posy + 1;
				/* Check for vblank and generate an IRQ if needed. */
				if (posy == 143) begin 
					mode01irq <= 1;
				end
				if ((posy + 1) == rLYC)
					lycirq <= 1;
				
			end
		end else begin
			posx <= posx + 1;
			if (posx == 165)
				mode00irq <= 1;
			else if (posx == 373)
				mode10irq <= 1;
			else begin
				mode00irq <= 0;
				mode01irq <= 0;
				mode10irq <= 0;
			end
			lycirq <= 0;
		end
		
		lcdr <= lcdr_;
		lcdg <= lcdg_;
		lcdb <= lcdb_;
	end
	
	/***** Video RAM *****/
	/* Base is 0x8000
	 *
	 * Tile data from 8000-8FFF or 8800-97FF
	 * Background tile maps 9800-9BFF or 9C00-9FFF
	 */
	reg [7:0] tiledatahigh [3071:0];
	reg [7:0] tiledatalow [3071:0];
	reg [7:0] bgmap1 [1023:0];
	reg [7:0] bgmap2 [1023:0];
	
	// Upper five bits are Y coord, lower five bits are X coord
	// The new tile number is loaded when vxpos[2:0] is 3'b110
	// The new tile data is loaded when vxpos[2:0] is 3'b111
	// The new tile data is latched and ready when vxpos[2:0] is 3'b000!
	wire [7:0] vxpos_ = vxpos + 1;
	wire [9:0] bgmapaddr = {vypos[7:3], vxpos_[7:3]};
	reg [7:0] tileno;
	wire [10:0] tileaddr = {tileno, vypos[2:0]};
	reg [7:0] tilehigh, tilelow;
	assign pixdata = {tilehigh[7-vxpos[2:0]], tilelow[7-vxpos[2:0]]};
	
	wire decode_tiledata = (addr >= 16'h8000) && (addr <= 16'h97FF);
	wire decode_bgmap1 = (addr >= 16'h9800) && (addr <= 16'h9BFF);

	wire [9:0] bgmapaddr_in = vraminuse ? bgmapaddr : addr[9:0];
	wire [11:0] tileaddr_in = vraminuse ? tileaddr : addr[12:1];
	
	always @(negedge clk)
		if ((vraminuse && ((posx == 2) || (vxpos[2:0] == 3'b111))) || decode_bgmap1) begin
			tileno <= bgmap1[bgmapaddr_in];
			if (wr && decode_bgmap1 && ~vraminuse)
				bgmap1[bgmapaddr_in] <= data;
		end
	
	always @(negedge clk)
		if ((vraminuse && ((posx == 3) || (vxpos[2:0] == 3'b000))) || decode_tiledata) begin
			tilehigh <= tiledatahigh[tileaddr_in];
			tilelow <= tiledatalow[tileaddr_in];
			if (wr && addr[0] && decode_tiledata && ~vraminuse)
				tiledatahigh[tileaddr_in] <= data;
			if (wr && ~addr[0] && decode_tiledata && ~vraminuse)
				tiledatalow[tileaddr_in] <= data;
		end
  
	/***** Bus interface *****/
	assign data = rd ?
			((addr == `ADDR_LCDC) ? rLCDC :
			 (addr == `ADDR_STAT) ? {rSTAT[7:3], (rLYC == posy) ? 1'b1 : 1'b0, mode} :
			 (addr == `ADDR_SCY) ? rSCY :
			 (addr == `ADDR_SCX) ? rSCX :
			 (addr == `ADDR_LY) ? posy :
			 (addr == `ADDR_LYC) ? rLYC :
			 (addr == `ADDR_BGP) ? rBGP :
			 (addr == `ADDR_OBP0) ? rOBP0 :
			 (addr == `ADDR_OBP1) ? rOBP1 :
			 (addr == `ADDR_WY) ? rWY :
			 (addr == `ADDR_WX) ? rWX :
			 (decode_tiledata && addr[0]) ? tilehigh :
			 (decode_tiledata && ~addr[0]) ? tilelow :
			 (decode_bgmap1) ? tileno :
			 8'bzzzzzzzz) :
		8'bzzzzzzzz;
  
	always @(negedge clk)
	begin
		if (wr)
			case (addr)
			`ADDR_LCDC:	rLCDC <= data;
			`ADDR_STAT:	rSTAT <= {data[7:2],rSTAT[1:0]};
			`ADDR_SCY:	rSCY <= data;
			`ADDR_SCX:	rSCX <= data;
			`ADDR_LYC:	rLYC <= data;
			`ADDR_DMA:	rDMA <= data;
			`ADDR_BGP:	rBGP <= data;
			`ADDR_OBP0:	rOBP0 <= data;
			`ADDR_OBP1:	rOBP1 <= data;
			`ADDR_WY:	rWY <= data;
			`ADDR_WX:	rWX <= data;
			endcase
	end
endmodule
Commit	Line	Data
537e1f83 JW	1	`define ADDR_LCDC 16'hFF40
	2	`define ADDR_STAT 16'hFF41
	3	`define ADDR_SCY 16'hFF42
	4	`define ADDR_SCX 16'hFF43
	5	`define ADDR_LY 16'hFF44
	6	`define ADDR_LYC 16'hFF45
	7	`define ADDR_DMA 16'hFF46
	8	`define ADDR_BGP 16'hFF47
	9	`define ADDR_OBP0 16'hFF48
	10	`define ADDR_OBP1 16'hFF49
	11	`define ADDR_WY 16'hFF4A
	12	`define ADDR_WX 16'hFF4B
	13
	14	module LCDC(
	15	input [15:0] addr,
	16	inout [7:0] data,
	17	input clk, // 8MHz clock
	18	input wr, rd,
00573fd5 JW	19	output wire lcdcirq,
00573fd5 JW	20	output wire vblankirq,
fe3dc890	21	output wire lcdclk, lcdvs, lcdhs,
ec727403	22	output reg [2:0] lcdr, lcdg, output reg [1:0] lcdb);
537e1f83	23
39a68cde JW	24	/*** Needed prototypes ***/
	25	wire [1:0] pixdata;
	26
537e1f83 JW	27	/*** Internal clock that is stable and does not depend on CPU in single/double clock mode ***/
	28	reg clk4 = 0;
	29	always @(posedge clk)
	30	clk4 = ~clk4;
fe3dc890	31	assign lcdclk = clk4;
537e1f83	32
00573fd5 JW	33	/*** LCD control registers ***/
	34	reg [7:0] rLCDC = 8'h91;
	35	reg [7:0] rSTAT = 8'h00;
	36	reg [7:0] rSCY = 8'b00;
	37	reg [7:0] rSCX = 8'b00;
	38	reg [7:0] rLYC = 8'b00;
	39	reg [7:0] rDMA = 8'b00;
	40	reg [7:0] rBGP = 8'b00;
	41	reg [7:0] rOBP0 = 8'b00;
	42	reg [7:0] rOBP1 = 8'b00;
	43	reg [7:0] rWY = 8'b00;
	44	reg [7:0] rWX = 8'b00;
	45
537e1f83 JW	46	/*** Sync generation ***/
	47
	48	/* A complete cycle takes 456 clocks.
	49	* VBlank lasts 4560 clocks (10 scanlines) -- LY = 144 - 153.
	50	*
	51	* Modes: 0 -> in hblank and OAM/VRAM available - present 207 clks
	52	* 1 -> in vblank and OAM/VRAM available
39a68cde JW	53	* 2 -> OAM in use - present 86 clks
	54	* 3 -> OAM/VRAM in use - present 163 clks
	55	* So, X = 0~162 is HActive,
	56	* X = 163-369 is HBlank,
	57	* X = 370-455 is HWhirrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrrr.
fe3dc890 JW	58	* [02:15:10] <Judge_> LY is updated near the 0 -> 2 transition
	59	* [02:15:38] <Judge_> it seems to be updated internally first before it is visible in the LY register itself
	60	* [02:15:40] <Judge_> some kind of delay
	61	* [02:16:19] <Judge_> iirc it is updated about 4 cycles prior to mode 2
537e1f83 JW	62	*/
	63	reg [8:0] posx = 9'h000;
	64	reg [7:0] posy = 8'h00;
39a68cde	65
80ecd2fe JW	66	wire vraminuse = (posx < 163) && (posy < 144);
80ecd2fe JW	67	wire oaminuse = (posx > 369) && (posy < 144);
39a68cde JW	68
	69	wire display = (posx > 2) && (posx < 163) && (posy < 144);
	70
537e1f83	71	wire [1:0] mode = (posy < 144) ?
39a68cde JW	72	(vraminuse ? 2'b11 :
	73	oaminuse ? 2'b10 :
	74	2'b00)
537e1f83 JW	75	: 2'b01;
537e1f83 JW	76
4d90f272 JW	77	wire [7:0] vxpos = rSCX + posx - 3;
	78	wire [7:0] vypos = rSCY + posy;
	79
ec727403 JW	80	assign lcdvs = (posy == 153) && (posx == 2);
	81	assign lcdhs = (posx == 2);
	82
	83	wire [2:0] lcdr_ = display ? {pixdata[1] ? 3'b111 : 3'b000} : 3'b000;
	84	wire [2:0] lcdg_ = display ? {pixdata[0] ? 3'b111 : 3'b000} : 3'b000;
	85	wire [1:0] lcdb_ = display ? {(vypos < 8 \|\| vxpos < 8) ? 2'b11 : 2'b00} : 2'b00;
00573fd5 JW	86
	87	reg mode00irq = 0, mode01irq = 0, mode10irq = 0, lycirq = 0;
	88	assign lcdcirq = (rSTAT[3] & mode00irq) \| (rSTAT[4] & mode01irq) \| (rSTAT[5] & mode10irq) \| (rSTAT[6] & lycirq);
	89	assign vblankirq = (posx == 0 && posy == 153);
	90
	91	always @(posedge clk4)
537e1f83 JW	92	begin
	93	if (posx == 455) begin
	94	posx <= 0;
00573fd5	95	if (posy == 153) begin
537e1f83	96	posy <= 0;
00573fd5 JW	97	if (0 == rLYC)
	98	lycirq <= 1;
	99	end else begin
537e1f83	100	posy <= posy + 1;
00573fd5 JW	101	/* Check for vblank and generate an IRQ if needed. */
	102	if (posy == 143) begin
	103	mode01irq <= 1;
	104	end
	105	if ((posy + 1) == rLYC)
	106	lycirq <= 1;
	107
	108	end
	109	end else begin
537e1f83	110	posx <= posx + 1;
00573fd5 JW	111	if (posx == 165)
	112	mode00irq <= 1;
	113	else if (posx == 373)
	114	mode10irq <= 1;
	115	else begin
	116	mode00irq <= 0;
	117	mode01irq <= 0;
	118	mode10irq <= 0;
	119	end
	120	lycirq <= 0;
	121	end
ec727403 JW	122
	123	lcdr <= lcdr_;
	124	lcdg <= lcdg_;
	125	lcdb <= lcdb_;
537e1f83	126	end
39a68cde JW	127
	128	/*** Video RAM ***/
	129	/* Base is 0x8000
	130	*
	131	* Tile data from 8000-8FFF or 8800-97FF
	132	* Background tile maps 9800-9BFF or 9C00-9FFF
	133	*/
4d90f272 JW	134	reg [7:0] tiledatahigh [3071:0];
4d90f272 JW	135	reg [7:0] tiledatalow [3071:0];
39a68cde JW	136	reg [7:0] bgmap1 [1023:0];
	137	reg [7:0] bgmap2 [1023:0];
	138
	139	// Upper five bits are Y coord, lower five bits are X coord
4d90f272 JW	140	// The new tile number is loaded when vxpos[2:0] is 3'b110
4d90f272 JW	141	// The new tile data is loaded when vxpos[2:0] is 3'b111
39a68cde	142	// The new tile data is latched and ready when vxpos[2:0] is 3'b000!
ec727403 JW	143	wire [7:0] vxpos_ = vxpos + 1;
ec727403 JW	144	wire [9:0] bgmapaddr = {vypos[7:3], vxpos_[7:3]};
39a68cde	145	reg [7:0] tileno;
75be7c71	146	wire [10:0] tileaddr = {tileno, vypos[2:0]};
4d90f272	147	reg [7:0] tilehigh, tilelow;
ec727403	148	assign pixdata = {tilehigh[7-vxpos[2:0]], tilelow[7-vxpos[2:0]]};
39a68cde JW	149
	150	wire decode_tiledata = (addr >= 16'h8000) && (addr <= 16'h97FF);
	151	wire decode_bgmap1 = (addr >= 16'h9800) && (addr <= 16'h9BFF);
4d90f272 JW	152
	153	wire [9:0] bgmapaddr_in = vraminuse ? bgmapaddr : addr[9:0];
	154	wire [11:0] tileaddr_in = vraminuse ? tileaddr : addr[12:1];
39a68cde JW	155
39a68cde JW	156	always @(negedge clk)
ec727403	157	if ((vraminuse && ((posx == 2) \|\| (vxpos[2:0] == 3'b111))) \|\| decode_bgmap1) begin
4d90f272	158	tileno <= bgmap1[bgmapaddr_in];
80ecd2fe	159	if (wr && decode_bgmap1 && ~vraminuse)
4d90f272 JW	160	bgmap1[bgmapaddr_in] <= data;
	161	end
	162
	163	always @(negedge clk)
ec727403	164	if ((vraminuse && ((posx == 3) \|\| (vxpos[2:0] == 3'b000))) \|\| decode_tiledata) begin
4d90f272 JW	165	tilehigh <= tiledatahigh[tileaddr_in];
4d90f272 JW	166	tilelow <= tiledatalow[tileaddr_in];
80ecd2fe	167	if (wr && addr[0] && decode_tiledata && ~vraminuse)
4d90f272	168	tiledatahigh[tileaddr_in] <= data;
80ecd2fe	169	if (wr && ~addr[0] && decode_tiledata && ~vraminuse)
4d90f272	170	tiledatalow[tileaddr_in] <= data;
39a68cde	171	end
537e1f83 JW	172
537e1f83 JW	173	/*** Bus interface ***/
537e1f83	174	assign data = rd ?
75be7c71 JW	175	((addr == `ADDR_LCDC) ? rLCDC :
	176	(addr == `ADDR_STAT) ? {rSTAT[7:3], (rLYC == posy) ? 1'b1 : 1'b0, mode} :
	177	(addr == `ADDR_SCY) ? rSCY :
	178	(addr == `ADDR_SCX) ? rSCX :
	179	(addr == `ADDR_LY) ? posy :
	180	(addr == `ADDR_LYC) ? rLYC :
	181	(addr == `ADDR_BGP) ? rBGP :
	182	(addr == `ADDR_OBP0) ? rOBP0 :
	183	(addr == `ADDR_OBP1) ? rOBP1 :
	184	(addr == `ADDR_WY) ? rWY :
	185	(addr == `ADDR_WX) ? rWX :
	186	(decode_tiledata && addr[0]) ? tilehigh :
	187	(decode_tiledata && ~addr[0]) ? tilelow :
	188	(decode_bgmap1) ? tileno :
	189	8'bzzzzzzzz) :
537e1f83 JW	190	8'bzzzzzzzz;
	191
	192	always @(negedge clk)
	193	begin
	194	if (wr)
	195	case (addr)
	196	`ADDR_LCDC: rLCDC <= data;
	197	`ADDR_STAT: rSTAT <= {data[7:2],rSTAT[1:0]};
	198	`ADDR_SCY: rSCY <= data;
	199	`ADDR_SCX: rSCX <= data;
	200	`ADDR_LYC: rLYC <= data;
	201	`ADDR_DMA: rDMA <= data;
	202	`ADDR_BGP: rBGP <= data;
	203	`ADDR_OBP0: rOBP0 <= data;
	204	`ADDR_OBP1: rOBP1 <= data;
	205	`ADDR_WY: rWY <= data;
	206	`ADDR_WX: rWX <= data;
	207	endcase
	208	end
	209	endmodule