qbit/xenocara
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity
fced6378df
xenocara/driver/xf86-video-openchrome/libxvmc/viaLowLevelPro.c
matthieu 63215a6123 Import the openchrome video driver, version 0.2.902. Discussed with 
bernd@ and oga@. Tested by many in snaphots.
2008-07-12 12:48:04 +00:00

1651 lines
41 KiB
C
Raw Blame History

/*****************************************************************************
* VIA Unichrome XvMC extension client lib.
*
* Copyright (c) 2004 Thomas Hellström. All rights reserved.
* Copyright (c) 2003 Andreas Robinson. All rights reserved.
*
* Permission is hereby granted, free of charge, to any person obtaining a
* copy of this software and associated documentation files (the "Software"),
* to deal in the Software without restriction, including without limitation
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
* and/or sell copies of the Software, and to permit persons to whom the
* Software is furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHOR(S) OR COPYRIGHT HOLDER(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
* DEALINGS IN THE SOFTWARE.
*/
/*
* Low-level functions that deal directly with the hardware. In the future,
* these functions might be implemented in a kernel module. Also, some of them
* would benefit from DMA.
*
* Authors:
* Andreas Robinson 2003. (Initial decoder interface functions).
* Thomas Hellstrom 2004, 2005 (Blitting functions, AGP and locking, Unichrome Pro Video AGP).
* Ivor Hewitt 2005 (Unichrome Pro modifications and merging).
*/
/* IH
* I've left the proReg or-ing in case we need/want to implement the V1/V3
* register toggle too, which also moves the register locations.
* The CN400 has dual mpeg decoders, not sure at the moment whether these
* are also operated through independent registers also.
*/
#undef VIDEO_DMA
#define HQV_USE_IRQ
#define UNICHROME_PRO
#include "viaXvMCPriv.h"
#include "viaLowLevel.h"
#include "driDrawable.h"
#include <time.h>
#include <sys/time.h>
#include <stdio.h>
typedef enum
{ ll_init, ll_agpBuf, ll_pciBuf, ll_timeStamp, ll_llBuf }
LLState;
typedef struct
{
drm_via_mem_t mem;
unsigned offset;
unsigned stride;
unsigned height;
} LowLevelBuffer;
struct _XvMCLowLevel;
typedef struct _ViaCommandBuffer
{
CARD32 *buf;
CARD32 waitFlags;
unsigned pos;
unsigned bufSize;
int mode;
int header_start;
int rindex;
void (*flushFunc) (struct _ViaCommandBuffer * cb,
struct _XvMCLowLevel * xl);
} ViaCommandBuffer;
typedef struct _XvMCLowLevel
{
ViaCommandBuffer agpBuf, pciBuf, *videoBuf;
int use_agp;
int fd;
drm_context_t *drmcontext;
drmLockPtr hwLock;
drmAddress mmioAddress;
drmAddress fbAddress;
unsigned fbStride;
unsigned fbDepth;
unsigned width;
unsigned height;
int performLocking;
unsigned errors;
drm_via_mem_t tsMem;
CARD32 tsOffset;
volatile CARD32 *tsP;
CARD32 curTimeStamp;
CARD32 lastReadTimeStamp;
int agpSync;
CARD32 agpSyncTimeStamp;
unsigned chipId;
/*
* Data for video-engine less display
*/
XvMCRegion sRegion;
XvMCRegion dRegion;
LowLevelBuffer scale;
LowLevelBuffer back;
Bool downScaling;
CARD32 downScaleW;
CARD32 downScaleH;
CARD32 upScaleW;
CARD32 upScaleH;
unsigned fetch;
unsigned line;
LLState state;
} XvMCLowLevel;
/*
* For Other architectures than i386 these might have to be modified for
* bigendian etc.
*/
#define MPEGIN(xl,reg) \
*((volatile CARD32 *)(((CARD8 *)(xl)->mmioAddress) + 0xc00 + (reg)))
#define VIDIN(ctx,reg) \
*((volatile CARD32 *)(((CARD8 *)(ctx)->mmioAddress) + 0x200 + (reg)))
#define REGIN(ctx,reg) \
*((volatile CARD32 *)(((CARD8 *)(ctx)->mmioAddress) + 0x0000 + (reg)))
#define HQV_CONTROL 0x1D0
#define HQV_SRC_OFFSET 0x1CC
#define HQV_SRC_STARTADDR_Y 0x1D4
#define HQV_SRC_STARTADDR_U 0x1D8
#define HQV_SRC_STARTADDR_V 0x1DC
#define HQV_MINIFY_DEBLOCK 0x1E8
#define REG_HQV1_INDEX 0x00001000
#define HQV_SW_FLIP 0x00000010
#define HQV_FLIP_STATUS 0x00000001
#define HQV_SUBPIC_FLIP 0x00008000
#define HQV_FLIP_ODD 0x00000020
#define HQV_DEINTERLACE 0x00010000
#define HQV_FIELD_2_FRAME 0x00020000
#define HQV_FRAME_2_FIELD 0x00040000
#define HQV_FIELD_UV 0x00100000
#define HQV_DEBLOCK_HOR 0x00008000
#define HQV_DEBLOCK_VER 0x80000000
#define HQV_YUV420 0xC0000000
#define HQV_YUV422 0x80000000
#define HQV_ENABLE 0x08000000
#define HQV_GEN_IRQ 0x00000080
#define HQV_SCALE_ENABLE 0x00000800
#define HQV_SCALE_DOWN 0x00001000
#define V_COMPOSE_MODE 0x98
#define V1_COMMAND_FIRE 0x80000000
#define V3_COMMAND_FIRE 0x40000000
/* SUBPICTURE Registers */
#define SUBP_CONTROL_STRIDE 0x1C0
#define SUBP_STARTADDR 0x1C4
#define RAM_TABLE_CONTROL 0x1C8
#define RAM_TABLE_READ 0x1CC
/* SUBP_CONTROL_STRIDE 0x3c0 */
#define SUBP_HQV_ENABLE 0x00010000
#define SUBP_IA44 0x00020000
#define SUBP_AI44 0x00000000
#define SUBP_STRIDE_MASK 0x00001fff
#define SUBP_CONTROL_MASK 0x00070000
/* RAM_TABLE_CONTROL 0x3c8 */
#define RAM_TABLE_RGB_ENABLE 0x00000007
#define VIA_REG_STATUS 0x400
#define VIA_REG_GEMODE 0x004
#define VIA_REG_SRCBASE 0x030
#define VIA_REG_DSTBASE 0x034
#define VIA_REG_PITCH 0x038
#define VIA_REG_SRCCOLORKEY 0x01C
#define VIA_REG_KEYCONTROL 0x02C
#define VIA_REG_SRCPOS 0x008
#define VIA_REG_DSTPOS 0x00C
#define VIA_REG_GECMD 0x000
#define VIA_REG_DIMENSION 0x010 /* width and height */
#define VIA_REG_FGCOLOR 0x018
#define VIA_VR_QUEUE_BUSY 0x00020000 /* Virtual Queue is busy */
#define VIA_CMD_RGTR_BUSY 0x00000080 /* Command Regulator is busy */
#define VIA_2D_ENG_BUSY 0x00000002 /* 2D Engine is busy */
#define VIA_3D_ENG_BUSY 0x00000001 /* 3D Engine is busy */
#define VIA_GEM_8bpp 0x00000000
#define VIA_GEM_16bpp 0x00000100
#define VIA_GEM_32bpp 0x00000300
#define VIA_GEC_BLT 0x00000001
#define VIA_PITCH_ENABLE 0x80000000
#define VIA_GEC_INCX 0x00000000
#define VIA_GEC_DECY 0x00004000
#define VIA_GEC_INCY 0x00000000
#define VIA_GEC_DECX 0x00008000
#define VIA_GEC_FIXCOLOR_PAT 0x00002000
#define VIA_BLIT_CLEAR 0x00
#define VIA_BLIT_COPY 0xCC
#define VIA_BLIT_FILL 0xF0
#define VIA_BLIT_SET 0xFF
#define VIA_SYNCWAITTIMEOUT 50000 /* Might be a bit conservative */
#define VIA_DMAWAITTIMEOUT 150000
#define VIA_VIDWAITTIMEOUT 50000
#define VIA_XVMC_DECODERTIMEOUT 50000 /*(microseconds) */
#define VIA_AGP_HEADER5 0xFE040000
#define VIA_AGP_HEADER6 0xFE050000
typedef struct
{
CARD32 data;
Bool set;
} HQVRegister;
#define H1_ADDR(val) (((val) >> 2) | 0xF0000000)
#define WAITFLAGS(cb, flags) \
(cb)->waitFlags |= (flags)
#define BEGIN_RING_AGP(cb, xl, size) \
do { \
if ((cb)->pos > ((cb)->bufSize-(size))) { \
cb->flushFunc(cb, xl); \
} \
} while(0)
#define OUT_RING_AGP(cb, val) do{ \
(cb)->buf[(cb)->pos++] = (val); \
} while(0);
#define OUT_RING_QW_AGP(cb, val1, val2) \
do { \
(cb)->buf[(cb)->pos++] = (val1); \
(cb)->buf[(cb)->pos++] = (val2); \
} while (0)
#define BEGIN_HEADER5_AGP(cb, xl, index) \
do { \
BEGIN_RING_AGP(cb, xl, 8); \
(cb)->mode = VIA_AGP_HEADER5; \
(cb)->rindex = (index); \
(cb)->header_start = (cb)->pos; \
(cb)->pos += 4; \
} while (0)
#define BEGIN_HEADER6_AGP(cb, xl) \
do { \
BEGIN_RING_AGP(cb, xl, 8); \
(cb)->mode = VIA_AGP_HEADER6; \
(cb)->header_start = (cb)->pos; \
(cb)->pos += 4; \
} while (0)
#define BEGIN_HEADER5_DATA(cb, xl, size, index) \
do { \
if ((cb)->pos > ((cb)->bufSize - ((size) + 16))) { \
cb->flushFunc(cb, xl); \
BEGIN_HEADER5_AGP(cb, xl, index); \
} else if ((cb)->mode && (((cb)->mode != VIA_AGP_HEADER5) || \
((cb)->rindex != index))) { \
finish_header_agp(cb); \
BEGIN_HEADER5_AGP((cb), xl, (index)); \
} else if (cb->mode != VIA_AGP_HEADER5) { \
BEGIN_HEADER5_AGP((cb), xl, (index)); \
} \
}while(0)
#define BEGIN_HEADER6_DATA(cb, xl, size) \
do{ \
if ((cb)->pos > (cb->bufSize-(((size) << 1) + 16))) { \
cb->flushFunc(cb, xl); \
BEGIN_HEADER6_AGP(cb, xl); \
} else if ((cb)->mode && ((cb)->mode != VIA_AGP_HEADER6)) { \
finish_header_agp(cb); \
BEGIN_HEADER6_AGP(cb, xl); \
} \
else if ((cb->mode != VIA_AGP_HEADER6)) { \
BEGIN_HEADER6_AGP(cb, (xl)); \
} \
}while(0)
#define HQV_SHADOW_BASE 0x3CC
#define HQV_SHADOW_SIZE 13
#define SETHQVSHADOW(shadow, offset, value) \
do { \
HQVRegister *r = (shadow) + (((offset) - HQV_SHADOW_BASE) >> 2); \
r->data = (value); \
r->set = TRUE; \
} while(0)
#define GETHQVSHADOW(shadow, offset) ((shadow)[(offset - HQV_SHADOW_BASE) >> 2].data)
#define LL_HW_LOCK(xl) \
do { \
DRM_LOCK((xl)->fd,(xl)->hwLock,*(xl)->drmcontext,0); \
} while(0);
#define LL_HW_UNLOCK(xl) \
do { \
DRM_UNLOCK((xl)->fd,(xl)->hwLock,*(xl)->drmcontext); \
} while(0);
static HQVRegister hqvShadow[HQV_SHADOW_SIZE];
static void
initHQVShadow(HQVRegister * r)
{
int i;
for (i = 0; i < HQV_SHADOW_SIZE; ++i) {
r->data = 0;
r++->set = FALSE;
}
}
#if 0
static void
setHQVHWDeinterlacing(HQVRegister * shadow, Bool on, Bool motionDetect,
CARD32 stride, CARD32 height)
{
CARD32 tmp = GETHQVSHADOW(shadow, 0x3E4);
if (!on) {
tmp &= ~((1 << 0) | (1 << 12) | (1 << 27) | (1 << 31));
SETHQVSHADOW(shadow, 0x3E4, tmp);
return;
}
tmp = (1 << 31) |
(4 << 28) |
(1 << 27) |
(3 << 25) | (1 << 18) | (2 << 14) | (8 << 8) | (8 << 1) | (1 << 0);
if (motionDetect)
tmp |= (1 << 12);
SETHQVSHADOW(shadow, 0x3E4, tmp);
tmp = GETHQVSHADOW(shadow, 0x3DC);
tmp |= (stride * height * 1536) / 1024 & 0x7ff;
SETHQVSHADOW(shadow, 0x3DC, tmp);
tmp = GETHQVSHADOW(shadow, 0x3D0);
tmp |= (1 << 23);
SETHQVSHADOW(shadow, 0x3D0, tmp);
}
#endif
static void
setHQVDeblocking(HQVRegister * shadow, Bool on, Bool lowPass)
{
CARD32 tmp = GETHQVSHADOW(shadow, 0x3DC);
if (!on) {
tmp &= ~(1 << 27);
SETHQVSHADOW(shadow, 0x3DC, tmp);
return;
}
tmp |= (8 << 16) | (1 << 27);
if (lowPass)
tmp |= (1 << 26);
SETHQVSHADOW(shadow, 0x3DC, tmp);
tmp = GETHQVSHADOW(shadow, 0x3D4);
tmp |= (6 << 27);
SETHQVSHADOW(shadow, 0x3D4, tmp);
tmp = GETHQVSHADOW(shadow, 0x3D8);
tmp |= (19 << 27);
SETHQVSHADOW(shadow, 0x3D8, tmp);
}
static void
setHQVStartAddress(HQVRegister * shadow, unsigned yOffs, unsigned uOffs,
unsigned stride, unsigned format)
{
CARD32 tmp = GETHQVSHADOW(shadow, 0x3D4);
tmp |= yOffs & 0x03FFFFF0;
SETHQVSHADOW(shadow, 0x3D4, tmp);
tmp = GETHQVSHADOW(shadow, 0x3D8);
tmp |= uOffs & 0x03FFFFF0;
SETHQVSHADOW(shadow, 0x3D8, tmp);
tmp = GETHQVSHADOW(shadow, 0x3F8);
tmp |= (stride & 0x1FF8);
SETHQVSHADOW(shadow, 0x3F8, tmp);
tmp = GETHQVSHADOW(shadow, 0x3D0);
if (format == 0) {
/*
* NV12
*/
tmp |= (0x0C << 28);
} else if (format == 1) {
/*
* RGB16
*/
tmp |= (0x02 << 28);
} else if (format == 2) {
/*
* RGB32
*/
;
}
SETHQVSHADOW(shadow, 0x3D0, tmp);
}
#if 0
static void
setHQVColorSpaceConversion(HQVRegister * shadow, unsigned depth, Bool on)
{
CARD32 tmp = GETHQVSHADOW(shadow, 0x3DC);
if (!on) {
tmp &= ~(1 << 28);
SETHQVSHADOW(shadow, 0x3DC, tmp);
return;
}
if (depth == 32)
tmp |= (1 << 29);
tmp |= (1 << 28);
tmp &= ~(1 << 15);
SETHQVSHADOW(shadow, 0x3DC, tmp);
}
static void
setHQVFetchLine(HQVRegister * shadow, unsigned fetch, unsigned lines)
{
SETHQVSHADOW(shadow, 0x3E0,
((lines - 1) & 0x7FF) | (((fetch - 1) & 0x1FFF) << 16));
}
static void
setHQVScale(HQVRegister * shadow, unsigned horizontal, unsigned vertical)
{
SETHQVSHADOW(shadow, 0x3E8,
(horizontal & 0xFFFF) | ((vertical & 0xFFFF) << 16));
}
static void
setHQVSingleDestination(HQVRegister * shadow, unsigned offset,
unsigned stride)
{
CARD32 tmp = GETHQVSHADOW(shadow, 0x3D0);
tmp |= (1 << 6);
SETHQVSHADOW(shadow, 0x3D0, tmp);
SETHQVSHADOW(shadow, 0x3EC, offset & 0x03FFFFF8);
SETHQVSHADOW(shadow, 0x3F4, stride & 0x1FF8);
}
#endif
static void
setHQVDeinterlacing(HQVRegister * shadow, CARD32 frameType)
{
CARD32 tmp = GETHQVSHADOW(shadow, 0x3D0);
if ((frameType & XVMC_FRAME_PICTURE) == XVMC_TOP_FIELD) {
tmp |= HQV_FIELD_UV |
HQV_DEINTERLACE | HQV_FIELD_2_FRAME | HQV_FRAME_2_FIELD;
} else if ((frameType & XVMC_FRAME_PICTURE) == XVMC_BOTTOM_FIELD) {
tmp |= HQV_FIELD_UV |
HQV_DEINTERLACE |
HQV_FIELD_2_FRAME | HQV_FRAME_2_FIELD | HQV_FLIP_ODD;
}
SETHQVSHADOW(shadow, 0x3D0, tmp);
}
static void
setHQVTripleBuffer(HQVRegister * shadow, Bool on)
{
CARD32 tmp = GETHQVSHADOW(shadow, 0x3D0);
if (on)
tmp |= (1 << 26);
else
tmp &= ~(1 << 26);
SETHQVSHADOW(shadow, 0x3D0, tmp);
}
static void
finish_header_agp(ViaCommandBuffer * cb)
{
int numDWords, i;
CARD32 *hb;
if (!cb->mode)
return;
numDWords = cb->pos - cb->header_start - 4;
hb = cb->buf + cb->header_start;
switch (cb->mode) {
case VIA_AGP_HEADER5:
hb[0] = VIA_AGP_HEADER5 | cb->rindex;
hb[1] = numDWords;
hb[2] = 0x00F50000; /* SW debug flag. (?) */
break;
default:
hb[0] = VIA_AGP_HEADER6;
hb[1] = numDWords >> 1;
hb[2] = 0x00F60000; /* SW debug flag. (?) */
break;
}
hb[3] = 0;
if (numDWords & 3) {
for (i = 0; i < (4 - (numDWords & 3)); ++i)
OUT_RING_AGP(cb, 0x00000000);
}
cb->mode = 0;
}
void
hwlLock(void *xlp, int videoLock)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
LL_HW_LOCK(xl);
}
void
hwlUnlock(void *xlp, int videoLock)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
LL_HW_UNLOCK(xl);
}
static unsigned
timeDiff(struct timeval *now, struct timeval *then)
{
return (now->tv_usec >= then->tv_usec) ?
now->tv_usec - then->tv_usec :
1000000 - (then->tv_usec - now->tv_usec);
}
void
setAGPSyncLowLevel(void *xlp, int val, CARD32 timeStamp)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
xl->agpSync = val;
xl->agpSyncTimeStamp = timeStamp;
}
CARD32
viaDMATimeStampLowLevel(void *xlp)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
if (xl->use_agp) {
viaBlit(xl, 32, xl->tsOffset, 1, xl->tsOffset, 1, 1, 1, 0, 0,
VIABLIT_FILL, xl->curTimeStamp);
return xl->curTimeStamp++;
}
return 0;
}
static void
viaDMAWaitTimeStamp(XvMCLowLevel * xl, CARD32 timeStamp, int doSleep)
{
struct timeval now, then;
struct timezone here;
struct timespec sleep, rem;
if (xl->use_agp && (xl->lastReadTimeStamp - timeStamp > (1 << 23))) {
sleep.tv_nsec = 1;
sleep.tv_sec = 0;
here.tz_minuteswest = 0;
here.tz_dsttime = 0;
gettimeofday(&then, &here);
while (((xl->lastReadTimeStamp = *xl->tsP) - timeStamp) > (1 << 23)) {
gettimeofday(&now, &here);
if (timeDiff(&now, &then) > VIA_DMAWAITTIMEOUT) {
if (((xl->lastReadTimeStamp =
*xl->tsP) - timeStamp) > (1 << 23)) {
xl->errors |= LL_DMA_TIMEDOUT;
break;
}
}
if (doSleep)
nanosleep(&sleep, &rem);
}
}
}
static int
viaDMAInitTimeStamp(XvMCLowLevel * xl)
{
int ret = 0;
if (xl->use_agp) {
xl->tsMem.context = *(xl->drmcontext);
xl->tsMem.size = 64;
xl->tsMem.type = VIA_MEM_VIDEO;
if ((ret = drmCommandWriteRead(xl->fd, DRM_VIA_ALLOCMEM,
&xl->tsMem, sizeof(xl->tsMem))) < 0)
return ret;
if (xl->tsMem.size != 64)
return -1;
xl->tsOffset = (xl->tsMem.offset + 31) & ~31;
xl->tsP = (CARD32 *) xl->fbAddress + (xl->tsOffset >> 2);
xl->curTimeStamp = 1;
*xl->tsP = 0;
}
return 0;
}
static int
viaDMACleanupTimeStamp(XvMCLowLevel * xl)
{
if (!(xl->tsMem.size) || !xl->use_agp)
return 0;
return drmCommandWrite(xl->fd, DRM_VIA_FREEMEM, &xl->tsMem,
sizeof(xl->tsMem));
}
static CARD32
viaMpegGetStatus(XvMCLowLevel * xl)
{
return MPEGIN(xl, 0x54);
}
static int
viaMpegIsBusy(XvMCLowLevel * xl, CARD32 mask, CARD32 idle)
{
CARD32 tmp = viaMpegGetStatus(xl);
/*
* Error detected.
* FIXME: Are errors really shown when error concealment is on?
*/
if (tmp & 0x70)
return 0;
return (tmp & mask) != idle;
}
static void
syncDMA(XvMCLowLevel * xl, unsigned int doSleep)
{
/*
* Ideally, we'd like to have an interrupt wait here, but, according to second hand
* information, the hardware does not support this, although earlier S3 chips do that.
* It is therefore not implemented into the DRM, and we'll do a user space wait here.
*/
struct timeval now, then;
struct timezone here;
struct timespec sleep, rem;
sleep.tv_nsec = 1;
sleep.tv_sec = 0;
here.tz_minuteswest = 0;
here.tz_dsttime = 0;
gettimeofday(&then, &here);
while (!(REGIN(xl, VIA_REG_STATUS) & VIA_VR_QUEUE_BUSY)) {
gettimeofday(&now, &here);
if (timeDiff(&now, &then) > VIA_DMAWAITTIMEOUT) {
if (!(REGIN(xl, VIA_REG_STATUS) & VIA_VR_QUEUE_BUSY)) {
xl->errors |= LL_DMA_TIMEDOUT;
break;
}
}
if (doSleep)
nanosleep(&sleep, &rem);
}
while (REGIN(xl, VIA_REG_STATUS) & VIA_CMD_RGTR_BUSY) {
gettimeofday(&now, &here);
if (timeDiff(&now, &then) > VIA_DMAWAITTIMEOUT) {
if (REGIN(xl, VIA_REG_STATUS) & VIA_CMD_RGTR_BUSY) {
xl->errors |= LL_DMA_TIMEDOUT;
break;
}
}
if (doSleep)
nanosleep(&sleep, &rem);
}
}
#ifdef HQV_USE_IRQ
static void
syncVideo(XvMCLowLevel * xl, unsigned int doSleep)
{
int proReg = REG_HQV1_INDEX;
/*
* Wait for HQV completion using completion interrupt. Nothing strange here.
* Note that the interrupt handler clears the HQV_FLIP_STATUS bit, so we
* can't wait on that one.
*/
if ((VIDIN(xl, HQV_CONTROL | proReg) & (HQV_SW_FLIP | HQV_SUBPIC_FLIP))) {
drm_via_irqwait_t irqw;
irqw.request.irq = 1;
irqw.request.type = VIA_IRQ_ABSOLUTE;
if (drmCommandWriteRead(xl->fd, DRM_VIA_WAIT_IRQ, &irqw,
sizeof(irqw)) < 0)
xl->errors |= LL_VIDEO_TIMEDOUT;
}
}
#else
static void
syncVideo(XvMCLowLevel * xl, unsigned int doSleep)
{
/*
* Wait for HQV completion. Nothing strange here. We assume that the HQV
* Handles syncing to the V1 / V3 engines by itself. It should be safe to
* always wait for SUBPIC_FLIP completion although subpictures are not always
* used.
*/
struct timeval now, then;
struct timezone here;
struct timespec sleep, rem;
int proReg = REG_HQV1_INDEX;
sleep.tv_nsec = 1;
sleep.tv_sec = 0;
here.tz_minuteswest = 0;
here.tz_dsttime = 0;
gettimeofday(&then, &here);
while ((VIDIN(xl,
HQV_CONTROL | proReg) & (HQV_SW_FLIP | HQV_SUBPIC_FLIP))) {
gettimeofday(&now, &here);
if (timeDiff(&now, &then) > VIA_SYNCWAITTIMEOUT) {
if ((VIDIN(xl,
HQV_CONTROL | proReg) & (HQV_SW_FLIP |
HQV_SUBPIC_FLIP))) {
xl->errors |= LL_VIDEO_TIMEDOUT;
break;
}
}
if (doSleep)
nanosleep(&sleep, &rem);
}
}
#endif
static void
syncAccel(XvMCLowLevel * xl, unsigned int mode, unsigned int doSleep)
{
struct timeval now, then;
struct timezone here;
struct timespec sleep, rem;
CARD32 mask = ((mode & LL_MODE_2D) ? VIA_2D_ENG_BUSY : 0) |
((mode & LL_MODE_3D) ? VIA_3D_ENG_BUSY : 0);
sleep.tv_nsec = 1;
sleep.tv_sec = 0;
here.tz_minuteswest = 0;
here.tz_dsttime = 0;
gettimeofday(&then, &here);
while (REGIN(xl, VIA_REG_STATUS) & mask) {
gettimeofday(&now, &here);
if (timeDiff(&now, &then) > VIA_SYNCWAITTIMEOUT) {
if (REGIN(xl, VIA_REG_STATUS) & mask) {
xl->errors |= LL_ACCEL_TIMEDOUT;
break;
}
}
if (doSleep)
nanosleep(&sleep, &rem);
}
}
static void
syncMpeg(XvMCLowLevel * xl, unsigned int mode, unsigned int doSleep)
{
/*
* Ideally, we'd like to have an interrupt wait here, but from information from VIA
* at least the MPEG completion interrupt is broken on the CLE266, which was
* discovered during validation of the chip.
*/
struct timeval now, then;
struct timezone here;
struct timespec sleep, rem;
CARD32 busyMask = 0;
CARD32 idleVal = 0;
CARD32 ret;
sleep.tv_nsec = 1;
sleep.tv_sec = 0;
here.tz_minuteswest = 0;
here.tz_dsttime = 0;
gettimeofday(&then, &here);
if (mode & LL_MODE_DECODER_SLICE) {
busyMask = VIA_SLICEBUSYMASK;
idleVal = VIA_SLICEIDLEVAL;
}
if (mode & LL_MODE_DECODER_IDLE) {
busyMask |= VIA_BUSYMASK;
idleVal = VIA_IDLEVAL;
}
while (viaMpegIsBusy(xl, busyMask, idleVal)) {
gettimeofday(&now, &here);
if (timeDiff(&now, &then) > VIA_XVMC_DECODERTIMEOUT) {
if (viaMpegIsBusy(xl, busyMask, idleVal)) {
xl->errors |= LL_DECODER_TIMEDOUT;
}
break;
}
if (doSleep)
nanosleep(&sleep, &rem);
}
ret = viaMpegGetStatus(xl);
if (ret & 0x70) {
xl->errors |= ((ret & 0x70) >> 3);
}
return;
}
static void
pciFlush(ViaCommandBuffer * cb, XvMCLowLevel * xl)
{
int ret;
drm_via_cmdbuffer_t b;
unsigned mode = cb->waitFlags;
finish_header_agp(cb);
b.buf = (char *)cb->buf;
b.size = cb->pos * sizeof(CARD32);
if (xl->performLocking)
hwlLock(xl, 0);
if (((mode == LL_MODE_VIDEO) && (xl->videoBuf == &xl->agpBuf)) ||
((mode != LL_MODE_VIDEO) && (mode != 0)))
syncDMA(xl, 0);
if ((mode & LL_MODE_2D) || (mode & LL_MODE_3D)) {
syncAccel(xl, mode, 0);
}
if (mode & LL_MODE_VIDEO) {
syncVideo(xl, 1);
}
if (mode & (LL_MODE_DECODER_SLICE | LL_MODE_DECODER_IDLE)) {
syncMpeg(xl, mode, 0);
}
ret = drmCommandWrite(xl->fd, DRM_VIA_PCICMD, &b, sizeof(b));
if (xl->performLocking)
hwlUnlock(xl, 0);
if (ret) {
xl->errors |= LL_PCI_COMMAND_ERR;
}
cb->pos = 0;
cb->waitFlags = 0;
}
static void
agpFlush(ViaCommandBuffer * cb, XvMCLowLevel * xl)
{
drm_via_cmdbuffer_t b;
int ret;
int i;
finish_header_agp(cb);
if (xl->use_agp) {
b.buf = (char *)cb->buf;
b.size = cb->pos * sizeof(CARD32);
if (xl->agpSync) {
syncXvMCLowLevel(xl, LL_MODE_DECODER_IDLE, 1,
xl->agpSyncTimeStamp);
xl->agpSync = 0;
}
if (xl->performLocking)
hwlLock(xl, 0);
do {
ret = drmCommandWrite(xl->fd, DRM_VIA_CMDBUFFER, &b, sizeof(b));
} while (-EAGAIN == ret);
if (xl->performLocking)
hwlUnlock(xl, 0);
if (ret) {
xl->errors |= LL_AGP_COMMAND_ERR;
for (i = 0; i < cb->pos; i += 2) {
printf("0x%x, 0x%x\n", (unsigned)cb->buf[i],
(unsigned)cb->buf[i + 1]);
}
exit(-1);
} else {
cb->pos = 0;
}
cb->waitFlags &= LL_MODE_VIDEO; /* FIXME: Check this! */
} else {
unsigned mode = cb->waitFlags;
b.buf = (char *)cb->buf;
b.size = cb->pos * sizeof(CARD32);
if (xl->performLocking)
hwlLock(xl, 0);
if (((mode == LL_MODE_VIDEO) && (cb == &xl->agpBuf)) ||
((mode != LL_MODE_VIDEO) && (mode != 0)))
syncDMA(xl, 0);
if ((mode & LL_MODE_2D) || (mode & LL_MODE_3D))
syncAccel(xl, mode, 0);
if (mode & LL_MODE_VIDEO)
syncVideo(xl, 1);
if (mode & (LL_MODE_DECODER_SLICE | LL_MODE_DECODER_IDLE))
syncMpeg(xl, mode, 0);
ret = drmCommandWrite(xl->fd, DRM_VIA_PCICMD, &b, sizeof(b));
if (xl->performLocking)
hwlUnlock(xl, 0);
if (ret) {
xl->errors |= LL_PCI_COMMAND_ERR;
}
cb->pos = 0;
cb->waitFlags = 0;
}
}
#if 0 /* Needs debugging */
static void
uploadHQVDeinterlace(XvMCLowLevel * xl, unsigned offset, HQVRegister * shadow,
CARD32 cur_offset, CARD32 prev_offset, CARD32 stride,
Bool top_field_first, CARD32 height)
{
CARD32 tmp;
ViaCommandBuffer *cb = &xl->agpBuf;
BEGIN_HEADER6_DATA(cb, xl, 9);
tmp = GETHQVSHADOW(shadow, 0x3F8);
tmp &= ~(3 << 30);
tmp |= (1 << 30);
OUT_RING_QW_AGP(cb, 0x3F8 + offset, tmp);
OUT_RING_QW_AGP(cb, 0x3D4 + offset, prev_offset +
((top_field_first) ? stride : 0));
OUT_RING_QW_AGP(cb, 0x3D8 + offset, prev_offset + stride * height);
tmp &= ~(3 << 30);
tmp |= (2 << 30);
OUT_RING_QW_AGP(cb, 0x3F8 + offset, tmp);
OUT_RING_QW_AGP(cb, 0x3D4 + offset, cur_offset +
((top_field_first) ? 0 : stride));
OUT_RING_QW_AGP(cb, 0x3D8 + offset, cur_offset + stride * height);
tmp |= (3 << 30);
OUT_RING_QW_AGP(cb, 0x3F8 + offset, tmp);
OUT_RING_QW_AGP(cb, 0x3D4 + offset, cur_offset +
((top_field_first) ? stride : 0));
OUT_RING_QW_AGP(cb, 0x3D8 + offset, cur_offset + stride * height);
}
#endif
static void
uploadHQVShadow(XvMCLowLevel * xl, unsigned offset, HQVRegister * shadow,
Bool flip)
{
int i;
CARD32 tmp;
ViaCommandBuffer *cb = xl->videoBuf;
BEGIN_HEADER6_DATA(cb, xl, HQV_SHADOW_SIZE);
WAITFLAGS(cb, LL_MODE_VIDEO);
if (shadow[0].set)
OUT_RING_QW_AGP(cb, 0x3CC + offset, 0);
for (i = 2; i < HQV_SHADOW_SIZE; ++i) {
if (shadow[i].set) {
OUT_RING_QW_AGP(cb, offset + HQV_SHADOW_BASE + (i << 2),
shadow[i].data);
shadow[i].set = FALSE;
}
}
/*
* Finally the control register for flip.
*/
if (flip) {
tmp = GETHQVSHADOW(shadow, 0x3D0);
OUT_RING_QW_AGP(cb, offset + HQV_CONTROL + 0x200,
HQV_ENABLE | HQV_GEN_IRQ | HQV_SUBPIC_FLIP | HQV_SW_FLIP | tmp);
}
shadow[0].set = FALSE;
shadow[1].set = FALSE;
}
unsigned
flushXvMCLowLevel(void *xlp)
{
unsigned errors;
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
if (xl->pciBuf.pos)
pciFlush(&xl->pciBuf, xl);
if (xl->agpBuf.pos)
agpFlush(&xl->agpBuf, xl);
errors = xl->errors;
if (errors)
printf("Error 0x%x\n", errors);
xl->errors = 0;
return errors;
}
void
flushPCIXvMCLowLevel(void *xlp)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
if (xl->pciBuf.pos)
pciFlush(&xl->pciBuf, xl);
if ((!xl->use_agp && xl->agpBuf.pos))
agpFlush(&xl->agpBuf, xl);
}
void
viaMpegSetSurfaceStride(void *xlp, ViaXvMCContext * ctx)
{
CARD32 y_stride = ctx->yStride;
CARD32 uv_stride = y_stride >> 1;
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
ViaCommandBuffer *cb = &xl->agpBuf;
BEGIN_HEADER6_DATA(cb, xl, 1);
OUT_RING_QW_AGP(cb, 0xc50, (y_stride >> 3) | ((uv_stride >> 3) << 16));
WAITFLAGS(cb, LL_MODE_DECODER_IDLE);
}
void
viaVideoSetSWFLipLocked(void *xlp, unsigned yOffs, unsigned uOffs,
unsigned vOffs, unsigned yStride, unsigned uvStride)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
initHQVShadow(hqvShadow);
setHQVStartAddress(hqvShadow, yOffs, vOffs, yStride, 0);
if (xl->videoBuf == &xl->agpBuf)
syncDMA(xl, 1);
syncVideo(xl, 1);
uploadHQVShadow(xl, REG_HQV1_INDEX, hqvShadow, FALSE);
xl->videoBuf->flushFunc(xl->videoBuf, xl);
}
void
viaVideoSWFlipLocked(void *xlp, unsigned flags, Bool progressiveSequence)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
setHQVDeinterlacing(hqvShadow, flags);
setHQVDeblocking(hqvShadow,
((flags & XVMC_FRAME_PICTURE) == XVMC_FRAME_PICTURE), TRUE);
setHQVTripleBuffer(hqvShadow, TRUE);
if (xl->videoBuf == &xl->agpBuf)
syncDMA(xl, 1);
syncVideo(xl, 1);
uploadHQVShadow(xl, REG_HQV1_INDEX, hqvShadow, TRUE);
xl->videoBuf->flushFunc(xl->videoBuf, xl);
}
void
viaMpegSetFB(void *xlp, unsigned i,
unsigned yOffs, unsigned uOffs, unsigned vOffs)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
ViaCommandBuffer *cb = &xl->agpBuf;
i *= (4 * 2);
BEGIN_HEADER6_DATA(cb, xl, 2);
OUT_RING_QW_AGP(cb, 0xc28 + i, yOffs >> 3);
OUT_RING_QW_AGP(cb, 0xc2c + i, vOffs >> 3);
WAITFLAGS(cb, LL_MODE_DECODER_IDLE);
}
void
viaMpegBeginPicture(void *xlp, ViaXvMCContext * ctx,
unsigned width, unsigned height, const XvMCMpegControl * control)
{
unsigned j, mb_width, mb_height;
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
ViaCommandBuffer *cb = &xl->agpBuf;
mb_width = (width + 15) >> 4;
mb_height =
((control->mpeg_coding == XVMC_MPEG_2) &&
(control->flags & XVMC_PROGRESSIVE_SEQUENCE)) ?
2 * ((height + 31) >> 5) : (((height + 15) >> 4));
BEGIN_HEADER6_DATA(cb, xl, 72);
WAITFLAGS(cb, LL_MODE_DECODER_IDLE);
OUT_RING_QW_AGP(cb, 0xc00,
((control->picture_structure & XVMC_FRAME_PICTURE) << 2) |
((control->picture_coding_type & 3) << 4) |
((control->flags & XVMC_ALTERNATE_SCAN) ? (1 << 6) : 0));
if (!(ctx->intraLoaded)) {
OUT_RING_QW_AGP(cb, 0xc5c, 0);
for (j = 0; j < 64; j += 4) {
OUT_RING_QW_AGP(cb, 0xc60,
ctx->intra_quantiser_matrix[j] |
(ctx->intra_quantiser_matrix[j + 1] << 8) |
(ctx->intra_quantiser_matrix[j + 2] << 16) |
(ctx->intra_quantiser_matrix[j + 3] << 24));
}
ctx->intraLoaded = 1;
}
if (!(ctx->nonIntraLoaded)) {
OUT_RING_QW_AGP(cb, 0xc5c, 1);
for (j = 0; j < 64; j += 4) {
OUT_RING_QW_AGP(cb, 0xc60,
ctx->non_intra_quantiser_matrix[j] |
(ctx->non_intra_quantiser_matrix[j + 1] << 8) |
(ctx->non_intra_quantiser_matrix[j + 2] << 16) |
(ctx->non_intra_quantiser_matrix[j + 3] << 24));
}
ctx->nonIntraLoaded = 1;
}
if (!(ctx->chromaIntraLoaded)) {
OUT_RING_QW_AGP(cb, 0xc5c, 2);
for (j = 0; j < 64; j += 4) {
OUT_RING_QW_AGP(cb, 0xc60,
ctx->chroma_intra_quantiser_matrix[j] |
(ctx->chroma_intra_quantiser_matrix[j + 1] << 8) |
(ctx->chroma_intra_quantiser_matrix[j + 2] << 16) |
(ctx->chroma_intra_quantiser_matrix[j + 3] << 24));
}
ctx->chromaIntraLoaded = 1;
}
if (!(ctx->chromaNonIntraLoaded)) {
OUT_RING_QW_AGP(cb, 0xc5c, 3);
for (j = 0; j < 64; j += 4) {
OUT_RING_QW_AGP(cb, 0xc60,
ctx->chroma_non_intra_quantiser_matrix[j] |
(ctx->chroma_non_intra_quantiser_matrix[j + 1] << 8) |
(ctx->chroma_non_intra_quantiser_matrix[j + 2] << 16) |
(ctx->chroma_non_intra_quantiser_matrix[j + 3] << 24));
}
ctx->chromaNonIntraLoaded = 1;
}
OUT_RING_QW_AGP(cb, 0xc90,
((mb_width * mb_height) & 0x3fff) |
((control->flags & XVMC_PRED_DCT_FRAME) ? (1 << 14) : 0) |
((control->flags & XVMC_TOP_FIELD_FIRST) ? (1 << 15) : 0) |
((control->mpeg_coding == XVMC_MPEG_2) ? (1 << 16) : 0) |
((mb_width & 0xff) << 18));
OUT_RING_QW_AGP(cb, 0xc94,
((control->flags & XVMC_CONCEALMENT_MOTION_VECTORS) ? 1 : 0) |
((control->flags & XVMC_Q_SCALE_TYPE) ? 2 : 0) |
((control->intra_dc_precision & 3) << 2) |
(((1 + 0x100000 / mb_width) & 0xfffff) << 4) |
((control->flags & XVMC_INTRA_VLC_FORMAT) ? (1 << 24) : 0));
OUT_RING_QW_AGP(cb, 0xc98,
(((control->FHMV_range) & 0xf) << 0) |
(((control->FVMV_range) & 0xf) << 4) |
(((control->BHMV_range) & 0xf) << 8) |
(((control->BVMV_range) & 0xf) << 12) |
((control->flags & XVMC_SECOND_FIELD) ? (1 << 20) : 0) |
(0x0a6 << 16));
}
void
viaMpegReset(void *xlp)
{
int i, j;
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
ViaCommandBuffer *cb = &xl->agpBuf;
BEGIN_HEADER6_DATA(cb, xl, 99);
WAITFLAGS(cb, LL_MODE_DECODER_IDLE);
OUT_RING_QW_AGP(cb, 0xcf0, 0);
for (i = 0; i < 6; i++) {
OUT_RING_QW_AGP(cb, 0xcc0, 0);
OUT_RING_QW_AGP(cb, 0xc0c, 0x43 | 0x20);
for (j = 0xc10; j < 0xc20; j += 4)
OUT_RING_QW_AGP(cb, j, 0);
}
OUT_RING_QW_AGP(cb, 0xc0c, 0x1c3);
for (j = 0xc10; j < 0xc20; j += 4)
OUT_RING_QW_AGP(cb, j, 0);
for (i = 0; i < 19; i++)
OUT_RING_QW_AGP(cb, 0xc08, 0);
OUT_RING_QW_AGP(cb, 0xc98, 0x400000);
for (i = 0; i < 6; i++) {
OUT_RING_QW_AGP(cb, 0xcc0, 0);
OUT_RING_QW_AGP(cb, 0xc0c, 0x1c3 | 0x20);
for (j = 0xc10; j < 0xc20; j += 4)
OUT_RING_QW_AGP(cb, j, 0);
}
OUT_RING_QW_AGP(cb, 0xcf0, 0);
}
void
viaMpegWriteSlice(void *xlp, CARD8 * slice, int nBytes, CARD32 sCode)
{
int i, n, r;
CARD32 *buf;
int count;
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
ViaCommandBuffer *cb = &xl->agpBuf;
if (xl->errors & (LL_DECODER_TIMEDOUT |
LL_IDCT_FIFO_ERROR | LL_SLICE_FIFO_ERROR | LL_SLICE_FAULT))
return;
n = nBytes >> 2;
if (sCode)
nBytes += 4;
r = nBytes & 3;
buf = (CARD32 *) slice;
if (r)
nBytes += 4 - r;
nBytes += 8;
BEGIN_HEADER6_DATA(cb, xl, 2);
WAITFLAGS(cb, LL_MODE_DECODER_IDLE);
OUT_RING_QW_AGP(cb, 0xc9c, nBytes);
if (sCode)
OUT_RING_QW_AGP(cb, 0xca0, sCode);
i = 0;
count = 0;
do {
count += (LL_AGP_CMDBUF_SIZE - 20);
count = (count > n) ? n : count;
BEGIN_HEADER5_DATA(cb, xl, (count - i), 0xca0);
for (; i < count; i++) {
OUT_RING_AGP(cb, *buf++);
}
finish_header_agp(cb);
} while (i < n);
BEGIN_HEADER5_DATA(cb, xl, 3, 0xca0);
if (r) {
OUT_RING_AGP(cb, *buf & ((1 << (r << 3)) - 1));
}
OUT_RING_AGP(cb, 0);
OUT_RING_AGP(cb, 0);
finish_header_agp(cb);
}
void
viaVideoSubPictureOffLocked(void *xlp)
{
CARD32 stride;
int proReg = REG_HQV1_INDEX;
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
ViaCommandBuffer *cb = xl->videoBuf;
if (xl->videoBuf == &xl->agpBuf)
syncDMA(xl, 1);
stride = VIDIN(xl, proReg | SUBP_CONTROL_STRIDE);
WAITFLAGS(cb, LL_MODE_VIDEO);
BEGIN_HEADER6_DATA(cb, xl, 1);
OUT_RING_QW_AGP(cb, proReg | SUBP_CONTROL_STRIDE | 0x200,
stride & ~SUBP_HQV_ENABLE);
}
void
viaVideoSubPictureLocked(void *xlp, ViaXvMCSubPicture * pViaSubPic)
{
unsigned i;
CARD32 cWord;
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
int proReg = REG_HQV1_INDEX;
ViaCommandBuffer *cb = xl->videoBuf;
if (xl->videoBuf == &xl->agpBuf)
syncDMA(xl, 1);
WAITFLAGS(cb, LL_MODE_VIDEO);
BEGIN_HEADER6_DATA(cb, xl, VIA_SUBPIC_PALETTE_SIZE + 2);
for (i = 0; i < VIA_SUBPIC_PALETTE_SIZE; ++i) {
OUT_RING_QW_AGP(cb, proReg | RAM_TABLE_CONTROL | 0x200,
pViaSubPic->palette[i]);
}
cWord = (pViaSubPic->stride & SUBP_STRIDE_MASK) | SUBP_HQV_ENABLE;
cWord |= (pViaSubPic->ia44) ? SUBP_IA44 : SUBP_AI44;
OUT_RING_QW_AGP(cb, proReg | SUBP_STARTADDR | 0x200, pViaSubPic->offset);
OUT_RING_QW_AGP(cb, proReg | SUBP_CONTROL_STRIDE | 0x200, cWord);
}
void
viaBlit(void *xlp, unsigned bpp, unsigned srcBase,
unsigned srcPitch, unsigned dstBase, unsigned dstPitch,
unsigned w, unsigned h, int xdir, int ydir, unsigned blitMode,
unsigned color)
{
CARD32 dwGEMode = 0, srcY = 0, srcX, dstY = 0, dstX;
CARD32 cmd;
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
ViaCommandBuffer *cb = &xl->agpBuf;
if (!w || !h)
return;
finish_header_agp(cb);
switch (bpp) {
case 16:
dwGEMode |= VIA_GEM_16bpp;
break;
case 32:
dwGEMode |= VIA_GEM_32bpp;
break;
default:
dwGEMode |= VIA_GEM_8bpp;
break;
}
srcX = srcBase & 31;
dstX = dstBase & 31;
switch (bpp) {
case 16:
dwGEMode |= VIA_GEM_16bpp;
srcX >>= 2;
dstX >>= 2;
break;
case 32:
dwGEMode |= VIA_GEM_32bpp;
srcX >>= 4;
dstX >>= 4;
break;
default:
dwGEMode |= VIA_GEM_8bpp;
break;
}
BEGIN_RING_AGP(cb, xl, 20);
WAITFLAGS(cb, LL_MODE_2D);
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_GEMODE), dwGEMode);
cmd = 0;
if (xdir < 0) {
cmd |= VIA_GEC_DECX;
srcX += (w - 1);
dstX += (w - 1);
}
if (ydir < 0) {
cmd |= VIA_GEC_DECY;
srcY += (h - 1);
dstY += (h - 1);
}
switch (blitMode) {
case VIABLIT_TRANSCOPY:
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_SRCCOLORKEY), color);
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_KEYCONTROL), 0x4000);
cmd |= VIA_GEC_BLT | (VIA_BLIT_COPY << 24);
break;
case VIABLIT_FILL:
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_FGCOLOR), color);
cmd |= VIA_GEC_BLT | VIA_GEC_FIXCOLOR_PAT | (VIA_BLIT_FILL << 24);
break;
default:
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_KEYCONTROL), 0x0);
cmd |= VIA_GEC_BLT | (VIA_BLIT_COPY << 24);
}
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_SRCBASE), (srcBase & ~31) >> 3);
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_DSTBASE), (dstBase & ~31) >> 3);
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_PITCH), VIA_PITCH_ENABLE |
(srcPitch >> 3) | (((dstPitch) >> 3) << 16));
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_SRCPOS), ((srcY << 16) | srcX));
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_DSTPOS), ((dstY << 16) | dstX));
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_DIMENSION),
(((h - 1) << 16) | (w - 1)));
OUT_RING_QW_AGP(cb, H1_ADDR(VIA_REG_GECMD), cmd);
}
unsigned
syncXvMCLowLevel(void *xlp, unsigned int mode, unsigned int doSleep,
CARD32 timeStamp)
{
unsigned errors;
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
if (mode == 0) {
errors = xl->errors;
xl->errors = 0;
return errors;
}
if ((mode & (LL_MODE_VIDEO | LL_MODE_3D)) || !xl->use_agp) {
if (xl->performLocking)
hwlLock(xl, 0);
if ((xl->videoBuf == &xl->agpBuf) || (mode != LL_MODE_VIDEO))
syncDMA(xl, doSleep);
if (mode & LL_MODE_3D)
syncAccel(xl, mode, doSleep);
if (mode & LL_MODE_VIDEO)
syncVideo(xl, doSleep);
if (xl->performLocking)
hwlUnlock(xl, 0);
} else {
viaDMAWaitTimeStamp(xl, timeStamp, doSleep);
}
if (mode & (LL_MODE_DECODER_SLICE | LL_MODE_DECODER_IDLE))
syncMpeg(xl, mode, doSleep);
errors = xl->errors;
xl->errors = 0;
return errors;
}
static int
updateLowLevelBuf(XvMCLowLevel * xl, LowLevelBuffer * buf,
unsigned width, unsigned height)
{
unsigned stride, size;
drm_via_mem_t *mem = &buf->mem;
int ret;
stride = (width + 31) & ~31;
size = stride * height + (xl->fbDepth >> 3);
if (size != mem->size) {
if (mem->size)
drmCommandWrite(xl->fd, DRM_VIA_FREEMEM, mem, sizeof(mem));
mem->context = *(xl->drmcontext);
mem->size = size;
mem->type = VIA_MEM_VIDEO;
if (((ret = drmCommandWriteRead(xl->fd, DRM_VIA_ALLOCMEM, mem,
sizeof(mem))) < 0) || mem->size != size) {
mem->size = 0;
return -1;
}
}
buf->offset = (mem->offset + 31) & ~31;
buf->stride = stride;
buf->height = height;
return 0;
}
static void
cleanupLowLevelBuf(XvMCLowLevel * xl, LowLevelBuffer * buf)
{
drm_via_mem_t *mem = &buf->mem;
if (mem->size)
drmCommandWrite(xl->fd, DRM_VIA_FREEMEM, mem, sizeof(mem));
mem->size = 0;
}
static void *
releaseXvMCLowLevel(XvMCLowLevel * xl)
{
switch (xl->state) {
case ll_llBuf:
cleanupLowLevelBuf(xl, &xl->scale);
case ll_timeStamp:
viaDMACleanupTimeStamp(xl);
case ll_pciBuf:
free(xl->pciBuf.buf);
case ll_agpBuf:
free(xl->agpBuf.buf);
case ll_init:
free(xl);
default:
;
}
return NULL;
}
void *
initXvMCLowLevel(int fd, drm_context_t * ctx,
drmLockPtr hwLock, drmAddress mmioAddress,
drmAddress fbAddress, unsigned fbStride, unsigned fbDepth,
unsigned width, unsigned height, int useAgp, unsigned chipId)
{
XvMCLowLevel *xl;
if (chipId != PCI_CHIP_VT3259 && chipId != PCI_CHIP_VT3364) {
fprintf(stderr, "You are using an XvMC driver for the wrong chip.\n");
fprintf(stderr, "Chipid is 0x%04x.\n", chipId);
return NULL;
}
xl = (XvMCLowLevel *) malloc(sizeof(XvMCLowLevel));
if (!xl)
return NULL;
xl->state = ll_init;
xl->agpBuf.buf = (CARD32 *) malloc(LL_AGP_CMDBUF_SIZE * sizeof(CARD32));
if (!xl->agpBuf.buf)
return releaseXvMCLowLevel(xl);
xl->state = ll_agpBuf;
xl->agpBuf.bufSize = LL_AGP_CMDBUF_SIZE;
xl->agpBuf.flushFunc = &agpFlush;
xl->agpBuf.pos = 0;
xl->agpBuf.mode = 0;
xl->agpBuf.waitFlags = 0;
xl->pciBuf.buf = (CARD32 *) malloc(LL_PCI_CMDBUF_SIZE * sizeof(CARD32));
if (!xl->pciBuf.buf)
return releaseXvMCLowLevel(xl);
xl->state = ll_pciBuf;
xl->pciBuf.bufSize = LL_PCI_CMDBUF_SIZE;
xl->pciBuf.flushFunc = &pciFlush;
xl->pciBuf.pos = 0;
xl->pciBuf.mode = 0;
xl->pciBuf.waitFlags = 0;
xl->use_agp = useAgp;
xl->fd = fd;
xl->drmcontext = ctx;
xl->hwLock = hwLock;
xl->mmioAddress = mmioAddress;
xl->fbAddress = fbAddress;
xl->fbDepth = fbDepth;
xl->fbStride = fbStride;
xl->width = width;
xl->height = height;
xl->performLocking = 1;
xl->errors = 0;
xl->agpSync = 0;
xl->chipId = chipId;
if (viaDMAInitTimeStamp(xl))
return releaseXvMCLowLevel(xl);
xl->state = ll_timeStamp;
xl->scale.mem.size = 0;
xl->back.mem.size = 0;
if (updateLowLevelBuf(xl, &xl->scale, width, height))
return releaseXvMCLowLevel(xl);
xl->state = ll_llBuf;
#ifdef VIDEO_DMA
xl->videoBuf = &xl->agpBuf;
#else
xl->videoBuf = &xl->pciBuf;
#endif
return xl;
}
void
setLowLevelLocking(void *xlp, int performLocking)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
xl->performLocking = performLocking;
}
void
closeXvMCLowLevel(void *xlp)
{
XvMCLowLevel *xl = (XvMCLowLevel *) xlp;
releaseXvMCLowLevel(xl);
}
#if 0 /* Under development */
static CARD32
computeDownScaling(int dst, int *src)
{
CARD32 value = 0x800;
while (*src > dst) {
*src >>= 1;
value--;
}
return value;
}
static void
computeHQVScaleAndFilter(XvMCLowLevel * xl)
{
int srcW, srcH;
const XvMCRegion *src = &xl->sRegion, *back = &xl->dRegion;
xl->downScaling = FALSE;
if (back->w < src->w || back->h < src->h) {
xl->downScaling = TRUE;
srcW = src->w;
srcH = src->h;
xl->downScaleW = (back->w >= srcW) ? 0 :
HQV_SCALE_ENABLE | HQV_SCALE_DOWN |
(computeDownScaling(back->w, &srcW));
xl->downScaleH = (back->h >= srcH) ? 0 :
HQV_SCALE_ENABLE | HQV_SCALE_DOWN |
(computeDownScaling(back->h, &srcH));
}
xl->upScaleW =
(back->w == srcW) ? 0 : (0x800 * srcW / back->w) | HQV_SCALE_ENABLE;
xl->upScaleH =
(back->h == srcH) ? 0 : (0x800 * srcH / back->h) | HQV_SCALE_ENABLE;
}
static int
setupBackBuffer(XvMCLowLevel * xl)
{
return updateLowLevelBuf(xl, &xl->back, xl->dRegion.w, xl->dRegion.h);
}
#endif
Reference in New Issue View Git Blame Copy Permalink