Subversion Repositories or1k

/*

 *  arch/m68k/mvme16x/config.c

 *

 *  Copyright (C) 1995 Richard Hirst [richard@sleepie.demon.co.uk]

 *

 * Based on:

 *

 *  linux/amiga/config.c

 *

 *  Copyright (C) 1993 Hamish Macdonald

 *

 * This file is subject to the terms and conditions of the GNU General Public

 * License.  See the file README.legal in the main directory of this archive

 * for more details.

 */

#include <linux/types.h>

#include <linux/kernel.h>

#include <linux/mm.h>

#include <linux/tty.h>

#include <linux/console.h>

#include <linux/linkage.h>

#include <linux/init.h>

#include <linux/major.h>

#include <asm/bootinfo.h>

#include <asm/system.h>

#include <asm/pgtable.h>

#include <asm/setup.h>

#include <asm/irq.h>

#include <asm/traps.h>

#include <asm/rtc.h>

#include <asm/machdep.h>

#include <asm/mvme16xhw.h>

extern t_bdid mvme_bdid;

static MK48T08ptr_t volatile rtc = (MK48T08ptr_t)MVME_RTC_BASE;

extern void mvme16x_process_int (int level, struct pt_regs *regs);

extern void mvme16x_init_IRQ (void);

extern void mvme16x_free_irq (unsigned int, void *);

extern int  mvme16x_get_irq_list (char *);

extern void mvme16x_enable_irq (unsigned int);

extern void mvme16x_disable_irq (unsigned int);

static void mvme16x_get_model(char *model);

static int  mvme16x_get_hardware_list(char *buffer);

extern int  mvme16x_request_irq(unsigned int irq, void (*handler)(int, void *, struct pt_regs *), unsigned long flags, const char *devname, void *dev_id);

extern void mvme16x_sched_init(void (*handler)(int, void *, struct pt_regs *));

extern int  mvme16x_keyb_init(void);

extern int  mvme16x_kbdrate (struct kbd_repeat *);

extern unsigned long mvme16x_gettimeoffset (void);

extern void mvme16x_gettod (int *year, int *mon, int *day, int *hour,

                           int *min, int *sec);

extern int mvme16x_hwclk (int, struct rtc_time *);

extern int mvme16x_set_clock_mmss (unsigned long);

extern void mvme16x_check_partition (struct gendisk *hd, unsigned int dev);

extern void mvme16x_mksound( unsigned int count, unsigned int ticks );

extern void mvme16x_reset (void);

extern void mvme16x_waitbut(void);

int bcd2int (unsigned char b);

/* Save tick handler routine pointer, will point to do_timer() in

 * kernel/sched.c, called via mvme16x_process_int() */

static void (*tick_handler)(int, void *, struct pt_regs *);

unsigned short mvme16x_config;

int mvme16x_parse_bootinfo(const struct bi_record *bi)

{

        if (bi->tag == BI_VME_TYPE || bi->tag == BI_VME_BRDINFO)

                return 0;

        else

                return 1;

}

int mvme16x_kbdrate (struct kbd_repeat *k)

{

        return 0;

}

void mvme16x_mksound( unsigned int count, unsigned int ticks )

{

}

void mvme16x_reset()

{

        printk ("\r\n\nCalled mvme16x_reset\r\n"

                        "\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r\r");

        /* The string of returns is to delay the reset until the whole

         * message is output.  Assert reset bit in GCSR */

        *(volatile char *)0xfff40107 = 0x80;

}

static void mvme16x_get_model(char *model)

{

    p_bdid p = &mvme_bdid;

    char suf[4];

    suf[1] = p->brdsuffix[0];

    suf[2] = p->brdsuffix[1];

    suf[3] = '\0';

    suf[0] = suf[1] ? '-' : '\0';

    sprintf(model, "Motorola MVME%x%s", p->brdno, suf);

}

static int mvme16x_get_hardware_list(char *buffer)

{

    p_bdid p = &mvme_bdid;

    int len = 0;

    if (p->brdno == 0x0162 || p->brdno == 0x0172)

    {

        unsigned char rev = *(unsigned char *)MVME162_VERSION_REG;

        len += sprintf (buffer+len, "VMEchip2        %spresent\n",

                        rev & MVME16x_CONFIG_NO_VMECHIP2 ? "NOT " : "");

        len += sprintf (buffer+len, "SCSI interface  %spresent\n",

                        rev & MVME16x_CONFIG_NO_SCSICHIP ? "NOT " : "");

        len += sprintf (buffer+len, "Ethernet i/f    %spresent\n",

                        rev & MVME16x_CONFIG_NO_ETHERNET ? "NOT " : "");

    }

    else

        *buffer = '\0';

    return (len);

}

#define pcc2chip        ((volatile u_char *)0xfff42000)

#define PccSCCMICR      0x1d

#define PccSCCTICR      0x1e

#define PccSCCRICR      0x1f

void __init config_mvme16x(void)

