cg14_accel.c revision b0f02aef
1b0f02aefSmacallan/* $NetBSD: cg14_accel.c,v 1.31 2022/05/11 21:10:37 macallan Exp $ */
24261fa58Smacallan/*
34261fa58Smacallan * Copyright (c) 2013 Michael Lorenz
44261fa58Smacallan * All rights reserved.
54261fa58Smacallan *
64261fa58Smacallan * Redistribution and use in source and binary forms, with or without
74261fa58Smacallan * modification, are permitted provided that the following conditions
84261fa58Smacallan * are met:
94261fa58Smacallan *
104261fa58Smacallan *    - Redistributions of source code must retain the above copyright
114261fa58Smacallan *      notice, this list of conditions and the following disclaimer.
124261fa58Smacallan *    - Redistributions in binary form must reproduce the above
134261fa58Smacallan *      copyright notice, this list of conditions and the following
144261fa58Smacallan *      disclaimer in the documentation and/or other materials provided
154261fa58Smacallan *      with the distribution.
164261fa58Smacallan *
174261fa58Smacallan * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
184261fa58Smacallan * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
194261fa58Smacallan * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
204261fa58Smacallan * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
214261fa58Smacallan * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
224261fa58Smacallan * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
234261fa58Smacallan * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
244261fa58Smacallan * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
254261fa58Smacallan * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
264261fa58Smacallan * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
274261fa58Smacallan * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
284261fa58Smacallan * POSSIBILITY OF SUCH DAMAGE.
294261fa58Smacallan *
304261fa58Smacallan */
31c88c16f8Smacallan
32c88c16f8Smacallan#ifdef HAVE_CONFIG_H
33c88c16f8Smacallan#include "config.h"
34c88c16f8Smacallan#endif
35c88c16f8Smacallan
364261fa58Smacallan#include <sys/types.h>
374261fa58Smacallan
384261fa58Smacallan/* all driver need this */
394261fa58Smacallan#include "xf86.h"
404261fa58Smacallan#include "xf86_OSproc.h"
414261fa58Smacallan#include "compiler.h"
424261fa58Smacallan
434261fa58Smacallan#include "cg14.h"
444261fa58Smacallan
45b0f02aefSmacallan/*#define SX_DEBUG*/
46b0f02aefSmacallan/*#define SX_TRACE*/
474261fa58Smacallan
486fd6e0f4Smacallan#ifdef SX_TRACE
494261fa58Smacallan#define ENTER xf86Msg(X_ERROR, "%s>\n", __func__);
504261fa58Smacallan#else
514261fa58Smacallan#define ENTER
526fd6e0f4Smacallan#endif
536fd6e0f4Smacallan
546fd6e0f4Smacallan#ifdef SX_DEBUG
556fd6e0f4Smacallan#define DPRINTF xf86Msg
566fd6e0f4Smacallan#else
574261fa58Smacallan#define DPRINTF while (0) xf86Msg
584261fa58Smacallan#endif
594261fa58Smacallan
604261fa58Smacallan#define arraysize(ary)        (sizeof(ary) / sizeof(ary[0]))
614261fa58Smacallan
624261fa58Smacallan/* 0xcc is SX's GXcopy equivalent */
634261fa58Smacallanuint32_t sx_rop[] = { 0x00, 0x88, 0x44, 0xcc, 0x22, 0xaa, 0x66, 0xee,
644261fa58Smacallan		      0x11, 0x99, 0x55, 0xdd, 0x33, 0xbb, 0x77, 0xff};
654261fa58Smacallan
664261fa58Smacallanint src_formats[] = {PICT_a8r8g8b8, PICT_x8r8g8b8,
674261fa58Smacallan		     PICT_a8b8g8r8, PICT_x8b8g8r8, PICT_a8};
684261fa58Smacallanint tex_formats[] = {PICT_a8r8g8b8, PICT_a8b8g8r8, PICT_a8};
694261fa58Smacallan
70f71acd79Smacallanstatic void CG14Copy32(PixmapPtr, int, int, int, int, int, int);
71f71acd79Smacallanstatic void CG14Copy8(PixmapPtr, int, int, int, int, int, int);
72f71acd79Smacallan
734261fa58Smacallanstatic inline void
744261fa58SmacallanCG14Wait(Cg14Ptr p)
754261fa58Smacallan{
76fc473876Smacallan	int bail = 10000000;
77fc473876Smacallan	/* we wait for the busy bit to clear */
78fc473876Smacallan	while (((read_sx_reg(p, SX_CONTROL_STATUS) & SX_BZ) != 0) &&
79fc473876Smacallan	       (bail > 0)) {
80fc473876Smacallan		bail--;
81fc473876Smacallan	};
82fc473876Smacallan	if (bail == 0) {
83fc473876Smacallan		xf86Msg(X_ERROR, "SX wait for idle timed out %08x %08x\n",
84fc473876Smacallan		    read_sx_reg(p, SX_CONTROL_STATUS),
85fc473876Smacallan		    read_sx_reg(p, SX_ERROR));
86fc473876Smacallan	}
874261fa58Smacallan}
884261fa58Smacallan
894261fa58Smacallanstatic void
904261fa58SmacallanCG14WaitMarker(ScreenPtr pScreen, int Marker)
914261fa58Smacallan{
924261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
934261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
944261fa58Smacallan
954261fa58Smacallan	CG14Wait(p);
964261fa58Smacallan}
974261fa58Smacallan
984261fa58Smacallanstatic Bool
994261fa58SmacallanCG14PrepareCopy(PixmapPtr pSrcPixmap, PixmapPtr pDstPixmap,
1004261fa58Smacallan		int xdir, int ydir, int alu, Pixel planemask)
1014261fa58Smacallan{
1024261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pDstPixmap->drawable.pScreen->myNum];
1034261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
1044261fa58Smacallan
1054261fa58Smacallan	ENTER;
106b0f02aefSmacallan	DPRINTF(X_ERROR, "%s bpp %d rop %x\n", __func__,
10781c68cf8Smacallan	    pSrcPixmap->drawable.bitsPerPixel, alu);
1084261fa58Smacallan
1094261fa58Smacallan	if (planemask != p->last_mask) {
1104261fa58Smacallan		CG14Wait(p);
1114261fa58Smacallan		write_sx_reg(p, SX_PLANEMASK, planemask);
1124261fa58Smacallan		p->last_mask = planemask;
1134261fa58Smacallan	}
1144261fa58Smacallan	alu = sx_rop[alu];
1154261fa58Smacallan	if (alu != p->last_rop) {
1164261fa58Smacallan		CG14Wait(p);
1174261fa58Smacallan		write_sx_reg(p, SX_ROP_CONTROL, alu);
1184261fa58Smacallan		p->last_rop = alu;
1194261fa58Smacallan	}
120f71acd79Smacallan	switch (pSrcPixmap->drawable.bitsPerPixel)  {
121f71acd79Smacallan		case 8:
122f71acd79Smacallan			p->pExa->Copy = CG14Copy8;
123f71acd79Smacallan			break;
124f71acd79Smacallan		case 32:
125f71acd79Smacallan			p->pExa->Copy = CG14Copy32;
126f71acd79Smacallan			break;
127f71acd79Smacallan		default:
128b0f02aefSmacallan			DPRINTF(X_ERROR, "%s depth %d\n", __func__,
129f71acd79Smacallan			    pSrcPixmap->drawable.bitsPerPixel);
130f71acd79Smacallan	}
1314261fa58Smacallan	p->srcpitch = exaGetPixmapPitch(pSrcPixmap);
1324261fa58Smacallan	p->srcoff = exaGetPixmapOffset(pSrcPixmap);
1334261fa58Smacallan	p->xdir = xdir;
1344261fa58Smacallan	p->ydir = ydir;
1354261fa58Smacallan	return TRUE;
1364261fa58Smacallan}
1374261fa58Smacallan
1384261fa58Smacallanstatic void
139f71acd79SmacallanCG14Copy32(PixmapPtr pDstPixmap,
1404261fa58Smacallan         int srcX, int srcY, int dstX, int dstY, int w, int h)
1414261fa58Smacallan{
1424261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pDstPixmap->drawable.pScreen->myNum];
1434261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
1444261fa58Smacallan	int dstpitch, dstoff, srcpitch, srcoff;
1454261fa58Smacallan	int srcstart, dststart, xinc, srcinc, dstinc;
1464261fa58Smacallan	int line, count, s, d, num;
1474261fa58Smacallan
1484261fa58Smacallan	ENTER;
1494261fa58Smacallan	dstpitch = exaGetPixmapPitch(pDstPixmap);
1504261fa58Smacallan	dstoff = exaGetPixmapOffset(pDstPixmap);
1514261fa58Smacallan	srcpitch = p->srcpitch;
1524261fa58Smacallan	srcoff = p->srcoff;
1534261fa58Smacallan	/*
1544261fa58Smacallan	 * should clear the WO bit in SX_CONTROL_STATUS, then check if SX
1554261fa58Smacallan	 * actually wrote anything and only sync if it did
1564261fa58Smacallan	 */
1574261fa58Smacallan	srcstart = (srcX << 2) + (srcpitch * srcY) + srcoff;
1584261fa58Smacallan	dststart = (dstX << 2) + (dstpitch * dstY) + dstoff;
1594261fa58Smacallan
1604261fa58Smacallan	/*
1614261fa58Smacallan	 * we always copy up to 32 pixels at a time so direction doesn't
1624261fa58Smacallan	 * matter if w<=32
1634261fa58Smacallan	 */
1644261fa58Smacallan	if (w > 32) {
1654261fa58Smacallan		if (p->xdir < 0) {
1664261fa58Smacallan			srcstart += (w - 32) << 2;
1674261fa58Smacallan			dststart += (w - 32) << 2;
1684261fa58Smacallan			xinc = -128;
1694261fa58Smacallan		} else
1704261fa58Smacallan			xinc = 128;
1714261fa58Smacallan	} else
1724261fa58Smacallan		xinc = 128;
1734261fa58Smacallan	if (p->ydir < 0) {
1744261fa58Smacallan		srcstart += (h - 1) * srcpitch;
1754261fa58Smacallan		dststart += (h - 1) * dstpitch;
1764261fa58Smacallan		srcinc = -srcpitch;
1774261fa58Smacallan		dstinc = -dstpitch;
1784261fa58Smacallan	} else {
1794261fa58Smacallan		srcinc = srcpitch;
1804261fa58Smacallan		dstinc = dstpitch;
1814261fa58Smacallan	}
1824261fa58Smacallan	if (p->last_rop == 0xcc) {
1834261fa58Smacallan		/* plain old copy */
1844261fa58Smacallan		if ( xinc > 0) {
1854261fa58Smacallan			/* going left to right */
1864261fa58Smacallan			for (line = 0; line < h; line++) {
1874261fa58Smacallan				count = 0;
1884261fa58Smacallan				s = srcstart;
1894261fa58Smacallan				d = dststart;
1904261fa58Smacallan				while ( count < w) {
1914261fa58Smacallan					num = min(32, w - count);
19272fd264fSmacallan					sxm(SX_LD, s, 10, num - 1);
19372fd264fSmacallan					sxm(SX_STM, d, 10, num - 1);
1944261fa58Smacallan					s += xinc;
1954261fa58Smacallan					d += xinc;
1964261fa58Smacallan					count += 32;
1974261fa58Smacallan				}
1984261fa58Smacallan				srcstart += srcinc;
1994261fa58Smacallan				dststart += dstinc;
2004261fa58Smacallan			}
2014261fa58Smacallan		} else {
2024261fa58Smacallan			/* going right to left */
2034261fa58Smacallan			int i, chunks = (w >> 5);
2044261fa58Smacallan			for (line = 0; line < h; line++) {
2054261fa58Smacallan				s = srcstart;
2064261fa58Smacallan				d = dststart;
2074261fa58Smacallan				count = w;
2084261fa58Smacallan				for (i = 0; i < chunks; i++) {
20972fd264fSmacallan					sxm(SX_LD, s, 10, 31);
21072fd264fSmacallan					sxm(SX_STM, d, 10, 31);
2114261fa58Smacallan					s -= 128;
2124261fa58Smacallan					d -= 128;
2134261fa58Smacallan					count -= 32;
2144261fa58Smacallan				}
2154261fa58Smacallan				/* leftovers, if any */
2164261fa58Smacallan				if (count > 0) {
2174261fa58Smacallan					s += (32 - count) << 2;
2184261fa58Smacallan					d += (32 - count) << 2;
21972fd264fSmacallan					sxm(SX_LD, s, 10, count - 1);
22072fd264fSmacallan					sxm(SX_STM, d, 10, count - 1);
2214261fa58Smacallan				}
2224261fa58Smacallan				srcstart += srcinc;
2234261fa58Smacallan				dststart += dstinc;
2244261fa58Smacallan			}
2254261fa58Smacallan		}
2264261fa58Smacallan	} else {
2274261fa58Smacallan		/* ROPs needed */
2284261fa58Smacallan		if ( xinc > 0) {
2294261fa58Smacallan			/* going left to right */
2304261fa58Smacallan			for (line = 0; line < h; line++) {
2314261fa58Smacallan				count = 0;
2324261fa58Smacallan				s = srcstart;
2334261fa58Smacallan				d = dststart;
2344261fa58Smacallan				while ( count < w) {
2354261fa58Smacallan					num = min(32, w - count);
23672fd264fSmacallan					sxm(SX_LD, s, 10, num - 1);
23772fd264fSmacallan					sxm(SX_LD, d, 42, num - 1);
2384261fa58Smacallan					if (num > 16) {
239230e26c7Smacallan						sxi(SX_ROP, 10, 42, 74, 15);
240230e26c7Smacallan						sxi(SX_ROP, 26, 58, 90, num - 17);
2414261fa58Smacallan					} else {
242230e26c7Smacallan						sxi(SX_ROP, 10, 42, 74, num - 1);
2434261fa58Smacallan					}
24472fd264fSmacallan					sxm(SX_STM, d, 74, num - 1);
2454261fa58Smacallan					s += xinc;
2464261fa58Smacallan					d += xinc;
2474261fa58Smacallan					count += 32;
2484261fa58Smacallan				}
2494261fa58Smacallan				srcstart += srcinc;
2504261fa58Smacallan				dststart += dstinc;
2514261fa58Smacallan			}
2524261fa58Smacallan		} else {
2534261fa58Smacallan			/* going right to left */
2544261fa58Smacallan			int i, chunks = (w >> 5);
2554261fa58Smacallan			for (line = 0; line < h; line++) {
2564261fa58Smacallan				s = srcstart;
2574261fa58Smacallan				d = dststart;
2584261fa58Smacallan				count = w;
2594261fa58Smacallan				for (i = 0; i < chunks; i++) {
26072fd264fSmacallan					sxm(SX_LD, s, 10, 31);
26172fd264fSmacallan					sxm(SX_LD, d, 42, 31);
262230e26c7Smacallan					sxi(SX_ROP, 10, 42, 74, 15);
263230e26c7Smacallan					sxi(SX_ROP, 26, 58, 90, 15);
26472fd264fSmacallan					sxm(SX_STM, d, 74, 31);
2654261fa58Smacallan					s -= 128;
2664261fa58Smacallan					d -= 128;
2674261fa58Smacallan					count -= 32;
2684261fa58Smacallan				}
2694261fa58Smacallan				/* leftovers, if any */
2704261fa58Smacallan				if (count > 0) {
2714261fa58Smacallan					s += (32 - count) << 2;
2724261fa58Smacallan					d += (32 - count) << 2;
27372fd264fSmacallan					sxm(SX_LD, s, 10, count - 1);
27472fd264fSmacallan					sxm(SX_LD, d, 42, count - 1);
2754261fa58Smacallan					if (count > 16) {
276230e26c7Smacallan						sxi(SX_ROP, 10, 42, 74, 15);
277230e26c7Smacallan						sxi(SX_ROP, 26, 58, 90, count - 17);
2784261fa58Smacallan					} else {
279230e26c7Smacallan						sxi(SX_ROP, 10, 42, 74, count - 1);
2804261fa58Smacallan					}
28172fd264fSmacallan					sxm(SX_STM, d, 74, count - 1);
2824261fa58Smacallan				}
2834261fa58Smacallan				srcstart += srcinc;
2844261fa58Smacallan				dststart += dstinc;
2854261fa58Smacallan			}
2864261fa58Smacallan		}
2874261fa58Smacallan	}
2884261fa58Smacallan	exaMarkSync(pDstPixmap->drawable.pScreen);
2894261fa58Smacallan}
2904261fa58Smacallan
29181c68cf8Smacallan/*
29281c68cf8Smacallan * copy with same alignment, left to right, no ROP
29381c68cf8Smacallan */
29481c68cf8Smacallanstatic void
29572fd264fSmacallanCG14Copy8_aligned_norop(Cg14Ptr p, int srcstart, int dststart, int w, int h,
29672fd264fSmacallan    int srcpitch, int dstpitch)
29781c68cf8Smacallan{
29881c68cf8Smacallan	int saddr, daddr, pre, cnt, wrds;
29981c68cf8Smacallan
30081c68cf8Smacallan	ENTER;
30181c68cf8Smacallan
30281c68cf8Smacallan	pre = srcstart & 3;
30381c68cf8Smacallan	if (pre != 0) pre = 4 - pre;
30481c68cf8Smacallan	pre = min(pre, w);
30581c68cf8Smacallan
30681c68cf8Smacallan	while (h > 0) {
30781c68cf8Smacallan		saddr = srcstart;
30881c68cf8Smacallan		daddr = dststart;
30981c68cf8Smacallan		cnt = w;
31081c68cf8Smacallan		if (pre > 0) {
31172fd264fSmacallan			sxm(SX_LDB, saddr, 8, pre - 1);
31272fd264fSmacallan			sxm(SX_STB, daddr, 8, pre - 1);
31381c68cf8Smacallan			saddr += pre;
31481c68cf8Smacallan			daddr += pre;
31581c68cf8Smacallan			cnt -= pre;
31681c68cf8Smacallan			if (cnt == 0) goto next;
31781c68cf8Smacallan		}
31881c68cf8Smacallan		while (cnt > 3) {
31981c68cf8Smacallan			wrds = min(32, cnt >> 2);
32072fd264fSmacallan			sxm(SX_LD, saddr, 8, wrds - 1);
32172fd264fSmacallan			sxm(SX_ST, daddr, 8, wrds - 1);
32281c68cf8Smacallan			saddr += wrds << 2;
32381c68cf8Smacallan			daddr += wrds << 2;
32481c68cf8Smacallan			cnt -= wrds << 2;
32581c68cf8Smacallan		}
32681c68cf8Smacallan		if (cnt > 0) {
32772fd264fSmacallan			sxm(SX_LDB, saddr, 8, cnt - 1);
32872fd264fSmacallan			sxm(SX_STB, daddr, 8, cnt - 1);
32981c68cf8Smacallan		}
33081c68cf8Smacallannext:
33181c68cf8Smacallan		srcstart += srcpitch;
33281c68cf8Smacallan		dststart += dstpitch;
33381c68cf8Smacallan		h--;
33481c68cf8Smacallan	}
33581c68cf8Smacallan}
33681c68cf8Smacallan
33781c68cf8Smacallan/*
33881c68cf8Smacallan * copy with same alignment, left to right, ROP
33981c68cf8Smacallan */
34081c68cf8Smacallanstatic void
34172fd264fSmacallanCG14Copy8_aligned_rop(Cg14Ptr p, int srcstart, int dststart, int w, int h,
34272fd264fSmacallan    int srcpitch, int dstpitch)
34381c68cf8Smacallan{
34481c68cf8Smacallan	int saddr, daddr, pre, cnt, wrds;
34581c68cf8Smacallan
34681c68cf8Smacallan	ENTER;
34781c68cf8Smacallan
34881c68cf8Smacallan	pre = srcstart & 3;
34981c68cf8Smacallan	if (pre != 0) pre = 4 - pre;
35081c68cf8Smacallan	pre = min(pre, w);
35181c68cf8Smacallan
35281c68cf8Smacallan	while (h > 0) {
35381c68cf8Smacallan		saddr = srcstart;
35481c68cf8Smacallan		daddr = dststart;
35581c68cf8Smacallan		cnt = w;
35681c68cf8Smacallan		if (pre > 0) {
35772fd264fSmacallan			sxm(SX_LDB, saddr, 8, pre - 1);
35872fd264fSmacallan			sxm(SX_LDB, daddr, 40, pre - 1);
359230e26c7Smacallan			sxi(SX_ROP, 8, 40, 72, pre - 1);
36072fd264fSmacallan			sxm(SX_STB, daddr, 72, pre - 1);
36181c68cf8Smacallan			saddr += pre;
36281c68cf8Smacallan			daddr += pre;
36381c68cf8Smacallan			cnt -= pre;
36481c68cf8Smacallan			if (cnt == 0) goto next;
36581c68cf8Smacallan		}
36681c68cf8Smacallan		while (cnt > 3) {
36781c68cf8Smacallan			wrds = min(32, cnt >> 2);
36872fd264fSmacallan			sxm(SX_LD, saddr, 8, wrds - 1);
36972fd264fSmacallan			sxm(SX_LD, daddr, 40, wrds - 1);
37081c68cf8Smacallan			if (cnt > 16) {
371230e26c7Smacallan				sxi(SX_ROP, 8, 40, 72, 15);
372230e26c7Smacallan				sxi(SX_ROP, 8, 56, 88, wrds - 17);
37381c68cf8Smacallan			} else
374230e26c7Smacallan				sxi(SX_ROP, 8, 40, 72, wrds - 1);
37572fd264fSmacallan			sxm(SX_ST, daddr, 72, wrds - 1);
37681c68cf8Smacallan			saddr += wrds << 2;
37781c68cf8Smacallan			daddr += wrds << 2;
37881c68cf8Smacallan			cnt -= wrds << 2;
37981c68cf8Smacallan		}
38081c68cf8Smacallan		if (cnt > 0) {
38172fd264fSmacallan			sxm(SX_LDB, saddr, 8, cnt - 1);
38272fd264fSmacallan			sxm(SX_LDB, daddr, 40, cnt - 1);
383230e26c7Smacallan			sxi(SX_ROP, 8, 40, 72, cnt - 1);
38472fd264fSmacallan			sxm(SX_STB, daddr, 72, cnt - 1);
38581c68cf8Smacallan		}
38681c68cf8Smacallannext:
38781c68cf8Smacallan		srcstart += srcpitch;
38881c68cf8Smacallan		dststart += dstpitch;
38981c68cf8Smacallan		h--;
39081c68cf8Smacallan	}
39181c68cf8Smacallan}
39281c68cf8Smacallan
393f787bc61Smacallan/* up to 124 pixels so direction doesn't matter, unaligned, ROP */
394f787bc61Smacallanstatic void
395f787bc61SmacallanCG14Copy8_short_rop(Cg14Ptr p, int srcstart, int dststart, int w, int h, int srcpitch, int dstpitch)
396f787bc61Smacallan{
397f787bc61Smacallan	int saddr, daddr, pre, dist, wrds, swrds, spre, sreg, restaddr, post;
3989d7fb28bSmacallan	int ssreg;
399f787bc61Smacallan#ifdef DEBUG
400f787bc61Smacallan	int taddr = 4 + dstpitch * 50;
401f787bc61Smacallan#endif
402f787bc61Smacallan	uint32_t lmask, rmask;
403f787bc61Smacallan	ENTER;
404f787bc61Smacallan
405f787bc61Smacallan	pre = dststart & 3;
406f787bc61Smacallan	lmask = 0xffffffff >> pre;
407f787bc61Smacallan	spre = srcstart & 3;
408f787bc61Smacallan	/*
409f787bc61Smacallan	 * make sure we count all the words needed to cover the destination
410f787bc61Smacallan	 * line, covering potential partials on both ends
411f787bc61Smacallan	 */
412f787bc61Smacallan	wrds = (w + pre + 3) >> 2;
413f787bc61Smacallan	swrds = (w + spre + 3) >> 2;
414f787bc61Smacallan
415f787bc61Smacallan	if (spre < pre) {
416f787bc61Smacallan		dist = 32 - (pre - spre) * 8;
417f787bc61Smacallan		sreg = 9;
418f787bc61Smacallan	} else {
419f787bc61Smacallan		dist = (spre - pre) * 8;
420f787bc61Smacallan		sreg = 8;
421f787bc61Smacallan	}
422f787bc61Smacallan
423f787bc61Smacallan	/*
424f787bc61Smacallan	 * mask out trailing pixels to avoid partial writes
425f787bc61Smacallan	 */
426f787bc61Smacallan	post = (dststart + w) & 3;
42776a85281Smacallan	if (post != 0) {
42876a85281Smacallan		rmask = ~(0xffffffff >> (post * 8));
42976a85281Smacallan		write_sx_reg(p, SX_QUEUED(7), rmask);
43076a85281Smacallan		write_sx_reg(p, SX_QUEUED(6), ~rmask);
43176a85281Smacallan	}
43276a85281Smacallan
433f787bc61Smacallan	DPRINTF(X_ERROR, "%s %d %d, %d %d %08x %d %d %d %d %08x\n", __func__,
434f787bc61Smacallan	    w, h, spre, pre, lmask, dist, sreg, wrds, post, rmask);
435f787bc61Smacallan
436f787bc61Smacallan	/* mask out the leading pixels in dst by using a mask and ROP */
43776a85281Smacallan	if (pre != 0) {
438c1537409Smacallan		CG14Wait(p);
43976a85281Smacallan		write_sx_reg(p, SX_ROP_CONTROL, (p->last_rop & 0xf0) | 0xa);
44076a85281Smacallan		write_sx_reg(p, SX_QUEUED(R_MASK), 0xffffffff);
44176a85281Smacallan	}
442f787bc61Smacallan
443f787bc61Smacallan	saddr = srcstart & ~3;
444f787bc61Smacallan	daddr = dststart & ~3;
44576a85281Smacallan
446f787bc61Smacallan	while (h > 0) {
44772fd264fSmacallan		sxm(SX_LD, daddr, 80, wrds - 1);
44872fd264fSmacallan		sxm(SX_LD, saddr, sreg, swrds - 1);
449f787bc61Smacallan		if (wrds > 15) {
4509d7fb28bSmacallan			if (dist != 0) {
451230e26c7Smacallan				sxi(SX_FUNNEL_I, 8, dist, 40, 15);
452230e26c7Smacallan				sxi(SX_FUNNEL_I, 24, dist, 56, wrds - 16);
4539d7fb28bSmacallan				/* shifted source pixels are now at register 40+ */
4549d7fb28bSmacallan				ssreg = 40;
4559d7fb28bSmacallan			} else ssreg = 8;
456f787bc61Smacallan			if (pre != 0) {
457f787bc61Smacallan				/* mask out leading junk */
458f787bc61Smacallan				write_sx_reg(p, SX_QUEUED(R_MASK), lmask);
459230e26c7Smacallan				sxi(SX_ROPB, ssreg, 80, 8, 0);
460f787bc61Smacallan				write_sx_reg(p, SX_QUEUED(R_MASK), 0xffffffff);
461230e26c7Smacallan				sxi(SX_ROPB, ssreg + 1, 81, 9, 14);
462f787bc61Smacallan			} else {
463230e26c7Smacallan				sxi(SX_ROPB, ssreg, 80, 8, 15);
464f787bc61Smacallan			}
465230e26c7Smacallan			sxi(SX_ROPB, ssreg + 16, 96, 24, wrds - 16);
466f787bc61Smacallan		} else {
4679d7fb28bSmacallan			if (dist != 0) {
468230e26c7Smacallan				sxi(SX_FUNNEL_I, 8, dist, 40, wrds);
4699d7fb28bSmacallan				ssreg = 40;
4709d7fb28bSmacallan			} else ssreg = 8;
471f787bc61Smacallan			if (pre != 0) {
472f787bc61Smacallan				/* mask out leading junk */
473f787bc61Smacallan				write_sx_reg(p, SX_QUEUED(R_MASK), lmask);
474230e26c7Smacallan				sxi(SX_ROPB, ssreg, 80, 8, 0);
475f787bc61Smacallan				write_sx_reg(p, SX_QUEUED(R_MASK), 0xffffffff);
476230e26c7Smacallan				sxi(SX_ROPB, ssreg + 1, 81, 9, wrds);
477f787bc61Smacallan			} else {
478230e26c7Smacallan				sxi(SX_ROPB, ssreg, 80, 8, wrds);
479f787bc61Smacallan			}
480f787bc61Smacallan		}
481f787bc61Smacallan		if (post != 0) {
482f787bc61Smacallan			/*
483f787bc61Smacallan			 * if the last word to be written out is a partial we
484f787bc61Smacallan			 * mask out the leftovers and replace them with
485f787bc61Smacallan			 * background pixels
486f787bc61Smacallan			 * we could pull the same ROP * mask trick as we do on
487f787bc61Smacallan			 * the left end but it's less annoying this way and
488f787bc61Smacallan			 * the instruction count is the same
489f787bc61Smacallan			 */
490230e26c7Smacallan			sxi(SX_ANDS, 7 + wrds, 7, 5, 0);
491230e26c7Smacallan			sxi(SX_ANDS, 79 + wrds, 6, 4, 0);
492230e26c7Smacallan			sxi(SX_ORS, 5, 4, 7 + wrds, 0);
493f787bc61Smacallan		}
494f787bc61Smacallan#ifdef DEBUG
49572fd264fSmacallan		sxm(SX_ST, taddr, 40, wrds - 1);
496f787bc61Smacallan		taddr += dstpitch;
497f787bc61Smacallan#endif
49872fd264fSmacallan		sxm(SX_ST, daddr, 8, wrds - 1);
499f787bc61Smacallan		saddr += srcpitch;
500f787bc61Smacallan		daddr += dstpitch;
501f787bc61Smacallan		h--;
502f787bc61Smacallan	}
503f787bc61Smacallan}
504f787bc61Smacallan
50576a85281Smacallan/* up to 124 pixels so direction doesn't matter, unaligned, straight copy */
50676a85281Smacallanstatic void
50772fd264fSmacallanCG14Copy8_short_norop(Cg14Ptr p, int srcstart, int dststart, int w, int h,
50872fd264fSmacallan    int srcpitch, int dstpitch)
50976a85281Smacallan{
51076a85281Smacallan	int saddr, daddr, pre, dist, wrds, swrds, spre, sreg, restaddr, post;
51176a85281Smacallan	int ssreg;
51276a85281Smacallan#ifdef DEBUG
51376a85281Smacallan	int taddr = 4 + dstpitch * 50;
51476a85281Smacallan#endif
51576a85281Smacallan	uint32_t lmask, rmask;
51676a85281Smacallan	ENTER;
51776a85281Smacallan
51876a85281Smacallan	pre = dststart & 3;
51976a85281Smacallan	lmask = 0xffffffff >> pre;
52076a85281Smacallan	spre = srcstart & 3;
52176a85281Smacallan	/*
52276a85281Smacallan	 * make sure we count all the words needed to cover the destination
52376a85281Smacallan	 * line, covering potential partials on both ends
52476a85281Smacallan	 */
52576a85281Smacallan	wrds = (w + pre + 3) >> 2;
52676a85281Smacallan	swrds = (w + spre + 3) >> 2;
52776a85281Smacallan
52876a85281Smacallan	if (spre < pre) {
52976a85281Smacallan		dist = 32 - (pre - spre) * 8;
53076a85281Smacallan		sreg = 9;
53176a85281Smacallan	} else {
53276a85281Smacallan		dist = (spre - pre) * 8;
53376a85281Smacallan		sreg = 8;
53476a85281Smacallan	}
53576a85281Smacallan
53676a85281Smacallan	/*
53776a85281Smacallan	 * mask out trailing pixels to avoid partial writes
53876a85281Smacallan	 */
53976a85281Smacallan	post = (dststart + w) & 3;
54076a85281Smacallan	if (post != 0) {
54176a85281Smacallan		rmask = ~(0xffffffff >> (post * 8));
54276a85281Smacallan		write_sx_reg(p, SX_QUEUED(7), rmask);
54376a85281Smacallan		write_sx_reg(p, SX_QUEUED(6), ~rmask);
54476a85281Smacallan	}
54576a85281Smacallan
54676a85281Smacallan	DPRINTF(X_ERROR, "%s %d %d, %d %d %08x %d %d %d %d %08x\n", __func__,
54776a85281Smacallan	    w, h, spre, pre, lmask, dist, sreg, wrds, post, rmask);
54876a85281Smacallan
54976a85281Smacallan	/* mask out the leading pixels in dst by using a mask and ROP */
55076a85281Smacallan	if (pre != 0) {
551c1537409Smacallan		CG14Wait(p);
55276a85281Smacallan		write_sx_reg(p, SX_ROP_CONTROL, 0xca);
55376a85281Smacallan		write_sx_reg(p, SX_QUEUED(R_MASK), lmask);
55476a85281Smacallan	}
55576a85281Smacallan
55676a85281Smacallan	saddr = srcstart & ~3;
55776a85281Smacallan	daddr = dststart & ~3;
55876a85281Smacallan
55976a85281Smacallan	while (h > 0) {
56072fd264fSmacallan		sxm(SX_LD, saddr, sreg, swrds - 1);
56176a85281Smacallan		if (wrds > 15) {
56276a85281Smacallan			if (dist != 0) {
563230e26c7Smacallan				sxi(SX_FUNNEL_I, 8, dist, 40, 15);
564230e26c7Smacallan				sxi(SX_FUNNEL_I, 24, dist, 56, wrds - 16);
56572fd264fSmacallan				/* shifted source pixels are now at reg 40+ */
56676a85281Smacallan				ssreg = 40;
56776a85281Smacallan			} else ssreg = 8;
56876a85281Smacallan			if (pre != 0) {
56976a85281Smacallan				/* read only the first word */
57072fd264fSmacallan				sxm(SX_LD, daddr, 80, 0);
57176a85281Smacallan				/* mask out leading junk */
572230e26c7Smacallan				sxi(SX_ROPB, ssreg, 80, ssreg, 0);
57376a85281Smacallan			}
57476a85281Smacallan		} else {
57576a85281Smacallan			if (dist != 0) {
576230e26c7Smacallan				sxi(SX_FUNNEL_I, 8, dist, 40, wrds);
57776a85281Smacallan				ssreg = 40;
57876a85281Smacallan			} else ssreg = 8;
57976a85281Smacallan			if (pre != 0) {
58076a85281Smacallan				/* read only the first word */
58172fd264fSmacallan				sxm(SX_LD, daddr, 80, 0);
58276a85281Smacallan				/* mask out leading junk */
583230e26c7Smacallan				sxi(SX_ROPB, ssreg, 80, ssreg, 0);
58476a85281Smacallan			}
58576a85281Smacallan		}
58676a85281Smacallan		if (post != 0) {
58776a85281Smacallan			int laddr = daddr + ((wrds - 1) << 2);
58876a85281Smacallan			/*
58976a85281Smacallan			 * if the last word to be written out is a partial we
59076a85281Smacallan			 * mask out the leftovers and replace them with
59176a85281Smacallan			 * background pixels
59276a85281Smacallan			 * we could pull the same ROP * mask trick as we do on
59376a85281Smacallan			 * the left end but it's less annoying this way and
59476a85281Smacallan			 * the instruction count is the same
59576a85281Smacallan			 */
59672fd264fSmacallan			sxm(SX_LD, laddr, 81, 0);
597230e26c7Smacallan			sxi(SX_ANDS, ssreg + wrds - 1, 7, 5, 0);
598230e26c7Smacallan			sxi(SX_ANDS, 81, 6, 4, 0);
599230e26c7Smacallan			sxi(SX_ORS, 5, 4, ssreg + wrds - 1, 0);
60076a85281Smacallan		}
60176a85281Smacallan#ifdef DEBUG
60272fd264fSmacallan		sxm(SX_ST, taddr, 40, wrds - 1);
60376a85281Smacallan		taddr += dstpitch;
60476a85281Smacallan#endif
60572fd264fSmacallan		sxm(SX_ST, daddr, ssreg, wrds - 1);
60676a85281Smacallan		saddr += srcpitch;
60776a85281Smacallan		daddr += dstpitch;
60876a85281Smacallan		h--;
60976a85281Smacallan	}
61076a85281Smacallan}
61176a85281Smacallan
612f71acd79Smacallanstatic void
613f71acd79SmacallanCG14Copy8(PixmapPtr pDstPixmap,
614f71acd79Smacallan         int srcX, int srcY, int dstX, int dstY, int w, int h)
615f71acd79Smacallan{
616f71acd79Smacallan	ScrnInfoPtr pScrn = xf86Screens[pDstPixmap->drawable.pScreen->myNum];
617f71acd79Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
618f71acd79Smacallan	int dstpitch, dstoff, srcpitch, srcoff;
619f71acd79Smacallan	int srcstart, dststart, xinc, srcinc, dstinc;
620f71acd79Smacallan	int line, count, s, d, num;
621f71acd79Smacallan
622f71acd79Smacallan	ENTER;
623f71acd79Smacallan	dstpitch = exaGetPixmapPitch(pDstPixmap);
624f71acd79Smacallan	dstoff = exaGetPixmapOffset(pDstPixmap);
625f71acd79Smacallan	srcpitch = p->srcpitch;
626f71acd79Smacallan	srcoff = p->srcoff;
627f71acd79Smacallan	/*
628f71acd79Smacallan	 * should clear the WO bit in SX_CONTROL_STATUS, then check if SX
629f71acd79Smacallan	 * actually wrote anything and only sync if it did
630f71acd79Smacallan	 */
631f71acd79Smacallan	srcstart = srcX + (srcpitch * srcY) + srcoff;
632f71acd79Smacallan	dststart = dstX + (dstpitch * dstY) + dstoff;
633f71acd79Smacallan
634f71acd79Smacallan	if (p->ydir < 0) {
635f71acd79Smacallan		srcstart += (h - 1) * srcpitch;
636f71acd79Smacallan		dststart += (h - 1) * dstpitch;
637f71acd79Smacallan		srcinc = -srcpitch;
638f71acd79Smacallan		dstinc = -dstpitch;
639f71acd79Smacallan	} else {
640f71acd79Smacallan		srcinc = srcpitch;
641f71acd79Smacallan		dstinc = dstpitch;
642f71acd79Smacallan	}
643f787bc61Smacallan
644f787bc61Smacallan	/*
645f787bc61Smacallan	 * this copies up to 124 pixels wide in one go, so horizontal
646f787bc61Smacallan	 * direction / overlap don't matter
647f787bc61Smacallan	 * uses all 32bit accesses and funnel shifter for unaligned copies
648f787bc61Smacallan	 */
649f787bc61Smacallan	if ((w < 125) && (w > 8)) {
65076a85281Smacallan		switch (p->last_rop) {
65176a85281Smacallan			case 0xcc:
65272fd264fSmacallan				CG14Copy8_short_norop(p,
65372fd264fSmacallan				    srcstart, dststart, w, h, srcinc, dstinc);
65476a85281Smacallan				break;
65576a85281Smacallan			default:
65672fd264fSmacallan				CG14Copy8_short_rop(p,
65772fd264fSmacallan				    srcstart, dststart, w, h, srcinc, dstinc);
65876a85281Smacallan		}
659f787bc61Smacallan		return;
660f787bc61Smacallan	}
661f787bc61Smacallan
662f787bc61Smacallan	/*
663f787bc61Smacallan	 * only invert x direction if absolutely necessary, it's a pain to
664f787bc61Smacallan	 * go backwards on SX so avoid as much as possible
665f787bc61Smacallan	 */
666f787bc61Smacallan	if ((p->xdir < 0) && (srcoff == dstoff) && (srcY == dstY)) {
667f787bc61Smacallan		xinc = -32;
668f787bc61Smacallan	} else
669f787bc61Smacallan		xinc = 32;
670f787bc61Smacallan
671f787bc61Smacallan	/*
672f787bc61Smacallan	 * for aligned copies we can go all 32bit and avoid VRAM reads in the
673f787bc61Smacallan	 * most common case
674f787bc61Smacallan	 */
67581c68cf8Smacallan	if (((srcstart & 3) == (dststart & 3)) && (xinc > 0)) {
67681c68cf8Smacallan		switch (p->last_rop) {
67781c68cf8Smacallan			case 0xcc:
67872fd264fSmacallan				CG14Copy8_aligned_norop(p,
67972fd264fSmacallan				    srcstart, dststart, w, h, srcinc, dstinc);
68081c68cf8Smacallan				break;
68181c68cf8Smacallan			default:
68272fd264fSmacallan				CG14Copy8_aligned_rop(p,
68372fd264fSmacallan				    srcstart, dststart, w, h, srcinc, dstinc);
68481c68cf8Smacallan		}
68581c68cf8Smacallan		return;
68681c68cf8Smacallan	}
687f787bc61Smacallan
68886527ef6Smacallan	/*
68986527ef6Smacallan	 * if we make it here we either have something large and unaligned,
69086527ef6Smacallan	 * something we need to do right to left, or something tiny.
69186527ef6Smacallan	 * we handle the non-tiny cases by breaking them down into chunks that
69286527ef6Smacallan	 * Copy8_short_*() can handle, making sure the destinations are 32bit
69386527ef6Smacallan	 * aligned whenever possible
69486527ef6Smacallan	 * since we copy by block, not by line we need to go backwards even if
69586527ef6Smacallan	 * we don't copy within the same line
69686527ef6Smacallan	 */
69786527ef6Smacallan	if (w > 8) {
69886527ef6Smacallan		int next, wi, end = dststart + w;
69972fd264fSmacallan		DPRINTF(X_ERROR, "%s %08x %08x %d\n",
70072fd264fSmacallan		    __func__, srcstart, dststart, w);
70186527ef6Smacallan		if ((p->xdir < 0) && (srcoff == dstoff)) {
70286527ef6Smacallan			srcstart += w;
70386527ef6Smacallan			next = max((end - 120) & ~3, dststart);
70486527ef6Smacallan			wi = end - next;
70586527ef6Smacallan			srcstart -= wi;
70686527ef6Smacallan			while (wi > 0) {
70772fd264fSmacallan				DPRINTF(X_ERROR, "%s RL %08x %08x %d\n",
70872fd264fSmacallan				    __func__, srcstart, next, wi);
70986527ef6Smacallan				if (p->last_rop == 0xcc) {
71072fd264fSmacallan					CG14Copy8_short_norop(p, srcstart,
71172fd264fSmacallan					    next, wi, h, srcinc, dstinc);
71286527ef6Smacallan				} else
71372fd264fSmacallan					CG14Copy8_short_rop(p, srcstart,
71472fd264fSmacallan					    next, wi, h, srcinc, dstinc);
71586527ef6Smacallan				end = next;
71686527ef6Smacallan				/*
71786527ef6Smacallan				 * avoid extremely narrow copies so I don't
71886527ef6Smacallan				 * have to deal with dangling start and end
71986527ef6Smacallan				 * pixels in the same word
72086527ef6Smacallan				 */
72186527ef6Smacallan				if ((end - dststart) < 140) {
72286527ef6Smacallan					next = max((end - 80) & ~3, dststart);
72386527ef6Smacallan				} else {
72486527ef6Smacallan					next = max((end - 120) & ~3, dststart);
72586527ef6Smacallan				}
72686527ef6Smacallan				wi = end - next;
72786527ef6Smacallan				srcstart -= wi;
72886527ef6Smacallan			}
72986527ef6Smacallan		} else {
73086527ef6Smacallan			next = min(end, (dststart + 124) & ~3);
73186527ef6Smacallan			wi = next - dststart;
73286527ef6Smacallan			while (wi > 0) {
73372fd264fSmacallan				DPRINTF(X_ERROR, "%s LR %08x %08x %d\n",
73472fd264fSmacallan				    __func__, srcstart, next, wi);
73586527ef6Smacallan				if (p->last_rop == 0xcc) {
73672fd264fSmacallan					CG14Copy8_short_norop(p,
73772fd264fSmacallan					    srcstart, dststart, wi, h,
73872fd264fSmacallan					    srcinc, dstinc);
73986527ef6Smacallan				} else
74072fd264fSmacallan					CG14Copy8_short_rop(p,
74172fd264fSmacallan					    srcstart, dststart, wi, h,
74272fd264fSmacallan					    srcinc, dstinc);
74386527ef6Smacallan				srcstart += wi;
74486527ef6Smacallan				dststart = next;
74586527ef6Smacallan				if ((end - dststart) < 140) {
74686527ef6Smacallan					next = min(end, (dststart + 84) & ~3);
74786527ef6Smacallan				} else {
74886527ef6Smacallan					next = min(end, (dststart + 124) & ~3);
74986527ef6Smacallan				}
75086527ef6Smacallan				wi = next - dststart;
75186527ef6Smacallan			}
75286527ef6Smacallan		}
75386527ef6Smacallan		return;
75486527ef6Smacallan	}
75586527ef6Smacallan	if (xinc < 0) {
75686527ef6Smacallan		srcstart += (w - 32);
75786527ef6Smacallan		dststart += (w - 32);
75886527ef6Smacallan	}
75986527ef6Smacallan
76086527ef6Smacallan	DPRINTF(X_ERROR, "%s fallback to byte-wise %d %d\n", __func__, w, h);
761f71acd79Smacallan	if (p->last_rop == 0xcc) {
762f71acd79Smacallan		/* plain old copy */
763f71acd79Smacallan		if ( xinc > 0) {
764f71acd79Smacallan			/* going left to right */
765f71acd79Smacallan			for (line = 0; line < h; line++) {
766f71acd79Smacallan				count = 0;
767f71acd79Smacallan				s = srcstart;
768f71acd79Smacallan				d = dststart;
769f71acd79Smacallan				while ( count < w) {
770f71acd79Smacallan					num = min(32, w - count);
77172fd264fSmacallan					sxm(SX_LDB, s, 10, num - 1);
77272fd264fSmacallan					sxm(SX_STBM, d, 10, num - 1);
773f71acd79Smacallan					s += xinc;
774f71acd79Smacallan					d += xinc;
775f71acd79Smacallan					count += 32;
776f71acd79Smacallan				}
777f71acd79Smacallan				srcstart += srcinc;
778f71acd79Smacallan				dststart += dstinc;
779f71acd79Smacallan			}
780f71acd79Smacallan		} else {
781f71acd79Smacallan			/* going right to left */
782f71acd79Smacallan			int i, chunks = (w >> 5);
783f71acd79Smacallan			for (line = 0; line < h; line++) {
784f71acd79Smacallan				s = srcstart;
785f71acd79Smacallan				d = dststart;
786f71acd79Smacallan				count = w;
787f71acd79Smacallan				for (i = 0; i < chunks; i++) {
78872fd264fSmacallan					sxm(SX_LDB, s, 10, 31);
78972fd264fSmacallan					sxm(SX_STBM, d, 10, 31);
790f71acd79Smacallan					s -= 32;
791f71acd79Smacallan					d -= 32;
792f71acd79Smacallan					count -= 32;
793f71acd79Smacallan				}
794f71acd79Smacallan				/* leftovers, if any */
795f71acd79Smacallan				if (count > 0) {
796f71acd79Smacallan					s += (32 - count);
797f71acd79Smacallan					d += (32 - count);
79872fd264fSmacallan					sxm(SX_LDB, s, 10, count - 1);
79972fd264fSmacallan					sxm(SX_STBM, d, 10, count - 1);
800f71acd79Smacallan				}
801f71acd79Smacallan				srcstart += srcinc;
802f71acd79Smacallan				dststart += dstinc;
803f71acd79Smacallan			}
804f71acd79Smacallan		}
805f71acd79Smacallan	} else {
806f71acd79Smacallan		/* ROPs needed */
807f71acd79Smacallan		if ( xinc > 0) {
808f71acd79Smacallan			/* going left to right */
809f71acd79Smacallan			for (line = 0; line < h; line++) {
810f71acd79Smacallan				count = 0;
811f71acd79Smacallan				s = srcstart;
812f71acd79Smacallan				d = dststart;
813f71acd79Smacallan				while ( count < w) {
814f71acd79Smacallan					num = min(32, w - count);
81572fd264fSmacallan					sxm(SX_LDB, s, 10, num - 1);
81672fd264fSmacallan					sxm(SX_LDB, d, 42, num - 1);
817f71acd79Smacallan					if (num > 16) {
818230e26c7Smacallan						sxi(SX_ROP, 10, 42, 74, 15);
819230e26c7Smacallan						sxi(SX_ROP, 26, 58, 90, num - 17);
820f71acd79Smacallan					} else {
821230e26c7Smacallan						sxi(SX_ROP, 10, 42, 74, num - 1);
822f71acd79Smacallan					}
82372fd264fSmacallan					sxm(SX_STBM, d, 74, num - 1);
824f71acd79Smacallan					s += xinc;
825f71acd79Smacallan					d += xinc;
826f71acd79Smacallan					count += 32;
827f71acd79Smacallan				}
828f71acd79Smacallan				srcstart += srcinc;
829f71acd79Smacallan				dststart += dstinc;
830f71acd79Smacallan			}
831f71acd79Smacallan		} else {
832f71acd79Smacallan			/* going right to left */
833f71acd79Smacallan			int i, chunks = (w >> 5);
834f71acd79Smacallan			for (line = 0; line < h; line++) {
835f71acd79Smacallan				s = srcstart;
836f71acd79Smacallan				d = dststart;
837f71acd79Smacallan				count = w;
838f71acd79Smacallan				for (i = 0; i < chunks; i++) {
83972fd264fSmacallan					sxm(SX_LDB, s, 10, 31);
84072fd264fSmacallan					sxm(SX_LDB, d, 42, 31);
841230e26c7Smacallan					sxi(SX_ROP, 10, 42, 74, 15);
842230e26c7Smacallan					sxi(SX_ROP, 26, 58, 90, 15);
84372fd264fSmacallan					sxm(SX_STBM, d, 74, 31);
844f71acd79Smacallan					s -= 128;
845f71acd79Smacallan					d -= 128;
846f71acd79Smacallan					count -= 32;
847f71acd79Smacallan				}
848f71acd79Smacallan				/* leftovers, if any */
849f71acd79Smacallan				if (count > 0) {
850f71acd79Smacallan					s += (32 - count);
851f71acd79Smacallan					d += (32 - count);
85272fd264fSmacallan					sxm(SX_LDB, s, 10, count - 1);
85372fd264fSmacallan					sxm(SX_LDB, d, 42, count - 1);
854f71acd79Smacallan					if (count > 16) {
855230e26c7Smacallan						sxi(SX_ROP, 10, 42, 74, 15);
856230e26c7Smacallan						sxi(SX_ROP, 26, 58, 90, count - 17);
857f71acd79Smacallan					} else {
858230e26c7Smacallan						sxi(SX_ROP, 10, 42, 74, count - 1);
859f71acd79Smacallan					}
86072fd264fSmacallan					sxm(SX_STBM, d, 74, count - 1);
861f71acd79Smacallan				}
862f71acd79Smacallan				srcstart += srcinc;
863f71acd79Smacallan				dststart += dstinc;
864f71acd79Smacallan			}
865f71acd79Smacallan		}
866f71acd79Smacallan	}
867f71acd79Smacallan	exaMarkSync(pDstPixmap->drawable.pScreen);
868f71acd79Smacallan}
869f71acd79Smacallan
8704261fa58Smacallanstatic void
8714261fa58SmacallanCG14DoneCopy(PixmapPtr pDstPixmap)
8724261fa58Smacallan{
8734261fa58Smacallan}
8744261fa58Smacallan
8754261fa58Smacallanstatic Bool
8764261fa58SmacallanCG14PrepareSolid(PixmapPtr pPixmap, int alu, Pixel planemask, Pixel fg)
8774261fa58Smacallan{
8784261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pPixmap->drawable.pScreen->myNum];
8794261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
8804261fa58Smacallan
8814261fa58Smacallan	ENTER;
882faf11d72Schristos	DPRINTF(X_ERROR, "bits per pixel: %d %08lx\n",
883b8ad197aSmacallan	    pPixmap->drawable.bitsPerPixel, fg);
884b8ad197aSmacallan
885dbf8597cSmacallan	/*
886dbf8597cSmacallan	 * GXset and GXclear are really just specual cases of GXcopy with
887dbf8597cSmacallan	 * fixed fill colour
888dbf8597cSmacallan	 */
889dbf8597cSmacallan	switch (alu) {
890dbf8597cSmacallan		case GXclear:
891dbf8597cSmacallan			alu = GXcopy;
892dbf8597cSmacallan			fg = 0;
893dbf8597cSmacallan			break;
894dbf8597cSmacallan		case GXset:
895dbf8597cSmacallan			alu = GXcopy;
896dbf8597cSmacallan			fg = 0xffffffff;
897dbf8597cSmacallan			break;
898dbf8597cSmacallan	}
899b8ad197aSmacallan	/* repeat the colour in every sub byte if we're in 8 bit */
900b8ad197aSmacallan	if (pPixmap->drawable.bitsPerPixel == 8) {
901b8ad197aSmacallan		fg |= fg << 8;
902b8ad197aSmacallan		fg |= fg << 16;
903b8ad197aSmacallan	}
9044261fa58Smacallan	write_sx_reg(p, SX_QUEUED(8), fg);
9054261fa58Smacallan	write_sx_reg(p, SX_QUEUED(9), fg);
9064261fa58Smacallan	if (planemask != p->last_mask) {
9074261fa58Smacallan		CG14Wait(p);
9084261fa58Smacallan		write_sx_reg(p, SX_PLANEMASK, planemask);
9094261fa58Smacallan		p->last_mask = planemask;
9104261fa58Smacallan	}
9114261fa58Smacallan	alu = sx_rop[alu];
9124261fa58Smacallan	if (alu != p->last_rop) {
9134261fa58Smacallan		CG14Wait(p);
9144261fa58Smacallan		write_sx_reg(p, SX_ROP_CONTROL, alu);
9154261fa58Smacallan		p->last_rop = alu;
9164261fa58Smacallan	}
917dbf8597cSmacallan
9184261fa58Smacallan	DPRINTF(X_ERROR, "%s: %x\n", __func__, alu);
9194261fa58Smacallan	return TRUE;
9204261fa58Smacallan}
9214261fa58Smacallan
9224261fa58Smacallanstatic void
9234261fa58SmacallanCG14Solid32(Cg14Ptr p, uint32_t start, uint32_t pitch, int w, int h)
9244261fa58Smacallan{
9254261fa58Smacallan	int line, x, num;
9264261fa58Smacallan	uint32_t ptr;
9274261fa58Smacallan
9284261fa58Smacallan	ENTER;
9294261fa58Smacallan	if (p->last_rop == 0xcc) {
9304261fa58Smacallan		/* simple fill */
9314261fa58Smacallan		for (line = 0; line < h; line++) {
9324261fa58Smacallan			x = 0;
9334261fa58Smacallan			while (x < w) {
9344261fa58Smacallan				ptr = start + (x << 2);
9354261fa58Smacallan				num = min(32, w - x);
93672fd264fSmacallan				sxm(SX_STS, ptr, 8, num - 1);
9374261fa58Smacallan				x += 32;
9384261fa58Smacallan			}
9394261fa58Smacallan			start += pitch;
9404261fa58Smacallan		}
9414261fa58Smacallan	} else if (p->last_rop == 0xaa) {
9424261fa58Smacallan		/* nothing to do here */
9434261fa58Smacallan		return;
9444261fa58Smacallan	} else {
9454261fa58Smacallan		/* alright, let's do actual ROP stuff */
9464261fa58Smacallan
9474261fa58Smacallan		/* first repeat the fill colour into 16 registers */
948230e26c7Smacallan		sxi(SX_SELECT_S, 8, 8, 10, 15);
9494261fa58Smacallan
9504261fa58Smacallan		for (line = 0; line < h; line++) {
9514261fa58Smacallan			x = 0;
9524261fa58Smacallan			while (x < w) {
9534261fa58Smacallan				ptr = start + (x << 2);
9544261fa58Smacallan				num = min(32, w - x);
9554261fa58Smacallan				/* now suck fb data into registers */
95672fd264fSmacallan				sxm(SX_LD, ptr, 42, num - 1);
9574261fa58Smacallan				/*
9584261fa58Smacallan				 * ROP them with the fill data we left in 10
9594261fa58Smacallan				 * non-memory ops can only have counts up to 16
9604261fa58Smacallan				 */
9614261fa58Smacallan				if (num <= 16) {
962230e26c7Smacallan					sxi(SX_ROP, 10, 42, 74, num - 1);
9634261fa58Smacallan				} else {
964230e26c7Smacallan					sxi(SX_ROP, 10, 42, 74, 15);
965230e26c7Smacallan					sxi(SX_ROP, 10, 58, 90, num - 17);
9664261fa58Smacallan				}
9674261fa58Smacallan				/* and write the result back into memory */
96872fd264fSmacallan				sxm(SX_ST, ptr, 74, num - 1);
9694261fa58Smacallan				x += 32;
9704261fa58Smacallan			}
9714261fa58Smacallan			start += pitch;
9724261fa58Smacallan		}
9734261fa58Smacallan	}
9744261fa58Smacallan}
9754261fa58Smacallan
9764261fa58Smacallanstatic void
9774261fa58SmacallanCG14Solid8(Cg14Ptr p, uint32_t start, uint32_t pitch, int w, int h)
9784261fa58Smacallan{
979dbf8597cSmacallan	int line, num, pre, cnt;
9804261fa58Smacallan	uint32_t ptr;
9814261fa58Smacallan
9824261fa58Smacallan	ENTER;
983b8ad197aSmacallan	pre = start & 3;
984b8ad197aSmacallan	if (pre != 0) pre = 4 - pre;
9854261fa58Smacallan
9864261fa58Smacallan	if (p->last_rop == 0xcc) {
9874261fa58Smacallan		/* simple fill */
9884261fa58Smacallan		for (line = 0; line < h; line++) {
989b8ad197aSmacallan			ptr = start;
990b8ad197aSmacallan			cnt = w;
991b46cab2aSmacallan			pre = min(pre, cnt);
992b8ad197aSmacallan			if (pre) {
99372fd264fSmacallan				sxm(SX_STBS, ptr, 8, pre - 1);
994b8ad197aSmacallan				ptr += pre;
995b8ad197aSmacallan				cnt -= pre;
996b46cab2aSmacallan				if (cnt == 0) goto next;
997b8ad197aSmacallan			}
998b8ad197aSmacallan			/* now do the aligned pixels in 32bit chunks */
999b8ad197aSmacallan			if (ptr & 3) xf86Msg(X_ERROR, "%s %x\n", __func__, ptr);
1000b8ad197aSmacallan			while(cnt > 3) {
1001b8ad197aSmacallan				num = min(32, cnt >> 2);
100272fd264fSmacallan				sxm(SX_STS, ptr, 8, num - 1);
1003b8ad197aSmacallan				ptr += num << 2;
1004b8ad197aSmacallan				cnt -= num << 2;
1005b8ad197aSmacallan			}
1006b8ad197aSmacallan			if (cnt > 3) xf86Msg(X_ERROR, "%s cnt %d\n", __func__, cnt);
1007b8ad197aSmacallan			if (cnt > 0) {
100872fd264fSmacallan				sxm(SX_STBS, ptr, 8, cnt - 1);
10094261fa58Smacallan			}
1010b8ad197aSmacallan			if ((ptr + cnt) != (start + w)) xf86Msg(X_ERROR, "%s %x vs %x\n", __func__, ptr + cnt, start + w);
1011b46cab2aSmacallannext:
10124261fa58Smacallan			start += pitch;
10134261fa58Smacallan		}
10144261fa58Smacallan	} else if (p->last_rop == 0xaa) {
10154261fa58Smacallan		/* nothing to do here */
10164261fa58Smacallan		return;
10174261fa58Smacallan	} else {
10184261fa58Smacallan		/* alright, let's do actual ROP stuff */
10194261fa58Smacallan
10204261fa58Smacallan		/* first repeat the fill colour into 16 registers */
1021230e26c7Smacallan		sxi(SX_SELECT_S, 8, 8, 10, 15);
10224261fa58Smacallan
10234261fa58Smacallan		for (line = 0; line < h; line++) {
1024dbf8597cSmacallan			ptr = start;
1025dbf8597cSmacallan			cnt = w;
1026dbf8597cSmacallan			pre = min(pre, cnt);
1027dbf8597cSmacallan			if (pre) {
102872fd264fSmacallan				sxm(SX_LDB, ptr, 26, pre - 1);
1029230e26c7Smacallan				sxi(SX_ROP, 10, 26, 42, pre - 1);
103072fd264fSmacallan				sxm(SX_STB, ptr, 42, pre - 1);
1031dbf8597cSmacallan				ptr += pre;
1032dbf8597cSmacallan				cnt -= pre;
1033dbf8597cSmacallan				if (cnt == 0) goto next2;
1034dbf8597cSmacallan			}
1035dbf8597cSmacallan			/* now do the aligned pixels in 32bit chunks */
1036dbf8597cSmacallan			if (ptr & 3) xf86Msg(X_ERROR, "%s %x\n", __func__, ptr);
1037dbf8597cSmacallan			while(cnt > 3) {
1038dbf8597cSmacallan				num = min(32, cnt >> 2);
103972fd264fSmacallan				sxm(SX_LD, ptr, 26, num - 1);
10404261fa58Smacallan				if (num <= 16) {
1041230e26c7Smacallan					sxi(SX_ROP, 10, 26, 58, num - 1);
10424261fa58Smacallan				} else {
1043230e26c7Smacallan					sxi(SX_ROP, 10, 26, 58, 15);
1044230e26c7Smacallan					sxi(SX_ROP, 10, 42, 74, num - 17);
10454261fa58Smacallan				}
104672fd264fSmacallan				sxm(SX_ST, ptr, 58, num - 1);
1047dbf8597cSmacallan				ptr += num << 2;
1048dbf8597cSmacallan				cnt -= num << 2;
10494261fa58Smacallan			}
1050dbf8597cSmacallan			if (cnt > 3) xf86Msg(X_ERROR, "%s cnt %d\n", __func__, cnt);
1051dbf8597cSmacallan			if (cnt > 0) {
105272fd264fSmacallan				sxm(SX_LDB, ptr, 26, cnt - 1);
1053230e26c7Smacallan				sxi(SX_ROP, 10, 26, 42, cnt - 1);
105472fd264fSmacallan				sxm(SX_STB, ptr, 42, cnt - 1);
1055dbf8597cSmacallan			}
1056dbf8597cSmacallan			if ((ptr + cnt) != (start + w)) xf86Msg(X_ERROR, "%s %x vs %x\n", __func__, ptr + cnt, start + w);
1057dbf8597cSmacallannext2:
10584261fa58Smacallan			start += pitch;
10594261fa58Smacallan		}
10604261fa58Smacallan	}
10614261fa58Smacallan}
10624261fa58Smacallan
10634261fa58Smacallanstatic void
10644261fa58SmacallanCG14Solid(PixmapPtr pPixmap, int x1, int y1, int x2, int y2)
10654261fa58Smacallan{
10664261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pPixmap->drawable.pScreen->myNum];
10674261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
10684261fa58Smacallan	int w = x2 - x1, h = y2 - y1, dstoff, dstpitch;
10694261fa58Smacallan	int start, depth;
10704261fa58Smacallan
10714261fa58Smacallan	ENTER;
10724261fa58Smacallan	dstpitch = exaGetPixmapPitch(pPixmap);
10734261fa58Smacallan	dstoff = exaGetPixmapOffset(pPixmap);
10744261fa58Smacallan
10754261fa58Smacallan	depth = pPixmap->drawable.bitsPerPixel;
10764261fa58Smacallan	switch (depth) {
10774261fa58Smacallan		case 32:
10784261fa58Smacallan			start = dstoff + (y1 * dstpitch) + (x1 << 2);
10794261fa58Smacallan			CG14Solid32(p, start, dstpitch, w, h);
10804261fa58Smacallan			break;
10814261fa58Smacallan		case 8:
10824261fa58Smacallan			start = dstoff + (y1 * dstpitch) + x1;
10834261fa58Smacallan			CG14Solid8(p, start, dstpitch, w, h);
10844261fa58Smacallan			break;
10854261fa58Smacallan	}
10864261fa58Smacallan
10874261fa58Smacallan	DPRINTF(X_ERROR, "Solid %d %d %d %d, %d %d -> %d\n", x1, y1, x2, y2,
10884261fa58Smacallan	    dstpitch, dstoff, start);
10894261fa58Smacallan	DPRINTF(X_ERROR, "%x %x %x\n", p->last_rop,
10904261fa58Smacallan	    read_sx_reg(p, SX_QUEUED(8)), read_sx_reg(p, SX_QUEUED(9)));
10914261fa58Smacallan	exaMarkSync(pPixmap->drawable.pScreen);
10924261fa58Smacallan}
10934261fa58Smacallan
10944261fa58Smacallan/*
10954261fa58Smacallan * Memcpy-based UTS.
10964261fa58Smacallan */
10974261fa58Smacallanstatic Bool
10984261fa58SmacallanCG14UploadToScreen(PixmapPtr pDst, int x, int y, int w, int h,
10994261fa58Smacallan    char *src, int src_pitch)
11004261fa58Smacallan{
11014261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pDst->drawable.pScreen->myNum];
11024261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
11034261fa58Smacallan	char  *dst        = p->fb + exaGetPixmapOffset(pDst);
11044261fa58Smacallan	int    dst_pitch  = exaGetPixmapPitch(pDst);
11054261fa58Smacallan
11064261fa58Smacallan	int bpp    = pDst->drawable.bitsPerPixel;
11074261fa58Smacallan	int cpp    = (bpp + 7) >> 3;
11084261fa58Smacallan	int wBytes = w * cpp;
11094261fa58Smacallan
11104261fa58Smacallan	ENTER;
1111f71acd79Smacallan	DPRINTF(X_ERROR, "%s depth %d\n", __func__, bpp);
11124261fa58Smacallan	dst += (x * cpp) + (y * dst_pitch);
11134261fa58Smacallan
11144261fa58Smacallan	CG14Wait(p);
11154261fa58Smacallan
11164261fa58Smacallan	while (h--) {
11174261fa58Smacallan		memcpy(dst, src, wBytes);
11184261fa58Smacallan		src += src_pitch;
11194261fa58Smacallan		dst += dst_pitch;
11204261fa58Smacallan	}
11214261fa58Smacallan	__asm("stbar;");
11224261fa58Smacallan	return TRUE;
11234261fa58Smacallan}
11244261fa58Smacallan
11254261fa58Smacallan/*
11264261fa58Smacallan * Memcpy-based DFS.
11274261fa58Smacallan */
11284261fa58Smacallanstatic Bool
11294261fa58SmacallanCG14DownloadFromScreen(PixmapPtr pSrc, int x, int y, int w, int h,
11304261fa58Smacallan    char *dst, int dst_pitch)
11314261fa58Smacallan{
11324261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pSrc->drawable.pScreen->myNum];
11334261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
11344261fa58Smacallan	char  *src        = p->fb + exaGetPixmapOffset(pSrc);
11354261fa58Smacallan	int    src_pitch  = exaGetPixmapPitch(pSrc);
11364261fa58Smacallan
11374261fa58Smacallan	ENTER;
11384261fa58Smacallan	int bpp    = pSrc->drawable.bitsPerPixel;
11394261fa58Smacallan	int cpp    = (bpp + 7) >> 3;
11404261fa58Smacallan	int wBytes = w * cpp;
11414261fa58Smacallan
11424261fa58Smacallan	src += (x * cpp) + (y * src_pitch);
11434261fa58Smacallan
11444261fa58Smacallan	CG14Wait(p);
11454261fa58Smacallan
11464261fa58Smacallan	while (h--) {
11474261fa58Smacallan		memcpy(dst, src, wBytes);
11484261fa58Smacallan		src += src_pitch;
11494261fa58Smacallan		dst += dst_pitch;
11504261fa58Smacallan	}
11514261fa58Smacallan
11524261fa58Smacallan	return TRUE;
11534261fa58Smacallan}
11544261fa58Smacallan
11554261fa58SmacallanBool
11564261fa58SmacallanCG14CheckComposite(int op, PicturePtr pSrcPicture,
11574261fa58Smacallan                           PicturePtr pMaskPicture,
11584261fa58Smacallan                           PicturePtr pDstPicture)
11594261fa58Smacallan{
11604261fa58Smacallan	int i, ok = FALSE;
11614261fa58Smacallan
11624261fa58Smacallan	ENTER;
11634261fa58Smacallan
11644261fa58Smacallan	/*
11654261fa58Smacallan	 * SX is in theory capable of accelerating pretty much all Xrender ops,
11664261fa58Smacallan	 * even coordinate transformation and gradients. Support will be added
11674261fa58Smacallan	 * over time and likely have to spill over into its own source file.
11684261fa58Smacallan	 */
11694261fa58Smacallan
11706fd6e0f4Smacallan	if ((op != PictOpOver) && (op != PictOpAdd)/* && (op != PictOpSrc)*/) {
1171fe97f391Smacallan		DPRINTF(X_ERROR, "%s: rejecting %d\n", __func__, op);
11724261fa58Smacallan		return FALSE;
11734261fa58Smacallan	}
11744261fa58Smacallan
11754bd47ccfSmacallan	if (pSrcPicture != NULL) {
11764bd47ccfSmacallan		i = 0;
11774bd47ccfSmacallan		while ((i < arraysize(src_formats)) && (!ok)) {
11784bd47ccfSmacallan			ok =  (pSrcPicture->format == src_formats[i]);
11794bd47ccfSmacallan			i++;
11804bd47ccfSmacallan		}
11814bd47ccfSmacallan
11824bd47ccfSmacallan		if (!ok) {
11834bd47ccfSmacallan			DPRINTF(X_ERROR, "%s: unsupported src format %x\n",
11844bd47ccfSmacallan			    __func__, pSrcPicture->format);
11854bd47ccfSmacallan			return FALSE;
11864bd47ccfSmacallan		}
11874bd47ccfSmacallan		DPRINTF(X_ERROR, "src is %x, %d\n", pSrcPicture->format, op);
11884261fa58Smacallan	}
11894261fa58Smacallan
11904bd47ccfSmacallan	if (pDstPicture != NULL) {
11914bd47ccfSmacallan		i = 0;
11924bd47ccfSmacallan		ok = FALSE;
11934bd47ccfSmacallan		while ((i < arraysize(src_formats)) && (!ok)) {
11944bd47ccfSmacallan			ok =  (pDstPicture->format == src_formats[i]);
11954bd47ccfSmacallan			i++;
11964bd47ccfSmacallan		}
11974bd47ccfSmacallan
11984bd47ccfSmacallan		if (!ok) {
11994bd47ccfSmacallan			DPRINTF(X_ERROR, "%s: unsupported dst format %x\n",
12004bd47ccfSmacallan			    __func__, pDstPicture->format);
12014bd47ccfSmacallan			return FALSE;
12024bd47ccfSmacallan		}
12034bd47ccfSmacallan		DPRINTF(X_ERROR, "dst is %x, %d\n", pDstPicture->format, op);
12044bd47ccfSmacallan	}
12054261fa58Smacallan
12064261fa58Smacallan	if (pMaskPicture != NULL) {
12074261fa58Smacallan		DPRINTF(X_ERROR, "mask is %x %d %d\n", pMaskPicture->format,
12084261fa58Smacallan		    pMaskPicture->pDrawable->width,
12094261fa58Smacallan		    pMaskPicture->pDrawable->height);
12104261fa58Smacallan	}
12114261fa58Smacallan	return TRUE;
12124261fa58Smacallan}
12134261fa58Smacallan
12144261fa58SmacallanBool
12154261fa58SmacallanCG14PrepareComposite(int op, PicturePtr pSrcPicture,
12164261fa58Smacallan                             PicturePtr pMaskPicture,
12174261fa58Smacallan                             PicturePtr pDstPicture,
12184261fa58Smacallan                             PixmapPtr  pSrc,
12194261fa58Smacallan                             PixmapPtr  pMask,
12204261fa58Smacallan                             PixmapPtr  pDst)
12214261fa58Smacallan{
12224261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pDst->drawable.pScreen->myNum];
12234261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
12244261fa58Smacallan
12254261fa58Smacallan	ENTER;
12264261fa58Smacallan
1227f7cb851fSmacallan	p->no_source_pixmap = FALSE;
1228f7cb851fSmacallan	p->source_is_solid = FALSE;
1229f7cb851fSmacallan
1230a3a2ba44Smacallan	if (pSrcPicture->format == PICT_a1) {
12316fd6e0f4Smacallan		DPRINTF(X_ERROR, "src mono, dst %x, op %d\n",
12326bdc2ffdSmacallan		    pDstPicture->format, op);
1233a3a2ba44Smacallan		if (pMaskPicture != NULL) {
12346fd6e0f4Smacallan			DPRINTF(X_ERROR, "msk %x\n", pMaskPicture->format);
1235a3a2ba44Smacallan		}
1236f7cb851fSmacallan	}
12374261fa58Smacallan	if (pSrcPicture->pSourcePict != NULL) {
12384261fa58Smacallan		if (pSrcPicture->pSourcePict->type == SourcePictTypeSolidFill) {
12394261fa58Smacallan			p->fillcolour =
12404261fa58Smacallan			    pSrcPicture->pSourcePict->solidFill.color;
1241f7cb851fSmacallan			DPRINTF(X_ERROR, "%s: solid src %08x\n",
12424261fa58Smacallan			    __func__, p->fillcolour);
1243f7cb851fSmacallan			p->no_source_pixmap = TRUE;
1244f7cb851fSmacallan			p->source_is_solid = TRUE;
12454261fa58Smacallan		}
12464261fa58Smacallan	}
12474261fa58Smacallan	if ((pMaskPicture != NULL) && (pMaskPicture->pSourcePict != NULL)) {
12484261fa58Smacallan		if (pMaskPicture->pSourcePict->type ==
12494261fa58Smacallan		    SourcePictTypeSolidFill) {
12504261fa58Smacallan			p->fillcolour =
12514261fa58Smacallan			   pMaskPicture->pSourcePict->solidFill.color;
12526fd6e0f4Smacallan			DPRINTF(X_ERROR, "%s: solid mask %08x\n",
12534261fa58Smacallan			    __func__, p->fillcolour);
12544261fa58Smacallan		}
12554261fa58Smacallan	}
12564261fa58Smacallan	if (pMaskPicture != NULL) {
1257239808baSmacallan		p->mskoff = exaGetPixmapOffset(pMask);
12584261fa58Smacallan		p->mskpitch = exaGetPixmapPitch(pMask);
12594261fa58Smacallan		p->mskformat = pMaskPicture->format;
1260a3a2ba44Smacallan	} else {
1261239808baSmacallan		p->mskoff = 0;
1262a3a2ba44Smacallan		p->mskpitch = 0;
1263a3a2ba44Smacallan		p->mskformat = 0;
12644261fa58Smacallan	}
1265f7cb851fSmacallan	if (pSrc != NULL) {
1266f7cb851fSmacallan		p->source_is_solid =
1267f7cb851fSmacallan		   ((pSrc->drawable.width == 1) && (pSrc->drawable.height == 1));
1268f7cb851fSmacallan		p->srcoff = exaGetPixmapOffset(pSrc);
1269f7cb851fSmacallan		p->srcpitch = exaGetPixmapPitch(pSrc);
1270f7cb851fSmacallan		if (p->source_is_solid) {
1271f7cb851fSmacallan			p->fillcolour = *(uint32_t *)(p->fb + p->srcoff);
1272f7cb851fSmacallan		}
1273f7cb851fSmacallan	}
12744261fa58Smacallan	p->srcformat = pSrcPicture->format;
12754261fa58Smacallan	p->dstformat = pDstPicture->format;
1276f7cb851fSmacallan
1277f7cb851fSmacallan	if (p->source_is_solid) {
1278f7cb851fSmacallan		uint32_t temp;
1279f7cb851fSmacallan
1280f7cb851fSmacallan		/* stuff source colour into SX registers, swap as needed */
1281f7cb851fSmacallan		temp = p->fillcolour;
12826fd6e0f4Smacallan		DPRINTF(X_ERROR, "solid %08x\n", temp);
1283f7cb851fSmacallan		switch (p->srcformat) {
1284f7cb851fSmacallan			case PICT_a8r8g8b8:
1285f7cb851fSmacallan			case PICT_x8r8g8b8:
1286f7cb851fSmacallan				write_sx_reg(p, SX_QUEUED(9), temp & 0xff);
1287f7cb851fSmacallan				temp = temp >> 8;
1288f7cb851fSmacallan				write_sx_reg(p, SX_QUEUED(10), temp & 0xff);
1289f7cb851fSmacallan				temp = temp >> 8;
1290f7cb851fSmacallan				write_sx_reg(p, SX_QUEUED(11), temp & 0xff);
1291f7cb851fSmacallan				break;
1292f7cb851fSmacallan			case PICT_a8b8g8r8:
1293f7cb851fSmacallan			case PICT_x8b8g8r8:
1294f7cb851fSmacallan				write_sx_reg(p, SX_QUEUED(11), temp & 0xff);
1295f7cb851fSmacallan				temp = temp >> 8;
1296f7cb851fSmacallan				write_sx_reg(p, SX_QUEUED(10), temp & 0xff);
1297f7cb851fSmacallan				temp = temp >> 8;
1298f7cb851fSmacallan				write_sx_reg(p, SX_QUEUED(9), temp & 0xff);
1299f7cb851fSmacallan				break;
1300f7cb851fSmacallan		}
1301f7cb851fSmacallan		write_sx_reg(p, SX_QUEUED(8), 0xff);
1302f7cb851fSmacallan	}
13034261fa58Smacallan	p->op = op;
1304a3a2ba44Smacallan	if (op == PictOpSrc) {
13056fd6e0f4Smacallan		if (pSrc == NULL) {
13066fd6e0f4Smacallan			DPRINTF(X_ERROR, "src type %d\n", pSrcPicture->pSourcePict->type);
13076fd6e0f4Smacallan			return FALSE;
13086fd6e0f4Smacallan		}
1309a3a2ba44Smacallan		CG14PrepareCopy(pSrc, pDst, 1, 1, GXcopy, 0xffffffff);
1310a3a2ba44Smacallan	}
13114261fa58Smacallan#ifdef SX_DEBUG
13124261fa58Smacallan	DPRINTF(X_ERROR, "%x %x -> %x\n", p->srcoff, p->mskoff,
13134261fa58Smacallan	    *(uint32_t *)(p->fb + p->srcoff));
13144261fa58Smacallan#endif
13154261fa58Smacallan	return TRUE;
13164261fa58Smacallan}
13174261fa58Smacallan
13184261fa58Smacallanvoid
13194261fa58SmacallanCG14Composite(PixmapPtr pDst, int srcX, int srcY,
13204261fa58Smacallan                              int maskX, int maskY,
13214261fa58Smacallan                              int dstX, int dstY,
13224261fa58Smacallan                              int width, int height)
13234261fa58Smacallan{
13244261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pDst->drawable.pScreen->myNum];
13254261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
13264261fa58Smacallan	uint32_t dstoff, dstpitch;
13274261fa58Smacallan	uint32_t dst, msk, src;
1328e311bbeeSmacallan	int flip = 0;
13294261fa58Smacallan
13304261fa58Smacallan	ENTER;
13314261fa58Smacallan	dstoff = exaGetPixmapOffset(pDst);
13324261fa58Smacallan	dstpitch = exaGetPixmapPitch(pDst);
13334261fa58Smacallan
1334e311bbeeSmacallan	flip = (PICT_FORMAT_TYPE(p->srcformat) !=
1335e311bbeeSmacallan		PICT_FORMAT_TYPE(p->dstformat));
1336e311bbeeSmacallan
13374261fa58Smacallan	switch (p->op) {
13384261fa58Smacallan		case PictOpOver:
13394261fa58Smacallan			dst = dstoff + (dstY * dstpitch) + (dstX << 2);
13404261fa58Smacallan			DPRINTF(X_ERROR, "Over %08x %08x, %d %d\n",
13414261fa58Smacallan			    p->mskformat, p->dstformat, srcX, srcY);
1342a3a2ba44Smacallan			if (p->source_is_solid) {
1343a3a2ba44Smacallan				switch (p->mskformat) {
1344a3a2ba44Smacallan					case PICT_a8:
1345a3a2ba44Smacallan						msk = p->mskoff +
1346a3a2ba44Smacallan						    (maskY * p->mskpitch) +
1347a3a2ba44Smacallan						    maskX;
1348a3a2ba44Smacallan						CG14Comp_Over8Solid(p,
1349a3a2ba44Smacallan						    msk, p->mskpitch,
1350a3a2ba44Smacallan						    dst, dstpitch,
1351a3a2ba44Smacallan						    width, height);
1352a3a2ba44Smacallan						break;
1353a3a2ba44Smacallan					case PICT_a8r8g8b8:
1354a3a2ba44Smacallan					case PICT_a8b8g8r8:
1355a3a2ba44Smacallan						msk = p->mskoff +
1356a3a2ba44Smacallan						    (maskY * p->mskpitch) +
1357a3a2ba44Smacallan						    (maskX << 2);
1358a3a2ba44Smacallan						CG14Comp_Over32Solid(p,
1359a3a2ba44Smacallan						    msk, p->mskpitch,
1360a3a2ba44Smacallan						    dst, dstpitch,
1361a3a2ba44Smacallan						    width, height);
1362a3a2ba44Smacallan						break;
1363a3a2ba44Smacallan					default:
1364a3a2ba44Smacallan						xf86Msg(X_ERROR,
1365f71acd79Smacallan						  "unsupported mask format %08x\n", p->mskformat);
1366a3a2ba44Smacallan				}
1367a3a2ba44Smacallan			} else {
13686bdc2ffdSmacallan				DPRINTF(X_ERROR, "non-solid over with msk %x\n",
13696bdc2ffdSmacallan				    p->mskformat);
1370a3a2ba44Smacallan				switch (p->srcformat) {
1371a3a2ba44Smacallan					case PICT_a8r8g8b8:
1372a3a2ba44Smacallan					case PICT_a8b8g8r8:
1373a3a2ba44Smacallan						src = p->srcoff +
1374a3a2ba44Smacallan						    (srcY * p->srcpitch) +
1375a3a2ba44Smacallan						    (srcX << 2);
1376a3a2ba44Smacallan						dst = dstoff +
1377a3a2ba44Smacallan						    (dstY * dstpitch) +
1378a3a2ba44Smacallan						    (dstX << 2);
1379a3a2ba44Smacallan						if (p->mskformat == PICT_a8) {
1380a3a2ba44Smacallan							msk = p->mskoff +
1381a3a2ba44Smacallan							    (maskY * p->mskpitch) +
1382a3a2ba44Smacallan							    maskX;
1383a3a2ba44Smacallan							CG14Comp_Over32Mask(p,
1384a3a2ba44Smacallan							    src, p->srcpitch,
1385a3a2ba44Smacallan							    msk, p->mskpitch,
1386a3a2ba44Smacallan							    dst, dstpitch,
1387e311bbeeSmacallan							    width, height, flip);
1388a3a2ba44Smacallan						} else {
1389a3a2ba44Smacallan							CG14Comp_Over32(p,
1390a3a2ba44Smacallan							    src, p->srcpitch,
1391a3a2ba44Smacallan							    dst, dstpitch,
1392e311bbeeSmacallan							    width, height, flip);
1393a3a2ba44Smacallan						}
1394a3a2ba44Smacallan						break;
1395a3a2ba44Smacallan					case PICT_x8r8g8b8:
1396a3a2ba44Smacallan					case PICT_x8b8g8r8:
13976bdc2ffdSmacallan						src = p->srcoff +
13986bdc2ffdSmacallan						    (srcY * p->srcpitch) +
13996bdc2ffdSmacallan						    (srcX << 2);
14006bdc2ffdSmacallan						dst = dstoff +
14016bdc2ffdSmacallan						    (dstY * dstpitch) +
14026bdc2ffdSmacallan						    (dstX << 2);
14036bdc2ffdSmacallan						if (p->mskformat == PICT_a8) {
14046bdc2ffdSmacallan							msk = p->mskoff +
14056bdc2ffdSmacallan							    (maskY * p->mskpitch) +
14066bdc2ffdSmacallan							    maskX;
14076bdc2ffdSmacallan							CG14Comp_Over32Mask_noalpha(p,
14086bdc2ffdSmacallan							    src, p->srcpitch,
14096bdc2ffdSmacallan							    msk, p->mskpitch,
1410fa158432Smacallan							    dst, dstpitch,
1411e311bbeeSmacallan							    width, height, flip);
1412fa158432Smacallan						} else if ((p->mskformat == PICT_a8r8g8b8) ||
1413fa158432Smacallan							   (p->mskformat == PICT_a8b8g8r8)) {
1414fa158432Smacallan							msk = p->mskoff +
1415fa158432Smacallan							    (maskY * p->mskpitch) +
1416fa158432Smacallan							    (maskX << 2);
1417fa158432Smacallan							CG14Comp_Over32Mask32_noalpha(p,
1418fa158432Smacallan							    src, p->srcpitch,
1419fa158432Smacallan							    msk, p->mskpitch,
14206bdc2ffdSmacallan							    dst, dstpitch,
1421e311bbeeSmacallan							    width, height, flip);
14226bdc2ffdSmacallan						} else {
14236bdc2ffdSmacallan							xf86Msg(X_ERROR, "no src alpha, mask is %x\n", p->mskformat);
14246bdc2ffdSmacallan						}
1425a3a2ba44Smacallan						break;
1426a3a2ba44Smacallan					default:
1427a3a2ba44Smacallan						xf86Msg(X_ERROR, "%s: format %x in non-solid Over op\n",
1428a3a2ba44Smacallan						    __func__, p->srcformat);
1429a3a2ba44Smacallan				}
1430a3a2ba44Smacallan			}
14314261fa58Smacallan			break;
14324261fa58Smacallan		case PictOpAdd:
14334261fa58Smacallan			DPRINTF(X_ERROR, "Add %08x %08x\n",
14344261fa58Smacallan			    p->srcformat, p->dstformat);
14354261fa58Smacallan			switch (p->srcformat) {
14364261fa58Smacallan				case PICT_a8:
14374261fa58Smacallan					src = p->srcoff +
14384261fa58Smacallan					    (srcY * p->srcpitch) + srcX;
1439d71cb32dSmacallan					if (p->dstformat == PICT_a8) {
1440d71cb32dSmacallan						dst = dstoff +
1441d71cb32dSmacallan						      (dstY * dstpitch) + dstX;
1442d71cb32dSmacallan						CG14Comp_Add8(p,
1443d71cb32dSmacallan						    src, p->srcpitch,
1444d71cb32dSmacallan						    dst, dstpitch,
1445d71cb32dSmacallan						    width, height);
1446d71cb32dSmacallan					} else {
1447d71cb32dSmacallan						dst = dstoff +
1448d71cb32dSmacallan						      (dstY * dstpitch) +
1449d71cb32dSmacallan						      (dstX << 2);
1450d71cb32dSmacallan						CG14Comp_Add8_32(p,
1451d71cb32dSmacallan						    src, p->srcpitch,
1452d71cb32dSmacallan						    dst, dstpitch,
1453d71cb32dSmacallan						    width, height);
1454d71cb32dSmacallan					}
14554261fa58Smacallan					break;
14564261fa58Smacallan				case PICT_a8r8g8b8:
14574261fa58Smacallan				case PICT_x8r8g8b8:
14584261fa58Smacallan					src = p->srcoff +
14594261fa58Smacallan					    (srcY * p->srcpitch) + (srcX << 2);
14604261fa58Smacallan					dst = dstoff + (dstY * dstpitch) +
14614261fa58Smacallan					    (dstX << 2);
14624261fa58Smacallan					CG14Comp_Add32(p, src, p->srcpitch,
14634261fa58Smacallan					    dst, dstpitch, width, height);
14644261fa58Smacallan					break;
14654261fa58Smacallan				default:
14664261fa58Smacallan					xf86Msg(X_ERROR,
14674261fa58Smacallan					    "unsupported src format\n");
14684261fa58Smacallan			}
14694261fa58Smacallan			break;
1470a3a2ba44Smacallan		case PictOpSrc:
1471a3a2ba44Smacallan			DPRINTF(X_ERROR, "Src %08x %08x\n",
1472a3a2ba44Smacallan			    p->srcformat, p->dstformat);
1473239808baSmacallan			if (p->mskformat != 0)
1474239808baSmacallan				xf86Msg(X_ERROR, "Src mask %08x\n", p->mskformat);
1475f71acd79Smacallan			if (p->srcformat == PICT_a8) {
1476f71acd79Smacallan				CG14Copy8(pDst, srcX, srcY, dstX, dstY, width, height);
1477f71acd79Smacallan			} else {
1478f71acd79Smacallan				/* convert between RGB and BGR? */
1479f71acd79Smacallan				CG14Copy32(pDst, srcX, srcY, dstX, dstY, width, height);
1480f71acd79Smacallan			}
1481a3a2ba44Smacallan			break;
14824261fa58Smacallan		default:
14834261fa58Smacallan			xf86Msg(X_ERROR, "unsupported op %d\n", p->op);
14844261fa58Smacallan	}
14854261fa58Smacallan	exaMarkSync(pDst->drawable.pScreen);
14864261fa58Smacallan}
14874261fa58Smacallan
14884261fa58Smacallan
14894261fa58Smacallan
14904261fa58SmacallanBool
14914261fa58SmacallanCG14InitAccel(ScreenPtr pScreen)
14924261fa58Smacallan{
14934261fa58Smacallan	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
14944261fa58Smacallan	Cg14Ptr p = GET_CG14_FROM_SCRN(pScrn);
14954261fa58Smacallan	ExaDriverPtr pExa;
14964261fa58Smacallan
14974261fa58Smacallan	pExa = exaDriverAlloc();
14984261fa58Smacallan	if (!pExa)
14994261fa58Smacallan		return FALSE;
15004261fa58Smacallan
15014261fa58Smacallan	p->pExa = pExa;
15024261fa58Smacallan
15034261fa58Smacallan	pExa->exa_major = EXA_VERSION_MAJOR;
15044261fa58Smacallan	pExa->exa_minor = EXA_VERSION_MINOR;
15054261fa58Smacallan
15064261fa58Smacallan	pExa->memoryBase = p->fb;
15074261fa58Smacallan	pExa->memorySize = p->memsize;
1508031e8e94Smacallan	pExa->offScreenBase = p->width * p->height * (pScrn->bitsPerPixel >> 3);
15094261fa58Smacallan
15104261fa58Smacallan	/*
15114261fa58Smacallan	 * SX memory instructions are written to 64bit aligned addresses with
15124261fa58Smacallan	 * a 3 bit displacement. Make sure the displacement remains constant
15134261fa58Smacallan	 * within one column
15144261fa58Smacallan	 */
15154261fa58Smacallan
15164261fa58Smacallan	pExa->pixmapOffsetAlign = 8;
15174261fa58Smacallan	pExa->pixmapPitchAlign = 8;
15184261fa58Smacallan
1519fe97f391Smacallan	pExa->flags = EXA_OFFSCREEN_PIXMAPS
1520f71acd79Smacallan		      | EXA_SUPPORTS_OFFSCREEN_OVERLAPS
1521f71acd79Smacallan		      /*| EXA_MIXED_PIXMAPS*/;
15224261fa58Smacallan
15234261fa58Smacallan	/*
15244261fa58Smacallan	 * these limits are bogus
15254261fa58Smacallan	 * SX doesn't deal with coordinates at all, so there is no limit but
15264261fa58Smacallan	 * we have to put something here
15274261fa58Smacallan	 */
15284261fa58Smacallan	pExa->maxX = 4096;
15294261fa58Smacallan	pExa->maxY = 4096;
15304261fa58Smacallan
15314261fa58Smacallan	pExa->WaitMarker = CG14WaitMarker;
15324261fa58Smacallan
15334261fa58Smacallan	pExa->PrepareSolid = CG14PrepareSolid;
15344261fa58Smacallan	pExa->Solid = CG14Solid;
15354261fa58Smacallan	pExa->DoneSolid = CG14DoneCopy;
15364261fa58Smacallan	pExa->PrepareCopy = CG14PrepareCopy;
1537f71acd79Smacallan	pExa->Copy = CG14Copy32;
15384261fa58Smacallan	pExa->DoneCopy = CG14DoneCopy;
15394261fa58Smacallan	if (p->use_xrender) {
15404261fa58Smacallan		pExa->CheckComposite = CG14CheckComposite;
15414261fa58Smacallan		pExa->PrepareComposite = CG14PrepareComposite;
15424261fa58Smacallan		pExa->Composite = CG14Composite;
15434261fa58Smacallan		pExa->DoneComposite = CG14DoneCopy;
15444261fa58Smacallan	}
15454261fa58Smacallan
15464261fa58Smacallan	/* EXA hits more optimized paths when it does not have to fallback
15474261fa58Smacallan	 * because of missing UTS/DFS, hook memcpy-based UTS/DFS.
15484261fa58Smacallan	 */
15494261fa58Smacallan	pExa->UploadToScreen = CG14UploadToScreen;
15504261fa58Smacallan	pExa->DownloadFromScreen = CG14DownloadFromScreen;
15514261fa58Smacallan
1552c2193d98Smacallan	p->queuecount = 0;
15534261fa58Smacallan	/* do some hardware init */
15544261fa58Smacallan	write_sx_reg(p, SX_PLANEMASK, 0xffffffff);
15554261fa58Smacallan	p->last_mask = 0xffffffff;
15564261fa58Smacallan	write_sx_reg(p, SX_ROP_CONTROL, 0xcc);
15574261fa58Smacallan	p->last_rop = 0xcc;
15584261fa58Smacallan	return exaDriverInit(pScreen, pExa);
15594261fa58Smacallan}
1560