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 != 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 == 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 == 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 != 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 == 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 == 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 /* ------------------------------------------------------------------------- */