Commit d13ce4f1 authored by Greg Ungerer's avatar Greg Ungerer Committed by Christoph Hellwig

[PATCH] move common timer and vector code for m68knommu/ColdFire/5272

This patch moves common ColdFire vector and timer procesing code from
the local per-processor config.c for the 5272 ColdFire sub-architecture.
All ColdFire CPU's have the same timer and basic vector setup, seems
crazy to repeat this code for each of 6 ColdFire CPU varients.
This patch also removes the reset button support, this is now moved to
a proper device driver, where it belongs.
parent 024d46c5
...@@ -26,7 +26,15 @@ ...@@ -26,7 +26,15 @@
/***************************************************************************/ /***************************************************************************/
void reset_setupbutton(void); void coldfire_tick(void);
void coldfire_timer_init(void (*handler)(int, void *, struct pt_regs *));
unsigned long coldfire_timer_offset(void);
void coldfire_trap_init(void);
void coldfire_reset(void);
extern unsigned int mcf_timervector;
extern unsigned int mcf_profilevector;
extern unsigned int mcf_timerlevel;
/***************************************************************************/ /***************************************************************************/
...@@ -37,50 +45,21 @@ unsigned int dma_base_addr[MAX_M68K_DMA_CHANNELS] = { ...@@ -37,50 +45,21 @@ unsigned int dma_base_addr[MAX_M68K_DMA_CHANNELS] = {
MCF_MBAR + MCFDMA_BASE0, MCF_MBAR + MCFDMA_BASE0,
}; };
unsigned int dma_device_address[MAX_M68K_DMA_CHANNELS];
/***************************************************************************/ /***************************************************************************/
void coldfire_tick(void) void mcf_disableall(void)
{ {
volatile unsigned char *timerp;
/* Reset the ColdFire timer */
timerp = (volatile unsigned char *) (MCF_MBAR + MCFTIMER_BASE4);
timerp[MCFTIMER_TER] = MCFTIMER_TER_CAP | MCFTIMER_TER_REF;
}
/***************************************************************************/
void coldfire_timer_init(void (*handler)(int, void *, struct pt_regs *))
{
volatile unsigned short *timerp;
volatile unsigned long *icrp; volatile unsigned long *icrp;
/* Set up TIMER 4 as poll clock */
timerp = (volatile unsigned short *) (MCF_MBAR + MCFTIMER_BASE4);
timerp[MCFTIMER_TMR] = MCFTIMER_TMR_DISABLE;
timerp[MCFTIMER_TRR] = (unsigned short) ((MCF_CLK / 16) / HZ);
timerp[MCFTIMER_TMR] = MCFTIMER_TMR_ENORI | MCFTIMER_TMR_CLK16 |
MCFTIMER_TMR_RESTART | MCFTIMER_TMR_ENABLE;
icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR1); icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR1);
*icrp = 0x0000000d; /* TMR4 with priority 5 */ icrp[0] = 0x88888888;
request_irq(72, handler, SA_INTERRUPT, "ColdFire Timer", NULL); icrp[1] = 0x88888888;
icrp[2] = 0x88888888;
#ifdef CONFIG_RESETSWITCH icrp[3] = 0x88888888;
/* This is not really the right place to do this... */
reset_setupbutton();
#endif
} }
/***************************************************************************/ /***************************************************************************/
/*
* Program the vector to be an auto-vectored.
*/
void mcf_autovector(unsigned int vec) void mcf_autovector(unsigned int vec)
{ {
/* Everything is auto-vectored on the 5272 */ /* Everything is auto-vectored on the 5272 */
...@@ -88,68 +67,20 @@ void mcf_autovector(unsigned int vec) ...@@ -88,68 +67,20 @@ void mcf_autovector(unsigned int vec)
/***************************************************************************/ /***************************************************************************/
extern e_vector *_ramvec; void mcf_settimericr(int timer, int level)
void set_evector(int vecnum, void (*handler)(void))
{ {
if (vecnum >= 0 && vecnum <= 255) volatile unsigned long *icrp;
_ramvec[vecnum] = handler; unsigned int icr;
}
switch (timer) {
/***************************************************************************/ case 2: icr = MCFSIM_ICR2; break;
case 3: icr = MCFSIM_ICR3; break;
/* assembler routines */ case 4: icr = MCFSIM_ICR4; break;
asmlinkage void buserr(void); default: icr = MCFSIM_ICR1; break;
asmlinkage void trap(void); }
asmlinkage void system_call(void);
asmlinkage void inthandler(void);
void coldfire_trap_init(void)
{
int i;
#ifndef ENABLE_dBUG
volatile unsigned long *icrp;
icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR1);
icrp[0] = 0x88888888;
icrp[1] = 0x88888888;
icrp[2] = 0x88888888;
icrp[3] = 0x88888888;
#endif
/*
* There is a common trap handler and common interrupt
* handler that handle almost every vector. We treat
* the system call and bus error special, they get their
* own first level handlers.
*/
#ifndef ENABLE_dBUG
for (i = 3; (i <= 23); i++)
_ramvec[i] = trap;
for (i = 33; (i <= 63); i++)
_ramvec[i] = trap;
#endif
for (i = 24; (i <= 30); i++)
_ramvec[i] = inthandler;
#ifndef ENABLE_dBUG
_ramvec[31] = inthandler; // Disables the IRQ7 button
#endif
for (i = 64; (i < 255); i++)
_ramvec[i] = inthandler;
_ramvec[255] = 0;
_ramvec[2] = buserr;
_ramvec[32] = system_call;
}
/***************************************************************************/
void coldfire_reset(void) icrp = (volatile unsigned long *) (MCF_MBAR + icr);
{ *icrp = (0x8 | level) << ((4 - timer) * 4);
HARD_RESET_NOW();
} }
/***************************************************************************/ /***************************************************************************/
...@@ -164,8 +95,9 @@ void config_BSP(char *commandp, int size) ...@@ -164,8 +95,9 @@ void config_BSP(char *commandp, int size)
*pivrp = 0x40; *pivrp = 0x40;
#endif #endif
#if defined(CONFIG_NETtel) || defined(CONFIG_eLIA) || \ mcf_disableall();
defined(CONFIG_DISKtel) || defined(CONFIG_SECUREEDGEMP3)
#if defined(CONFIG_NETtel)
/* Copy command line from FLASH to local buffer... */ /* Copy command line from FLASH to local buffer... */
memcpy(commandp, (char *) 0xf0004000, size); memcpy(commandp, (char *) 0xf0004000, size);
commandp[size-1] = 0; commandp[size-1] = 0;
...@@ -177,71 +109,13 @@ void config_BSP(char *commandp, int size) ...@@ -177,71 +109,13 @@ void config_BSP(char *commandp, int size)
memset(commandp, 0, size); memset(commandp, 0, size);
#endif #endif
mcf_timervector = 69;
mcf_profilevector = 70;
mach_sched_init = coldfire_timer_init; mach_sched_init = coldfire_timer_init;
mach_tick = coldfire_tick; mach_tick = coldfire_tick;
mach_gettimeoffset = coldfire_timer_offset;
mach_trap_init = coldfire_trap_init; mach_trap_init = coldfire_trap_init;
mach_reset = coldfire_reset; mach_reset = coldfire_reset;
} }
/***************************************************************************/ /***************************************************************************/
#ifdef CONFIG_RESETSWITCH
/***************************************************************************/
/*
* Routines to support the NETtel software reset button.
*/
void reset_button(int irq, void *dev_id, struct pt_regs *regs)
{
volatile unsigned long *icrp, *isrp;
extern void flash_eraseconfig(void);
static int inbutton = 0;
/*
* IRQ7 is not maskable by the CPU core. It is possible
* that switch bounce mey get us back here before we have
* really serviced the interrupt.
*/
if (inbutton)
return;
inbutton = 1;
/* Disable interrupt at SIM - best we can do... */
icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR1);
*icrp = (*icrp & 0x07777777) | 0x80000000;
/* Try and de-bounce the switch a little... */
udelay(10000);
flash_eraseconfig();
/* Don't leave here 'till button is no longer pushed! */
isrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ISR);
for (;;) {
if (*isrp & 0x80000000)
break;
}
HARD_RESET_NOW();
/* Should never get here... */
inbutton = 0;
/* Interrupt service done, acknowledge it */
icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR1);
*icrp = (*icrp & 0x07777777) | 0xf0000000;
}
/***************************************************************************/
void reset_setupbutton(void)
{
volatile unsigned long *icrp;
icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR1);
*icrp = (*icrp & 0x07777777) | 0xf0000000;
request_irq(65, reset_button, (SA_INTERRUPT | IRQ_FLG_FAST),
"Reset Button", NULL);
}
/***************************************************************************/
#endif /* CONFIG_RESETSWITCH */
/***************************************************************************/
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment