304 строки
8.2 KiB
C
304 строки
8.2 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/errno.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/stddef.h>
|
|
#include <linux/unistd.h>
|
|
#include <linux/ptrace.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/user.h>
|
|
#include <linux/a.out.h>
|
|
#include <linux/tty.h>
|
|
#include <linux/major.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/reboot.h>
|
|
#include <linux/init.h>
|
|
#include <linux/initrd.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/bootmem.h>
|
|
#include <linux/seq_file.h>
|
|
#include <linux/root_dev.h>
|
|
#include <linux/time.h>
|
|
#include <linux/rtc.h>
|
|
|
|
#include <asm/mmu.h>
|
|
#include <asm/reg.h>
|
|
#include <asm/residual.h>
|
|
#include <asm/io.h>
|
|
#include <asm/pgtable.h>
|
|
#include <asm/mpc8xx.h>
|
|
#include <asm/8xx_immap.h>
|
|
#include <asm/machdep.h>
|
|
#include <asm/bootinfo.h>
|
|
#include <asm/time.h>
|
|
#include <asm/prom.h>
|
|
#include <asm/fs_pd.h>
|
|
#include <mm/mmu_decl.h>
|
|
|
|
#include "sysdev/mpc8xx_pic.h"
|
|
|
|
void m8xx_calibrate_decr(void);
|
|
extern void m8xx_wdt_handler_install(bd_t *bp);
|
|
extern int cpm_pic_init(void);
|
|
extern int cpm_get_irq(void);
|
|
|
|
/* A place holder for time base interrupts, if they are ever enabled. */
|
|
irqreturn_t timebase_interrupt(int irq, void * dev)
|
|
{
|
|
printk ("timebase_interrupt()\n");
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static struct irqaction tbint_irqaction = {
|
|
.handler = timebase_interrupt,
|
|
.mask = CPU_MASK_NONE,
|
|
.name = "tbint",
|
|
};
|
|
|
|
/* per-board overridable init_internal_rtc() function. */
|
|
void __init __attribute__ ((weak))
|
|
init_internal_rtc(void)
|
|
{
|
|
sit8xx_t *sys_tmr = (sit8xx_t *) 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;
|
|
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 = (unsigned int *)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 *clk_r1;
|
|
car8xx_t *clk_r2;
|
|
sitk8xx_t *sys_tmr1;
|
|
sit8xx_t *sys_tmr2;
|
|
int irq, virq;
|
|
|
|
clk_r1 = (cark8xx_t *) 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 = (car8xx_t *) immr_map(im_clkrst);
|
|
setbits32(&clk_r2->car_sccr, 0x02000000);
|
|
immr_unmap(clk_r2);
|
|
|
|
/* Processor frequency is MHz.
|
|
*/
|
|
ppc_tb_freq = 50000000;
|
|
if (!get_freq("bus-frequency", &ppc_tb_freq)) {
|
|
printk(KERN_ERR "WARNING: Estimating decrementer frequency "
|
|
"(not found)\n");
|
|
}
|
|
ppc_tb_freq /= 16;
|
|
ppc_proc_freq = 50000000;
|
|
if (!get_freq("clock-frequency", &ppc_proc_freq))
|
|
printk(KERN_ERR "WARNING: Estimating processor frequency"
|
|
"(not found)\n");
|
|
|
|
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 = (sitk8xx_t *) 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 = irq_map[virq].hwirq;
|
|
|
|
sys_tmr2 = (sit8xx_t *) 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!");
|
|
|
|
#ifdef CONFIG_8xx_WDT
|
|
/* Install watchdog timer handler early because it might be
|
|
* already enabled by the bootloader
|
|
*/
|
|
m8xx_wdt_handler_install(binfo);
|
|
#endif
|
|
}
|
|
|
|
/* 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 *sys_tmr1;
|
|
sit8xx_t *sys_tmr2;
|
|
int time;
|
|
|
|
sys_tmr1 = (sitk8xx_t *) immr_map(im_sitk);
|
|
sys_tmr2 = (sit8xx_t *) 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 *sys_tmr = (sit8xx_t *) 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 mpc8xx_restart(char *cmd)
|
|
{
|
|
__volatile__ unsigned char dummy;
|
|
car8xx_t * clk_r = (car8xx_t *) 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);
|
|
|
|
dummy = in_8(&clk_r->res[0]);
|
|
printk("Restart failed\n");
|
|
while(1);
|
|
}
|
|
|
|
void mpc8xx_show_cpuinfo(struct seq_file *m)
|
|
{
|
|
struct device_node *root;
|
|
uint memsize = total_memory;
|
|
const char *model = "";
|
|
|
|
seq_printf(m, "Vendor\t\t: Freescale Semiconductor\n");
|
|
|
|
root = of_find_node_by_path("/");
|
|
if (root)
|
|
model = get_property(root, "model", NULL);
|
|
seq_printf(m, "Machine\t\t: %s\n", model);
|
|
of_node_put(root);
|
|
|
|
seq_printf(m, "Memory\t\t: %d MB\n", memsize / (1024 * 1024));
|
|
}
|
|
|
|
static void cpm_cascade(unsigned int irq, struct irq_desc *desc)
|
|
{
|
|
int cascade_irq;
|
|
|
|
if ((cascade_irq = cpm_get_irq()) >= 0) {
|
|
struct irq_desc *cdesc = irq_desc + cascade_irq;
|
|
|
|
generic_handle_irq(cascade_irq);
|
|
cdesc->chip->eoi(cascade_irq);
|
|
}
|
|
desc->chip->eoi(irq);
|
|
}
|
|
|
|
/* Initialize the internal interrupt controller. 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 m8xx_pic_init(void)
|
|
{
|
|
int irq;
|
|
|
|
if (mpc8xx_pic_init()) {
|
|
printk(KERN_ERR "Failed interrupt 8xx controller initialization\n");
|
|
return;
|
|
}
|
|
|
|
irq = cpm_pic_init();
|
|
if (irq != NO_IRQ)
|
|
set_irq_chained_handler(irq, cpm_cascade);
|
|
}
|