forked from Minki/linux
b1ee26bab1
Implement support for HW color expansion of 1bpp images, along with some improvements to the FIFO handling and other accel operations. The offset fixup code is now unnecessary as the fbcon core will call our set_par upon switch back from KD_GRAPHICS before anything else happens. I removed it as it would slow down accel operations. The fifo wait has been improved to avoid hitting the HW register as often, and the various accel ops are now performing better caching of register values. Overall, this improve accel performances. The imageblit acceleration does result in a small overall regression in performances on some machines (on the order of 5% on some x86), probably becaus the SW path provides a better bus utilisation, but I decided to ingnore that as the performances is still very good, and on the other hand, some machines such as some sparc64 get a 3 fold performance improvement. Signed-off-by: Benjamin Herrenschmidt <benh@kernel.crashing.org> Acked-by: David S. Miller <davem@davemloft.net> Cc: Krzysztof Halasa <khc@pm.waw.pl> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
448 lines
12 KiB
C
448 lines
12 KiB
C
#include "radeonfb.h"
|
|
|
|
/* the accelerated functions here are patterned after the
|
|
* "ACCEL_MMIO" ifdef branches in XFree86
|
|
* --dte
|
|
*/
|
|
|
|
#define FLUSH_CACHE_WORKAROUND 1
|
|
|
|
void radeon_fifo_update_and_wait(struct radeonfb_info *rinfo, int entries)
|
|
{
|
|
int i;
|
|
|
|
for (i=0; i<2000000; i++) {
|
|
rinfo->fifo_free = INREG(RBBM_STATUS) & 0x7f;
|
|
if (rinfo->fifo_free >= entries)
|
|
return;
|
|
udelay(10);
|
|
}
|
|
printk(KERN_ERR "radeonfb: FIFO Timeout !\n");
|
|
/* XXX Todo: attempt to reset the engine */
|
|
}
|
|
|
|
static inline void radeon_fifo_wait(struct radeonfb_info *rinfo, int entries)
|
|
{
|
|
if (entries <= rinfo->fifo_free)
|
|
rinfo->fifo_free -= entries;
|
|
else
|
|
radeon_fifo_update_and_wait(rinfo, entries);
|
|
}
|
|
|
|
static inline void radeonfb_set_creg(struct radeonfb_info *rinfo, u32 reg,
|
|
u32 *cache, u32 new_val)
|
|
{
|
|
if (new_val == *cache)
|
|
return;
|
|
*cache = new_val;
|
|
radeon_fifo_wait(rinfo, 1);
|
|
OUTREG(reg, new_val);
|
|
}
|
|
|
|
static void radeonfb_prim_fillrect(struct radeonfb_info *rinfo,
|
|
const struct fb_fillrect *region)
|
|
{
|
|
radeonfb_set_creg(rinfo, DP_GUI_MASTER_CNTL, &rinfo->dp_gui_mc_cache,
|
|
rinfo->dp_gui_mc_base | GMC_BRUSH_SOLID_COLOR | ROP3_P);
|
|
radeonfb_set_creg(rinfo, DP_CNTL, &rinfo->dp_cntl_cache,
|
|
DST_X_LEFT_TO_RIGHT | DST_Y_TOP_TO_BOTTOM);
|
|
radeonfb_set_creg(rinfo, DP_BRUSH_FRGD_CLR, &rinfo->dp_brush_fg_cache,
|
|
region->color);
|
|
|
|
/* Ensure the dst cache is flushed and the engine idle before
|
|
* issuing the operation.
|
|
*
|
|
* This works around engine lockups on some cards
|
|
*/
|
|
#if FLUSH_CACHE_WORKAROUND
|
|
radeon_fifo_wait(rinfo, 2);
|
|
OUTREG(DSTCACHE_CTLSTAT, RB2D_DC_FLUSH_ALL);
|
|
OUTREG(WAIT_UNTIL, (WAIT_2D_IDLECLEAN | WAIT_DMA_GUI_IDLE));
|
|
#endif
|
|
radeon_fifo_wait(rinfo, 2);
|
|
OUTREG(DST_Y_X, (region->dy << 16) | region->dx);
|
|
OUTREG(DST_WIDTH_HEIGHT, (region->width << 16) | region->height);
|
|
}
|
|
|
|
void radeonfb_fillrect(struct fb_info *info, const struct fb_fillrect *region)
|
|
{
|
|
struct radeonfb_info *rinfo = info->par;
|
|
struct fb_fillrect modded;
|
|
int vxres, vyres;
|
|
|
|
WARN_ON(rinfo->gfx_mode);
|
|
if (info->state != FBINFO_STATE_RUNNING || rinfo->gfx_mode)
|
|
return;
|
|
if (info->flags & FBINFO_HWACCEL_DISABLED) {
|
|
cfb_fillrect(info, region);
|
|
return;
|
|
}
|
|
|
|
vxres = info->var.xres_virtual;
|
|
vyres = info->var.yres_virtual;
|
|
|
|
memcpy(&modded, region, sizeof(struct fb_fillrect));
|
|
|
|
if(!modded.width || !modded.height ||
|
|
modded.dx >= vxres || modded.dy >= vyres)
|
|
return;
|
|
|
|
if(modded.dx + modded.width > vxres) modded.width = vxres - modded.dx;
|
|
if(modded.dy + modded.height > vyres) modded.height = vyres - modded.dy;
|
|
|
|
if (info->fix.visual == FB_VISUAL_TRUECOLOR ||
|
|
info->fix.visual == FB_VISUAL_DIRECTCOLOR )
|
|
modded.color = ((u32 *) (info->pseudo_palette))[region->color];
|
|
|
|
radeonfb_prim_fillrect(rinfo, &modded);
|
|
}
|
|
|
|
static void radeonfb_prim_copyarea(struct radeonfb_info *rinfo,
|
|
const struct fb_copyarea *area)
|
|
{
|
|
int xdir, ydir;
|
|
u32 sx, sy, dx, dy, w, h;
|
|
|
|
w = area->width; h = area->height;
|
|
dx = area->dx; dy = area->dy;
|
|
sx = area->sx; sy = area->sy;
|
|
xdir = sx - dx;
|
|
ydir = sy - dy;
|
|
|
|
if ( xdir < 0 ) { sx += w-1; dx += w-1; }
|
|
if ( ydir < 0 ) { sy += h-1; dy += h-1; }
|
|
|
|
radeonfb_set_creg(rinfo, DP_GUI_MASTER_CNTL, &rinfo->dp_gui_mc_cache,
|
|
rinfo->dp_gui_mc_base |
|
|
GMC_BRUSH_NONE |
|
|
GMC_SRC_DATATYPE_COLOR |
|
|
ROP3_S |
|
|
DP_SRC_SOURCE_MEMORY);
|
|
radeonfb_set_creg(rinfo, DP_CNTL, &rinfo->dp_cntl_cache,
|
|
(xdir>=0 ? DST_X_LEFT_TO_RIGHT : 0) |
|
|
(ydir>=0 ? DST_Y_TOP_TO_BOTTOM : 0));
|
|
|
|
#if FLUSH_CACHE_WORKAROUND
|
|
radeon_fifo_wait(rinfo, 2);
|
|
OUTREG(DSTCACHE_CTLSTAT, RB2D_DC_FLUSH_ALL);
|
|
OUTREG(WAIT_UNTIL, (WAIT_2D_IDLECLEAN | WAIT_DMA_GUI_IDLE));
|
|
#endif
|
|
radeon_fifo_wait(rinfo, 3);
|
|
OUTREG(SRC_Y_X, (sy << 16) | sx);
|
|
OUTREG(DST_Y_X, (dy << 16) | dx);
|
|
OUTREG(DST_HEIGHT_WIDTH, (h << 16) | w);
|
|
}
|
|
|
|
|
|
void radeonfb_copyarea(struct fb_info *info, const struct fb_copyarea *area)
|
|
{
|
|
struct radeonfb_info *rinfo = info->par;
|
|
struct fb_copyarea modded;
|
|
u32 vxres, vyres;
|
|
modded.sx = area->sx;
|
|
modded.sy = area->sy;
|
|
modded.dx = area->dx;
|
|
modded.dy = area->dy;
|
|
modded.width = area->width;
|
|
modded.height = area->height;
|
|
|
|
WARN_ON(rinfo->gfx_mode);
|
|
if (info->state != FBINFO_STATE_RUNNING || rinfo->gfx_mode)
|
|
return;
|
|
if (info->flags & FBINFO_HWACCEL_DISABLED) {
|
|
cfb_copyarea(info, area);
|
|
return;
|
|
}
|
|
|
|
vxres = info->var.xres_virtual;
|
|
vyres = info->var.yres_virtual;
|
|
|
|
if(!modded.width || !modded.height ||
|
|
modded.sx >= vxres || modded.sy >= vyres ||
|
|
modded.dx >= vxres || modded.dy >= vyres)
|
|
return;
|
|
|
|
if(modded.sx + modded.width > vxres) modded.width = vxres - modded.sx;
|
|
if(modded.dx + modded.width > vxres) modded.width = vxres - modded.dx;
|
|
if(modded.sy + modded.height > vyres) modded.height = vyres - modded.sy;
|
|
if(modded.dy + modded.height > vyres) modded.height = vyres - modded.dy;
|
|
|
|
radeonfb_prim_copyarea(rinfo, &modded);
|
|
}
|
|
|
|
static void radeonfb_prim_imageblit(struct radeonfb_info *rinfo,
|
|
const struct fb_image *image,
|
|
u32 fg, u32 bg)
|
|
{
|
|
unsigned int src_bytes, dwords;
|
|
u32 *bits;
|
|
|
|
radeonfb_set_creg(rinfo, DP_GUI_MASTER_CNTL, &rinfo->dp_gui_mc_cache,
|
|
rinfo->dp_gui_mc_base |
|
|
GMC_BRUSH_NONE |
|
|
GMC_SRC_DATATYPE_MONO_FG_BG |
|
|
ROP3_S |
|
|
GMC_BYTE_ORDER_MSB_TO_LSB |
|
|
DP_SRC_SOURCE_HOST_DATA);
|
|
radeonfb_set_creg(rinfo, DP_CNTL, &rinfo->dp_cntl_cache,
|
|
DST_X_LEFT_TO_RIGHT | DST_Y_TOP_TO_BOTTOM);
|
|
radeonfb_set_creg(rinfo, DP_SRC_FRGD_CLR, &rinfo->dp_src_fg_cache, fg);
|
|
radeonfb_set_creg(rinfo, DP_SRC_BKGD_CLR, &rinfo->dp_src_bg_cache, bg);
|
|
|
|
radeon_fifo_wait(rinfo, 1);
|
|
OUTREG(DST_Y_X, (image->dy << 16) | image->dx);
|
|
|
|
/* Ensure the dst cache is flushed and the engine idle before
|
|
* issuing the operation.
|
|
*
|
|
* This works around engine lockups on some cards
|
|
*/
|
|
#if FLUSH_CACHE_WORKAROUND
|
|
radeon_fifo_wait(rinfo, 2);
|
|
OUTREG(DSTCACHE_CTLSTAT, RB2D_DC_FLUSH_ALL);
|
|
OUTREG(WAIT_UNTIL, (WAIT_2D_IDLECLEAN | WAIT_DMA_GUI_IDLE));
|
|
#endif
|
|
|
|
/* X here pads width to a multiple of 32 and uses the clipper to
|
|
* adjust the result. Is that really necessary ? Things seem to
|
|
* work ok for me without that and the doco doesn't seem to imply
|
|
* there is such a restriction.
|
|
*/
|
|
OUTREG(DST_WIDTH_HEIGHT, (image->width << 16) | image->height);
|
|
|
|
src_bytes = (((image->width * image->depth) + 7) / 8) * image->height;
|
|
dwords = (src_bytes + 3) / 4;
|
|
bits = (u32*)(image->data);
|
|
|
|
while(dwords >= 8) {
|
|
radeon_fifo_wait(rinfo, 8);
|
|
#if BITS_PER_LONG == 64
|
|
__raw_writeq(*((u64 *)(bits)), rinfo->mmio_base + HOST_DATA0);
|
|
__raw_writeq(*((u64 *)(bits+2)), rinfo->mmio_base + HOST_DATA2);
|
|
__raw_writeq(*((u64 *)(bits+4)), rinfo->mmio_base + HOST_DATA4);
|
|
__raw_writeq(*((u64 *)(bits+6)), rinfo->mmio_base + HOST_DATA6);
|
|
bits += 8;
|
|
#else
|
|
__raw_writel(*(bits++), rinfo->mmio_base + HOST_DATA0);
|
|
__raw_writel(*(bits++), rinfo->mmio_base + HOST_DATA1);
|
|
__raw_writel(*(bits++), rinfo->mmio_base + HOST_DATA2);
|
|
__raw_writel(*(bits++), rinfo->mmio_base + HOST_DATA3);
|
|
__raw_writel(*(bits++), rinfo->mmio_base + HOST_DATA4);
|
|
__raw_writel(*(bits++), rinfo->mmio_base + HOST_DATA5);
|
|
__raw_writel(*(bits++), rinfo->mmio_base + HOST_DATA6);
|
|
__raw_writel(*(bits++), rinfo->mmio_base + HOST_DATA7);
|
|
#endif
|
|
dwords -= 8;
|
|
}
|
|
while(dwords--) {
|
|
radeon_fifo_wait(rinfo, 1);
|
|
__raw_writel(*(bits++), rinfo->mmio_base + HOST_DATA0);
|
|
}
|
|
}
|
|
|
|
void radeonfb_imageblit(struct fb_info *info, const struct fb_image *image)
|
|
{
|
|
struct radeonfb_info *rinfo = info->par;
|
|
u32 fg, bg;
|
|
|
|
WARN_ON(rinfo->gfx_mode);
|
|
if (info->state != FBINFO_STATE_RUNNING || rinfo->gfx_mode)
|
|
return;
|
|
|
|
if (!image->width || !image->height)
|
|
return;
|
|
|
|
/* We only do 1 bpp color expansion for now */
|
|
if (info->flags & FBINFO_HWACCEL_DISABLED || image->depth != 1)
|
|
goto fallback;
|
|
|
|
/* Fallback if running out of the screen. We may do clipping
|
|
* in the future */
|
|
if ((image->dx + image->width) > info->var.xres_virtual ||
|
|
(image->dy + image->height) > info->var.yres_virtual)
|
|
goto fallback;
|
|
|
|
if (info->fix.visual == FB_VISUAL_TRUECOLOR ||
|
|
info->fix.visual == FB_VISUAL_DIRECTCOLOR) {
|
|
fg = ((u32*)(info->pseudo_palette))[image->fg_color];
|
|
bg = ((u32*)(info->pseudo_palette))[image->bg_color];
|
|
} else {
|
|
fg = image->fg_color;
|
|
bg = image->bg_color;
|
|
}
|
|
|
|
radeonfb_prim_imageblit(rinfo, image, fg, bg);
|
|
return;
|
|
|
|
fallback:
|
|
radeon_engine_idle(rinfo);
|
|
|
|
cfb_imageblit(info, image);
|
|
}
|
|
|
|
int radeonfb_sync(struct fb_info *info)
|
|
{
|
|
struct radeonfb_info *rinfo = info->par;
|
|
|
|
if (info->state != FBINFO_STATE_RUNNING)
|
|
return 0;
|
|
|
|
radeon_engine_idle(rinfo);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void radeonfb_engine_reset(struct radeonfb_info *rinfo)
|
|
{
|
|
u32 clock_cntl_index, mclk_cntl, rbbm_soft_reset;
|
|
u32 host_path_cntl;
|
|
|
|
radeon_engine_flush (rinfo);
|
|
|
|
clock_cntl_index = INREG(CLOCK_CNTL_INDEX);
|
|
mclk_cntl = INPLL(MCLK_CNTL);
|
|
|
|
OUTPLL(MCLK_CNTL, (mclk_cntl |
|
|
FORCEON_MCLKA |
|
|
FORCEON_MCLKB |
|
|
FORCEON_YCLKA |
|
|
FORCEON_YCLKB |
|
|
FORCEON_MC |
|
|
FORCEON_AIC));
|
|
|
|
host_path_cntl = INREG(HOST_PATH_CNTL);
|
|
rbbm_soft_reset = INREG(RBBM_SOFT_RESET);
|
|
|
|
if (IS_R300_VARIANT(rinfo)) {
|
|
u32 tmp;
|
|
|
|
OUTREG(RBBM_SOFT_RESET, (rbbm_soft_reset |
|
|
SOFT_RESET_CP |
|
|
SOFT_RESET_HI |
|
|
SOFT_RESET_E2));
|
|
INREG(RBBM_SOFT_RESET);
|
|
OUTREG(RBBM_SOFT_RESET, 0);
|
|
tmp = INREG(RB2D_DSTCACHE_MODE);
|
|
OUTREG(RB2D_DSTCACHE_MODE, tmp | (1 << 17)); /* FIXME */
|
|
} else {
|
|
OUTREG(RBBM_SOFT_RESET, rbbm_soft_reset |
|
|
SOFT_RESET_CP |
|
|
SOFT_RESET_HI |
|
|
SOFT_RESET_SE |
|
|
SOFT_RESET_RE |
|
|
SOFT_RESET_PP |
|
|
SOFT_RESET_E2 |
|
|
SOFT_RESET_RB);
|
|
INREG(RBBM_SOFT_RESET);
|
|
OUTREG(RBBM_SOFT_RESET, rbbm_soft_reset & (u32)
|
|
~(SOFT_RESET_CP |
|
|
SOFT_RESET_HI |
|
|
SOFT_RESET_SE |
|
|
SOFT_RESET_RE |
|
|
SOFT_RESET_PP |
|
|
SOFT_RESET_E2 |
|
|
SOFT_RESET_RB));
|
|
INREG(RBBM_SOFT_RESET);
|
|
}
|
|
|
|
OUTREG(HOST_PATH_CNTL, host_path_cntl | HDP_SOFT_RESET);
|
|
INREG(HOST_PATH_CNTL);
|
|
OUTREG(HOST_PATH_CNTL, host_path_cntl);
|
|
|
|
if (!IS_R300_VARIANT(rinfo))
|
|
OUTREG(RBBM_SOFT_RESET, rbbm_soft_reset);
|
|
|
|
OUTREG(CLOCK_CNTL_INDEX, clock_cntl_index);
|
|
OUTPLL(MCLK_CNTL, mclk_cntl);
|
|
}
|
|
|
|
void radeonfb_engine_init (struct radeonfb_info *rinfo)
|
|
{
|
|
unsigned long temp;
|
|
|
|
/* disable 3D engine */
|
|
OUTREG(RB3D_CNTL, 0);
|
|
|
|
rinfo->fifo_free = 0;
|
|
radeonfb_engine_reset(rinfo);
|
|
|
|
radeon_fifo_wait(rinfo, 1);
|
|
if (IS_R300_VARIANT(rinfo)) {
|
|
OUTREG(RB2D_DSTCACHE_MODE, INREG(RB2D_DSTCACHE_MODE) |
|
|
RB2D_DC_AUTOFLUSH_ENABLE |
|
|
RB2D_DC_DC_DISABLE_IGNORE_PE);
|
|
} else {
|
|
/* This needs to be double checked with ATI. Latest X driver
|
|
* completely "forgets" to set this register on < r3xx, and
|
|
* we used to just write 0 there... I'll keep the 0 and update
|
|
* that when we have sorted things out on X side.
|
|
*/
|
|
OUTREG(RB2D_DSTCACHE_MODE, 0);
|
|
}
|
|
|
|
radeon_fifo_wait(rinfo, 3);
|
|
/* We re-read MC_FB_LOCATION from card as it can have been
|
|
* modified by XFree drivers (ouch !)
|
|
*/
|
|
rinfo->fb_local_base = INREG(MC_FB_LOCATION) << 16;
|
|
|
|
OUTREG(DEFAULT_PITCH_OFFSET, (rinfo->pitch << 0x16) |
|
|
(rinfo->fb_local_base >> 10));
|
|
OUTREG(DST_PITCH_OFFSET, (rinfo->pitch << 0x16) | (rinfo->fb_local_base >> 10));
|
|
OUTREG(SRC_PITCH_OFFSET, (rinfo->pitch << 0x16) | (rinfo->fb_local_base >> 10));
|
|
|
|
radeon_fifo_wait(rinfo, 1);
|
|
#ifdef __BIG_ENDIAN
|
|
OUTREGP(DP_DATATYPE, HOST_BIG_ENDIAN_EN, ~HOST_BIG_ENDIAN_EN);
|
|
#else
|
|
OUTREGP(DP_DATATYPE, 0, ~HOST_BIG_ENDIAN_EN);
|
|
#endif
|
|
radeon_fifo_wait(rinfo, 2);
|
|
OUTREG(DEFAULT_SC_TOP_LEFT, 0);
|
|
OUTREG(DEFAULT_SC_BOTTOM_RIGHT, (DEFAULT_SC_RIGHT_MAX |
|
|
DEFAULT_SC_BOTTOM_MAX));
|
|
|
|
/* set default DP_GUI_MASTER_CNTL */
|
|
temp = radeon_get_dstbpp(rinfo->depth);
|
|
rinfo->dp_gui_mc_base = ((temp << 8) | GMC_CLR_CMP_CNTL_DIS);
|
|
|
|
rinfo->dp_gui_mc_cache = rinfo->dp_gui_mc_base |
|
|
GMC_BRUSH_SOLID_COLOR |
|
|
GMC_SRC_DATATYPE_COLOR;
|
|
radeon_fifo_wait(rinfo, 1);
|
|
OUTREG(DP_GUI_MASTER_CNTL, rinfo->dp_gui_mc_cache);
|
|
|
|
|
|
/* clear line drawing regs */
|
|
radeon_fifo_wait(rinfo, 2);
|
|
OUTREG(DST_LINE_START, 0);
|
|
OUTREG(DST_LINE_END, 0);
|
|
|
|
/* set brush and source color regs */
|
|
rinfo->dp_brush_fg_cache = 0xffffffff;
|
|
rinfo->dp_brush_bg_cache = 0x00000000;
|
|
rinfo->dp_src_fg_cache = 0xffffffff;
|
|
rinfo->dp_src_bg_cache = 0x00000000;
|
|
radeon_fifo_wait(rinfo, 4);
|
|
OUTREG(DP_BRUSH_FRGD_CLR, rinfo->dp_brush_fg_cache);
|
|
OUTREG(DP_BRUSH_BKGD_CLR, rinfo->dp_brush_bg_cache);
|
|
OUTREG(DP_SRC_FRGD_CLR, rinfo->dp_src_fg_cache);
|
|
OUTREG(DP_SRC_BKGD_CLR, rinfo->dp_src_bg_cache);
|
|
|
|
/* Default direction */
|
|
rinfo->dp_cntl_cache = DST_X_LEFT_TO_RIGHT | DST_Y_TOP_TO_BOTTOM;
|
|
radeon_fifo_wait(rinfo, 1);
|
|
OUTREG(DP_CNTL, rinfo->dp_cntl_cache);
|
|
|
|
/* default write mask */
|
|
radeon_fifo_wait(rinfo, 1);
|
|
OUTREG(DP_WRITE_MSK, 0xffffffff);
|
|
|
|
/* Default to no swapping of host data */
|
|
radeon_fifo_wait(rinfo, 1);
|
|
OUTREG(RBBM_GUICNTL, RBBM_GUICNTL_HOST_DATA_SWAP_NONE);
|
|
|
|
/* Make sure it's settled */
|
|
radeon_engine_idle(rinfo);
|
|
}
|