{

    p_bdid p = &mvme_bdid;

    char id[40];

    mach_max_dma_address = 0xffffffff;

    mach_sched_init      = mvme16x_sched_init;

#ifdef CONFIG_VT

    mach_keyb_init       = mvme16x_keyb_init;

    mach_kbdrate         = mvme16x_kbdrate;

/*  kd_mksound           = mvme16x_mksound; */

#endif

    mach_init_IRQ        = mvme16x_init_IRQ;

    mach_gettimeoffset   = mvme16x_gettimeoffset;

    mach_gettod          = mvme16x_gettod;

    mach_hwclk           = mvme16x_hwclk;

    mach_set_clock_mmss  = mvme16x_set_clock_mmss;

    mach_reset           = mvme16x_reset;

    mach_free_irq        = mvme16x_free_irq;

    mach_process_int     = mvme16x_process_int;

    mach_get_irq_list    = mvme16x_get_irq_list;

    mach_request_irq     = mvme16x_request_irq;

    enable_irq           = mvme16x_enable_irq;

    disable_irq          = mvme16x_disable_irq;

    mach_get_model       = mvme16x_get_model;

    mach_get_hardware_list = mvme16x_get_hardware_list;

    /* Report board revision */

    if (strncmp("BDID", p->bdid, 4))

    {

        printk ("\n\nBug call .BRD_ID returned garbage - giving up\n\n");

        while (1)

                ;

    }

    /* Board type is only set by newer versions of vmelilo/tftplilo */

    if (vme_brdtype == 0)

        vme_brdtype = p->brdno;

    mvme16x_get_model(id);

    printk ("\nBRD_ID: %s   BUG %x.%x %02x/%02x/%02x\n", id, p->rev>>4,

                                        p->rev&0xf, p->yr, p->mth, p->day);

    if (p->brdno == 0x0162 || p->brdno == 0x172)

    {

        unsigned char rev = *(unsigned char *)MVME162_VERSION_REG;

        mvme16x_config = rev | MVME16x_CONFIG_GOT_SCCA;

        printk ("MVME%x Hardware status:\n", p->brdno);

        printk ("    CPU Type           68%s040\n",

                        rev & MVME16x_CONFIG_GOT_FPU ? "" : "LC");

        printk ("    CPU clock          %dMHz\n",

                        rev & MVME16x_CONFIG_SPEED_32 ? 32 : 25);

        printk ("    VMEchip2           %spresent\n",

                        rev & MVME16x_CONFIG_NO_VMECHIP2 ? "NOT " : "");

        printk ("    SCSI interface     %spresent\n",

                        rev & MVME16x_CONFIG_NO_SCSICHIP ? "NOT " : "");

        printk ("    Ethernet interface %spresent\n",

                        rev & MVME16x_CONFIG_NO_ETHERNET ? "NOT " : "");

    }

    else

    {

        mvme16x_config = MVME16x_CONFIG_GOT_LP | MVME16x_CONFIG_GOT_CD2401;

        /* Dont allow any interrupts from the CD2401 until the interrupt */

        /* handlers are installed                                        */

        pcc2chip[PccSCCMICR] = 0x10;

        pcc2chip[PccSCCTICR] = 0x10;

        pcc2chip[PccSCCRICR] = 0x10;

    }

}

static void mvme16x_abort_int (int irq, void *dev_id, struct pt_regs *fp)

{

        p_bdid p = &mvme_bdid;

        unsigned long *new = (unsigned long *)vectors;

        unsigned long *old = (unsigned long *)0xffe00000;

        volatile unsigned char uc, *ucp;

        if (p->brdno == 0x0162 || p->brdno == 0x172)

        {

                ucp = (volatile unsigned char *)0xfff42043;

                uc = *ucp | 8;

                *ucp = uc;

        }

        else

        {

                *(volatile unsigned long *)0xfff40074 = 0x40000000;

        }

        *(new+4) = *(old+4);            /* Illegal instruction */

        *(new+9) = *(old+9);            /* Trace */

        *(new+47) = *(old+47);          /* Trap #15 */

        if (p->brdno == 0x0162 || p->brdno == 0x172)

                *(new+0x5e) = *(old+0x5e);      /* ABORT switch */

        else

                *(new+0x6e) = *(old+0x6e);      /* ABORT switch */

}

static void mvme16x_timer_int (int irq, void *dev_id, struct pt_regs *fp)

{

    *(volatile unsigned char *)0xfff4201b |= 8;

    tick_handler(irq, dev_id, fp);

}

void mvme16x_sched_init (void (*timer_routine)(int, void *, struct pt_regs *))

{

    p_bdid p = &mvme_bdid;

    int irq;

    tick_handler = timer_routine;

    /* Using PCCchip2 or MC2 chip tick timer 1 */

    *(volatile unsigned long *)0xfff42008 = 0;

    *(volatile unsigned long *)0xfff42004 = 10000;      /* 10ms */

    *(volatile unsigned char *)0xfff42017 |= 3;

    *(volatile unsigned char *)0xfff4201b = 0x16;

    if (request_irq(MVME16x_IRQ_TIMER, mvme16x_timer_int, 0,

                                "timer", mvme16x_timer_int))

        panic ("Couldn't register timer int");

    if (p->brdno == 0x0162 || p->brdno == 0x172)

        irq = MVME162_IRQ_ABORT;

    else

        irq = MVME167_IRQ_ABORT;

    if (request_irq(irq, mvme16x_abort_int, 0,

                                "abort", mvme16x_abort_int))

        panic ("Couldn't register abort int");

}

/* This is always executed with interrupts disabled.  */

unsigned long mvme16x_gettimeoffset (void)

{

    return (*(volatile unsigned long *)0xfff42008);

}

extern void mvme16x_gettod (int *year, int *mon, int *day, int *hour,

                           int *min, int *sec)

{

        rtc->ctrl = RTC_READ;

        *year = bcd2int (rtc->bcd_year);

        *mon = bcd2int (rtc->bcd_mth);

        *day = bcd2int (rtc->bcd_dom);

        *hour = bcd2int (rtc->bcd_hr);

        *min = bcd2int (rtc->bcd_min);

        *sec = bcd2int (rtc->bcd_sec);

        rtc->ctrl = 0;

}

int bcd2int (unsigned char b)

{

        return ((b>>4)*10 + (b&15));

}

int mvme16x_hwclk(int op, struct rtc_time *t)

{

        return 0;

}

int mvme16x_set_clock_mmss (unsigned long nowtime)

{

        return 0;

}

int mvme16x_keyb_init (void)

{

        return 0;

}