4 * Frank Gottschling <fgottschling@eltec.de>
6 * Board specific routines for the miniHiPerCam
8 * - initialisation (eeprom)
10 * - serial io initialisation
11 * - ethernet io initialisation
13 * -----------------------------------------------------------------
14 * SPDX-License-Identifier: GPL-2.0+
18 #include <linux/ctype.h>
23 extern void eeprom_init (void);
24 extern int eeprom_read (unsigned dev_addr, unsigned offset,
25 unsigned char *buffer, unsigned cnt);
26 extern int eeprom_write (unsigned dev_addr, unsigned offset,
27 unsigned char *buffer, unsigned cnt);
30 void *video_hw_init (void);
31 void video_set_lut (unsigned int index, /* color number */
32 unsigned char r, /* red */
33 unsigned char g, /* green */
34 unsigned char b /* blue */
40 static void video_circle (char *center, int radius, int color, int pitch);
41 static void video_test_image (void);
42 static void video_default_lut (unsigned int clut_type);
44 /* revision info foer MHPC EEPROM offset 480 */
46 char board[12]; /* 000 - Board Revision information */
47 char sensor; /* 012 - Sensor Type information */
48 char serial[8]; /* 013 - Board serial number */
49 char etheraddr[6]; /* 021 - Ethernet node addresse */
50 char revision[2]; /* 027 - Revision code */
51 char option[3]; /* 029 - resevered for options */
54 /* ------------------------------------------------------------------------- */
56 static const unsigned int sdram_table[] = {
57 /* read single beat cycle */
58 0xef0efc04, 0x0e2dac04, 0x01ba5c04, 0x1ff5fc00,
59 0xfffffc05, 0xeffafc34, 0x0ff0bc34, 0x1ff57c35,
61 /* read burst cycle */
62 0xef0efc04, 0x0e3dac04, 0x10ff5c04, 0xf0fffc00,
63 0xf0fffc00, 0xf1fffc00, 0xfffffc00, 0xfffffc05,
64 0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
65 0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
67 /* write single beat cycle */
68 0xef0efc04, 0x0e29ac00, 0x01b25c04, 0x1ff5fc05,
69 0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
71 /* write burst cycle */
72 0xef0ef804, 0x0e39a000, 0x10f75000, 0xf0fff440,
73 0xf0fffc40, 0xf1fffc04, 0xfffffc05, 0xfffffc04,
74 0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
75 0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
77 /* periodic timer expired */
78 0xeffebc84, 0x1ffd7c04, 0xfffffc04, 0xfffffc84,
79 0xeffebc04, 0x1ffd7c04, 0xfffffc04, 0xfffffc05,
80 0xfffffc04, 0xfffffc04, 0xfffffc04, 0xfffffc04,
83 0xfffffc04, 0xfffffc05, 0xfffffc04, 0xfffffc04
86 /* ------------------------------------------------------------------------- */
88 int board_early_init_f (void)
90 volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
91 volatile cpm8xx_t *cp = &(im->im_cpm);
92 volatile iop8xx_t *ip = (iop8xx_t *) & (im->im_ioport);
94 /* reset the port A s.a. cpm-routines */
95 ip->iop_padat = 0x0000;
96 ip->iop_papar = 0x0000;
97 ip->iop_padir = 0x0800;
98 ip->iop_paodr = 0x0000;
100 /* reset the port B for digital and LCD output */
101 cp->cp_pbdat = 0x0300;
102 cp->cp_pbpar = 0x5001;
103 cp->cp_pbdir = 0x5301;
104 cp->cp_pbodr = 0x0000;
106 /* reset the port C configured for SMC1 serial port and aqc. control */
107 ip->iop_pcdat = 0x0800;
108 ip->iop_pcpar = 0x0000;
109 ip->iop_pcdir = 0x0e30;
110 ip->iop_pcso = 0x0000;
112 /* Config port D for LCD output */
113 ip->iop_pdpar = 0x1fff;
114 ip->iop_pddir = 0x1fff;
119 /* ------------------------------------------------------------------------- */
122 * Check Board Identity
124 int checkboard (void)
126 puts ("Board: ELTEC miniHiperCam\n");
130 /* ------------------------------------------------------------------------- */
132 int misc_init_r (void)
136 char *mhpcSensorTypes[] = { "OMNIVISON OV7610/7620 color",
137 "OMNIVISON OV7110 b&w", NULL
139 char hex[23] = { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 0, 0, 0,
140 0, 0, 0, 0, 10, 11, 12, 13, 14, 15
144 /* check revision data */
145 eeprom_read (CONFIG_SYS_I2C_EEPROM_ADDR, 480, (uchar *) &mhpcRevInfo, 32);
147 if (strncmp ((char *) &mhpcRevInfo.board[2], "MHPC", 4) != 0) {
148 printf ("Enter revision number (0-9): %c ",
149 mhpcRevInfo.revision[0]);
150 if (0 != cli_readline(NULL)) {
151 mhpcRevInfo.revision[0] =
152 (char) toupper (console_buffer[0]);
155 printf ("Enter revision character (A-Z): %c ",
156 mhpcRevInfo.revision[1]);
157 if (1 == cli_readline(NULL)) {
158 mhpcRevInfo.revision[1] =
159 (char) toupper (console_buffer[0]);
162 printf ("Enter board name (V-XXXX-XXXX): %s ",
163 (char *) &mhpcRevInfo.board);
164 if (11 == cli_readline(NULL)) {
165 for (i = 0; i < 11; i++) {
166 mhpcRevInfo.board[i] =
167 (char) toupper (console_buffer[i]);
168 mhpcRevInfo.board[11] = '\0';
172 printf ("Supported sensor types:\n");
175 printf ("\n \'%d\' : %s\n", i, mhpcSensorTypes[i]);
176 } while (mhpcSensorTypes[++i] != NULL);
179 printf ("\nEnter sensor number (0-255): %d ",
180 (int) mhpcRevInfo.sensor);
181 if (0 != cli_readline(NULL)) {
184 simple_strtoul (console_buffer, NULL,
187 } while (mhpcRevInfo.sensor >= i);
189 printf ("Enter serial number: %s ",
190 (char *) &mhpcRevInfo.serial);
191 if (6 == cli_readline(NULL)) {
192 for (i = 0; i < 6; i++) {
193 mhpcRevInfo.serial[i] = console_buffer[i];
195 mhpcRevInfo.serial[6] = '\0';
198 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]);
199 if (12 == cli_readline(NULL)) {
200 for (i = 0; i < 12; i += 2) {
201 mhpcRevInfo.etheraddr[i >> 1] =
204 (console_buffer[i]) -
207 (console_buffer[i + 1]) -
212 /* setup new revision data */
213 eeprom_write (CONFIG_SYS_I2C_EEPROM_ADDR, 480, (uchar *) &mhpcRevInfo,
217 /* set environment */
218 sprintf (nid, "%02x:%02x:%02x:%02x:%02x:%02x",
219 mhpcRevInfo.etheraddr[0], mhpcRevInfo.etheraddr[1],
220 mhpcRevInfo.etheraddr[2], mhpcRevInfo.etheraddr[3],
221 mhpcRevInfo.etheraddr[4], mhpcRevInfo.etheraddr[5]);
222 setenv ("ethaddr", nid);
224 /* print actual board identification */
225 printf ("Ident: %s %s Ser %s Rev %c%c\n",
227 (mhpcRevInfo.sensor == 0 ? "color" : "b&w"),
228 (char *) &mhpcRevInfo.serial, mhpcRevInfo.revision[0],
229 mhpcRevInfo.revision[1]);
234 /* ------------------------------------------------------------------------- */
236 phys_size_t initdram (int board_type)
238 volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
239 volatile memctl8xx_t *memctl = &immap->im_memctl;
241 upmconfig (UPMA, (uint *) sdram_table,
242 sizeof (sdram_table) / sizeof (uint));
244 memctl->memc_mamr = CONFIG_SYS_MAMR & (~(MAMR_PTAE)); /* no refresh yet */
245 memctl->memc_mbmr = MBMR_GPL_B4DIS; /* should this be mamr? - NTL */
246 memctl->memc_mptpr = MPTPR_PTP_DIV64;
247 memctl->memc_mar = 0x00008800;
250 * Map controller SDRAM bank 0
252 memctl->memc_or1 = CONFIG_SYS_OR1_PRELIM;
253 memctl->memc_br1 = CONFIG_SYS_BR1_PRELIM;
257 * Map controller SDRAM bank 1
259 memctl->memc_or2 = CONFIG_SYS_OR2;
260 memctl->memc_br2 = CONFIG_SYS_BR2;
263 * Perform SDRAM initializsation sequence
265 memctl->memc_mcr = 0x80002105; /* SDRAM bank 0 */
267 memctl->memc_mcr = 0x80002730; /* SDRAM bank 0 - execute twice */
269 memctl->memc_mamr |= MAMR_PTAE; /* enable refresh */
273 /* leave place for framebuffers */
274 return (SDRAM_MAX_SIZE - SDRAM_RES_SIZE);
277 /* ------------------------------------------------------------------------- */
279 static void video_circle (char *center, int radius, int color, int pitch)
281 int x, y, d, dE, dSE;
287 dSE = -2 * radius + 5;
289 *(center + x + y * pitch) = color;
290 *(center + y + x * pitch) = color;
291 *(center + y - x * pitch) = color;
292 *(center + x - y * pitch) = color;
293 *(center - x - y * pitch) = color;
294 *(center - y - x * pitch) = color;
295 *(center - y + x * pitch) = color;
296 *(center - x + y * pitch) = color;
310 *(center + x + y * pitch) = color;
311 *(center + y + x * pitch) = color;
312 *(center + y - x * pitch) = color;
313 *(center + x - y * pitch) = color;
314 *(center - x - y * pitch) = color;
315 *(center - y - x * pitch) = color;
316 *(center - y + x * pitch) = color;
317 *(center - x + y * pitch) = color;
321 /* ------------------------------------------------------------------------- */
323 static void video_test_image (void)
329 for (i = 0; i < LCD_VIDEO_ROWS; i += 32) {
330 memset ((char *) (LCD_VIDEO_ADDR + i * LCD_VIDEO_COLS),
331 LCD_VIDEO_FG, LCD_VIDEO_COLS);
332 for (n = i + 1; n < i + 32; n++)
333 memset ((char *) (LCD_VIDEO_ADDR +
334 n * LCD_VIDEO_COLS), LCD_VIDEO_BG,
338 for (i = 0; i < LCD_VIDEO_COLS; i += 32) {
339 for (n = 0; n < LCD_VIDEO_ROWS; n++)
340 *(char *) (LCD_VIDEO_ADDR + n * LCD_VIDEO_COLS + i) =
345 di = (char *) (LCD_VIDEO_ADDR + (LCD_VIDEO_COLS - 256) / 64 * 32 +
346 97 * LCD_VIDEO_COLS);
347 for (n = 0; n < 63; n++) {
348 for (i = 0; i < 256; i++) {
350 *(di + LCD_VIDEO_COLS * 64) = (i & 1) * 255;
352 di += LCD_VIDEO_COLS - 256;
355 video_circle ((char *) LCD_VIDEO_ADDR + LCD_VIDEO_COLS / 2 +
356 LCD_VIDEO_ROWS / 2 * LCD_VIDEO_COLS, LCD_VIDEO_ROWS / 2,
357 LCD_VIDEO_FG, LCD_VIDEO_COLS);
360 /* ------------------------------------------------------------------------- */
362 static void video_default_lut (unsigned int clut_type)
365 unsigned char RGB[] = {
366 0x00, 0x00, 0x00, /* black */
367 0x80, 0x80, 0x80, /* gray */
368 0xff, 0x00, 0x00, /* red */
369 0x00, 0xff, 0x00, /* green */
370 0x00, 0x00, 0xff, /* blue */
371 0x00, 0xff, 0xff, /* cyan */
372 0xff, 0x00, 0xff, /* magenta */
373 0xff, 0xff, 0x00, /* yellow */
374 0x80, 0x00, 0x00, /* dark red */
375 0x00, 0x80, 0x00, /* dark green */
376 0x00, 0x00, 0x80, /* dark blue */
377 0x00, 0x80, 0x80, /* dark cyan */
378 0x80, 0x00, 0x80, /* dark magenta */
379 0x80, 0x80, 0x00, /* dark yellow */
380 0xc0, 0xc0, 0xc0, /* light gray */
381 0xff, 0xff, 0xff, /* white */
386 for (i = 0; i < 240; i++)
387 video_set_lut (i, i, i, i);
388 for (i = 0; i < 16; i++)
389 video_set_lut (i + 240, RGB[i * 3], RGB[i * 3 + 1],
393 for (i = 0; i < 256; i++)
394 video_set_lut (i, i, i, i);
398 /* ------------------------------------------------------------------------- */
400 void *video_hw_init (void)
402 unsigned int clut = 0;
404 immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
406 /* enable video only on CLUT value */
407 if ((penv = (uchar *)getenv ("clut")) != NULL)
408 clut = (u_int) simple_strtoul ((char *)penv, NULL, 10);
412 /* disable graphic before write LCD regs. */
413 immr->im_lcd.lcd_lccr = 0x96000866;
415 /* config LCD regs. */
416 immr->im_lcd.lcd_lcfaa = LCD_VIDEO_ADDR;
417 immr->im_lcd.lcd_lchcr = 0x010a0093;
418 immr->im_lcd.lcd_lcvcr = 0x900f0024;
420 printf ("Video: 640x480 8Bit Index Lut %s\n",
421 (clut == 1 ? "240/16 (gray/vga)" : "256(gray)"));
423 video_default_lut (clut);
425 /* clear framebuffer */
426 memset ((char *) (LCD_VIDEO_ADDR), LCD_VIDEO_BG,
427 LCD_VIDEO_ROWS * LCD_VIDEO_COLS);
430 immr->im_lcd.lcd_lccr = 0x96000867;
432 /* fill in Graphic Device */
433 gdev.frameAdrs = LCD_VIDEO_ADDR;
434 gdev.winSizeX = LCD_VIDEO_COLS;
435 gdev.winSizeY = LCD_VIDEO_ROWS;
437 gdev.gdfIndex = GDF__8BIT_INDEX;
440 /* return Graphic Device for console */
441 return (void *) &gdev;
443 /* just graphic enabled - draw something beautiful */
446 return NULL; /* this disabels cfb - console */
449 /* ------------------------------------------------------------------------- */
451 void video_set_lut (unsigned int index,
452 unsigned char r, unsigned char g, unsigned char b)
455 unsigned short *pLut = (unsigned short *) (CONFIG_SYS_IMMR + 0x0e00);
457 /* 16 bit lut values, 12 bit used, xxxx BBGG RRii iiii */
458 /* y = 0.299*R + 0.587*G + 0.114*B */
459 lum = (2990 * r + 5870 * g + 1140 * b) / 10000;
461 ((b & 0xc0) << 4) | ((g & 0xc0) << 2) | (r & 0xc0) | (lum &
465 /* ------------------------------------------------------------------------- */