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