484 lines
13 KiB
C
484 lines
13 KiB
C
|
/*
|
||
|
|
* (C) Copyright 2001
|
||
|
|
* ELTEC Elektronik AG
|
||
|
|
* Frank Gottschling <fgottschling@eltec.de>
|
||
|
|
*
|
||
|
|
* Board specific routines for the miniHiPerCam
|
||
|
|
*
|
||
|
|
* - initialisation (eeprom)
|
||
|
|
* - memory controller
|
||
|
|
* - serial io initialisation
|
||
|
|
* - ethernet io initialisation
|
||
|
|
*
|
||
|
|
* -----------------------------------------------------------------
|
||
|
|
* 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
|
||
|
|
*/
|
||
|
|
#include <common.h>
|
||
|
|
#include <linux/ctype.h>
|
||
|
|
#include <commproc.h>
|
||
|
|
#include "mpc8xx.h"
|
||
|
|
#include <video_fb.h>
|
||
|
|
|
||
|
|
/* imports from common/main.c */
|
||
|
|
extern char console_buffer[CFG_CBSIZE];
|
||
|
|
|
||
|
|
extern void eeprom_init (void);
|
||
|
|
extern int eeprom_read (unsigned dev_addr, unsigned offset,
|
||
|
|
unsigned char *buffer, unsigned cnt);
|
||
|
|
extern int eeprom_write (unsigned dev_addr, unsigned offset,
|
||
|
|
unsigned char *buffer, unsigned cnt);
|
||
|
|
|
||
|
|
/* globals */
|
||
|
|
void *video_hw_init (void);
|
||
|
|
void video_set_lut (unsigned int index, /* color number */
|
||
|
|
unsigned char r, /* red */
|
||
|
|
unsigned char g, /* green */
|
||
|
|
unsigned char b /* blue */
|
||
|
|
);
|
||
|
|
|
||
|
|
GraphicDevice gdev;
|
||
|
|
|
||
|
|
/* locals */
|
||
|
|
static void video_circle (char *center, int radius, int color, int pitch);
|
||
|
|
static void video_test_image (void);
|
||
|
|
static void video_default_lut (unsigned int clut_type);
|
||
|
|
|
||
|
|
/* revision info foer MHPC EEPROM offset 480 */
|
||
|
|
typedef struct {
|
||
|
|
char board[12]; /* 000 - Board Revision information */
|
||
|
|
char sensor; /* 012 - Sensor Type information */
|
||
|
|
char serial[8]; /* 013 - Board serial number */
|
||
|
|
char etheraddr[6]; /* 021 - Ethernet node addresse */
|
||
|
|
char revision[2]; /* 027 - Revision code */
|
||
|
|
char option[3]; /* 029 - resevered for options */
|
||
|
|
} revinfo;
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
static const unsigned int sdram_table[] = {
|
||
|
|
/* read single beat cycle */
|
||
|
|
0xef0efc04, 0x0e2dac04, 0x01ba5c04, 0x1ff5fc00,
|
||
|
|
0xfffffc05, 0xeffafc34, 0x0ff0bc34, 0x1ff57c35,
|
||
|
|
|
||
|
|
/* read burst cycle */
|
||
|
|
0xef0efc04, 0x0e3dac04, 0x10ff5c04, 0xf0fffc00,
|
||
|
|
0xf0fffc00, 0xf1fffc00, 0xfffffc00, 0xfffffc05,
|
||
|
|
0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
|
||
|
|
0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
|
||
|
|
|
||
|
|
/* write single beat cycle */
|
||
|
|
0xef0efc04, 0x0e29ac00, 0x01b25c04, 0x1ff5fc05,
|
||
|
|
0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
|
||
|
|
|
||
|
|
/* write burst cycle */
|
||
|
|
0xef0ef804, 0x0e39a000, 0x10f75000, 0xf0fff440,
|
||
|
|
0xf0fffc40, 0xf1fffc04, 0xfffffc05, 0xfffffc04,
|
||
|
|
0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
|
||
|
|
0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
|
||
|
|
|
||
|
|
/* periodic timer expired */
|
||
|
|
0xeffebc84, 0x1ffd7c04, 0xfffffc04, 0xfffffc84,
|
||
|
|
0xeffebc04, 0x1ffd7c04, 0xfffffc04, 0xfffffc05,
|
||
|
|
0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
|
||
|
|
|
||
|
|
/* exception */
|
||
|
|
0xfffffc04, 0xfffffc05, 0xfffffc04, 0xfffffc04
|
||
|
|
};
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
int board_early_init_f (void)
|
||
|
|
{
|
||
|
|
volatile immap_t *im = (immap_t *) CFG_IMMR;
|
||
|
|
volatile cpm8xx_t *cp = &(im->im_cpm);
|
||
|
|
volatile iop8xx_t *ip = (iop8xx_t *) & (im->im_ioport);
|
||
|
|
|
||
|
|
/* reset the port A s.a. cpm-routines */
|
||
|
|
ip->iop_padat = 0x0000;
|
||
|
|
ip->iop_papar = 0x0000;
|
||
|
|
ip->iop_padir = 0x0800;
|
||
|
|
ip->iop_paodr = 0x0000;
|
||
|
|
|
||
|
|
/* reset the port B for digital and LCD output */
|
||
|
|
cp->cp_pbdat = 0x0300;
|
||
|
|
cp->cp_pbpar = 0x5001;
|
||
|
|
cp->cp_pbdir = 0x5301;
|
||
|
|
cp->cp_pbodr = 0x0000;
|
||
|
|
|
||
|
|
/* reset the port C configured for SMC1 serial port and aqc. control */
|
||
|
|
ip->iop_pcdat = 0x0800;
|
||
|
|
ip->iop_pcpar = 0x0000;
|
||
|
|
ip->iop_pcdir = 0x0e30;
|
||
|
|
ip->iop_pcso = 0x0000;
|
||
|
|
|
||
|
|
/* Config port D for LCD output */
|
||
|
|
ip->iop_pdpar = 0x1fff;
|
||
|
|
ip->iop_pddir = 0x1fff;
|
||
|
|
|
||
|
|
return (0);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Check Board Identity
|
||
|
|
*/
|
||
|
|
int checkboard (void)
|
||
|
|
{
|
||
|
|
puts ("Board: ELTEC miniHiperCam\n");
|
||
|
|
return (0);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
int misc_init_r (void)
|
||
|
|
{
|
||
|
|
revinfo mhpcRevInfo;
|
||
|
|
char nid[32];
|
||
|
|
char *mhpcSensorTypes[] = { "OMNIVISON OV7610/7620 color",
|
||
|
|
"OMNIVISON OV7110 b&w", NULL
|
||
|
|
};
|
||
|
|
char hex[23] = { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 0, 0, 0,
|
||
|
|
0, 0, 0, 0, 10, 11, 12, 13, 14, 15
|
||
|
|
};
|
||
|
|
int i;
|
||
|
|
|
||
|
|
/* check revision data */
|
||
|
|
eeprom_read (CFG_I2C_EEPROM_ADDR, 480, (uchar *) &mhpcRevInfo, 32);
|
||
|
|
|
||
|
|
if (strncmp ((char *) &mhpcRevInfo.board[2], "MHPC", 4) != 0) {
|
||
|
|
printf ("Enter revision number (0-9): %c ",
|
||
|
|
mhpcRevInfo.revision[0]);
|
||
|
|
if (0 != readline (NULL)) {
|
||
|
|
mhpcRevInfo.revision[0] =
|
||
|
|
(char) toupper (console_buffer[0]);
|
||
|
|
}
|
||
|
|
|
||
|
|
printf ("Enter revision character (A-Z): %c ",
|
||
|
|
mhpcRevInfo.revision[1]);
|
||
|
|
if (1 == readline (NULL)) {
|
||
|
|
mhpcRevInfo.revision[1] =
|
||
|
|
(char) toupper (console_buffer[0]);
|
||
|
|
}
|
||
|
|
|
||
|
|
printf ("Enter board name (V-XXXX-XXXX): %s ",
|
||
|
|
(char *) &mhpcRevInfo.board);
|
||
|
|
if (11 == readline (NULL)) {
|
||
|
|
for (i = 0; i < 11; i++) {
|
||
|
|
mhpcRevInfo.board[i] =
|
||
|
|
(char) toupper (console_buffer[i]);
|
||
|
|
mhpcRevInfo.board[11] = '\0';
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
printf ("Supported sensor types:\n");
|
||
|
|
i = 0;
|
||
|
|
do {
|
||
|
|
printf ("\n \'%d\' : %s\n", i, mhpcSensorTypes[i]);
|
||
|
|
} while (mhpcSensorTypes[++i] != NULL);
|
||
|
|
|
||
|
|
do {
|
||
|
|
printf ("\nEnter sensor number (0-255): %d ",
|
||
|
|
(int) mhpcRevInfo.sensor);
|
||
|
|
if (0 != readline (NULL)) {
|
||
|
|
mhpcRevInfo.sensor =
|
||
|
|
(unsigned char)
|
||
|
|
simple_strtoul (console_buffer, NULL,
|
||
|
|
10);
|
||
|
|
}
|
||
|
|
} while (mhpcRevInfo.sensor >= i);
|
||
|
|
|
||
|
|
printf ("Enter serial number: %s ",
|
||
|
|
(char *) &mhpcRevInfo.serial);
|
||
|
|
if (6 == readline (NULL)) {
|
||
|
|
for (i = 0; i < 6; i++) {
|
||
|
|
mhpcRevInfo.serial[i] = console_buffer[i];
|
||
|
|
}
|
||
|
|
mhpcRevInfo.serial[6] = '\0';
|
||
|
|
}
|
||
|
|
|
||
|
|
printf ("Enter ether node ID with leading zero (HEX): %02x%02x%02x%02x%02x%02x ", mhpcRevInfo.etheraddr[0], mhpcRevInfo.etheraddr[1], mhpcRevInfo.etheraddr[2], mhpcRevInfo.etheraddr[3], mhpcRevInfo.etheraddr[4], mhpcRevInfo.etheraddr[5]);
|
||
|
|
if (12 == readline (NULL)) {
|
||
|
|
for (i = 0; i < 12; i += 2) {
|
||
|
|
mhpcRevInfo.etheraddr[i >> 1] =
|
||
|
|
(char) (16 *
|
||
|
|
hex[toupper
|
||
|
|
(console_buffer[i]) -
|
||
|
|
'0'] +
|
||
|
|
hex[toupper
|
||
|
|
(console_buffer[i + 1]) -
|
||
|
|
'0']);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* setup new revision data */
|
||
|
|
eeprom_write (CFG_I2C_EEPROM_ADDR, 480, (uchar *) &mhpcRevInfo,
|
||
|
|
32);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* set environment */
|
||
|
|
sprintf (nid, "%02x:%02x:%02x:%02x:%02x:%02x",
|
||
|
|
mhpcRevInfo.etheraddr[0], mhpcRevInfo.etheraddr[1],
|
||
|
|
mhpcRevInfo.etheraddr[2], mhpcRevInfo.etheraddr[3],
|
||
|
|
mhpcRevInfo.etheraddr[4], mhpcRevInfo.etheraddr[5]);
|
||
|
|
setenv ("ethaddr", nid);
|
||
|
|
|
||
|
|
/* print actual board identification */
|
||
|
|
printf ("Ident: %s %s Ser %s Rev %c%c\n",
|
||
|
|
mhpcRevInfo.board,
|
||
|
|
(mhpcRevInfo.sensor == 0 ? "color" : "b&w"),
|
||
|
|
(char *) &mhpcRevInfo.serial, mhpcRevInfo.revision[0],
|
||
|
|
mhpcRevInfo.revision[1]);
|
||
|
|
|
||
|
|
return (0);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
long int initdram (int board_type)
|
||
|
|
{
|
||
|
|
volatile immap_t *immap = (immap_t *) CFG_IMMR;
|
||
|
|
volatile memctl8xx_t *memctl = &immap->im_memctl;
|
||
|
|
|
||
|
|
upmconfig (UPMA, (uint *) sdram_table,
|
||
|
|
sizeof (sdram_table) / sizeof (uint));
|
||
|
|
|
||
|
|
memctl->memc_mamr = CFG_MAMR & (~(MAMR_PTAE)); /* no refresh yet */
|
||
|
|
memctl->memc_mbmr = MBMR_GPL_B4DIS; /* should this be mamr? - NTL */
|
||
|
|
memctl->memc_mptpr = MPTPR_PTP_DIV64;
|
||
|
|
memctl->memc_mar = 0x00008800;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Map controller SDRAM bank 0
|
||
|
|
*/
|
||
|
|
memctl->memc_or1 = CFG_OR1_PRELIM;
|
||
|
|
memctl->memc_br1 = CFG_BR1_PRELIM;
|
||
|
|
udelay (200);
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Map controller SDRAM bank 1
|
||
|
|
*/
|
||
|
|
memctl->memc_or2 = CFG_OR2;
|
||
|
|
memctl->memc_br2 = CFG_BR2;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Perform SDRAM initializsation sequence
|
||
|
|
*/
|
||
|
|
memctl->memc_mcr = 0x80002105; /* SDRAM bank 0 */
|
||
|
|
udelay (1);
|
||
|
|
memctl->memc_mcr = 0x80002730; /* SDRAM bank 0 - execute twice */
|
||
|
|
udelay (1);
|
||
|
|
memctl->memc_mamr |= MAMR_PTAE; /* enable refresh */
|
||
|
|
|
||
|
|
udelay (10000);
|
||
|
|
|
||
|
|
/* leave place for framebuffers */
|
||
|
|
return (SDRAM_MAX_SIZE - SDRAM_RES_SIZE);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
static void video_circle (char *center, int radius, int color, int pitch)
|
||
|
|
{
|
||
|
|
int x, y, d, dE, dSE;
|
||
|
|
|
||
|
|
x = 0;
|
||
|
|
y = radius;
|
||
|
|
d = 1 - radius;
|
||
|
|
dE = 3;
|
||
|
|
dSE = -2 * radius + 5;
|
||
|
|
|
||
|
|
*(center + x + y * pitch) = color;
|
||
|
|
*(center + y + x * pitch) = color;
|
||
|
|
*(center + y - x * pitch) = color;
|
||
|
|
*(center + x - y * pitch) = color;
|
||
|
|
*(center - x - y * pitch) = color;
|
||
|
|
*(center - y - x * pitch) = color;
|
||
|
|
*(center - y + x * pitch) = color;
|
||
|
|
*(center - x + y * pitch) = color;
|
||
|
|
while (y > x) {
|
||
|
|
if (d < 0) {
|
||
|
|
d += dE;
|
||
|
|
dE += 2;
|
||
|
|
dSE += 2;
|
||
|
|
x++;
|
||
|
|
} else {
|
||
|
|
d += dSE;
|
||
|
|
dE += 2;
|
||
|
|
dSE += 4;
|
||
|
|
x++;
|
||
|
|
y--;
|
||
|
|
}
|
||
|
|
*(center + x + y * pitch) = color;
|
||
|
|
*(center + y + x * pitch) = color;
|
||
|
|
*(center + y - x * pitch) = color;
|
||
|
|
*(center + x - y * pitch) = color;
|
||
|
|
*(center - x - y * pitch) = color;
|
||
|
|
*(center - y - x * pitch) = color;
|
||
|
|
*(center - y + x * pitch) = color;
|
||
|
|
*(center - x + y * pitch) = color;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
static void video_test_image (void)
|
||
|
|
{
|
||
|
|
char *di;
|
||
|
|
int i, n;
|
||
|
|
|
||
|
|
/* draw raster */
|
||
|
|
for (i = 0; i < LCD_VIDEO_ROWS; i += 32) {
|
||
|
|
memset ((char *) (LCD_VIDEO_ADDR + i * LCD_VIDEO_COLS),
|
||
|
|
LCD_VIDEO_FG, LCD_VIDEO_COLS);
|
||
|
|
for (n = i + 1; n < i + 32; n++)
|
||
|
|
memset ((char *) (LCD_VIDEO_ADDR +
|
||
|
|
n * LCD_VIDEO_COLS), LCD_VIDEO_BG,
|
||
|
|
LCD_VIDEO_COLS);
|
||
|
|
}
|
||
|
|
|
||
|
|
for (i = 0; i < LCD_VIDEO_COLS; i += 32) {
|
||
|
|
for (n = 0; n < LCD_VIDEO_ROWS; n++)
|
||
|
|
*(char *) (LCD_VIDEO_ADDR + n * LCD_VIDEO_COLS + i) =
|
||
|
|
LCD_VIDEO_FG;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* draw gray bar */
|
||
|
|
di = (char *) (LCD_VIDEO_ADDR + (LCD_VIDEO_COLS - 256) / 64 * 32 +
|
||
|
|
97 * LCD_VIDEO_COLS);
|
||
|
|
for (n = 0; n < 63; n++) {
|
||
|
|
for (i = 0; i < 256; i++) {
|
||
|
|
*di++ = (char) i;
|
||
|
|
*(di + LCD_VIDEO_COLS * 64) = (i & 1) * 255;
|
||
|
|
}
|
||
|
|
di += LCD_VIDEO_COLS - 256;
|
||
|
|
}
|
||
|
|
|
||
|
|
video_circle ((char *) LCD_VIDEO_ADDR + LCD_VIDEO_COLS / 2 +
|
||
|
|
LCD_VIDEO_ROWS / 2 * LCD_VIDEO_COLS, LCD_VIDEO_ROWS / 2,
|
||
|
|
LCD_VIDEO_FG, LCD_VIDEO_COLS);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
static void video_default_lut (unsigned int clut_type)
|
||
|
|
{
|
||
|
|
unsigned int i;
|
||
|
|
unsigned char RGB[] = {
|
||
|
|
0x00, 0x00, 0x00, /* black */
|
||
|
|
0x80, 0x80, 0x80, /* gray */
|
||
|
|
0xff, 0x00, 0x00, /* red */
|
||
|
|
0x00, 0xff, 0x00, /* green */
|
||
|
|
0x00, 0x00, 0xff, /* blue */
|
||
|
|
0x00, 0xff, 0xff, /* cyan */
|
||
|
|
0xff, 0x00, 0xff, /* magenta */
|
||
|
|
0xff, 0xff, 0x00, /* yellow */
|
||
|
|
0x80, 0x00, 0x00, /* dark red */
|
||
|
|
0x00, 0x80, 0x00, /* dark green */
|
||
|
|
0x00, 0x00, 0x80, /* dark blue */
|
||
|
|
0x00, 0x80, 0x80, /* dark cyan */
|
||
|
|
0x80, 0x00, 0x80, /* dark magenta */
|
||
|
|
0x80, 0x80, 0x00, /* dark yellow */
|
||
|
|
0xc0, 0xc0, 0xc0, /* light gray */
|
||
|
|
0xff, 0xff, 0xff, /* white */
|
||
|
|
};
|
||
|
|
|
||
|
|
switch (clut_type) {
|
||
|
|
case 1:
|
||
|
|
for (i = 0; i < 240; i++)
|
||
|
|
video_set_lut (i, i, i, i);
|
||
|
|
for (i = 0; i < 16; i++)
|
||
|
|
video_set_lut (i + 240, RGB[i * 3], RGB[i * 3 + 1],
|
||
|
|
RGB[i * 3 + 2]);
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
for (i = 0; i < 256; i++)
|
||
|
|
video_set_lut (i, i, i, i);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
void *video_hw_init (void)
|
||
|
|
{
|
||
|
|
unsigned int clut = 0;
|
||
|
|
unsigned char *penv;
|
||
|
|
immap_t *immr = (immap_t *) CFG_IMMR;
|
||
|
|
|
||
|
|
/* enable video only on CLUT value */
|
||
|
|
if ((penv = (uchar *)getenv ("clut")) != NULL)
|
||
|
|
clut = (u_int) simple_strtoul ((char *)penv, NULL, 10);
|
||
|
|
else
|
||
|
|
return NULL;
|
||
|
|
|
||
|
|
/* disable graphic before write LCD regs. */
|
||
|
|
immr->im_lcd.lcd_lccr = 0x96000866;
|
||
|
|
|
||
|
|
/* config LCD regs. */
|
||
|
|
immr->im_lcd.lcd_lcfaa = LCD_VIDEO_ADDR;
|
||
|
|
immr->im_lcd.lcd_lchcr = 0x010a0093;
|
||
|
|
immr->im_lcd.lcd_lcvcr = 0x900f0024;
|
||
|
|
|
||
|
|
printf ("Video: 640x480 8Bit Index Lut %s\n",
|
||
|
|
(clut == 1 ? "240/16 (gray/vga)" : "256(gray)"));
|
||
|
|
|
||
|
|
video_default_lut (clut);
|
||
|
|
|
||
|
|
/* clear framebuffer */
|
||
|
|
memset ((char *) (LCD_VIDEO_ADDR), LCD_VIDEO_BG,
|
||
|
|
LCD_VIDEO_ROWS * LCD_VIDEO_COLS);
|
||
|
|
|
||
|
|
/* enable graphic */
|
||
|
|
immr->im_lcd.lcd_lccr = 0x96000867;
|
||
|
|
|
||
|
|
/* fill in Graphic Device */
|
||
|
|
gdev.frameAdrs = LCD_VIDEO_ADDR;
|
||
|
|
gdev.winSizeX = LCD_VIDEO_COLS;
|
||
|
|
gdev.winSizeY = LCD_VIDEO_ROWS;
|
||
|
|
gdev.gdfBytesPP = 1;
|
||
|
|
gdev.gdfIndex = GDF__8BIT_INDEX;
|
||
|
|
|
||
|
|
if (clut > 1)
|
||
|
|
/* return Graphic Device for console */
|
||
|
|
return (void *) &gdev;
|
||
|
|
else
|
||
|
|
/* just graphic enabled - draw something beautiful */
|
||
|
|
video_test_image ();
|
||
|
|
|
||
|
|
return NULL; /* this disabels cfb - console */
|
||
|
|
}
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|
||
|
|
|
||
|
|
void video_set_lut (unsigned int index,
|
||
|
|
unsigned char r, unsigned char g, unsigned char b)
|
||
|
|
{
|
||
|
|
unsigned int lum;
|
||
|
|
unsigned short *pLut = (unsigned short *) (CFG_IMMR + 0x0e00);
|
||
|
|
|
||
|
|
/* 16 bit lut values, 12 bit used, xxxx BBGG RRii iiii */
|
||
|
|
/* y = 0.299*R + 0.587*G + 0.114*B */
|
||
|
|
lum = (2990 * r + 5870 * g + 1140 * b) / 10000;
|
||
|
|
pLut[index] =
|
||
|
|
((b & 0xc0) << 4) | ((g & 0xc0) << 2) | (r & 0xc0) | (lum &
|
||
|
|
0x3f);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* ------------------------------------------------------------------------- */
|