[RFC 12/21] DRM: Add VIA DRM driver

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



commit ab2beb77d5889b18112ee02c381e817eebbdccff
Author: James Simmons <jsimmons@xxxxxxxxxxxxx>
Date:   Sat Jun 8 11:02:43 2013 -0400

    via: IGA (CRTC) handling
    
    Routines to program all things crtc related. This covers gamma tables, cursors
    and of course resolution setting.
    
    Signed-Off-by: James Simmons <jsimmons@xxxxxxxxxxxxx>

diff --git a/drivers/gpu/drm/via/via_crtc.c b/drivers/gpu/drm/via/via_crtc.c
new file mode 100644
index 0000000..10a5017
--- /dev/null
+++ b/drivers/gpu/drm/via/via_crtc.c
@@ -0,0 +1,1622 @@
+/*
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the "Software"),
+ * to deal in the Software without restriction, including without limitation
+ * the rights to use, copy, modify, merge, publish, distribute, sub license,
+ * and/or sell copies of the Software, and to permit persons to whom the
+ * Software is furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice (including the
+ * next paragraph) shall be included in all copies or substantial portions
+ * of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
+ * THE AUTHOR(S) OR COPYRIGHT HOLDER(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
+ * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
+ * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
+ * DEALINGS IN THE SOFTWARE.
+ *
+ * Authors:
+ *	James Simmons <jsimmons@xxxxxxxxxxxxx>
+ */
+#include <drm/drm_mode.h>
+#include "drmP.h"
+#include "drm_crtc.h"
+#include "drm_crtc_helper.h"
+
+#include "via_drv.h"
+#include "via_disp_reg.h"
+
+static struct vga_regset vpit_table[] = {
+	{ VGA_SEQ_I, 0x01, 0xFF, 0x01 },
+	{ VGA_SEQ_I, 0x02, 0xFF, 0x0F },
+	{ VGA_SEQ_I, 0x03, 0xFF, 0x00 },
+	{ VGA_SEQ_I, 0x04, 0xFF, 0x0E },
+	{ VGA_GFX_I, 0x00, 0xFF, 0x00 },
+	{ VGA_GFX_I, 0x01, 0xFF, 0x00 },
+	{ VGA_GFX_I, 0x02, 0xFF, 0x00 },
+	{ VGA_GFX_I, 0x03, 0xFF, 0x00 },
+	{ VGA_GFX_I, 0x04, 0xFF, 0x00 },
+	{ VGA_GFX_I, 0x05, 0xFF, 0x00 },
+	{ VGA_GFX_I, 0x06, 0xFF, 0x05 },
+	{ VGA_GFX_I, 0x07, 0xFF, 0x0F },
+	{ VGA_GFX_I, 0x08, 0xFF, 0xFF }
+};
+
+static void
+via_hide_cursor(struct drm_crtc *crtc)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+	uint32_t temp;
+
+	if (iga->index) {
+		temp = VIA_READ(HI_CONTROL);
+		VIA_WRITE(HI_CONTROL, temp & 0xFFFFFFFA);
+	} else {
+		temp = VIA_READ(PRIM_HI_CTRL);
+		VIA_WRITE(PRIM_HI_CTRL, temp & 0xFFFFFFFA);
+	}
+}
+
+static void
+via_show_cursor(struct drm_crtc *crtc)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+
+	if (!iga->cursor_kmap.bo)
+		return;
+
+	/* Program the offset and turn on Hardware icon Cursor */
+	if (iga->index) {
+		VIA_WRITE(HI_FBOFFSET, iga->cursor_kmap.bo->offset);
+		VIA_WRITE(HI_CONTROL, 0xB6000005);
+	} else {
+		VIA_WRITE(PRIM_HI_FBOFFSET, iga->cursor_kmap.bo->offset);
+		VIA_WRITE(PRIM_HI_CTRL, 0x36000005);
+	}
+}
+
+static int
+via_crtc_cursor_set(struct drm_crtc *crtc, struct drm_file *file_priv,
+			uint32_t handle, uint32_t width, uint32_t height)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	int max_height = 64, max_width = 64, ret = 0, i;
+	struct drm_device *dev = crtc->dev;
+	struct drm_gem_object *obj = NULL;
+	struct ttm_bo_kmap_obj user_kmap;
+
+	if (!iga->cursor_kmap.bo)
+		return -ENXIO;
+
+	if (!handle) {
+		/* turn off cursor */
+		via_hide_cursor(crtc);
+		return ret;
+	}
+
+	if (dev->pdev->device == PCI_DEVICE_ID_VIA_CLE266 ||
+	    dev->pdev->device == PCI_DEVICE_ID_VIA_KM400) {
+		max_height >>= 1;
+		max_width >>= 1;
+	}
+
+	if ((height > max_height) || (width > max_width)) {
+		DRM_ERROR("bad cursor width or height %d x %d\n", width, height);
+		return -EINVAL;
+	}
+
+	obj = drm_gem_object_lookup(dev, file_priv, handle);
+	if (!obj || !obj->driver_private) {
+		DRM_ERROR("Cannot find cursor object %x for crtc %d\n", handle, crtc->base.id);
+		return -ENOENT;
+	}
+
+	user_kmap.bo = obj->driver_private;
+	ret = ttm_bo_kmap(user_kmap.bo, 0, user_kmap.bo->mem.size, &user_kmap);
+	if (!ret) {
+		/* Copy data from userland to cursor memory region */
+		u32 *dst = iga->cursor_kmap.virtual, *src = user_kmap.virtual;
+
+		memset_io(dst, 0x0, iga->cursor_kmap.bo->mem.size);
+		for (i = 0; i < height; i++) {
+			__iowrite32_copy(dst, src, width);
+			dst += max_width;
+			src += width;
+		}
+		ttm_bo_kunmap(&user_kmap);
+	}
+	drm_gem_object_unreference_unlocked(obj);
+	via_show_cursor(crtc);
+	return ret;
+}
+
+static int
+via_crtc_cursor_move(struct drm_crtc *crtc, int x, int y)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+	unsigned char xoff = 0, yoff = 0;
+	int xpos = x, ypos = y;
+
+	if (x < 0) {
+		xoff = (-x) & 0xFF;
+		xpos = 0;
+	}
+
+	if (y < 0) {
+		yoff = (-y) & 0xFF;
+		ypos = 0;
+	}
+
+	if (iga->index) {
+		VIA_WRITE(HI_POSSTART, ((xpos << 16) | (ypos & 0x07ff)));
+		VIA_WRITE(HI_CENTEROFFSET, ((xoff << 16) | (yoff & 0x07ff)));
+	} else {
+		VIA_WRITE(PRIM_HI_POSSTART, ((xpos << 16) | (ypos & 0x07ff)));
+		VIA_WRITE(PRIM_HI_CENTEROFFSET, ((xoff << 16) | (yoff & 0x07ff)));
+	}
+	return 0;
+}
+
+static void
+via_iga1_gamma_set(struct drm_crtc *crtc, u16 *red, u16 *green, u16 *blue,
+			uint32_t start, uint32_t size)
+{
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+	int end = (start + size > 256) ? 256 : start + size, i;
+	u8 val, sr1a = vga_rseq(VGABASE, 0x1A);
+
+	if (!crtc->enabled || !crtc->fb)
+		return;
+
+	if (crtc->fb->bits_per_pixel == 8) {
+		/* Prepare for initialize IGA1's LUT: */
+		vga_wseq(VGABASE, 0x1A, sr1a & 0xFE);
+		/* Change to Primary Display's LUT */
+		val = vga_rseq(VGABASE, 0x1B);
+		vga_wseq(VGABASE, 0x1B, val);
+		val = vga_rcrt(VGABASE, 0x67);
+		vga_wcrt(VGABASE, 0x67, val);
+
+		/* Fill in IGA1's LUT */
+		for (i = start; i < end; i++) {
+			/* Bit mask of palette */
+			vga_w(VGABASE, VGA_PEL_MSK, 0xFF);
+			vga_w(VGABASE, VGA_PEL_IW, i);
+			vga_w(VGABASE, VGA_PEL_D, red[i] >> 8);
+			vga_w(VGABASE, VGA_PEL_D, green[i] >> 8);
+			vga_w(VGABASE, VGA_PEL_D, blue[i] >> 8);
+		}
+		/* enable LUT */
+		svga_wseq_mask(VGABASE, 0x1B, 0x00, BIT(0));
+		/* Disable gamma in case it was enabled previously */
+		svga_wcrt_mask(VGABASE, 0x33, 0x00, BIT(7));
+		/* access Primary Display's LUT */
+		vga_wseq(VGABASE, 0x1A, sr1a & 0xFE);
+	} else {
+		/* Enable Gamma */
+		svga_wcrt_mask(VGABASE, 0x33, BIT(7), BIT(7));
+		svga_wseq_mask(VGABASE, 0x1A, 0x00, BIT(0));
+
+		/* Fill in IGA1's gamma */
+		for (i = start; i < end; i++) {
+			/* bit mask of palette */
+			vga_w(VGABASE, VGA_PEL_MSK, 0xFF);
+			vga_w(VGABASE, VGA_PEL_IW, i);
+			vga_w(VGABASE, VGA_PEL_D, red[i] >> 8);
+			vga_w(VGABASE, VGA_PEL_D, green[i] >> 8);
+			vga_w(VGABASE, VGA_PEL_D, blue[i] >> 8);
+		}
+		vga_wseq(VGABASE, 0x1A, sr1a);
+	}
+}
+
+static void
+via_iga2_gamma_set(struct drm_crtc *crtc, u16 *red, u16 *green, u16 *blue,
+			uint32_t start, uint32_t size)
+{
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+	int end = (start + size > 256) ? 256 : start + size, i;
+	u8 sr1a = vga_rseq(VGABASE, 0x1A);
+
+	if (!crtc->enabled || !crtc->fb)
+		return;
+
+	if (crtc->fb->bits_per_pixel == 8) {
+		/* Change Shadow to Secondary Display's LUT */
+		svga_wseq_mask(VGABASE, 0x1A, BIT(0), BIT(0));
+		/* Enable Secondary Display Engine */
+		svga_wseq_mask(VGABASE, 0x1B, BIT(7), BIT(7));
+		/* Second Display Color Depth, 8bpp */
+		svga_wcrt_mask(VGABASE, 0x67, 0x3F, 0x3F);
+
+		/* Enable second display channel just in case. */
+		if (!(vga_rcrt(VGABASE, 0x6A) & BIT(7)))
+			enable_second_display_channel(VGABASE);
+
+		/* Fill in IGA2's LUT */
+		for (i = start; i < end; i++) {
+			/* Bit mask of palette */
+			vga_w(VGABASE, VGA_PEL_MSK, 0xFF);
+			vga_w(VGABASE, VGA_PEL_IW, i);
+			vga_w(VGABASE, VGA_PEL_D, red[i] >> 8);
+			vga_w(VGABASE, VGA_PEL_D, green[i] >> 8);
+			vga_w(VGABASE, VGA_PEL_D, blue[i] >> 8);
+		}
+		/* Disable gamma in case it was enabled previously */
+		svga_wcrt_mask(VGABASE, 0x6A, 0x00, BIT(1));
+
+		/* access Primary Display's LUT */
+		vga_wseq(VGABASE, 0x1A, sr1a & 0xFE);
+	} else {
+		u8 reg_bits = BIT(1);
+
+		svga_wseq_mask(VGABASE, 0x1A, BIT(0), BIT(0));
+		/* Bit 1 enables gamma */
+		svga_wcrt_mask(VGABASE, 0x6A, BIT(1), BIT(1));
+
+		/* Old platforms LUT are 6 bits in size.
+		 * Newer it is 8 bits. */
+		switch (crtc->dev->pdev->device) {
+		case PCI_DEVICE_ID_VIA_CLE266:
+		case PCI_DEVICE_ID_VIA_KM400:
+		case PCI_DEVICE_ID_VIA_K8M800:
+		case PCI_DEVICE_ID_VIA_PM800:
+			break;
+
+		default:
+			reg_bits |= BIT(5);	
+			break;
+		}
+		svga_wcrt_mask(VGABASE, 0x6A, reg_bits, reg_bits);
+
+		/* Before we fill the second LUT, we have to enable
+		 * second display channel. If it's enabled before,
+		 * we don't need to do that, or else the secondary
+		 * display will be dark for about 1 sec and then be
+		 * turned on again.
+		 */
+		if (!(vga_rcrt(VGABASE, 0x6A) & BIT(7)))
+			enable_second_display_channel(VGABASE);
+
+		/* Fill in IGA2's gamma */
+		for (i = start; i < end; i++) {
+			/* bit mask of palette */
+			vga_w(VGABASE, VGA_PEL_MSK, 0xFF);
+			vga_w(VGABASE, VGA_PEL_IW, i);
+			vga_w(VGABASE, VGA_PEL_D, red[i] >> 8);
+			vga_w(VGABASE, VGA_PEL_D, green[i] >> 8);
+			vga_w(VGABASE, VGA_PEL_D, blue[i] >> 8);
+		}
+		/* access Primary Display's LUT */
+		vga_wseq(VGABASE, 0x1A, sr1a);
+	}
+}
+
+static void
+via_crtc_destroy(struct drm_crtc *crtc)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+
+	if (iga->cursor_kmap.bo) {
+		ttm_bo_unpin(iga->cursor_kmap.bo, &iga->cursor_kmap);
+		ttm_bo_unref(&iga->cursor_kmap.bo);
+	}
+	drm_crtc_cleanup(crtc);
+}
+
+static const struct drm_crtc_funcs via_iga1_funcs = {
+	.cursor_set = via_crtc_cursor_set,
+	.cursor_move = via_crtc_cursor_move,
+	.gamma_set = via_iga1_gamma_set,
+	.set_config = drm_crtc_helper_set_config,
+	.destroy = via_crtc_destroy,
+};
+
+static const struct drm_crtc_funcs via_iga2_funcs = {
+	.cursor_set = via_crtc_cursor_set,
+	.cursor_move = via_crtc_cursor_move,
+	.gamma_set = via_iga2_gamma_set,
+	.set_config = drm_crtc_helper_set_config,
+	.destroy = via_crtc_destroy,
+};
+
+static void
+via_load_vpit_regs(struct drm_via_private *dev_priv)
+{
+	u8 ar[] = {
+		0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
+		0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
+		0x01, 0x00, 0x0F, 0x00
+	};
+	struct vga_registers vpit_regs;
+	unsigned int i = 0;
+	u8 reg_value = 0;
+
+	/* Enable changing the palette registers */
+	reg_value = vga_r(VGABASE, VGA_IS1_RC);
+	vga_w(VGABASE, VGA_ATT_W, 0x00);
+
+	/* Write Misc register */
+	vga_w(VGABASE, VGA_MIS_W, 0xCF);
+
+	/* Fill VPIT registers */
+	vpit_regs.count = ARRAY_SIZE(vpit_table);
+	vpit_regs.regs = vpit_table;
+	load_register_tables(VGABASE, &vpit_regs);
+
+	/* Write Attribute Controller */
+	for (i = 0; i < 0x14; i++) {
+		reg_value = vga_r(VGABASE, VGA_IS1_RC);
+		vga_w(VGABASE, VGA_ATT_W, i);
+		vga_w(VGABASE, VGA_ATT_W, ar[i]);
+	}
+
+	/* Disable changing the palette registers */
+	reg_value = vga_r(VGABASE, VGA_IS1_RC);
+	vga_w(VGABASE, VGA_ATT_W, BIT(5));
+}
+
+static void
+via_load_fifo_regs(struct via_crtc *iga, struct drm_display_mode *mode)
+{
+	u32 queue_expire_num = iga->display_queue_expire_num, reg_value;
+	struct drm_via_private *dev_priv = iga->base.dev->dev_private;
+	int hor_active = mode->hdisplay, ver_active = mode->vdisplay;
+	struct drm_device *dev = iga->base.dev;
+
+	/* If resolution > 1280x1024, expire length = 64, else
+	   expire length = 128 */
+	if ((dev->pdev->device == PCI_DEVICE_ID_VIA_K8M800 ||
+	     dev->pdev->device == PCI_DEVICE_ID_VIA_CN700) &&
+	    ((hor_active > 1280) && (ver_active > 1024)))
+		queue_expire_num = 16;
+
+	if (!iga->index) {
+		/* Set IGA1 Display FIFO Depth Select */
+		reg_value = IGA1_FIFO_DEPTH_SELECT_FORMULA(iga->fifo_max_depth);
+		load_value_to_registers(VGABASE, &iga->fifo_depth, reg_value);
+	} else {
+		/* Set IGA2 Display FIFO Depth Select */
+		reg_value = IGA2_FIFO_DEPTH_SELECT_FORMULA(iga->fifo_max_depth);
+		if (dev->pdev->device == PCI_DEVICE_ID_VIA_K8M800)
+			reg_value--;
+		load_value_to_registers(VGABASE, &iga->fifo_depth, reg_value);
+	}
+
+	/* Set Display FIFO Threshold Select */
+	reg_value = iga->fifo_threshold / 4;
+	load_value_to_registers(VGABASE, &iga->threshold, reg_value);
+
+	/* Set FIFO High Threshold Select */
+	reg_value = iga->fifo_high_threshold / 4;
+	load_value_to_registers(VGABASE, &iga->high_threshold, reg_value);
+
+	/* Set Display Queue Expire Num */
+	reg_value = queue_expire_num / 4;
+	load_value_to_registers(VGABASE, &iga->display_queue, reg_value);
+}
+
+/* Load CRTC Pixel Timing registers */
+void via_load_crtc_pixel_timing(struct drm_crtc *crtc, struct drm_display_mode *mode)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+	u32 reg_value = 0;
+
+	reg_value = IGA1_PIXELTIMING_HOR_TOTAL_FORMULA(mode->crtc_htotal);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.htotal, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_HOR_ADDR_FORMULA(mode->crtc_hdisplay);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.hdisplay, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_HOR_BLANK_START_FORMULA(mode->crtc_hblank_start);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.hblank_start, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_HOR_BLANK_END_FORMULA(mode->crtc_hblank_end);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.hblank_end, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_HOR_SYNC_START_FORMULA(mode->crtc_hsync_start);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.hsync_start, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_HOR_SYNC_END_FORMULA(mode->crtc_hsync_end);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.hsync_end, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_VER_TOTAL_FORMULA(mode->crtc_vtotal);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.vtotal, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_VER_ADDR_FORMULA(mode->crtc_vdisplay);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.vdisplay, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_VER_BLANK_START_FORMULA(mode->crtc_vblank_start);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.vblank_start, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_VER_BLANK_END_FORMULA(mode->crtc_vblank_end);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.vblank_end, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_VER_SYNC_START_FORMULA(mode->crtc_vsync_start);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.vsync_start, reg_value);
+
+	reg_value = IGA1_PIXELTIMING_VER_SYNC_END_FORMULA(mode->crtc_vsync_end);
+	load_value_to_registers(VGABASE, &iga->pixel_timings.vsync_end, reg_value);
+}
+
+/* Load CRTC timing registers */
+void via_load_crtc_timing(struct via_crtc *iga, struct drm_display_mode *mode)
+{
+	struct drm_via_private *dev_priv = iga->base.dev->dev_private;
+	struct drm_device *dev = iga->base.dev;
+	u32 reg_value = 0;
+
+	if (!iga->index) {
+		if (dev->pdev->device == PCI_DEVICE_ID_VIA_VX900) {
+			/* Disable IGA1 shadow timing */
+			svga_wcrt_mask(VGABASE, 0x45, 0x00, BIT(0));
+
+			/* Disable IGA1 pixel timing */
+			svga_wcrt_mask(VGABASE, 0xFD, 0x00, BIT(6) | BIT(5));
+		}
+
+		reg_value = IGA1_HOR_TOTAL_FORMULA(mode->crtc_htotal);
+		load_value_to_registers(VGABASE, &iga->timings.htotal, reg_value);
+
+		reg_value = IGA1_HOR_ADDR_FORMULA(mode->crtc_hdisplay);
+		load_value_to_registers(VGABASE, &iga->timings.hdisplay, reg_value);
+
+		reg_value = IGA1_HOR_BLANK_START_FORMULA(mode->crtc_hblank_start);
+		load_value_to_registers(VGABASE, &iga->timings.hblank_start, reg_value);
+
+		reg_value = IGA1_HOR_BLANK_END_FORMULA(mode->crtc_hblank_end);
+		load_value_to_registers(VGABASE, &iga->timings.hblank_end, reg_value);
+
+		reg_value = IGA1_HOR_SYNC_START_FORMULA(mode->crtc_hsync_start);
+		load_value_to_registers(VGABASE, &iga->timings.hsync_start, reg_value);
+
+		reg_value = IGA1_HOR_SYNC_END_FORMULA(mode->crtc_hsync_end);
+		load_value_to_registers(VGABASE, &iga->timings.hsync_end, reg_value);
+
+		reg_value = IGA1_VER_TOTAL_FORMULA(mode->crtc_vtotal);
+		load_value_to_registers(VGABASE, &iga->timings.vtotal, reg_value);
+
+		reg_value = IGA1_VER_ADDR_FORMULA(mode->crtc_vdisplay);
+		load_value_to_registers(VGABASE, &iga->timings.vdisplay, reg_value);
+
+		reg_value = IGA1_VER_BLANK_START_FORMULA(mode->crtc_vblank_start);
+		load_value_to_registers(VGABASE, &iga->timings.vblank_start, reg_value);
+
+		reg_value = IGA1_VER_BLANK_END_FORMULA(mode->crtc_vblank_end);
+		load_value_to_registers(VGABASE, &iga->timings.vblank_end, reg_value);
+
+		reg_value = IGA1_VER_SYNC_START_FORMULA(mode->crtc_vsync_start);
+		load_value_to_registers(VGABASE, &iga->timings.vsync_start, reg_value);
+
+		reg_value = IGA1_VER_SYNC_END_FORMULA(mode->crtc_vsync_end);
+		load_value_to_registers(VGABASE, &iga->timings.vsync_end, reg_value);
+	} else {
+		reg_value = IGA2_HOR_TOTAL_FORMULA(mode->crtc_htotal);
+		load_value_to_registers(VGABASE, &iga->timings.htotal, reg_value);
+
+		reg_value = IGA2_HOR_ADDR_FORMULA(mode->crtc_hdisplay);
+		load_value_to_registers(VGABASE, &iga->timings.hdisplay, reg_value);
+
+		reg_value = IGA2_HOR_BLANK_START_FORMULA(mode->crtc_hblank_start);
+		load_value_to_registers(VGABASE, &iga->timings.hblank_start, reg_value);
+
+		reg_value = IGA2_HOR_BLANK_END_FORMULA(mode->crtc_hblank_end);
+		load_value_to_registers(VGABASE, &iga->timings.hblank_end, reg_value);
+
+		reg_value = IGA2_HOR_SYNC_START_FORMULA(mode->crtc_hsync_start);
+		load_value_to_registers(VGABASE, &iga->timings.hsync_start, reg_value);
+
+		reg_value = IGA2_HOR_SYNC_END_FORMULA(mode->crtc_hsync_end);
+		load_value_to_registers(VGABASE, &iga->timings.hsync_end, reg_value);
+
+		reg_value = IGA2_VER_TOTAL_FORMULA(mode->crtc_vtotal);
+		load_value_to_registers(VGABASE, &iga->timings.vtotal, reg_value);
+
+		reg_value = IGA2_VER_ADDR_FORMULA(mode->crtc_vdisplay);
+		load_value_to_registers(VGABASE, &iga->timings.vdisplay, reg_value);
+
+		reg_value = IGA2_VER_BLANK_START_FORMULA(mode->crtc_vblank_start);
+		load_value_to_registers(VGABASE, &iga->timings.vblank_start, reg_value);
+
+		reg_value = IGA2_VER_BLANK_END_FORMULA(mode->crtc_vblank_end);
+		load_value_to_registers(VGABASE, &iga->timings.vblank_end, reg_value);
+
+		reg_value = IGA2_VER_SYNC_START_FORMULA(mode->crtc_vsync_start);
+		load_value_to_registers(VGABASE, &iga->timings.vsync_start, reg_value);
+
+		reg_value = IGA2_VER_SYNC_END_FORMULA(mode->crtc_vsync_end);
+		load_value_to_registers(VGABASE, &iga->timings.vsync_end, reg_value);
+	}
+}
+
+/*
+ * This function changes the destination of scaling up/down
+ * and CRTC timing registers
+ * crtc : which IGA
+ * scale_type : upscaling(VIA_EXPAND) or downscaling(VIA_SHRINK)
+ */
+void via_set_scale_path(struct drm_crtc *crtc, u32 scale_type)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+	u8 reg_cr_fd = vga_rcrt(VGABASE, 0xFD);
+	struct drm_device *dev = crtc->dev;
+
+	if (!iga->index)
+		/* register reuse: select IGA1 path */
+		reg_cr_fd |= BIT(7);
+	else
+		/* register reuse: select IGA2 path */
+		reg_cr_fd &= ~BIT(7);
+
+	/* only IGA1 up scaling need to clear this bit CRFD.5. */
+	if (dev->pci_device == PCI_DEVICE_ID_VIA_VX900) {
+		if (!iga->index && ((VIA_HOR_EXPAND & scale_type) ||
+			(VIA_VER_EXPAND & scale_type)))
+			reg_cr_fd &= ~BIT(5);
+	}
+
+	/* CRFD.0 = 0 : common IGA2, = 1 : downscaling IGA */
+	switch (scale_type) {
+	case VIA_NO_SCALING:
+	case VIA_EXPAND:
+	case VIA_HOR_EXPAND:
+	case VIA_VER_EXPAND:
+		/* register reuse: as common IGA2 */
+		reg_cr_fd &= ~BIT(0);
+		break;
+
+	case VIA_SHRINK:
+		/* register reuse: as downscaling IGA */
+		reg_cr_fd |= BIT(0);
+		break;
+
+	default:
+		break;
+	}
+	vga_wcrt(VGABASE, 0xFD, reg_cr_fd);
+}
+
+/* disable IGA scaling */
+static void
+via_disable_iga_scaling(struct drm_crtc *crtc)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+
+	if (iga->index) {
+		/* IGA2 scalings disable */
+		via_set_scale_path(crtc, VIA_SHRINK);
+		/* disable IGA down scaling and buffer sharing. */
+		svga_wcrt_mask(VGABASE, 0x89, 0x00, BIT(7) | BIT(0));
+		/* Horizontal and Vertical scaling disable */
+		svga_wcrt_mask(VGABASE, 0xA2, 0x00, BIT(7) | BIT(3));
+
+		/* Disable scale up as well */
+		via_set_scale_path(crtc, VIA_EXPAND);
+		/* disable IGA up scaling */
+		svga_wcrt_mask(VGABASE, 0x79, 0, BIT(0));
+		/* Horizontal and Vertical scaling disable */
+		svga_wcrt_mask(VGABASE, 0xA2, 0x00, BIT(7) | BIT(3));
+	} else {
+		/* IGA1 scalings disable */
+		via_set_scale_path(crtc, VIA_SHRINK);
+		/* disable IGA down scaling and buffer sharing. */
+		svga_wcrt_mask(VGABASE, 0x89, 0x00, BIT(7) | BIT(0));
+		/* Horizontal and Vertical scaling disable */
+		svga_wcrt_mask(VGABASE, 0xA2, 0x00, BIT(7) | BIT(3));
+
+		/* Disable scale up as well */
+		via_set_scale_path(crtc, VIA_EXPAND);
+		/* disable IGA up scaling */
+		svga_wcrt_mask(VGABASE, 0x79, 0, BIT(0));
+		/* Horizontal and Vertical scaling disable */
+		svga_wcrt_mask(VGABASE, 0xA2, 0x00, BIT(7) | BIT(3));
+	}
+}
+
+/*
+ * Enable IGA scale functions.
+ *
+ * input : iga_path =	IGA1 or IGA2 or
+ *			IGA1+IGA2
+ *
+ * scale_type	=	VIA_HOR_EXPAND or VIA_VER_EXPAND or VIA_EXPAND or
+ *			VIA_SHRINK or VIA_SHRINK + VIA_EXPAND
+ */
+bool
+via_set_iga_scale_function(struct drm_crtc *crtc, u32 scale_type)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+
+	if (!(scale_type & (VIA_SHRINK + VIA_EXPAND)))
+		return false;
+
+	if (iga->index) {
+		/* IGA2 scalings enable */
+		if (VIA_SHRINK & scale_type) {
+			via_set_scale_path(crtc, VIA_SHRINK);
+			/* Horizontal and Vertical scaling enable */
+			svga_wcrt_mask(VGABASE, 0xA2,
+					BIT(7) | BIT(3), BIT(7) | BIT(3));
+			/* enable IGA down scaling */
+			svga_wcrt_mask(VGABASE, 0x89, BIT(0), BIT(0));
+			/* hor and ver scaling : Interpolation */
+			svga_wcrt_mask(VGABASE, 0x79,
+					BIT(2) | BIT(1), BIT(2) | BIT(1));
+		}
+
+		if (VIA_EXPAND & scale_type) {
+			via_set_scale_path(crtc, VIA_EXPAND);
+			/* enable IGA up scaling */
+			svga_wcrt_mask(VGABASE, 0x79, BIT(0), BIT(0));
+		}
+
+		if ((VIA_EXPAND & scale_type) == VIA_EXPAND) {
+			/* Horizontal and Vertical scaling enable */
+			svga_wcrt_mask(VGABASE, 0xA2, BIT(7) | BIT(3),
+					BIT(7) | BIT(3));
+			/* hor and ver scaling : Interpolation */
+			svga_wcrt_mask(VGABASE, 0x79, BIT(2) | BIT(1),
+					BIT(2) | BIT(1));
+		} else if (VIA_HOR_EXPAND & scale_type) {
+			/* Horizontal scaling disable */
+			svga_wcrt_mask(VGABASE, 0xA2, BIT(7), BIT(7));
+			/* hor scaling : Interpolation */
+			svga_wcrt_mask(VGABASE, 0x79, BIT(1), BIT(1));
+		} else if (VIA_VER_EXPAND & scale_type) {
+			/* Vertical scaling disable */
+			svga_wcrt_mask(VGABASE, 0xA2, BIT(3), BIT(3));
+			/* ver scaling : Interpolation */
+			svga_wcrt_mask(VGABASE, 0x79, BIT(2), BIT(2));
+		}
+	} else {
+		/* IGA1 scalings enable */
+		if (VIA_SHRINK & scale_type) {
+			via_set_scale_path(crtc, VIA_SHRINK);
+
+			/* Horizontal and Vertical scaling enable */
+			svga_wcrt_mask(VGABASE, 0xA2,
+					BIT(7) | BIT(3), BIT(7) | BIT(3));
+			/* enable IGA down scaling */
+			svga_wcrt_mask(VGABASE, 0x89, BIT(0), BIT(0));
+			/* hor and ver scaling : Interpolation */
+			svga_wcrt_mask(VGABASE, 0x79,
+					BIT(2) | BIT(1), BIT(2) | BIT(1));
+		}
+
+		if (VIA_EXPAND & scale_type) {
+			via_set_scale_path(crtc, VIA_EXPAND);
+			/* enable IGA up scaling */
+			svga_wcrt_mask(VGABASE, 0x79, BIT(0), BIT(0));
+		}
+
+		if ((VIA_EXPAND & scale_type) == VIA_EXPAND) {
+			/* Horizontal and Vertical scaling enable */
+			svga_wcrt_mask(VGABASE, 0xA2,
+					BIT(7) | BIT(3), BIT(7) | BIT(3));
+			/* hor and ver scaling : Interpolation */
+			svga_wcrt_mask(VGABASE, 0x79,
+					BIT(2) | BIT(1), BIT(2) | BIT(1));
+		} else if (VIA_HOR_EXPAND & scale_type) {
+			/* Horizontal scaling disable */
+			svga_wcrt_mask(VGABASE, 0xA2, BIT(7), BIT(7));
+			/* hor scaling : Interpolation */
+			svga_wcrt_mask(VGABASE, 0x79, BIT(1), BIT(1));
+		} else if (VIA_VER_EXPAND & scale_type) {
+			/* Vertical scaling disable */
+			svga_wcrt_mask(VGABASE, 0xA2, BIT(3), BIT(3));
+			/* ver scaling : Interpolation */
+			svga_wcrt_mask(VGABASE, 0x79, BIT(2), BIT(2));
+		}
+	}
+	return true;
+}
+
+/*
+ * 1. get scale factors from source and dest H & V size
+ * 2. load scale factors into registers
+ * 3. enable H or V scale ( set CRA2 bit7 or bit3 )
+ */
+bool
+via_load_iga_scale_factor_regs(struct drm_via_private *dev_priv,
+				struct drm_display_mode *mode,
+				struct drm_display_mode *adjusted_mode,
+				u32 scale_type, u32 is_hor_or_ver)
+{
+	u32 dst_hor_regs = adjusted_mode->crtc_hdisplay;
+	u32 dst_ver_regs = adjusted_mode->crtc_vdisplay;
+	u32 src_hor_regs = mode->crtc_hdisplay;
+	u32 src_ver_regs = mode->crtc_vdisplay;
+	u32 hor_factor = 0, ver_factor = 0;
+	struct vga_registers reg;
+
+	if ((0 == src_hor_regs) || (0 == src_ver_regs) ||
+		(0 == dst_hor_regs) || (0 == dst_ver_regs))
+		return false;
+
+	if (VIA_EXPAND == scale_type) {
+		if (HOR_SCALE & is_hor_or_ver) {
+			hor_factor = ((src_hor_regs - 1) * 4096) /
+				(dst_hor_regs - 1);
+			reg.count = ARRAY_SIZE(lcd_hor_scaling);
+			reg.regs = lcd_hor_scaling;
+			load_value_to_registers(VGABASE, &reg, hor_factor);
+			/* Horizontal scaling enable */
+			svga_wcrt_mask(VGABASE, 0xA2, BIT(7), BIT(7));
+		}
+
+		if (VER_SCALE & is_hor_or_ver) {
+			ver_factor = ((src_ver_regs - 1) * 2048) /
+				(dst_ver_regs - 1);
+			reg.count = ARRAY_SIZE(lcd_ver_scaling);
+			reg.regs = lcd_ver_scaling;
+			load_value_to_registers(VGABASE, &reg, ver_factor);
+			/* Vertical scaling enable */
+			svga_wcrt_mask(VGABASE, 0xA2, BIT(3), BIT(3));
+		}
+
+	} else if (VIA_SHRINK == scale_type) {
+
+		if (src_hor_regs > dst_hor_regs)
+			hor_factor =
+				((src_hor_regs - dst_hor_regs) * 4096) /
+				dst_hor_regs;
+
+		if (src_ver_regs > dst_ver_regs)
+			ver_factor =
+				((src_ver_regs - dst_ver_regs) * 2048) /
+				dst_ver_regs;
+
+		reg.count = ARRAY_SIZE(lcd_hor_scaling);
+		reg.regs = lcd_hor_scaling;
+		load_value_to_registers(VGABASE, &reg, hor_factor);
+
+		reg.count = ARRAY_SIZE(lcd_ver_scaling);
+		reg.regs = lcd_ver_scaling;
+		load_value_to_registers(VGABASE, &reg, ver_factor);
+
+		/* set buffer sharing enable bit . */
+		if (hor_factor || ver_factor) {
+			if (dst_hor_regs > 1024)
+				svga_wcrt_mask(VGABASE, 0x89,
+					BIT(7), BIT(7));
+			else
+				svga_wcrt_mask(VGABASE, 0x89,
+					0x00, BIT(7));
+		}
+
+		if (hor_factor)
+			/* CRA2[7]:1 Enable Hor scaling
+			CRA2[6]:1 Linear Mode */
+			svga_wcrt_mask(VGABASE, 0xA2, BIT(7) | BIT(6),
+				BIT(7) | BIT(6));
+		else
+			svga_wcrt_mask(VGABASE, 0xA2, 0, BIT(7));
+
+		if (ver_factor)
+			svga_wcrt_mask(VGABASE, 0xA2, BIT(3), BIT(3));
+		else
+			svga_wcrt_mask(VGABASE, 0xA2, 0, BIT(3));
+	}
+	return true;
+}
+
+void
+via_set_iga2_downscale_source_timing(struct drm_crtc *crtc,
+					struct drm_display_mode *mode,
+					struct drm_display_mode *adjusted_mode)
+{
+	unsigned int viewx = adjusted_mode->hdisplay, viewy = adjusted_mode->vdisplay;
+	unsigned int srcx = mode->crtc_hdisplay, srcy = mode->crtc_vdisplay;
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_display_mode *src_timing;
+
+	src_timing = drm_mode_duplicate(crtc->dev, adjusted_mode);
+	/* derived source timing */
+	if (srcx <= viewx) {
+		src_timing->crtc_htotal = adjusted_mode->crtc_htotal;
+		src_timing->crtc_hdisplay = adjusted_mode->crtc_hdisplay;
+	} else {
+		unsigned int htotal = adjusted_mode->crtc_htotal - adjusted_mode->crtc_hdisplay;
+
+		src_timing->crtc_htotal = htotal + srcx;
+		src_timing->crtc_hdisplay = srcx;
+	}
+	src_timing->crtc_hblank_start = src_timing->crtc_hdisplay;
+	src_timing->crtc_hblank_end = src_timing->crtc_htotal;
+	src_timing->crtc_hsync_start = src_timing->crtc_hdisplay + 2;
+	src_timing->crtc_hsync_end = src_timing->crtc_hsync_start + 1;
+
+	if (srcy <= viewy) {
+		src_timing->crtc_vtotal = adjusted_mode->crtc_vtotal;
+		src_timing->crtc_vdisplay = adjusted_mode->crtc_vdisplay;
+	} else {
+		unsigned int vtotal = adjusted_mode->crtc_vtotal - adjusted_mode->crtc_vdisplay;
+
+		src_timing->crtc_vtotal = vtotal + srcy;
+		src_timing->crtc_vdisplay = srcy;
+	}
+	src_timing->crtc_vblank_start = src_timing->crtc_vdisplay;
+	src_timing->crtc_vblank_end = src_timing->crtc_vtotal;
+	src_timing->crtc_vsync_start = src_timing->crtc_vdisplay + 2;
+	src_timing->crtc_vsync_end = src_timing->crtc_vsync_start + 1;
+
+	via_set_scale_path(crtc, VIA_NO_SCALING);
+	/* load src timing */
+	via_load_crtc_timing(iga, src_timing);
+
+	/* Cleanup up source timings */
+	drm_mode_destroy(crtc->dev, src_timing);
+}
+
+static void
+drm_mode_crtc_load_lut(struct drm_crtc *crtc)
+{
+	int size = crtc->gamma_size * sizeof(uint16_t);
+	void *r_base, *g_base, *b_base;
+
+	if (size) {
+		r_base = crtc->gamma_store;
+		g_base = r_base + size;
+		b_base = g_base + size;
+		crtc->funcs->gamma_set(crtc, r_base, g_base, b_base,
+					0, crtc->gamma_size);
+	}
+}
+
+static void
+via_crtc_dpms(struct drm_crtc *crtc, int mode)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+
+	switch (mode) {
+	case DRM_MODE_DPMS_SUSPEND:
+	case DRM_MODE_DPMS_STANDBY:
+	case DRM_MODE_DPMS_OFF:
+		if (crtc->dev->num_crtcs)
+			drm_vblank_pre_modeset(crtc->dev, iga->index);
+		if (iga->index) {
+			/* turn off CRT screen (IGA2) */
+			svga_wcrt_mask(VGABASE, 0x6B, BIT(2), BIT(2));
+			disable_second_display_channel(VGABASE);
+			/* clear for TV clock */
+			svga_wcrt_mask(VGABASE, 0x6C, 0x00, 0x0F);
+		} else {
+			/* turn off CRT screen (IGA1) */
+			svga_wseq_mask(VGABASE, 0x01, BIT(5), BIT(5));
+			/* clear for TV clock */
+			svga_wcrt_mask(VGABASE, 0x6C, 0x00, 0xF0);
+		}
+		break;
+
+	case DRM_MODE_DPMS_ON:
+		if (crtc->dev->num_crtcs)
+			drm_vblank_post_modeset(crtc->dev, iga->index);
+		if (iga->index) {
+			/* turn on CRT screen (IGA2) */
+			enable_second_display_channel(VGABASE);
+			svga_wcrt_mask(VGABASE, 0x6B, 0x00, BIT(2));
+		} else {
+			/* turn on CRT screen (IGA1) */
+			svga_wseq_mask(VGABASE, 0x01, 0x00, BIT(5));
+		}
+		/* disable simultaneous  */
+		svga_wcrt_mask(VGABASE, 0x6B, 0x00, BIT(3));
+		drm_mode_crtc_load_lut(crtc);
+		break;
+	}
+}
+
+static void
+via_crtc_disable(struct drm_crtc *crtc)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+
+	drm_vblank_off(crtc->dev, iga->index);
+
+	/* Turn off the cursor */
+	via_hide_cursor(crtc);
+
+	via_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
+}
+
+static void
+via_crtc_prepare(struct drm_crtc *crtc)
+{
+	/* Turn off the cursor */
+	via_hide_cursor(crtc);
+
+	/* Blank the screen */
+	if (crtc->enabled)
+		via_crtc_dpms(crtc, DRM_MODE_DPMS_OFF);
+}
+
+static void
+via_crtc_commit(struct drm_crtc *crtc)
+{
+	/* Turn on the cursor */
+	via_show_cursor(crtc);
+
+	/* Turn on the monitor */
+	if (crtc->enabled)
+		via_crtc_dpms(crtc, DRM_MODE_DPMS_ON);
+}
+
+static bool
+via_crtc_mode_fixup(struct drm_crtc *crtc, const struct drm_display_mode *mode,
+			struct drm_display_mode *adjusted_mode)
+{
+	return true;
+}
+
+static int
+via_crtc_mode_set(struct drm_crtc *crtc, struct drm_display_mode *mode,
+			struct drm_display_mode *adjusted_mode,
+			int x, int y, struct drm_framebuffer *old_fb)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+	struct drm_device *dev = crtc->dev;
+
+	/* Load standard registers */
+	via_load_vpit_regs(dev_priv);
+
+	/* Unlock */
+	via_unlock_crtc(VGABASE, dev->pdev->device);
+
+	/* IGA1 reset */
+	if (!iga->index) {
+		vga_wcrt(VGABASE, 0x09, 0x00);	/* initial CR09=0 */
+		svga_wcrt_mask(VGABASE, 0x11, 0x00, BIT(6));
+	}
+
+	/* disable IGA scales first */
+	via_disable_iga_scaling(crtc);
+
+	/* Load crtc timing and IGA scaling */
+	if (iga->scaling_mode & VIA_SHRINK) {
+		/* I. down scaling */
+		if (iga->index) {
+			/* enable IGA2 down scaling and set Interpolation */
+			via_set_iga_scale_function(crtc, VIA_SHRINK);
+
+			/* load hor and ver downscaling factor */
+			/**
+			 * interlace modes scaling support(example 1080I):
+			 * we should use mode->crtc_vdisplay here,
+			 * because crtc_vdisplay=540, vdisplay=1080,
+			 * we need 540 here, not 1080.
+			 */
+			via_load_iga_scale_factor_regs(dev_priv, mode,
+							adjusted_mode,
+							VIA_SHRINK,
+							HOR_VER_SCALE);
+			/* load src timing to timing registers */
+			/**
+			 * interlace modes scaling support(example 1080I):
+			 * we should use mode->crtc_vdisplay here,
+			 * because crtc_vdisplay=540, vdisplay=1080,
+			 * we need 540 here, not 1080.
+			 */
+			via_set_iga2_downscale_source_timing(crtc, mode,
+								adjusted_mode);
+
+			/* Download dst timing */
+			via_set_scale_path(crtc, VIA_SHRINK);
+			via_load_crtc_timing(iga, adjusted_mode);
+			/* very necessary to set IGA to none scaling status */
+			/* need to fix why so need. */
+			via_set_scale_path(crtc, VIA_NO_SCALING);
+		} else {
+			/* IGA1 downscaling not supported */
+		}
+	} else {
+		/* when not down scaling, we only need load one timing. */
+		via_load_crtc_timing(iga, adjusted_mode);
+
+		/* Patch the IGA1 ECK clock */
+		if (!iga->index) {
+			u8 reg_value = 0;
+
+			switch (adjusted_mode->crtc_htotal % 8) {
+			case 0:
+			default:
+				break;
+			case 2:
+				reg_value = BIT(7);
+				break;
+			case 4:
+				reg_value = BIT(6);
+				break;
+			case 6:
+				reg_value = BIT(3);
+				break;
+			}
+			svga_wcrt_mask(VGABASE, 0x47, reg_value, BIT(7) | BIT(6) | BIT(3));
+		}
+
+		/* II. up scaling */
+		if (iga->scaling_mode & VIA_EXPAND) {
+			if (iga->index) {
+				/* Horizontal scaling */
+				if (iga->scaling_mode & VIA_HOR_EXPAND) {
+					via_set_iga_scale_function(crtc,
+								VIA_HOR_EXPAND);
+					via_load_iga_scale_factor_regs(dev_priv,
+							mode, adjusted_mode,
+							VIA_EXPAND, HOR_SCALE);
+				}
+
+				/* Vertical scaling */
+				if (iga->scaling_mode & VIA_VER_EXPAND) {
+					via_set_iga_scale_function(crtc,
+								VIA_VER_EXPAND);
+					via_load_iga_scale_factor_regs(dev_priv,
+							mode, adjusted_mode,
+							VIA_EXPAND, VER_SCALE);
+				}
+			} else {
+				/* IGA1 Upscaling not supported */
+			}
+		} else {
+			/* III. no scaling */
+		}
+	}
+
+	/* Relock */
+	via_lock_crtc(VGABASE);
+
+	/* interlace setting */
+	if (adjusted_mode->flags & DRM_MODE_FLAG_INTERLACE) {
+		if (iga->index)
+			svga_wcrt_mask(VGABASE, 0x67, BIT(5), BIT(5));
+		else
+			svga_wcrt_mask(VGABASE, 0x33, BIT(6), BIT(6));
+	} else {
+		/* non-interlace, clear interlace setting. */
+		if (iga->index)
+			svga_wcrt_mask(VGABASE, 0x67, 0, BIT(5));
+		else
+			svga_wcrt_mask(VGABASE, 0x33, 0, BIT(6));
+	}
+
+	/* Load FIFO */
+	if ((dev->pdev->device != PCI_DEVICE_ID_VIA_CLE266) &&
+	    (dev->pdev->device != PCI_DEVICE_ID_VIA_KM400)) {
+		via_load_fifo_regs(iga, adjusted_mode);
+	} else if (adjusted_mode->hdisplay == 1024 &&
+		   adjusted_mode->vdisplay == 768) {
+		/* Update Patch Register */
+		svga_wseq_mask(VGABASE, 0x16, 0x0C, 0xBF);
+		vga_wseq(VGABASE, 0x18, 0x4C);
+	}
+
+	/* Set PLL */
+	if (adjusted_mode->clock) {
+		u32 clock = adjusted_mode->clock * 1000, pll_regs;
+
+		if (iga->scaling_mode & VIA_SHRINK)
+			clock *= 2;
+		pll_regs = via_get_clk_value(crtc->dev, clock);
+		via_set_vclock(crtc, pll_regs);
+	}
+	return crtc_funcs->mode_set_base(crtc, x, y, old_fb);
+}
+
+static int
+via_crtc_mode_set_base(struct drm_crtc *crtc, int x, int y,
+			struct drm_framebuffer *old_fb)
+{
+	enum mode_set_atomic state = old_fb ? LEAVE_ATOMIC_MODE_SET : ENTER_ATOMIC_MODE_SET;
+	struct drm_crtc_helper_funcs *crtc_funcs = crtc->helper_private;
+	struct drm_framebuffer *new_fb = crtc->fb;
+	struct ttm_buffer_object *bo;
+	struct drm_gem_object *obj;
+	int ret = 0;
+
+	/* no fb bound */
+	if (!new_fb) {
+		DRM_DEBUG_KMS("No FB bound\n");
+		return ret;
+	}
+
+	obj = new_fb->helper_private;
+	bo = obj->driver_private;
+
+	ret = ttm_bo_pin(bo, NULL);
+	if (unlikely(ret)) {
+		DRM_DEBUG("failed to pin FB\n");
+		return ret;
+	}
+
+	ret = crtc_funcs->mode_set_base_atomic(crtc, new_fb, x, y, state);
+	if (unlikely(ret)) {
+		DRM_DEBUG("failed to set new framebuffer\n");
+		ttm_bo_unpin(bo, NULL);
+		return ret;
+	}
+
+	/* Free the old framebuffer if it exist */
+	if (old_fb) {
+		obj = old_fb->helper_private;
+		bo = obj->driver_private;
+
+		ret = ttm_bo_unpin(bo, NULL);
+		if (unlikely(ret))
+			DRM_ERROR("framebuffer still locked\n");
+	}
+	return ret;
+}
+
+static int
+via_iga1_mode_set_base_atomic(struct drm_crtc *crtc, struct drm_framebuffer *fb,
+				int x, int y, enum mode_set_atomic state)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+	struct drm_gem_object *obj = fb->helper_private;
+	struct ttm_buffer_object *bo = obj->driver_private;
+	u32 pitch = (x * fb->bits_per_pixel) >> 3, addr;
+
+	/*if ((state == ENTER_ATOMIC_MODE_SET) && (fb != crtc->fb))
+		disable_accel(dev);
+	else
+		restore_accel(dev);*/
+
+	/* Set the framebuffer offset */
+	pitch += y * fb->pitches[0];
+	addr = round_up(bo->offset + pitch, 16) >> 1;
+
+	vga_wcrt(VGABASE, 0x0D, addr & 0xFF);
+	vga_wcrt(VGABASE, 0x0C, (addr >> 8) & 0xFF);
+	/* Yes order of setting these registers matters on some hardware */
+	svga_wcrt_mask(VGABASE, 0x48, ((addr >> 24) & 0x1F), 0x1F);
+	vga_wcrt(VGABASE, 0x34, (addr >> 16) & 0xFF);
+
+	/* Load fetch count registers */
+	pitch = ALIGN(crtc->mode.hdisplay * fb->bits_per_pixel >> 3, 16) >> 4;
+	load_value_to_registers(VGABASE, &iga->fetch, pitch + 1);
+
+	if ((state == ENTER_ATOMIC_MODE_SET) ||
+	     crtc->fb->pitches[0] != fb->pitches[0]) {
+		/* Spec does not say that first adapter skips 3 bits but old
+		 * code did it and seems to be reasonable in analogy to
+		 * second adapter */
+		load_value_to_registers(VGABASE, &iga->offset,
+					ALIGN(fb->pitches[0], 16) >> 3);
+	}
+
+	/* Load color depth registers */
+	if ((state == ENTER_ATOMIC_MODE_SET) || crtc->fb->depth != fb->depth) {
+		/* Bit 7 set LUT bit size to 8 bit. Bit 5 enables wrap around
+		 * and bit 1 enables extended display mode */
+		u8 value = BIT(7) | BIT(5) | BIT(1);
+
+		switch (fb->depth) {
+		case 8:
+			break;
+		case 15:
+			value |= BIT(2);
+			break;
+		case 16:
+			/* Bit 4 is for 555/565 selection */
+			value |= BIT(4) | BIT(2);
+			break;
+		case 24:
+			value |= BIT(3) | BIT(2);
+			break;
+		case 32:
+			value |= BIT(3);
+			break;
+		default:
+			DRM_ERROR("Unsupported depth: %d\n", fb->depth);
+			return -EINVAL;
+		}
+		svga_wseq_mask(VGABASE, 0x15, value, 0xFE);
+	}
+	return 0;
+}
+
+static int
+via_iga2_mode_set_base_atomic(struct drm_crtc *crtc, struct drm_framebuffer *fb,
+				int x, int y, enum mode_set_atomic state)
+{
+	struct via_crtc *iga = container_of(crtc, struct via_crtc, base);
+	struct drm_via_private *dev_priv = crtc->dev->dev_private;
+	struct drm_gem_object *obj = fb->helper_private;
+	struct ttm_buffer_object *bo = obj->driver_private;
+	u32 pitch = (x * fb->bits_per_pixel) >> 3, addr;
+	u8 value;
+
+	/* Set the framebuffer offset */
+	pitch += y * fb->pitches[0];
+	addr = round_up(bo->offset + pitch, 16);
+
+	/* Bits 9 to 3 of the frame buffer go into bits 7 to 1
+	 * of the register. Bit 0 is for setting tile mode or
+	 * linear mode. A value of zero sets it to linear mode */
+	vga_wcrt(VGABASE, 0x62, ((addr >> 3) & 0x7F) << 1);
+	vga_wcrt(VGABASE, 0x63, (addr >> 10) & 0xFF);
+	vga_wcrt(VGABASE, 0x64, (addr >> 18) & 0xFF);
+	svga_wcrt_mask(VGABASE, 0xA3, ((addr >> 26) & 0x07), 0x07);
+
+	/* Load fetch count registers */
+	pitch = ALIGN(crtc->mode.hdisplay * fb->bits_per_pixel >> 3, 16) >> 4;
+	load_value_to_registers(VGABASE, &iga->fetch, pitch + 1);
+
+	if ((state == ENTER_ATOMIC_MODE_SET) ||
+	     crtc->fb->pitches[0] != fb->pitches[0]) {
+		/* Set secondary pitch */
+		load_value_to_registers(VGABASE, &iga->offset,
+					ALIGN(fb->pitches[0], 16) >> 3);
+	}
+
+	/* Load color depth registers */
+	if ((state == ENTER_ATOMIC_MODE_SET) || crtc->fb->depth != fb->depth) {
+		switch (fb->depth) {
+		case 8:
+			value = 0x00;
+			break;
+		case 16:
+			value = BIT(6);
+			break;
+		case 24:
+			value = BIT(7) | BIT(6);
+			break;
+		case 32:
+			value = BIT(7);
+			break;
+		default:
+			DRM_ERROR("Unsupported depth: %d\n", fb->depth);
+			return -EINVAL;
+		}
+		svga_wcrt_mask(VGABASE, 0x67, value, BIT(7) | BIT(6));
+	}
+	return 0;
+}
+
+static const struct drm_crtc_helper_funcs via_iga1_helper_funcs = {
+	.dpms = via_crtc_dpms,
+	.disable = via_crtc_disable,
+	.prepare = via_crtc_prepare,
+	.commit = via_crtc_commit,
+	.mode_fixup = via_crtc_mode_fixup,
+	.mode_set = via_crtc_mode_set,
+	.mode_set_base = via_crtc_mode_set_base,
+	.mode_set_base_atomic = via_iga1_mode_set_base_atomic,
+	.load_lut = drm_mode_crtc_load_lut,
+};
+
+static const struct drm_crtc_helper_funcs via_iga2_helper_funcs = {
+	.dpms = via_crtc_dpms,
+	.disable = via_crtc_disable,
+	.prepare = via_crtc_prepare,
+	.commit = via_crtc_commit,
+	.mode_fixup = via_crtc_mode_fixup,
+	.mode_set = via_crtc_mode_set,
+	.mode_set_base = via_crtc_mode_set_base,
+	.mode_set_base_atomic = via_iga2_mode_set_base_atomic,
+	.load_lut = drm_mode_crtc_load_lut,
+};
+
+void
+via_crtc_init(struct drm_device *dev, int index)
+{
+	struct drm_via_private *dev_priv = dev->dev_private;
+	struct via_crtc *iga = &dev_priv->iga[index];
+	struct drm_crtc *crtc = &iga->base;
+	int cursor_size = 64 * 64 * 4, i;
+	u16 *gamma;
+
+	iga->index = index;
+	if (index) {
+		drm_crtc_init(dev, crtc, &via_iga2_funcs);
+		drm_crtc_helper_add(crtc, &via_iga2_helper_funcs);
+
+		/* Always start off IGA2 disabled until we detected something
+		   attached to it */
+		disable_second_display_channel(VGABASE);
+
+		iga->timings.htotal.count = ARRAY_SIZE(iga2_hor_total);
+		iga->timings.htotal.regs = iga2_hor_total;
+
+		iga->timings.hdisplay.count = ARRAY_SIZE(iga2_hor_addr);
+		iga->timings.hdisplay.regs = iga2_hor_addr;
+		if (dev->pdev->device != PCI_DEVICE_ID_VIA_VX900)
+			iga->timings.hdisplay.count--;
+
+		iga->timings.hblank_start.count = ARRAY_SIZE(iga2_hor_blank_start);
+		iga->timings.hblank_start.regs = iga2_hor_blank_start;
+		if (dev->pdev->device != PCI_DEVICE_ID_VIA_VX900)
+			iga->timings.hblank_start.count--;
+
+		iga->timings.hblank_end.count = ARRAY_SIZE(iga2_hor_blank_end);
+		iga->timings.hblank_end.regs = iga2_hor_blank_end;
+
+		iga->timings.hsync_start.count = ARRAY_SIZE(iga2_hor_sync_start);
+		iga->timings.hsync_start.regs = iga2_hor_sync_start;
+		if (dev->pdev->device == PCI_DEVICE_ID_VIA_CLE266 ||
+		    dev->pdev->device == PCI_DEVICE_ID_VIA_KM400)
+			iga->timings.hsync_start.count--;
+
+		iga->timings.hsync_end.count = ARRAY_SIZE(iga2_hor_sync_end);
+		iga->timings.hsync_end.regs = iga2_hor_sync_end;
+
+		iga->timings.vtotal.count = ARRAY_SIZE(iga2_ver_total);
+		iga->timings.vtotal.regs = iga2_ver_total;
+
+		iga->timings.vdisplay.count = ARRAY_SIZE(iga2_ver_addr);
+		iga->timings.vdisplay.regs = iga2_ver_addr;
+
+		iga->timings.vblank_start.count = ARRAY_SIZE(iga2_ver_blank_start);
+		iga->timings.vblank_start.regs = iga2_ver_blank_start;
+
+		iga->timings.vblank_end.count = ARRAY_SIZE(iga2_ver_blank_end);
+		iga->timings.vblank_end.regs = iga2_ver_blank_end;
+
+		iga->timings.vsync_start.count = ARRAY_SIZE(iga2_ver_sync_start);
+		iga->timings.vsync_start.regs = iga2_ver_sync_start;
+
+		iga->timings.vsync_end.count = ARRAY_SIZE(iga2_ver_sync_end);
+		iga->timings.vsync_end.regs = iga2_ver_sync_end;
+
+		/* Secondary FIFO setup */
+		iga->high_threshold.count = ARRAY_SIZE(iga2_fifo_high_threshold_select);
+		iga->high_threshold.regs = iga2_fifo_high_threshold_select;
+
+		iga->threshold.count = ARRAY_SIZE(iga2_fifo_threshold_select);
+		iga->threshold.regs = iga2_fifo_threshold_select;
+
+		iga->display_queue.count = ARRAY_SIZE(iga2_display_queue_expire_num);
+		iga->display_queue.regs = iga2_display_queue_expire_num;
+
+		iga->fifo_depth.count = ARRAY_SIZE(iga2_fifo_depth_select);
+		iga->fifo_depth.regs = iga2_fifo_depth_select;
+
+		iga->fetch.count = ARRAY_SIZE(iga2_fetch_count);
+		iga->fetch.regs = iga2_fetch_count;
+
+		/* Older hardware only uses 12 bits */
+		iga->offset.count = ARRAY_SIZE(iga2_offset) - 1;
+		iga->offset.regs = iga2_offset;
+
+		switch (dev->pdev->device) {
+		case PCI_DEVICE_ID_VIA_K8M800:
+			iga->display_queue_expire_num = 0;
+			iga->fifo_high_threshold = 296;
+			iga->fifo_threshold = 328;
+			iga->fifo_max_depth = 384;
+			break;
+
+		case PCI_DEVICE_ID_VIA_PM800:
+			iga->display_queue_expire_num = 0;
+			iga->fifo_high_threshold = 64;
+			iga->fifo_threshold = 128;
+			iga->fifo_max_depth = 192;
+			break;
+
+		case PCI_DEVICE_ID_VIA_CN700:
+			iga->display_queue_expire_num = 128;
+			iga->fifo_high_threshold = 32;
+			iga->fifo_threshold = 80;
+			iga->fifo_max_depth = 96;
+			break;
+
+		// CX700
+		case PCI_DEVICE_ID_VIA_VT3157:
+			iga->display_queue_expire_num = 128;
+			iga->fifo_high_threshold = 32;
+			iga->fifo_threshold = 64;
+			iga->fifo_max_depth = 96;
+			break;
+
+		// K8M890
+		case PCI_DEVICE_ID_VIA_K8M890:
+			iga->display_queue_expire_num = 124;
+			iga->fifo_high_threshold = 296;
+			iga->fifo_threshold = 328;
+			iga->fifo_max_depth = 360;
+			break;
+
+		// P4M890
+		case PCI_DEVICE_ID_VIA_VT3343:
+			iga->display_queue_expire_num = 32;
+			iga->fifo_high_threshold = 64;
+			iga->fifo_threshold = 76;
+			iga->fifo_max_depth = 96;
+			break;
+
+		// P4M900
+		case PCI_DEVICE_ID_VIA_P4M900:
+			iga->fifo_high_threshold = iga->fifo_threshold = 76;
+			iga->display_queue_expire_num = 32;
+			iga->fifo_max_depth = 96;
+			break;
+
+		// VX800
+		case PCI_DEVICE_ID_VIA_VT1122:
+			iga->display_queue_expire_num = 128;
+			iga->fifo_high_threshold = 32;
+			iga->fifo_threshold = 64;
+			iga->fifo_max_depth = 96;
+			iga->offset.count++;
+			break;
+
+		// VX855
+		case PCI_DEVICE_ID_VIA_VX875:
+			iga->fifo_high_threshold = iga->fifo_threshold = 160;
+			iga->display_queue_expire_num = 320;
+			iga->fifo_max_depth = 200;
+			iga->offset.count++;
+			break;
+
+		// VX900
+		case PCI_DEVICE_ID_VIA_VX900:
+			iga->fifo_high_threshold = iga->fifo_threshold = 160;
+			iga->display_queue_expire_num = 320;
+			iga->fifo_max_depth = 192;
+			iga->offset.count++;
+		default:
+			break;
+		}
+	} else {
+		drm_crtc_init(dev, crtc, &via_iga1_funcs);
+		drm_crtc_helper_add(crtc, &via_iga1_helper_funcs);
+
+		iga->timings.htotal.count = ARRAY_SIZE(iga1_hor_total);
+		iga->timings.htotal.regs = iga1_hor_total;
+
+		iga->timings.hdisplay.count = ARRAY_SIZE(iga1_hor_addr);
+		iga->timings.hdisplay.regs = iga1_hor_addr;
+		if (dev->pdev->device != PCI_DEVICE_ID_VIA_VX900)
+			iga->timings.hdisplay.count--;
+
+		iga->timings.hblank_start.count = ARRAY_SIZE(iga1_hor_blank_start);
+		iga->timings.hblank_start.regs = iga1_hor_blank_start;
+		if (dev->pdev->device != PCI_DEVICE_ID_VIA_VX900)
+			iga->timings.hblank_start.count--;
+
+		iga->timings.hblank_end.count = ARRAY_SIZE(iga1_hor_blank_end);
+		iga->timings.hblank_end.regs = iga1_hor_blank_end;
+
+		iga->timings.hsync_start.count = ARRAY_SIZE(iga1_hor_sync_start);
+		iga->timings.hsync_start.regs = iga1_hor_sync_start;
+
+		iga->timings.hsync_end.count = ARRAY_SIZE(iga1_hor_sync_end);
+		iga->timings.hsync_end.regs = iga1_hor_sync_end;
+
+		iga->timings.vtotal.count = ARRAY_SIZE(iga1_ver_total);
+		iga->timings.vtotal.regs = iga1_ver_total;
+
+		iga->timings.vdisplay.count = ARRAY_SIZE(iga1_ver_addr);
+		iga->timings.vdisplay.regs = iga1_ver_addr;
+
+		iga->timings.vblank_start.count = ARRAY_SIZE(iga1_ver_blank_start);
+		iga->timings.vblank_start.regs = iga1_ver_blank_start;
+
+		iga->timings.vblank_end.count = ARRAY_SIZE(iga1_ver_blank_end);
+		iga->timings.vblank_end.regs = iga1_ver_blank_end;
+
+		iga->timings.vsync_start.count = ARRAY_SIZE(iga1_ver_sync_start);
+		iga->timings.vsync_start.regs = iga1_ver_sync_start;
+
+		iga->timings.vsync_end.count = ARRAY_SIZE(iga1_ver_sync_end);
+		iga->timings.vsync_end.regs = iga1_ver_sync_end;
+
+		/* Primary FIFO setup */
+		iga->high_threshold.count = ARRAY_SIZE(iga1_fifo_high_threshold_select);
+		iga->high_threshold.regs = iga1_fifo_high_threshold_select;
+
+		iga->threshold.count = ARRAY_SIZE(iga1_fifo_threshold_select);
+		iga->threshold.regs = iga1_fifo_threshold_select;
+
+		iga->display_queue.count = ARRAY_SIZE(iga1_display_queue_expire_num);
+		iga->display_queue.regs = iga1_display_queue_expire_num;
+
+		iga->fifo_depth.count = ARRAY_SIZE(iga1_fifo_depth_select);
+		iga->fifo_depth.regs = iga1_fifo_depth_select;
+
+		iga->fetch.count = ARRAY_SIZE(iga1_fetch_count);
+		iga->fetch.regs = iga1_fetch_count;
+
+		iga->offset.count = ARRAY_SIZE(iga1_offset);
+		iga->offset.regs = iga1_offset;
+
+		switch (dev->pdev->device) {
+		case PCI_DEVICE_ID_VIA_K8M800:
+			iga->display_queue_expire_num = 128;
+			iga->fifo_high_threshold = 296;
+			iga->fifo_threshold = 328;
+			iga->fifo_max_depth = 384;
+			break;
+
+		case PCI_DEVICE_ID_VIA_PM800:
+			iga->display_queue_expire_num = 128;
+			iga->fifo_high_threshold = 32;
+			iga->fifo_threshold = 64;
+			iga->fifo_max_depth = 96;
+			break;
+
+		case PCI_DEVICE_ID_VIA_CN700:
+			iga->display_queue_expire_num = 0;
+			iga->fifo_high_threshold = 64;
+			iga->fifo_threshold = 80;
+			iga->fifo_max_depth = 96;
+			break;
+
+		// CX700
+		case PCI_DEVICE_ID_VIA_VT3157:
+			iga->fifo_high_threshold = iga->fifo_threshold = 128;
+			iga->display_queue_expire_num = 124;
+			iga->fifo_max_depth = 192;
+			break;
+
+		// K8M890
+		case PCI_DEVICE_ID_VIA_K8M890:
+			iga->display_queue_expire_num = 124;
+			iga->fifo_high_threshold = 296;
+			iga->fifo_threshold = 328;
+			iga->fifo_max_depth = 360;
+			break;
+
+		// P4M890
+		case PCI_DEVICE_ID_VIA_VT3343:
+			iga->display_queue_expire_num = 32;
+			iga->fifo_high_threshold = 64;
+			iga->fifo_threshold = 76;
+			iga->fifo_max_depth = 96;
+			break;
+
+		// P4M900
+		case PCI_DEVICE_ID_VIA_P4M900:
+			iga->fifo_high_threshold = iga->fifo_threshold = 76;
+			iga->display_queue_expire_num = 32;
+			iga->fifo_max_depth = 96;
+			break;
+
+		// VX800
+		case PCI_DEVICE_ID_VIA_VT1122:
+			iga->fifo_high_threshold = iga->fifo_threshold = 152;
+			iga->display_queue_expire_num = 64;
+			iga->fifo_max_depth = 192;
+			break;
+
+		// VX855
+		case PCI_DEVICE_ID_VIA_VX875:
+		// VX900
+		case PCI_DEVICE_ID_VIA_VX900:
+			iga->fifo_high_threshold = iga->fifo_threshold = 320;
+			iga->display_queue_expire_num = 160;
+			iga->fifo_max_depth = 400;
+		default:
+			break;
+		}
+	}
+	drm_mode_crtc_set_gamma_size(crtc, 256);
+	gamma = crtc->gamma_store;
+
+	for (i = 0; i < 256; i++) {
+		gamma[i] = i << 8 | i;
+		gamma[i+256] = i << 8 | i;
+		gamma[i+512] = i << 8 | i;
+	}
+
+	if (dev->pdev->device == PCI_DEVICE_ID_VIA_CLE266 ||
+	    dev->pdev->device == PCI_DEVICE_ID_VIA_KM400)
+		cursor_size = 32 * 32 * 4;
+
+	if (ttm_allocate_kernel_buffer(&dev_priv->bdev, cursor_size, 16,
+					TTM_PL_FLAG_VRAM, &iga->cursor_kmap))
+		DRM_ERROR("failed to create cursor\n");
+}
_______________________________________________
dri-devel mailing list
dri-devel@xxxxxxxxxxxxxxxxxxxxx
http://lists.freedesktop.org/mailman/listinfo/dri-devel




[Index of Archives]     [Linux DRI Users]     [Linux Intel Graphics]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [XFree86]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [XFree86]
  Powered by Linux