311 lines
9.7 KiB
C
311 lines
9.7 KiB
C
|
/*
|
|||
|
* (C) Copyright 2002
|
|||
|
* St<EFBFBD>ubli Faverges - <www.staubli.com>
|
|||
|
* Pierre AUBERT p.aubert@staubli.com
|
|||
|
*
|
|||
|
* See file CREDITS for list of people who contributed to this
|
|||
|
* project.
|
|||
|
*
|
|||
|
* This program is free software; you can redistribute it and/or
|
|||
|
* modify it under the terms of the GNU General Public License as
|
|||
|
* published by the Free Software Foundation; either version 2 of
|
|||
|
* the License, or (at your option) any later version.
|
|||
|
*
|
|||
|
* This program is distributed in the hope that it will be useful,
|
|||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|||
|
* GNU General Public License for more details.
|
|||
|
*
|
|||
|
* You should have received a copy of the GNU General Public License
|
|||
|
* along with this program; if not, write to the Free Software
|
|||
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|||
|
* MA 02111-1307 USA
|
|||
|
*/
|
|||
|
/* Video support for Epson SED13806 chipset */
|
|||
|
|
|||
|
#include <common.h>
|
|||
|
|
|||
|
#ifdef CONFIG_VIDEO_SED13806
|
|||
|
|
|||
|
#include <video_fb.h>
|
|||
|
#include <sed13806.h>
|
|||
|
|
|||
|
#define readByte(ptrReg) \
|
|||
|
*(volatile unsigned char *)(sed13806.isaBase + ptrReg)
|
|||
|
|
|||
|
#define writeByte(ptrReg,value) \
|
|||
|
*(volatile unsigned char *)(sed13806.isaBase + ptrReg) = value
|
|||
|
|
|||
|
#ifdef CONFIG_TOTAL5200
|
|||
|
#define writeWord(ptrReg,value) \
|
|||
|
(*(volatile unsigned short *)(sed13806.isaBase + ptrReg) = value)
|
|||
|
#else
|
|||
|
#define writeWord(ptrReg,value) \
|
|||
|
(*(volatile unsigned short *)(sed13806.isaBase + ptrReg) = ((value >> 8 ) & 0xff) | ((value << 8) & 0xff00))
|
|||
|
#endif
|
|||
|
|
|||
|
GraphicDevice sed13806;
|
|||
|
|
|||
|
/*-----------------------------------------------------------------------------
|
|||
|
* EpsonSetRegs --
|
|||
|
*-----------------------------------------------------------------------------
|
|||
|
*/
|
|||
|
static void EpsonSetRegs (void)
|
|||
|
{
|
|||
|
/* the content of the chipset register depends on the board (clocks, ...)*/
|
|||
|
const S1D_REGS *preg = board_get_regs ();
|
|||
|
while (preg -> Index) {
|
|||
|
writeByte (preg -> Index, preg -> Value);
|
|||
|
preg ++;
|
|||
|
}
|
|||
|
}
|
|||
|
|
|||
|
/*-----------------------------------------------------------------------------
|
|||
|
* video_hw_init --
|
|||
|
*-----------------------------------------------------------------------------
|
|||
|
*/
|
|||
|
void *video_hw_init (void)
|
|||
|
{
|
|||
|
unsigned int *vm, i;
|
|||
|
|
|||
|
memset (&sed13806, 0, sizeof (GraphicDevice));
|
|||
|
|
|||
|
/* Initialization of the access to the graphic chipset
|
|||
|
Retreive base address of the chipset
|
|||
|
(see board/RPXClassic/eccx.c) */
|
|||
|
if ((sed13806.isaBase = board_video_init ()) == 0) {
|
|||
|
return (NULL);
|
|||
|
}
|
|||
|
|
|||
|
sed13806.frameAdrs = sed13806.isaBase + FRAME_BUFFER_OFFSET;
|
|||
|
sed13806.winSizeX = board_get_width ();
|
|||
|
sed13806.winSizeY = board_get_height ();
|
|||
|
|
|||
|
#if defined(CONFIG_VIDEO_SED13806_8BPP)
|
|||
|
sed13806.gdfIndex = GDF__8BIT_INDEX;
|
|||
|
sed13806.gdfBytesPP = 1;
|
|||
|
|
|||
|
#elif defined(CONFIG_VIDEO_SED13806_16BPP)
|
|||
|
sed13806.gdfIndex = GDF_16BIT_565RGB;
|
|||
|
sed13806.gdfBytesPP = 2;
|
|||
|
|
|||
|
#else
|
|||
|
#error Unsupported SED13806 BPP
|
|||
|
#endif
|
|||
|
|
|||
|
sed13806.memSize = sed13806.winSizeX * sed13806.winSizeY * sed13806.gdfBytesPP;
|
|||
|
|
|||
|
/* Load SED registers */
|
|||
|
EpsonSetRegs ();
|
|||
|
|
|||
|
/* (see board/RPXClassic/RPXClassic.c) */
|
|||
|
board_validate_screen (sed13806.isaBase);
|
|||
|
|
|||
|
/* Clear video memory */
|
|||
|
i = sed13806.memSize/4;
|
|||
|
vm = (unsigned int *)sed13806.frameAdrs;
|
|||
|
while(i--)
|
|||
|
*vm++ = 0;
|
|||
|
|
|||
|
|
|||
|
return (&sed13806);
|
|||
|
}
|
|||
|
/*-----------------------------------------------------------------------------
|
|||
|
* Epson_wait_idle -- Wait for hardware to become idle
|
|||
|
*-----------------------------------------------------------------------------
|
|||
|
*/
|
|||
|
static void Epson_wait_idle (void)
|
|||
|
{
|
|||
|
while (readByte (BLT_CTRL0) & 0x80);
|
|||
|
|
|||
|
/* Read a word in the BitBLT memory area to shutdown the BitBLT engine */
|
|||
|
*(volatile unsigned short *)(sed13806.isaBase + BLT_REG);
|
|||
|
}
|
|||
|
|
|||
|
/*-----------------------------------------------------------------------------
|
|||
|
* video_hw_bitblt --
|
|||
|
*-----------------------------------------------------------------------------
|
|||
|
*/
|
|||
|
void video_hw_bitblt (
|
|||
|
unsigned int bpp, /* bytes per pixel */
|
|||
|
unsigned int src_x, /* source pos x */
|
|||
|
unsigned int src_y, /* source pos y */
|
|||
|
unsigned int dst_x, /* dest pos x */
|
|||
|
unsigned int dst_y, /* dest pos y */
|
|||
|
unsigned int dim_x, /* frame width */
|
|||
|
unsigned int dim_y /* frame height */
|
|||
|
)
|
|||
|
{
|
|||
|
register GraphicDevice *pGD = (GraphicDevice *)&sed13806;
|
|||
|
unsigned long srcAddr, dstAddr;
|
|||
|
unsigned int stride = bpp * pGD -> winSizeX;
|
|||
|
|
|||
|
srcAddr = (src_y * stride) + (src_x * bpp);
|
|||
|
dstAddr = (dst_y * stride) + (dst_x * bpp);
|
|||
|
|
|||
|
Epson_wait_idle ();
|
|||
|
|
|||
|
writeByte(BLT_ROP,0x0C); /* source */
|
|||
|
writeByte(BLT_OP,0x02);/* move blit in positive direction with ROP */
|
|||
|
writeWord(BLT_MEM_OFF0, stride / 2);
|
|||
|
if (pGD -> gdfIndex == GDF__8BIT_INDEX) {
|
|||
|
writeByte(BLT_CTRL1,0x00);
|
|||
|
}
|
|||
|
else {
|
|||
|
writeByte(BLT_CTRL1,0x01);
|
|||
|
}
|
|||
|
|
|||
|
writeWord(BLT_WIDTH0,(dim_x - 1));
|
|||
|
writeWord(BLT_HEIGHT0,(dim_y - 1));
|
|||
|
|
|||
|
/* set up blit registers */
|
|||
|
writeByte(BLT_SRC_ADDR0,srcAddr);
|
|||
|
writeByte(BLT_SRC_ADDR1,srcAddr>>8);
|
|||
|
writeByte(BLT_SRC_ADDR2,srcAddr>>16);
|
|||
|
|
|||
|
writeByte(BLT_DST_ADDR0,dstAddr);
|
|||
|
writeByte(BLT_DST_ADDR1,dstAddr>>8);
|
|||
|
writeByte(BLT_DST_ADDR2,dstAddr>>16);
|
|||
|
|
|||
|
/* Engage the blt engine */
|
|||
|
/* rectangular region for src and dst */
|
|||
|
writeByte(BLT_CTRL0,0x80);
|
|||
|
|
|||
|
/* wait untill current blits finished */
|
|||
|
Epson_wait_idle ();
|
|||
|
}
|
|||
|
/*-----------------------------------------------------------------------------
|
|||
|
* video_hw_rectfill --
|
|||
|
*-----------------------------------------------------------------------------
|
|||
|
*/
|
|||
|
void video_hw_rectfill (
|
|||
|
unsigned int bpp, /* bytes per pixel */
|
|||
|
unsigned int dst_x, /* dest pos x */
|
|||
|
unsigned int dst_y, /* dest pos y */
|
|||
|
unsigned int dim_x, /* frame width */
|
|||
|
unsigned int dim_y, /* frame height */
|
|||
|
unsigned int color /* fill color */
|
|||
|
)
|
|||
|
{
|
|||
|
register GraphicDevice *pGD = (GraphicDevice *)&sed13806;
|
|||
|
unsigned long dstAddr;
|
|||
|
unsigned int stride = bpp * pGD -> winSizeX;
|
|||
|
|
|||
|
dstAddr = (dst_y * stride) + (dst_x * bpp);
|
|||
|
|
|||
|
Epson_wait_idle ();
|
|||
|
|
|||
|
/* set up blit registers */
|
|||
|
writeByte(BLT_DST_ADDR0,dstAddr);
|
|||
|
writeByte(BLT_DST_ADDR1,dstAddr>>8);
|
|||
|
writeByte(BLT_DST_ADDR2,dstAddr>>16);
|
|||
|
|
|||
|
writeWord(BLT_WIDTH0,(dim_x - 1));
|
|||
|
writeWord(BLT_HEIGHT0,(dim_y - 1));
|
|||
|
writeWord(BLT_FGCOLOR0,color);
|
|||
|
|
|||
|
writeByte(BLT_OP,0x0C); /* solid fill */
|
|||
|
writeWord(BLT_MEM_OFF0,stride / 2);
|
|||
|
|
|||
|
if (pGD -> gdfIndex == GDF__8BIT_INDEX) {
|
|||
|
writeByte(BLT_CTRL1,0x00);
|
|||
|
}
|
|||
|
else {
|
|||
|
writeByte(BLT_CTRL1,0x01);
|
|||
|
}
|
|||
|
|
|||
|
/* Engage the blt engine */
|
|||
|
/* rectangular region for src and dst */
|
|||
|
writeByte(BLT_CTRL0,0x80);
|
|||
|
|
|||
|
/* wait untill current blits finished */
|
|||
|
Epson_wait_idle ();
|
|||
|
}
|
|||
|
|
|||
|
/*-----------------------------------------------------------------------------
|
|||
|
* video_set_lut --
|
|||
|
*-----------------------------------------------------------------------------
|
|||
|
*/
|
|||
|
void video_set_lut (
|
|||
|
unsigned int index, /* color number */
|
|||
|
unsigned char r, /* red */
|
|||
|
unsigned char g, /* green */
|
|||
|
unsigned char b /* blue */
|
|||
|
)
|
|||
|
{
|
|||
|
writeByte(REG_LUT_ADDR, index );
|
|||
|
writeByte(REG_LUT_DATA, r);
|
|||
|
writeByte(REG_LUT_DATA, g);
|
|||
|
writeByte(REG_LUT_DATA, b);
|
|||
|
}
|
|||
|
#ifdef CONFIG_VIDEO_HW_CURSOR
|
|||
|
/*-----------------------------------------------------------------------------
|
|||
|
* video_set_hw_cursor --
|
|||
|
*-----------------------------------------------------------------------------
|
|||
|
*/
|
|||
|
void video_set_hw_cursor (int x, int y)
|
|||
|
{
|
|||
|
writeByte (LCD_CURSOR_XL, (x & 0xff));
|
|||
|
writeByte (LCD_CURSOR_XM, (x >> 8));
|
|||
|
writeByte (LCD_CURSOR_YL, (y & 0xff));
|
|||
|
writeByte (LCD_CURSOR_YM, (y >> 8));
|
|||
|
}
|
|||
|
|
|||
|
/*-----------------------------------------------------------------------------
|
|||
|
* video_init_hw_cursor --
|
|||
|
*-----------------------------------------------------------------------------
|
|||
|
*/
|
|||
|
void video_init_hw_cursor (int font_width, int font_height)
|
|||
|
{
|
|||
|
volatile unsigned char *ptr;
|
|||
|
unsigned char pattern;
|
|||
|
int i;
|
|||
|
|
|||
|
|
|||
|
/* Init cursor content
|
|||
|
Cursor size is 64x64 pixels
|
|||
|
Start of the cursor memory depends on panel type (dual panel ...) */
|
|||
|
if ((i = readByte (LCD_CURSOR_START)) == 0) {
|
|||
|
ptr = (unsigned char *)(sed13806.frameAdrs + DEFAULT_VIDEO_MEMORY_SIZE - HWCURSORSIZE);
|
|||
|
}
|
|||
|
else {
|
|||
|
ptr = (unsigned char *)(sed13806.frameAdrs + DEFAULT_VIDEO_MEMORY_SIZE - (i * 8192));
|
|||
|
}
|
|||
|
|
|||
|
/* Fill the first line and the first empty line after cursor */
|
|||
|
for (i = 0, pattern = 0; i < 64; i++) {
|
|||
|
if (i < font_width) {
|
|||
|
/* Invert background */
|
|||
|
pattern |= 0x3;
|
|||
|
|
|||
|
}
|
|||
|
else {
|
|||
|
/* Background */
|
|||
|
pattern |= 0x2;
|
|||
|
}
|
|||
|
if ((i & 3) == 3) {
|
|||
|
*ptr = pattern;
|
|||
|
*(ptr + font_height * 16) = 0xaa;
|
|||
|
ptr ++;
|
|||
|
pattern = 0;
|
|||
|
}
|
|||
|
pattern <<= 2;
|
|||
|
}
|
|||
|
|
|||
|
/* Duplicate this line */
|
|||
|
for (i = 1; i < font_height; i++) {
|
|||
|
memcpy ((void *)ptr, (void *)(ptr - 16), 16);
|
|||
|
ptr += 16;
|
|||
|
}
|
|||
|
|
|||
|
for (; i < 64; i++) {
|
|||
|
memcpy ((void *)(ptr + 16), (void *)ptr, 16);
|
|||
|
ptr += 16;
|
|||
|
}
|
|||
|
|
|||
|
/* Select cursor mode */
|
|||
|
writeByte (LCD_CURSOR_CNTL, 1);
|
|||
|
}
|
|||
|
#endif
|
|||
|
#endif
|