From 57f0f512b273f60d52568b8c6b77e17f5636edc0 Mon Sep 17 00:00:00 2001 From: André Fabian Silva Delgado Date: Wed, 5 Aug 2015 17:04:01 -0300 Subject: Initial import --- arch/m68k/mvme147/config.c | 170 +++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 170 insertions(+) create mode 100644 arch/m68k/mvme147/config.c (limited to 'arch/m68k/mvme147/config.c') diff --git a/arch/m68k/mvme147/config.c b/arch/m68k/mvme147/config.c new file mode 100644 index 000000000..e6a3b56c6 --- /dev/null +++ b/arch/m68k/mvme147/config.c @@ -0,0 +1,170 @@ +/* + * arch/m68k/mvme147/config.c + * + * Copyright (C) 1996 Dave Frascone [chaos@mindspring.com] + * Cloned from Richard Hirst [richard@sleepie.demon.co.uk] + * + * Based on: + * + * 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 +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + + +static void mvme147_get_model(char *model); +extern void mvme147_sched_init(irq_handler_t handler); +extern u32 mvme147_gettimeoffset(void); +extern int mvme147_hwclk (int, struct rtc_time *); +extern int mvme147_set_clock_mmss (unsigned long); +extern void mvme147_reset (void); + + +static int bcd2int (unsigned char b); + +/* Save tick handler routine pointer, will point to xtime_update() in + * kernel/time/timekeeping.c, called via mvme147_process_int() */ + +irq_handler_t tick_handler; + + +int __init mvme147_parse_bootinfo(const struct bi_record *bi) +{ + uint16_t tag = be16_to_cpu(bi->tag); + if (tag == BI_VME_TYPE || tag == BI_VME_BRDINFO) + return 0; + else + return 1; +} + +void mvme147_reset(void) +{ + printk ("\r\n\nCalled mvme147_reset\r\n"); + m147_pcc->watchdog = 0x0a; /* Clear timer */ + m147_pcc->watchdog = 0xa5; /* Enable watchdog - 100ms to reset */ + while (1) + ; +} + +static void mvme147_get_model(char *model) +{ + sprintf(model, "Motorola MVME147"); +} + +/* + * This function is called during kernel startup to initialize + * the mvme147 IRQ handling routines. + */ + +void __init mvme147_init_IRQ(void) +{ + m68k_setup_user_interrupt(VEC_USER, 192); +} + +void __init config_mvme147(void) +{ + mach_max_dma_address = 0x01000000; + mach_sched_init = mvme147_sched_init; + mach_init_IRQ = mvme147_init_IRQ; + arch_gettimeoffset = mvme147_gettimeoffset; + mach_hwclk = mvme147_hwclk; + mach_set_clock_mmss = mvme147_set_clock_mmss; + mach_reset = mvme147_reset; + mach_get_model = mvme147_get_model; + + /* Board type is only set by newer versions of vmelilo/tftplilo */ + if (!vme_brdtype) + vme_brdtype = VME_TYPE_MVME147; +} + + +/* Using pcc tick timer 1 */ + +static irqreturn_t mvme147_timer_int (int irq, void *dev_id) +{ + m147_pcc->t1_int_cntrl = PCC_TIMER_INT_CLR; + m147_pcc->t1_int_cntrl = PCC_INT_ENAB|PCC_LEVEL_TIMER1; + return tick_handler(irq, dev_id); +} + + +void mvme147_sched_init (irq_handler_t timer_routine) +{ + tick_handler = timer_routine; + if (request_irq(PCC_IRQ_TIMER1, mvme147_timer_int, 0, "timer 1", NULL)) + pr_err("Couldn't register timer interrupt\n"); + + /* Init the clock with a value */ + /* our clock goes off every 6.25us */ + m147_pcc->t1_preload = PCC_TIMER_PRELOAD; + m147_pcc->t1_cntrl = 0x0; /* clear timer */ + m147_pcc->t1_cntrl = 0x3; /* start timer */ + m147_pcc->t1_int_cntrl = PCC_TIMER_INT_CLR; /* clear pending ints */ + m147_pcc->t1_int_cntrl = PCC_INT_ENAB|PCC_LEVEL_TIMER1; +} + +/* This is always executed with interrupts disabled. */ +/* XXX There are race hazards in this code XXX */ +u32 mvme147_gettimeoffset(void) +{ + volatile unsigned short *cp = (volatile unsigned short *)0xfffe1012; + unsigned short n; + + n = *cp; + while (n != *cp) + n = *cp; + + n -= PCC_TIMER_PRELOAD; + return ((unsigned long)n * 25 / 4) * 1000; +} + +static int bcd2int (unsigned char b) +{ + return ((b>>4)*10 + (b&15)); +} + +int mvme147_hwclk(int op, struct rtc_time *t) +{ +#warning check me! + if (!op) { + m147_rtc->ctrl = RTC_READ; + t->tm_year = bcd2int (m147_rtc->bcd_year); + t->tm_mon = bcd2int (m147_rtc->bcd_mth); + t->tm_mday = bcd2int (m147_rtc->bcd_dom); + t->tm_hour = bcd2int (m147_rtc->bcd_hr); + t->tm_min = bcd2int (m147_rtc->bcd_min); + t->tm_sec = bcd2int (m147_rtc->bcd_sec); + m147_rtc->ctrl = 0; + } + return 0; +} + +int mvme147_set_clock_mmss (unsigned long nowtime) +{ + return 0; +} -- cgit v1.2.3-54-g00ecf