/* * (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);}/* ------------------------------------------------------------------------- */