/* * (C) Copyright 2002 * Stäubli Faverges - <www.staubli.com> * Pierre AUBERT p.aubert@staubli.com * * SPDX-License-Identifier: GPL-2.0+ */ /* Video support for Epson SED13806 chipset */ #include <common.h> #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