STG4000OverlayDevice.c revision 1da177e4c3f41524e886b7f1b8a0c1fc7321cac
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * linux/drivers/video/kyro/STG4000OverlayDevice.c 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) 2000 Imagination Technologies Ltd 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) 2002 STMicroelectronics 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This file is subject to the terms and conditions of the GNU General Public 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * License. See the file COPYING in the main directory of this archive 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * for more details. 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h> 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "STG4000Reg.h" 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* HW Defines */ 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_NO_SCALING 0x800 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_NO_DECIMATION 0xFFFFFFFF 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Primary surface */ 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_PRIM_NUM_PIX 5 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_PRIM_ALIGN 4 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_PRIM_ADDR_BITS 20 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_PRIM_MIN_WIDTH 640 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_PRIM_MAX_WIDTH 1600 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_PRIM_MIN_HEIGHT 480 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_PRIM_MAX_HEIGHT 1200 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Overlay surface */ 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_OVRL_NUM_PIX 4 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_OVRL_ALIGN 2 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_OVRL_ADDR_BITS 20 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_OVRL_NUM_MODES 5 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_OVRL_MIN_WIDTH 0 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_OVRL_MAX_WIDTH 720 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_OVRL_MIN_HEIGHT 0 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STG4000_OVRL_MAX_HEIGHT 576 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Decimation and Scaling */ 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic u32 adwDecim8[33] = { 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0xffffffff, 0xfffeffff, 0xffdffbff, 0xfefefeff, 0xfdf7efbf, 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0xfbdf7bdf, 0xf7bbddef, 0xeeeeeeef, 0xeeddbb77, 0xedb76db7, 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0xdb6db6db, 0xdb5b5b5b, 0xdab5ad6b, 0xd5ab55ab, 0xd555aaab, 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0xaaaaaaab, 0xaaaa5555, 0xaa952a55, 0xa94a5295, 0xa5252525, 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0xa4924925, 0x92491249, 0x91224489, 0x91111111, 0x90884211, 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0x88410821, 0x88102041, 0x81010101, 0x80800801, 0x80010001, 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0x80000001, 0x00000001, 0x00000000 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldstypedef struct _OVRL_SRC_DEST { 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /*clipped on-screen pixel position of overlay */ 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulDstX1; 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulDstY1; 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulDstX2; 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulDstY2; 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /*clipped pixel pos of source data within buffer thses need to be 128 bit word aligned */ 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulSrcX1; 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulSrcY1; 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulSrcX2; 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulSrcY2; 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* on-screen pixel position of overlay */ 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s32 lDstX1; 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s32 lDstY1; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s32 lDstX2; 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s32 lDstY2; 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} OVRL_SRC_DEST; 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic u32 ovlWidth, ovlHeight, ovlStride; 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int ovlLinear; 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid ResetOverlayRegisters(volatile STG4000REG __iomem *pSTGReg) 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 tmp; 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Overlay address to default */ 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACOverlayAddr); 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 20); 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BIT(31); 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlayAddr, tmp); 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Overlay U address */ 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACOverlayUAddr); 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 20); 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlayUAddr, tmp); 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Overlay V address */ 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACOverlayVAddr); 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 20); 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlayVAddr, tmp); 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Overlay Size */ 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACOverlaySize); 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 10); 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(12, 31); 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlaySize, tmp); 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Overlay Vt Decimation */ 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG4000_NO_DECIMATION; 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlayVtDec, tmp); 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Overlay format to default value */ 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACPixelFormat); 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(4, 7); 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(16, 22); 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACPixelFormat, tmp); 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Vertical scaling to default */ 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACVerticalScal); 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 11); 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(16, 22); 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= STG4000_NO_SCALING; /* Set to no scaling */ 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACVerticalScal, tmp); 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Horizontal Scaling to default */ 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACHorizontalScal); 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 11); 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(16, 17); 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= STG4000_NO_SCALING; /* Set to no scaling */ 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACHorizontalScal, tmp); 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Blend mode to Alpha Blend */ 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* ????? SG 08/11/2001 Surely this isn't the alpha blend mode, 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds hopefully its overwrite 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACBlendCtrl); 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 30); 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = (GRAPHICS_MODE << 28); 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACBlendCtrl, tmp); 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint CreateOverlaySurface(volatile STG4000REG __iomem *pSTGReg, 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 inWidth, 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 inHeight, 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int bLinear, 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulOverlayOffset, 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 * retStride, u32 * retUVStride) 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 tmp; 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulStride; 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (inWidth > STG4000_OVRL_MAX_WIDTH || 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds inHeight > STG4000_OVRL_MAX_HEIGHT) { 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Stride in 16 byte words - 16Bpp */ 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bLinear) { 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Format is 16bits so num 16 byte words is width/8 */ 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((inWidth & 0x7) == 0) { /* inWidth % 8 */ 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulStride = (inWidth / 8); 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Round up to next 16byte boundary */ 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulStride = ((inWidth + 8) / 8); 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Y component is 8bits so num 16 byte words is width/16 */ 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((inWidth & 0xf) == 0) { /* inWidth % 16 */ 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulStride = (inWidth / 16); 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Round up to next 16byte boundary */ 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulStride = ((inWidth + 16) / 16); 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Overlay address and Format mode */ 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACOverlayAddr); 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 20); 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bLinear) { 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BIT(31); /* Overlay format to Linear */ 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= SET_BIT(31); /* Overlay format to Planer */ 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Only bits 24:4 of the Overlay address */ 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= (ulOverlayOffset >> 4); 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlayAddr, tmp); 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bLinear) { 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 uvSize = 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (inWidth & 0x1) ? (inWidth + 1 / 2) : (inWidth / 2); 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 uvStride; 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulOffset; 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Y component is 8bits so num 32 byte words is width/32 */ 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((uvSize & 0xf) == 0) { /* inWidth % 16 */ 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uvStride = (uvSize / 16); 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Round up to next 32byte boundary */ 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uvStride = ((uvSize + 16) / 16); 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulOffset = ulOverlayOffset + (inHeight * (ulStride * 16)); 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Align U,V data to 32byte boundary */ 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ulOffset & 0x1f) != 0) 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulOffset = (ulOffset + 32L) & 0xffffffE0L; 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACOverlayUAddr); 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 20); 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= (ulOffset >> 4); 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlayUAddr, tmp); 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulOffset += (inHeight / 2) * (uvStride * 16); 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Align U,V data to 32byte boundary */ 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ulOffset & 0x1f) != 0) 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulOffset = (ulOffset + 32L) & 0xffffffE0L; 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACOverlayVAddr); 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 20); 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= (ulOffset >> 4); 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlayVAddr, tmp); 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *retUVStride = uvStride * 16; 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Overlay YUV pixel format 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Make sure that LUT not used - ?????? 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACPixelFormat); 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Only support Planer or UYVY linear formats */ 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(4, 9); 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACPixelFormat, tmp); 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ovlWidth = inWidth; 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ovlHeight = inHeight; 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ovlStride = ulStride; 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ovlLinear = bLinear; 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *retStride = ulStride << 4; /* In bytes */ 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint SetOverlayBlendMode(volatile STG4000REG __iomem *pSTGReg, 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OVRL_BLEND_MODE mode, 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulAlpha, u32 ulColorKey) 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 tmp; 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACBlendCtrl); 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(28, 30); 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= (mode << 28); 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (mode) { 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case COLOR_KEY: 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 23); 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= (ulColorKey & 0x00FFFFFF); 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case GLOBAL_ALPHA: 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(24, 27); 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= ((ulAlpha & 0xF) << 24); 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CK_PIXEL_ALPHA: 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 23); 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= (ulColorKey & 0x00FFFFFF); 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CK_GLOBAL_ALPHA: 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 23); 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= (ulColorKey & 0x00FFFFFF); 2701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(24, 27); 2711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= ((ulAlpha & 0xF) << 24); 2721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case GRAPHICS_MODE: 2751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PER_PIXEL_ALPHA: 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACBlendCtrl, tmp); 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid EnableOverlayPlane(volatile STG4000REG __iomem *pSTGReg) 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 tmp; 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Enable Overlay */ 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACPixelFormat); 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= SET_BIT(7); 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACPixelFormat, tmp); 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set video stream control */ 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACStreamCtrl); 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= SET_BIT(1); /* video stream */ 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACStreamCtrl, tmp); 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic u32 Overlap(u32 ulBits, u32 ulPattern) 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulCount = 0; 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (ulBits) { 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!(ulPattern & 1)) 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulCount++; 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulBits--; 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulPattern = ulPattern >> 1; 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ulCount; 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint SetOverlayViewPort(volatile STG4000REG __iomem *pSTGReg, 3171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 left, u32 top, 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 right, u32 bottom) 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OVRL_SRC_DEST srcDest; 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulSrcTop, ulSrcBottom; 3231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulSrc, ulDest; 3241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulFxScale, ulFxOffset; 3251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulHeight, ulWidth; 3261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulPattern; 3271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulDecimate, ulDecimated; 3281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulApplied; 3291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulDacXScale, ulDacYScale; 3301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulScale; 3311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulLeft, ulRight; 3321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulSrcLeft, ulSrcRight; 3331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulScaleLeft, ulScaleRight; 3341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulhDecim; 3351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulsVal; 3361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulVertDecFactor; 3371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int bResult; 3381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulClipOff = 0; 3391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulBits = 0; 3401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulsAdd = 0; 3411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 tmp, ulStride; 3421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds u32 ulExcessPixels, ulClip, ulExtraLines; 3431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.ulSrcX1 = 0; 3461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.ulSrcY1 = 0; 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.ulSrcX2 = ovlWidth - 1; 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.ulSrcY2 = ovlHeight - 1; 3491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.ulDstX1 = left; 3511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.ulDstY1 = top; 3521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.ulDstX2 = right; 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.ulDstY2 = bottom; 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.lDstX1 = srcDest.ulDstX1; 3561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.lDstY1 = srcDest.ulDstY1; 3571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.lDstX2 = srcDest.ulDstX2; 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds srcDest.lDstY2 = srcDest.ulDstY2; 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /************* Vertical decimation/scaling ******************/ 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Get Src Top and Bottom */ 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrcTop = srcDest.ulSrcY1; 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrcBottom = srcDest.ulSrcY2; 3651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrc = ulSrcBottom - ulSrcTop; 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulDest = srcDest.lDstY2 - srcDest.lDstY1; /* on-screen overlay */ 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ulSrc <= 1) 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 3711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* First work out the position we are to display as offset from the 3731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * source of the buffer 3741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 3751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulFxScale = (ulDest << 11) / ulSrc; /* fixed point scale factor */ 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulFxOffset = (srcDest.lDstY2 - srcDest.ulDstY2) << 11; 3771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrcBottom = ulSrcBottom - (ulFxOffset / ulFxScale); 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrc = ulSrcBottom - ulSrcTop; 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulHeight = ulSrc; 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulDest = srcDest.ulDstY2 - (srcDest.ulDstY1 - 1); 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulPattern = adwDecim8[ulBits]; 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* At this point ulSrc represents the input decimator */ 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ulSrc > ulDest) { 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulDecimate = ulSrc - ulDest; 3881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulBits = 0; 3891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulApplied = ulSrc / 32; 3901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (((ulBits * ulApplied) + 3921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Overlap((ulSrc % 32), 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds adwDecim8[ulBits])) < ulDecimate) 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulBits++; 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulPattern = adwDecim8[ulBits]; 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulDecimated = 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ulBits * ulApplied) + Overlap((ulSrc % 32), 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulPattern); 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrc = ulSrc - ulDecimated; /* the number number of lines that will go into the scaler */ 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ulBits && (ulBits != 32)) { 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulVertDecFactor = (63 - ulBits) / (32 - ulBits); /* vertical decimation factor scaled up to nearest integer */ 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulVertDecFactor = 1; 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulDacYScale = ((ulSrc - 1) * 2048) / (ulDest + 1); 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACOverlayVtDec); /* Decimation */ 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 31); 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = ulPattern; 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlayVtDec, tmp); 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /***************** Horizontal decimation/scaling ***************************/ 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Now we handle the horizontal case, this is a simplified verison of 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the vertical case in that we decimate by factors of 2. as we are 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * working in words we should always be able to decimate by these 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * factors. as we always have to have a buffer which is aligned to a 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * whole number of 128 bit words, we must align the left side to the 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * lowest to the next lowest 128 bit boundary, and the right hand edge 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to the next largets boundary, (in a similar way to how we didi it in 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * PMX1) as the left and right hand edges are aligned to these 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * boundaries normally this only becomes an issue when we are chopping 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * of one of the sides We shall work out vertical stuff first 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrc = srcDest.ulSrcX2 - srcDest.ulSrcX1; 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulDest = srcDest.lDstX2 - srcDest.lDstX1; 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef _OLDCODE 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulLeft = srcDest.ulDstX1; 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulRight = srcDest.ulDstX2; 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (srcDest.ulDstX1 > 2) { 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulLeft = srcDest.ulDstX1 + 2; 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulRight = srcDest.ulDstX2 + 1; 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulLeft = srcDest.ulDstX1; 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulRight = srcDest.ulDstX2 + 1; 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* first work out the position we are to display as offset from the source of the buffer */ 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bResult = 1; 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do { 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ulDest == 0) 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* source pixels per dest pixel <<11 */ 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulFxScale = ((ulSrc - 1) << 11) / (ulDest); 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* then number of destination pixels out we are */ 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulFxOffset = ulFxScale * ((srcDest.ulDstX1 - srcDest.lDstX1) + ulClipOff); 4561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulFxOffset >>= 11; 4571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* this replaces the code which was making a decision as to use either ulFxOffset or ulSrcX1 */ 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrcLeft = srcDest.ulSrcX1 + ulFxOffset; 4601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* then number of destination pixels out we are */ 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulFxOffset = ulFxScale * (srcDest.lDstX2 - srcDest.ulDstX2); 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulFxOffset >>= 11; 4641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrcRight = srcDest.ulSrcX2 - ulFxOffset; 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 4681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we must align these to our 128 bit boundaries. we shall 4691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * round down the pixel pos to the nearest 8 pixels. 4701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulScaleLeft = ulSrcLeft; 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulScaleRight = ulSrcRight; 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* shift fxscale until it is in the range of the scaler */ 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulhDecim = 0; 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulScale = (((ulSrcRight - ulSrcLeft) - 1) << (11 - ulhDecim)) / (ulRight - ulLeft + 2); 4771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (ulScale > 0x800) { 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulhDecim++; 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulScale = (((ulSrcRight - ulSrcLeft) - 1) << (11 - ulhDecim)) / (ulRight - ulLeft + 2); 4811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to try and get the best values We first try and use 4851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * src/dwdest for the scale factor, then we move onto src-1 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we want to check to see if we will need to clip data, if so 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * then we should clip our source so that we don't need to 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!ovlLinear) { 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrcLeft &= ~0x1f; 4921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we must align the right hand edge to the next 32 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * pixel` boundary, must be on a 256 boundary so u, and 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * v are 128 bit aligned 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrcRight = (ulSrcRight + 0x1f) & ~0x1f; 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrcLeft &= ~0x7; 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we must align the right hand edge to the next 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 8pixel` boundary 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrcRight = (ulSrcRight + 0x7) & ~0x7; 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* this is the input size line store needs to cope with */ 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulWidth = ulSrcRight - ulSrcLeft; 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * use unclipped value to work out scale factror this is the 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * scale factor we want we shall now work out the horizonal 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * decimation and scaling 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulsVal = ((ulWidth / 8) >> ulhDecim); 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ulWidth != (ulsVal << ulhDecim) * 8)) 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulsAdd = 1; 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* input pixels to scaler; */ 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulSrc = ulWidth >> ulhDecim; 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ulSrc <= 2) 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulExcessPixels = ((((ulScaleLeft - ulSrcLeft)) << (11 - ulhDecim)) / ulScale); 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulClip = (ulSrc << 11) / ulScale; 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulClip -= (ulRight - ulLeft); 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulClip += ulExcessPixels; 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ulClip) 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulClip--; 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* We may need to do more here if we really have a HW rev < 5 */ 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } while (!bResult); 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulExtraLines = (1 << ulhDecim) * ulVertDecFactor; 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulExtraLines += 64; 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulHeight += ulExtraLines; 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulDacXScale = ulScale; 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACVerticalScal); 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 11); 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(16, 22); /* Vertical Scaling */ 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Calculate new output line stride, this is always the number of 422 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds words in the line buffer, so it doesn't matter if the 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mode is 420. Then set the vertical scale register. 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ulStride = (ulWidth >> (ulhDecim + 3)) + ulsAdd; 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= ((ulStride << 16) | (ulDacYScale)); /* DAC_LS_CTRL = stride */ 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACVerticalScal, tmp); 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Now set up the overlay size using the modified width and height 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds from decimate and scaling calculations 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACOverlaySize); 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 10); 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(12, 31); 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ovlLinear) { 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ovlStride | ((ulHeight + 1) << 12) | 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (((ulWidth / 8) - 1) << 23)); 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (ovlStride | ((ulHeight + 1) << 12) | 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (((ulWidth / 32) - 1) << 23)); 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACOverlaySize, tmp); 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Video Window Start */ 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = ((ulLeft << 16)) | (srcDest.ulDstY1); 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACVidWinStart, tmp); 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set Video Window End */ 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = ((ulRight) << 16) | (srcDest.ulDstY2); 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACVidWinEnd, tmp); 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Finally set up the rest of the overlay regs in the order 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds done in the IMG driver 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACPixelFormat); 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = ((ulExcessPixels << 16) | tmp) & 0x7fffffff; 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACPixelFormat, tmp); 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = STG_READ_REG(DACHorizontalScal); 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(0, 11); 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLEAR_BITS_FRM_TO(16, 17); 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp |= ((ulhDecim << 16) | (ulDacXScale)); 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds STG_WRITE_REG(DACHorizontalScal, tmp); 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 601