initial commit with v2.6.9
[linux-2.6.9-moxart.git] / drivers / video / kyro / STG4000OverlayDevice.c
blob25b286b4e09c0732af07d62824e62211cd8ea105
1 /*
2 * linux/drivers/video/kyro/STG4000OverlayDevice.c
4 * Copyright (C) 2000 Imagination Technologies Ltd
5 * Copyright (C) 2002 STMicroelectronics
7 * This file is subject to the terms and conditions of the GNU General Public
8 * License. See the file COPYING in the main directory of this archive
9 * for more details.
12 #include <linux/kernel.h>
13 #include <linux/errno.h>
14 #include <linux/types.h>
16 #include "STG4000Reg.h"
18 /* HW Defines */
20 #define STG4000_NO_SCALING 0x800
21 #define STG4000_NO_DECIMATION 0xFFFFFFFF
23 /* Primary surface */
24 #define STG4000_PRIM_NUM_PIX 5
25 #define STG4000_PRIM_ALIGN 4
26 #define STG4000_PRIM_ADDR_BITS 20
28 #define STG4000_PRIM_MIN_WIDTH 640
29 #define STG4000_PRIM_MAX_WIDTH 1600
30 #define STG4000_PRIM_MIN_HEIGHT 480
31 #define STG4000_PRIM_MAX_HEIGHT 1200
33 /* Overlay surface */
34 #define STG4000_OVRL_NUM_PIX 4
35 #define STG4000_OVRL_ALIGN 2
36 #define STG4000_OVRL_ADDR_BITS 20
37 #define STG4000_OVRL_NUM_MODES 5
39 #define STG4000_OVRL_MIN_WIDTH 0
40 #define STG4000_OVRL_MAX_WIDTH 720
41 #define STG4000_OVRL_MIN_HEIGHT 0
42 #define STG4000_OVRL_MAX_HEIGHT 576
44 /* Decimation and Scaling */
45 u32 adwDecim8[33] = {
46 0xffffffff, 0xfffeffff, 0xffdffbff, 0xfefefeff, 0xfdf7efbf,
47 0xfbdf7bdf, 0xf7bbddef, 0xeeeeeeef, 0xeeddbb77, 0xedb76db7,
48 0xdb6db6db, 0xdb5b5b5b, 0xdab5ad6b, 0xd5ab55ab, 0xd555aaab,
49 0xaaaaaaab, 0xaaaa5555, 0xaa952a55, 0xa94a5295, 0xa5252525,
50 0xa4924925, 0x92491249, 0x91224489, 0x91111111, 0x90884211,
51 0x88410821, 0x88102041, 0x81010101, 0x80800801, 0x80010001,
52 0x80000001, 0x00000001, 0x00000000
55 typedef struct _OVRL_SRC_DEST {
56 /*clipped on-screen pixel position of overlay */
57 u32 ulDstX1;
58 u32 ulDstY1;
59 u32 ulDstX2;
60 u32 ulDstY2;
62 /*clipped pixel pos of source data within buffer thses need to be 128 bit word aligned */
63 u32 ulSrcX1;
64 u32 ulSrcY1;
65 u32 ulSrcX2;
66 u32 ulSrcY2;
68 /* on-screen pixel position of overlay */
69 s32 lDstX1;
70 s32 lDstY1;
71 s32 lDstX2;
72 s32 lDstY2;
73 } OVRL_SRC_DEST;
75 static u32 ovlWidth, ovlHeight, ovlStride;
76 static int ovlLinear;
78 void ResetOverlayRegisters(volatile STG4000REG * pSTGReg)
80 u32 tmp;
82 /* Set Overlay address to default */
83 tmp = STG_READ_REG(DACOverlayAddr);
84 CLEAR_BITS_FRM_TO(0, 20);
85 CLEAR_BIT(31);
86 STG_WRITE_REG(DACOverlayAddr, tmp);
88 /* Set Overlay U address */
89 tmp = STG_READ_REG(DACOverlayUAddr);
90 CLEAR_BITS_FRM_TO(0, 20);
91 STG_WRITE_REG(DACOverlayUAddr, tmp);
93 /* Set Overlay V address */
94 tmp = STG_READ_REG(DACOverlayVAddr);
95 CLEAR_BITS_FRM_TO(0, 20);
96 STG_WRITE_REG(DACOverlayVAddr, tmp);
98 /* Set Overlay Size */
99 tmp = STG_READ_REG(DACOverlaySize);
100 CLEAR_BITS_FRM_TO(0, 10);
101 CLEAR_BITS_FRM_TO(12, 31);
102 STG_WRITE_REG(DACOverlaySize, tmp);
104 /* Set Overlay Vt Decimation */
105 tmp = STG4000_NO_DECIMATION;
106 STG_WRITE_REG(DACOverlayVtDec, tmp);
108 /* Set Overlay format to default value */
109 tmp = STG_READ_REG(DACPixelFormat);
110 CLEAR_BITS_FRM_TO(4, 7);
111 CLEAR_BITS_FRM_TO(16, 22);
112 STG_WRITE_REG(DACPixelFormat, tmp);
114 /* Set Vertical scaling to default */
115 tmp = STG_READ_REG(DACVerticalScal);
116 CLEAR_BITS_FRM_TO(0, 11);
117 CLEAR_BITS_FRM_TO(16, 22);
118 tmp |= STG4000_NO_SCALING; /* Set to no scaling */
119 STG_WRITE_REG(DACVerticalScal, tmp);
121 /* Set Horizontal Scaling to default */
122 tmp = STG_READ_REG(DACHorizontalScal);
123 CLEAR_BITS_FRM_TO(0, 11);
124 CLEAR_BITS_FRM_TO(16, 17);
125 tmp |= STG4000_NO_SCALING; /* Set to no scaling */
126 STG_WRITE_REG(DACHorizontalScal, tmp);
128 /* Set Blend mode to Alpha Blend */
129 /* ????? SG 08/11/2001 Surely this isn't the alpha blend mode,
130 hopefully its overwrite
132 tmp = STG_READ_REG(DACBlendCtrl);
133 CLEAR_BITS_FRM_TO(0, 30);
134 tmp = (GRAPHICS_MODE << 28);
135 STG_WRITE_REG(DACBlendCtrl, tmp);
139 int CreateOverlaySurface(volatile STG4000REG * pSTGReg,
140 u32 inWidth,
141 u32 inHeight,
142 int bLinear,
143 u32 ulOverlayOffset,
144 u32 * retStride, u32 * retUVStride)
146 u32 tmp;
147 u32 ulStride;
149 if (inWidth > STG4000_OVRL_MAX_WIDTH ||
150 inHeight > STG4000_OVRL_MAX_HEIGHT) {
151 return -EINVAL;
154 /* Stride in 16 byte words - 16Bpp */
155 if (bLinear) {
156 /* Format is 16bits so num 16 byte words is width/8 */
157 if ((inWidth & 0x7) == 0) { /* inWidth % 8 */
158 ulStride = (inWidth / 8);
159 } else {
160 /* Round up to next 16byte boundary */
161 ulStride = ((inWidth + 8) / 8);
163 } else {
164 /* Y component is 8bits so num 16 byte words is width/16 */
165 if ((inWidth & 0xf) == 0) { /* inWidth % 16 */
166 ulStride = (inWidth / 16);
167 } else {
168 /* Round up to next 16byte boundary */
169 ulStride = ((inWidth + 16) / 16);
174 /* Set Overlay address and Format mode */
175 tmp = STG_READ_REG(DACOverlayAddr);
176 CLEAR_BITS_FRM_TO(0, 20);
177 if (bLinear) {
178 CLEAR_BIT(31); /* Overlay format to Linear */
179 } else {
180 tmp |= SET_BIT(31); /* Overlay format to Planer */
183 /* Only bits 24:4 of the Overlay address */
184 tmp |= (ulOverlayOffset >> 4);
185 STG_WRITE_REG(DACOverlayAddr, tmp);
187 if (!bLinear) {
188 u32 uvSize =
189 (inWidth & 0x1) ? (inWidth + 1 / 2) : (inWidth / 2);
190 u32 uvStride;
191 u32 ulOffset;
192 /* Y component is 8bits so num 32 byte words is width/32 */
193 if ((uvSize & 0xf) == 0) { /* inWidth % 16 */
194 uvStride = (uvSize / 16);
195 } else {
196 /* Round up to next 32byte boundary */
197 uvStride = ((uvSize + 16) / 16);
200 ulOffset = ulOverlayOffset + (inHeight * (ulStride * 16));
201 /* Align U,V data to 32byte boundary */
202 if ((ulOffset & 0x1f) != 0)
203 ulOffset = (ulOffset + 32L) & 0xffffffE0L;
205 tmp = STG_READ_REG(DACOverlayUAddr);
206 CLEAR_BITS_FRM_TO(0, 20);
207 tmp |= (ulOffset >> 4);
208 STG_WRITE_REG(DACOverlayUAddr, tmp);
210 ulOffset += (inHeight / 2) * (uvStride * 16);
211 /* Align U,V data to 32byte boundary */
212 if ((ulOffset & 0x1f) != 0)
213 ulOffset = (ulOffset + 32L) & 0xffffffE0L;
215 tmp = STG_READ_REG(DACOverlayVAddr);
216 CLEAR_BITS_FRM_TO(0, 20);
217 tmp |= (ulOffset >> 4);
218 STG_WRITE_REG(DACOverlayVAddr, tmp);
220 *retUVStride = uvStride * 16;
224 /* Set Overlay YUV pixel format
225 * Make sure that LUT not used - ??????
227 tmp = STG_READ_REG(DACPixelFormat);
228 /* Only support Planer or UYVY linear formats */
229 CLEAR_BITS_FRM_TO(4, 9);
230 STG_WRITE_REG(DACPixelFormat, tmp);
232 ovlWidth = inWidth;
233 ovlHeight = inHeight;
234 ovlStride = ulStride;
235 ovlLinear = bLinear;
236 *retStride = ulStride << 4; /* In bytes */
238 return 0;
241 int SetOverlayBlendMode(volatile STG4000REG * pSTGReg,
242 OVRL_BLEND_MODE mode,
243 u32 ulAlpha, u32 ulColorKey)
245 u32 tmp;
247 tmp = STG_READ_REG(DACBlendCtrl);
248 CLEAR_BITS_FRM_TO(28, 30);
249 tmp |= (mode << 28);
251 switch (mode) {
252 case COLOR_KEY:
253 CLEAR_BITS_FRM_TO(0, 23);
254 tmp |= (ulColorKey & 0x00FFFFFF);
255 break;
257 case GLOBAL_ALPHA:
258 CLEAR_BITS_FRM_TO(24, 27);
259 tmp |= ((ulAlpha & 0xF) << 24);
260 break;
262 case CK_PIXEL_ALPHA:
263 CLEAR_BITS_FRM_TO(0, 23);
264 tmp |= (ulColorKey & 0x00FFFFFF);
265 break;
267 case CK_GLOBAL_ALPHA:
268 CLEAR_BITS_FRM_TO(0, 23);
269 tmp |= (ulColorKey & 0x00FFFFFF);
270 CLEAR_BITS_FRM_TO(24, 27);
271 tmp |= ((ulAlpha & 0xF) << 24);
272 break;
274 case GRAPHICS_MODE:
275 case PER_PIXEL_ALPHA:
276 break;
278 default:
279 return -EINVAL;
282 STG_WRITE_REG(DACBlendCtrl, tmp);
284 return 0;
287 void EnableOverlayPlane(volatile STG4000REG * pSTGReg)
289 u32 tmp;
290 /* Enable Overlay */
291 tmp = STG_READ_REG(DACPixelFormat);
292 tmp |= SET_BIT(7);
293 STG_WRITE_REG(DACPixelFormat, tmp);
295 /* Set video stream control */
296 tmp = STG_READ_REG(DACStreamCtrl);
297 tmp |= SET_BIT(1); /* video stream */
298 STG_WRITE_REG(DACStreamCtrl, tmp);
301 static u32 Overlap(u32 ulBits, u32 ulPattern)
303 u32 ulCount = 0;
305 while (ulBits) {
306 if (!(ulPattern & 1))
307 ulCount++;
308 ulBits--;
309 ulPattern = ulPattern >> 1;
312 return ulCount;
316 int SetOverlayViewPort(volatile STG4000REG * pSTGReg,
317 u32 left, u32 top,
318 u32 right, u32 bottom)
320 OVRL_SRC_DEST srcDest;
322 u32 ulSrcTop, ulSrcBottom;
323 u32 ulSrc, ulDest;
324 u32 ulFxScale, ulFxOffset;
325 u32 ulHeight, ulWidth;
326 u32 ulPattern;
327 u32 ulDecimate, ulDecimated;
328 u32 ulApplied;
329 u32 ulDacXScale, ulDacYScale;
330 u32 ulScale;
331 u32 ulLeft, ulRight;
332 u32 ulSrcLeft, ulSrcRight;
333 u32 ulScaleLeft, ulScaleRight;
334 u32 ulhDecim;
335 u32 ulsVal;
336 u32 ulVertDecFactor;
337 int bResult;
338 u32 ulClipOff = 0;
339 u32 ulBits = 0;
340 u32 ulsAdd = 0;
341 u32 tmp, ulStride;
342 u32 ulExcessPixels, ulClip, ulExtraLines;
345 srcDest.ulSrcX1 = 0;
346 srcDest.ulSrcY1 = 0;
347 srcDest.ulSrcX2 = ovlWidth - 1;
348 srcDest.ulSrcY2 = ovlHeight - 1;
350 srcDest.ulDstX1 = left;
351 srcDest.ulDstY1 = top;
352 srcDest.ulDstX2 = right;
353 srcDest.ulDstY2 = bottom;
355 srcDest.lDstX1 = srcDest.ulDstX1;
356 srcDest.lDstY1 = srcDest.ulDstY1;
357 srcDest.lDstX2 = srcDest.ulDstX2;
358 srcDest.lDstY2 = srcDest.ulDstY2;
360 /************* Vertical decimation/scaling ******************/
362 /* Get Src Top and Bottom */
363 ulSrcTop = srcDest.ulSrcY1;
364 ulSrcBottom = srcDest.ulSrcY2;
366 ulSrc = ulSrcBottom - ulSrcTop;
367 ulDest = srcDest.lDstY2 - srcDest.lDstY1; /* on-screen overlay */
369 if (ulSrc <= 1)
370 return -EINVAL;
372 /* First work out the position we are to display as offset from the
373 * source of the buffer
375 ulFxScale = (ulDest << 11) / ulSrc; /* fixed point scale factor */
376 ulFxOffset = (srcDest.lDstY2 - srcDest.ulDstY2) << 11;
378 ulSrcBottom = ulSrcBottom - (ulFxOffset / ulFxScale);
379 ulSrc = ulSrcBottom - ulSrcTop;
380 ulHeight = ulSrc;
382 ulDest = srcDest.ulDstY2 - (srcDest.ulDstY1 - 1);
383 ulPattern = adwDecim8[ulBits];
385 /* At this point ulSrc represents the input decimator */
386 if (ulSrc > ulDest) {
387 ulDecimate = ulSrc - ulDest;
388 ulBits = 0;
389 ulApplied = ulSrc / 32;
391 while (((ulBits * ulApplied) +
392 Overlap((ulSrc % 32),
393 adwDecim8[ulBits])) < ulDecimate)
394 ulBits++;
396 ulPattern = adwDecim8[ulBits];
397 ulDecimated =
398 (ulBits * ulApplied) + Overlap((ulSrc % 32),
399 ulPattern);
400 ulSrc = ulSrc - ulDecimated; /* the number number of lines that will go into the scaler */
403 if (ulBits && (ulBits != 32)) {
404 ulVertDecFactor = (63 - ulBits) / (32 - ulBits); /* vertical decimation factor scaled up to nearest integer */
405 } else {
406 ulVertDecFactor = 1;
409 ulDacYScale = ((ulSrc - 1) * 2048) / (ulDest + 1);
411 tmp = STG_READ_REG(DACOverlayVtDec); /* Decimation */
412 CLEAR_BITS_FRM_TO(0, 31);
413 tmp = ulPattern;
414 STG_WRITE_REG(DACOverlayVtDec, tmp);
416 /***************** Horizontal decimation/scaling ***************************/
419 * Now we handle the horizontal case, this is a simplified verison of
420 * the vertical case in that we decimate by factors of 2. as we are
421 * working in words we should always be able to decimate by these
422 * factors. as we always have to have a buffer which is aligned to a
423 * whole number of 128 bit words, we must align the left side to the
424 * lowest to the next lowest 128 bit boundary, and the right hand edge
425 * to the next largets boundary, (in a similar way to how we didi it in
426 * PMX1) as the left and right hand edges are aligned to these
427 * boundaries normally this only becomes an issue when we are chopping
428 * of one of the sides We shall work out vertical stuff first
430 ulSrc = srcDest.ulSrcX2 - srcDest.ulSrcX1;
431 ulDest = srcDest.lDstX2 - srcDest.lDstX1;
432 #ifdef _OLDCODE
433 ulLeft = srcDest.ulDstX1;
434 ulRight = srcDest.ulDstX2;
435 #else
436 if (srcDest.ulDstX1 > 2) {
437 ulLeft = srcDest.ulDstX1 + 2;
438 ulRight = srcDest.ulDstX2 + 1;
439 } else {
440 ulLeft = srcDest.ulDstX1;
441 ulRight = srcDest.ulDstX2 + 1;
443 #endif
444 /* first work out the position we are to display as offset from the source of the buffer */
445 bResult = 1;
447 do {
448 if (ulDest == 0)
449 return -EINVAL;
451 /* source pixels per dest pixel <<11 */
452 ulFxScale = ((ulSrc - 1) << 11) / (ulDest);
454 /* then number of destination pixels out we are */
455 ulFxOffset = ulFxScale * ((srcDest.ulDstX1 - srcDest.lDstX1) + ulClipOff);
456 ulFxOffset >>= 11;
458 /* this replaces the code which was making a decision as to use either ulFxOffset or ulSrcX1 */
459 ulSrcLeft = srcDest.ulSrcX1 + ulFxOffset;
461 /* then number of destination pixels out we are */
462 ulFxOffset = ulFxScale * (srcDest.lDstX2 - srcDest.ulDstX2);
463 ulFxOffset >>= 11;
465 ulSrcRight = srcDest.ulSrcX2 - ulFxOffset;
468 * we must align these to our 128 bit boundaries. we shall
469 * round down the pixel pos to the nearest 8 pixels.
471 ulScaleLeft = ulSrcLeft;
472 ulScaleRight = ulSrcRight;
474 /* shift fxscale until it is in the range of the scaler */
475 ulhDecim = 0;
476 ulScale = (((ulSrcRight - ulSrcLeft) - 1) << (11 - ulhDecim)) / (ulRight - ulLeft + 2);
478 while (ulScale > 0x800) {
479 ulhDecim++;
480 ulScale = (((ulSrcRight - ulSrcLeft) - 1) << (11 - ulhDecim)) / (ulRight - ulLeft + 2);
484 * to try and get the best values We first try and use
485 * src/dwdest for the scale factor, then we move onto src-1
487 * we want to check to see if we will need to clip data, if so
488 * then we should clip our source so that we don't need to
490 if (!ovlLinear) {
491 ulSrcLeft &= ~0x1f;
494 * we must align the right hand edge to the next 32
495 * pixel` boundary, must be on a 256 boundary so u, and
496 * v are 128 bit aligned
498 ulSrcRight = (ulSrcRight + 0x1f) & ~0x1f;
499 } else {
500 ulSrcLeft &= ~0x7;
503 * we must align the right hand edge to the next
504 * 8pixel` boundary
506 ulSrcRight = (ulSrcRight + 0x7) & ~0x7;
509 /* this is the input size line store needs to cope with */
510 ulWidth = ulSrcRight - ulSrcLeft;
513 * use unclipped value to work out scale factror this is the
514 * scale factor we want we shall now work out the horizonal
515 * decimation and scaling
517 ulsVal = ((ulWidth / 8) >> ulhDecim);
519 if ((ulWidth != (ulsVal << ulhDecim) * 8))
520 ulsAdd = 1;
522 /* input pixels to scaler; */
523 ulSrc = ulWidth >> ulhDecim;
525 if (ulSrc <= 2)
526 return -EINVAL;
528 ulExcessPixels = ((((ulScaleLeft - ulSrcLeft)) << (11 - ulhDecim)) / ulScale);
530 ulClip = (ulSrc << 11) / ulScale;
531 ulClip -= (ulRight - ulLeft);
532 ulClip += ulExcessPixels;
534 if (ulClip)
535 ulClip--;
537 /* We may need to do more here if we really have a HW rev < 5 */
538 } while (!bResult);
540 ulExtraLines = (1 << ulhDecim) * ulVertDecFactor;
541 ulExtraLines += 64;
542 ulHeight += ulExtraLines;
544 ulDacXScale = ulScale;
547 tmp = STG_READ_REG(DACVerticalScal);
548 CLEAR_BITS_FRM_TO(0, 11);
549 CLEAR_BITS_FRM_TO(16, 22); /* Vertical Scaling */
551 /* Calculate new output line stride, this is always the number of 422
552 words in the line buffer, so it doesn't matter if the
553 mode is 420. Then set the vertical scale register.
555 ulStride = (ulWidth >> (ulhDecim + 3)) + ulsAdd;
556 tmp |= ((ulStride << 16) | (ulDacYScale)); /* DAC_LS_CTRL = stride */
557 STG_WRITE_REG(DACVerticalScal, tmp);
559 /* Now set up the overlay size using the modified width and height
560 from decimate and scaling calculations
562 tmp = STG_READ_REG(DACOverlaySize);
563 CLEAR_BITS_FRM_TO(0, 10);
564 CLEAR_BITS_FRM_TO(12, 31);
566 if (ovlLinear) {
567 tmp |=
568 (ovlStride | ((ulHeight + 1) << 12) |
569 (((ulWidth / 8) - 1) << 23));
570 } else {
571 tmp |=
572 (ovlStride | ((ulHeight + 1) << 12) |
573 (((ulWidth / 32) - 1) << 23));
576 STG_WRITE_REG(DACOverlaySize, tmp);
578 /* Set Video Window Start */
579 tmp = ((ulLeft << 16)) | (srcDest.ulDstY1);
580 STG_WRITE_REG(DACVidWinStart, tmp);
582 /* Set Video Window End */
583 tmp = ((ulRight) << 16) | (srcDest.ulDstY2);
584 STG_WRITE_REG(DACVidWinEnd, tmp);
586 /* Finally set up the rest of the overlay regs in the order
587 done in the IMG driver
589 tmp = STG_READ_REG(DACPixelFormat);
590 tmp = ((ulExcessPixels << 16) | tmp) & 0x7fffffff;
591 STG_WRITE_REG(DACPixelFormat, tmp);
593 tmp = STG_READ_REG(DACHorizontalScal);
594 CLEAR_BITS_FRM_TO(0, 11);
595 CLEAR_BITS_FRM_TO(16, 17);
596 tmp |= ((ulhDecim << 16) | (ulDacXScale));
597 STG_WRITE_REG(DACHorizontalScal, tmp);
599 return 0;