247 lines
6.3 KiB
C
247 lines
6.3 KiB
C
|
/*
|
||
|
|
* Copyright (C) 1995 Linus Torvalds
|
||
|
|
* Adapted from 'alpha' version by Gary Thomas
|
||
|
|
* Modified by Cort Dougan (cort@cs.nmt.edu)
|
||
|
|
* Modified for MBX using prep/chrp/pmac functions by Dan (dmalek@jlc.net)
|
||
|
|
* Further modified for generic 8xx by Dan.
|
||
|
|
*/
|
||
|
|
|
||
|
|
/*
|
||
|
|
* bootup setup stuff..
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/kernel.h>
|
||
|
|
#include <linux/interrupt.h>
|
||
|
|
#include <linux/init.h>
|
||
|
|
#include <linux/time.h>
|
||
|
|
#include <linux/rtc.h>
|
||
|
|
#include <linux/fsl_devices.h>
|
||
|
|
|
||
|
|
#include <asm/io.h>
|
||
|
|
#include <asm/8xx_immap.h>
|
||
|
|
#include <asm/prom.h>
|
||
|
|
#include <asm/fs_pd.h>
|
||
|
|
#include <mm/mmu_decl.h>
|
||
|
|
|
||
|
|
#include <sysdev/mpc8xx_pic.h>
|
||
|
|
|
||
|
|
#include "mpc8xx.h"
|
||
|
|
|
||
|
|
extern int cpm_pic_init(void);
|
||
|
|
extern int cpm_get_irq(void);
|
||
|
|
|
||
|
|
/* A place holder for time base interrupts, if they are ever enabled. */
|
||
|
|
static irqreturn_t timebase_interrupt(int irq, void *dev)
|
||
|
|
{
|
||
|
|
printk ("timebase_interrupt()\n");
|
||
|
|
|
||
|
|
return IRQ_HANDLED;
|
||
|
|
}
|
||
|
|
|
||
|
|
static struct irqaction tbint_irqaction = {
|
||
|
|
.handler = timebase_interrupt,
|
||
|
|
.flags = IRQF_NO_THREAD,
|
||
|
|
.name = "tbint",
|
||
|
|
};
|
||
|
|
|
||
|
|
/* per-board overridable init_internal_rtc() function. */
|
||
|
|
void __init __attribute__ ((weak))
|
||
|
|
init_internal_rtc(void)
|
||
|
|
{
|
||
|
|
sit8xx_t __iomem *sys_tmr = immr_map(im_sit);
|
||
|
|
|
||
|
|
/* Disable the RTC one second and alarm interrupts. */
|
||
|
|
clrbits16(&sys_tmr->sit_rtcsc, (RTCSC_SIE | RTCSC_ALE));
|
||
|
|
|
||
|
|
/* Enable the RTC */
|
||
|
|
setbits16(&sys_tmr->sit_rtcsc, (RTCSC_RTF | RTCSC_RTE));
|
||
|
|
immr_unmap(sys_tmr);
|
||
|
|
}
|
||
|
|
|
||
|
|
static int __init get_freq(char *name, unsigned long *val)
|
||
|
|
{
|
||
|
|
struct device_node *cpu;
|
||
|
|
const unsigned int *fp;
|
||
|
|
int found = 0;
|
||
|
|
|
||
|
|
/* The cpu node should have timebase and clock frequency properties */
|
||
|
|
cpu = of_find_node_by_type(NULL, "cpu");
|
||
|
|
|
||
|
|
if (cpu) {
|
||
|
|
fp = of_get_property(cpu, name, NULL);
|
||
|
|
if (fp) {
|
||
|
|
found = 1;
|
||
|
|
*val = *fp;
|
||
|
|
}
|
||
|
|
|
||
|
|
of_node_put(cpu);
|
||
|
|
}
|
||
|
|
|
||
|
|
return found;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* The decrementer counts at the system (internal) clock frequency divided by
|
||
|
|
* sixteen, or external oscillator divided by four. We force the processor
|
||
|
|
* to use system clock divided by sixteen.
|
||
|
|
*/
|
||
|
|
void __init mpc8xx_calibrate_decr(void)
|
||
|
|
{
|
||
|
|
struct device_node *cpu;
|
||
|
|
cark8xx_t __iomem *clk_r1;
|
||
|
|
car8xx_t __iomem *clk_r2;
|
||
|
|
sitk8xx_t __iomem *sys_tmr1;
|
||
|
|
sit8xx_t __iomem *sys_tmr2;
|
||
|
|
int irq, virq;
|
||
|
|
|
||
|
|
clk_r1 = immr_map(im_clkrstk);
|
||
|
|
|
||
|
|
/* Unlock the SCCR. */
|
||
|
|
out_be32(&clk_r1->cark_sccrk, ~KAPWR_KEY);
|
||
|
|
out_be32(&clk_r1->cark_sccrk, KAPWR_KEY);
|
||
|
|
immr_unmap(clk_r1);
|
||
|
|
|
||
|
|
/* Force all 8xx processors to use divide by 16 processor clock. */
|
||
|
|
clk_r2 = immr_map(im_clkrst);
|
||
|
|
setbits32(&clk_r2->car_sccr, 0x02000000);
|
||
|
|
immr_unmap(clk_r2);
|
||
|
|
|
||
|
|
/* Processor frequency is MHz.
|
||
|
|
*/
|
||
|
|
ppc_proc_freq = 50000000;
|
||
|
|
if (!get_freq("clock-frequency", &ppc_proc_freq))
|
||
|
|
printk(KERN_ERR "WARNING: Estimating processor frequency "
|
||
|
|
"(not found)\n");
|
||
|
|
|
||
|
|
ppc_tb_freq = ppc_proc_freq / 16;
|
||
|
|
printk("Decrementer Frequency = 0x%lx\n", ppc_tb_freq);
|
||
|
|
|
||
|
|
/* Perform some more timer/timebase initialization. This used
|
||
|
|
* to be done elsewhere, but other changes caused it to get
|
||
|
|
* called more than once....that is a bad thing.
|
||
|
|
*
|
||
|
|
* First, unlock all of the registers we are going to modify.
|
||
|
|
* To protect them from corruption during power down, registers
|
||
|
|
* that are maintained by keep alive power are "locked". To
|
||
|
|
* modify these registers we have to write the key value to
|
||
|
|
* the key location associated with the register.
|
||
|
|
* Some boards power up with these unlocked, while others
|
||
|
|
* are locked. Writing anything (including the unlock code?)
|
||
|
|
* to the unlocked registers will lock them again. So, here
|
||
|
|
* we guarantee the registers are locked, then we unlock them
|
||
|
|
* for our use.
|
||
|
|
*/
|
||
|
|
sys_tmr1 = immr_map(im_sitk);
|
||
|
|
out_be32(&sys_tmr1->sitk_tbscrk, ~KAPWR_KEY);
|
||
|
|
out_be32(&sys_tmr1->sitk_rtcsck, ~KAPWR_KEY);
|
||
|
|
out_be32(&sys_tmr1->sitk_tbk, ~KAPWR_KEY);
|
||
|
|
out_be32(&sys_tmr1->sitk_tbscrk, KAPWR_KEY);
|
||
|
|
out_be32(&sys_tmr1->sitk_rtcsck, KAPWR_KEY);
|
||
|
|
out_be32(&sys_tmr1->sitk_tbk, KAPWR_KEY);
|
||
|
|
immr_unmap(sys_tmr1);
|
||
|
|
|
||
|
|
init_internal_rtc();
|
||
|
|
|
||
|
|
/* Enabling the decrementer also enables the timebase interrupts
|
||
|
|
* (or from the other point of view, to get decrementer interrupts
|
||
|
|
* we have to enable the timebase). The decrementer interrupt
|
||
|
|
* is wired into the vector table, nothing to do here for that.
|
||
|
|
*/
|
||
|
|
cpu = of_find_node_by_type(NULL, "cpu");
|
||
|
|
virq= irq_of_parse_and_map(cpu, 0);
|
||
|
|
irq = virq_to_hw(virq);
|
||
|
|
|
||
|
|
sys_tmr2 = immr_map(im_sit);
|
||
|
|
out_be16(&sys_tmr2->sit_tbscr, ((1 << (7 - (irq/2))) << 8) |
|
||
|
|
(TBSCR_TBF | TBSCR_TBE));
|
||
|
|
immr_unmap(sys_tmr2);
|
||
|
|
|
||
|
|
if (setup_irq(virq, &tbint_irqaction))
|
||
|
|
panic("Could not allocate timer IRQ!");
|
||
|
|
}
|
||
|
|
|
||
|
|
/* The RTC on the MPC8xx is an internal register.
|
||
|
|
* We want to protect this during power down, so we need to unlock,
|
||
|
|
* modify, and re-lock.
|
||
|
|
*/
|
||
|
|
|
||
|
|
int mpc8xx_set_rtc_time(struct rtc_time *tm)
|
||
|
|
{
|
||
|
|
sitk8xx_t __iomem *sys_tmr1;
|
||
|
|
sit8xx_t __iomem *sys_tmr2;
|
||
|
|
int time;
|
||
|
|
|
||
|
|
sys_tmr1 = immr_map(im_sitk);
|
||
|
|
sys_tmr2 = immr_map(im_sit);
|
||
|
|
time = mktime(tm->tm_year+1900, tm->tm_mon+1, tm->tm_mday,
|
||
|
|
tm->tm_hour, tm->tm_min, tm->tm_sec);
|
||
|
|
|
||
|
|
out_be32(&sys_tmr1->sitk_rtck, KAPWR_KEY);
|
||
|
|
out_be32(&sys_tmr2->sit_rtc, time);
|
||
|
|
out_be32(&sys_tmr1->sitk_rtck, ~KAPWR_KEY);
|
||
|
|
|
||
|
|
immr_unmap(sys_tmr2);
|
||
|
|
immr_unmap(sys_tmr1);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void mpc8xx_get_rtc_time(struct rtc_time *tm)
|
||
|
|
{
|
||
|
|
unsigned long data;
|
||
|
|
sit8xx_t __iomem *sys_tmr = immr_map(im_sit);
|
||
|
|
|
||
|
|
/* Get time from the RTC. */
|
||
|
|
data = in_be32(&sys_tmr->sit_rtc);
|
||
|
|
to_tm(data, tm);
|
||
|
|
tm->tm_year -= 1900;
|
||
|
|
tm->tm_mon -= 1;
|
||
|
|
immr_unmap(sys_tmr);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
void __noreturn mpc8xx_restart(char *cmd)
|
||
|
|
{
|
||
|
|
car8xx_t __iomem *clk_r = immr_map(im_clkrst);
|
||
|
|
|
||
|
|
|
||
|
|
local_irq_disable();
|
||
|
|
|
||
|
|
setbits32(&clk_r->car_plprcr, 0x00000080);
|
||
|
|
/* Clear the ME bit in MSR to cause checkstop on machine check
|
||
|
|
*/
|
||
|
|
mtmsr(mfmsr() & ~0x1000);
|
||
|
|
|
||
|
|
in_8(&clk_r->res[0]);
|
||
|
|
panic("Restart failed\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
static void cpm_cascade(struct irq_desc *desc)
|
||
|
|
{
|
||
|
|
struct irq_chip *chip = irq_desc_get_chip(desc);
|
||
|
|
int cascade_irq = cpm_get_irq();
|
||
|
|
|
||
|
|
if (cascade_irq >= 0)
|
||
|
|
generic_handle_irq(cascade_irq);
|
||
|
|
|
||
|
|
chip->irq_eoi(&desc->irq_data);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Initialize the internal interrupt controllers. The number of
|
||
|
|
* interrupts supported can vary with the processor type, and the
|
||
|
|
* 82xx family can have up to 64.
|
||
|
|
* External interrupts can be either edge or level triggered, and
|
||
|
|
* need to be initialized by the appropriate driver.
|
||
|
|
*/
|
||
|
|
void __init mpc8xx_pics_init(void)
|
||
|
|
{
|
||
|
|
int irq;
|
||
|
|
|
||
|
|
if (mpc8xx_pic_init()) {
|
||
|
|
printk(KERN_ERR "Failed interrupt 8xx controller initialization\n");
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
irq = cpm_pic_init();
|
||
|
|
if (irq)
|
||
|
|
irq_set_chained_handler(irq, cpm_cascade);
|
||
|
|
}
|