Initial revision

1 files changed, 477 insertions, 0 deletions

diff --git a/board/eltec/mhpc/mhpc.c b/board/eltec/mhpc/mhpc.c
new file mode 100644
index 0000000..81f820a
--- /dev/null
+++ b/board/eltec/mhpc/mhpc.c
@@ -0,0 +1,477 @@
+/*
+ * (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_pre_init (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, (char*)&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, (char*)&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  = MAMR_GPL_B4DIS;
+    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 = getenv ("clut")) != NULL)
+        clut = (u_int)simple_strtoul (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);
+}
+
+/* ------------------------------------------------------------------------- */