Update sys. HV-Integer scale. Vertical crop.

2025-07-19 07:11:22 +03:00 · 2021-03-02 20:11:28 +08:00
parent 17fc907348
commit 2c2b476975
11 changed files with 559 additions and 180 deletions
--- a/sys/video_freak.sv
+++ b/sys/video_freak.sv
@ -0,0 +1,231 @@
+//
+//
+// Video crop 
+// Copyright (c) 2020 Grabulosaure, (c) 2021 Alexey Melnikov
+// 
+// Integer scaling
+// Copyright (c) 2021 Alexey Melnikov
+//
+// This program is GPL Licensed. See COPYING for the full license.
+//
+//
+////////////////////////////////////////////////////////////////////////////////////////////////////////
+
+`timescale 1ns / 1ps
+
+module video_freak
+(
+	input             CLK_VIDEO,
+	input             CE_PIXEL,
+	input             VGA_VS,
+	input      [11:0] HDMI_WIDTH,
+	input      [11:0] HDMI_HEIGHT,
+	output            VGA_DE,
+	output reg [12:0] VIDEO_ARX,
+	output reg [12:0] VIDEO_ARY,
+
+	input             VGA_DE_IN,
+	input      [11:0] ARX,
+	input      [11:0] ARY,
+	input      [11:0] CROP_SIZE,
+	input       [4:0] CROP_OFF,
+	input       [1:0] SCALE
+);
+
+reg        vde;
+reg [11:0] arxo,aryo;
+reg [11:0] vsize;
+reg [11:0] hsize;
+
+always @(posedge CLK_VIDEO) begin
+	reg        old_de, old_vs,vcalc,ovde;
+	reg [11:0] vtot,vcpt,vcrop,voff;
+	reg [11:0] hcpt;
+	reg [11:0] vadj;
+	reg [23:0] ARXG,ARYG,arx,ary;
+
+	if (CE_PIXEL) begin
+		old_de <= VGA_DE_IN;
+		old_vs <= VGA_VS;
+		if (VGA_VS & ~old_vs) begin
+			vcpt  <= 0;
+			vtot  <= vcpt;
+			vcalc <= 1;
+			vcrop <= ((CROP_SIZE >= vcpt) || !CROP_SIZE) ? 12'd0 : CROP_SIZE;
+		end
+		
+		if (VGA_DE_IN) hcpt <= hcpt + 1'd1;
+		if (~VGA_DE_IN & old_de) begin
+			vcpt <= vcpt + 1'd1;
+			if(!vcpt) hsize <= hcpt;
+			hcpt <= 0;
+		end
+	end
+
+	arx <= ARX;
+	ary <= ARY;
+
+	vsize <= vcrop;
+
+	if(!vcrop || !ary || !arx) begin
+		arxo  <= arx[11:0];
+		aryo  <= ary[11:0];
+		vsize <= vtot;
+	end
+	else if (vcalc) begin
+		ARXG <= arx * vtot;
+		ARYG <= ary * vcrop;
+		vcalc <= 0;
+	end
+	else if (ARXG[23] | ARYG[23]) begin
+		arxo <= ARXG[23:12];
+		aryo <= ARYG[23:12];
+	end
+	else begin
+		ARXG <= ARXG << 1;
+		ARYG <= ARYG << 1;
+	end
+
+	vadj <= (vtot-vcrop) + {{6{CROP_OFF[4]}},CROP_OFF,1'b0};
+	voff <= vadj[11] ? 12'd0 : ((vadj[11:1] + vcrop) > vtot) ? vtot-vcrop : vadj[11:1];
+	ovde <= ((vcpt >= voff) && (vcpt < (vcrop + voff))) || !vcrop;
+	vde  <= ovde;
+end
+
+assign VGA_DE = vde & VGA_DE_IN;
+
+video_scale_int scale
+(
+	.CLK_VIDEO(CLK_VIDEO),
+	.HDMI_WIDTH(HDMI_WIDTH),
+	.HDMI_HEIGHT(HDMI_HEIGHT),
+	.hsize(hsize),
+	.vsize(vsize),
+	.arx_i(arxo),
+	.ary_i(aryo),
+	.scale(SCALE),
+	.arx_o(VIDEO_ARX),
+	.ary_o(VIDEO_ARY)
+);
+
+endmodule
+
+
+module video_scale_int
+(
+	input         CLK_VIDEO,
+
+	input  [11:0] HDMI_WIDTH,
+	input  [11:0] HDMI_HEIGHT,
+
+	input  [11:0] hsize,
+	input  [11:0] vsize,
+
+	input  [11:0] arx_i,
+	input  [11:0] ary_i,
+
+	input   [1:0] scale,
+
+	output reg [12:0] arx_o,
+	output reg [12:0] ary_o
+);
+
+reg         div_start;
+wire        div_run;
+reg  [23:0] div_num;
+reg  [11:0] div_den;
+wire [23:0] div_res;
+sys_udiv #(24,12) div(CLK_VIDEO,div_start,div_run, div_num,div_den,div_res);
+
+reg         mul_start;
+wire        mul_run;
+reg  [11:0] mul_arg1, mul_arg2;
+wire [23:0] mul_res;
+sys_umul #(12,12) mul(CLK_VIDEO,mul_start,mul_run, mul_arg1,mul_arg2,mul_res);
+
+wire [11:0] wideres = mul_res[11:0] + hsize;
+reg  [12:0] arxf,aryf;
+
+always @(posedge CLK_VIDEO) begin
+	reg [11:0] oheight;
+	reg  [3:0] cnt;
+
+	div_start <= 0;
+	mul_start <= 0;
+
+	if (!scale || !ary_i || !arx_i) begin
+		arxf <= arx_i;
+		aryf <= ary_i;
+	end
+	else if(~div_start & ~div_run & ~mul_start & ~mul_run) begin
+		cnt <= cnt + 1'd1;
+		case(cnt)
+			0: begin
+					div_num   <= HDMI_HEIGHT;
+					div_den   <= vsize;
+					div_start <= 1;
+				end
+
+			1: if(!div_res[11:0]) begin
+					// screen resolution is lower than video resolution.
+					// Integer scaling is impossible.
+					arxf      <= arx_i;
+					aryf      <= ary_i;
+					cnt       <= 0;
+				end
+				else begin
+					mul_arg1  <= vsize;
+					mul_arg2  <= div_res[11:0];
+					mul_start <= 1;
+				end
+
+			2: begin
+					oheight   <= mul_res[11:0];
+					mul_arg1  <= mul_res[11:0];
+					mul_arg2  <= arx_i;
+					mul_start <= 1;
+				end
+
+			3: begin
+					div_num   <= mul_res;
+					div_den   <= ary_i;
+					div_start <= 1;
+				end
+
+			4: begin
+					div_num   <= div_res;
+					div_den   <= hsize;
+					div_start <= 1;
+				end
+
+			5: begin
+					mul_arg1  <= hsize;
+					mul_arg2  <= div_res[11:0] ? div_res[11:0] : 12'd1;
+					mul_start <= 1;
+				end
+
+			6: if(mul_res <= HDMI_WIDTH) cnt <= 8;
+				else begin
+					div_num   <= HDMI_WIDTH;
+					div_den   <= hsize;
+					div_start <= 1;
+				end
+
+			7: begin
+					mul_arg1  <= hsize;
+					mul_arg2  <= div_res[11:0] ? div_res[11:0] : 12'd1;
+					mul_start <= 1;
+				end
+
+			8: begin
+					arxf <= {1'b1, ~scale[1] ? div_num[11:0] : (scale[0] && (wideres <= HDMI_WIDTH)) ? wideres : mul_res[11:0]};
+					aryf <= {1'b1, oheight};
+				end
+		endcase
+	end
+
+	arx_o <= arxf;
+	ary_o <= aryf;
+end
+
+endmodule