380 строки
11 KiB
C
380 строки
11 KiB
C
/*
|
|
* interrupts.c: Interrupt mappings for PNX833X.
|
|
*
|
|
* Copyright 2008 NXP Semiconductors
|
|
* Chris Steel <chris.steel@nxp.com>
|
|
* Daniel Laird <daniel.j.laird@nxp.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
#include <linux/kernel.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/hardirq.h>
|
|
#include <linux/interrupt.h>
|
|
#include <asm/mipsregs.h>
|
|
#include <asm/irq_cpu.h>
|
|
#include <irq.h>
|
|
#include <irq-mapping.h>
|
|
#include <gpio.h>
|
|
|
|
static int mips_cpu_timer_irq;
|
|
|
|
static const unsigned int irq_prio[PNX833X_PIC_NUM_IRQ] =
|
|
{
|
|
0, /* unused */
|
|
4, /* PNX833X_PIC_I2C0_INT 1 */
|
|
4, /* PNX833X_PIC_I2C1_INT 2 */
|
|
1, /* PNX833X_PIC_UART0_INT 3 */
|
|
1, /* PNX833X_PIC_UART1_INT 4 */
|
|
6, /* PNX833X_PIC_TS_IN0_DV_INT 5 */
|
|
6, /* PNX833X_PIC_TS_IN0_DMA_INT 6 */
|
|
7, /* PNX833X_PIC_GPIO_INT 7 */
|
|
4, /* PNX833X_PIC_AUDIO_DEC_INT 8 */
|
|
5, /* PNX833X_PIC_VIDEO_DEC_INT 9 */
|
|
4, /* PNX833X_PIC_CONFIG_INT 10 */
|
|
4, /* PNX833X_PIC_AOI_INT 11 */
|
|
9, /* PNX833X_PIC_SYNC_INT 12 */
|
|
9, /* PNX8335_PIC_SATA_INT 13 */
|
|
4, /* PNX833X_PIC_OSD_INT 14 */
|
|
9, /* PNX833X_PIC_DISP1_INT 15 */
|
|
4, /* PNX833X_PIC_DEINTERLACER_INT 16 */
|
|
9, /* PNX833X_PIC_DISPLAY2_INT 17 */
|
|
4, /* PNX833X_PIC_VC_INT 18 */
|
|
4, /* PNX833X_PIC_SC_INT 19 */
|
|
9, /* PNX833X_PIC_IDE_INT 20 */
|
|
9, /* PNX833X_PIC_IDE_DMA_INT 21 */
|
|
6, /* PNX833X_PIC_TS_IN1_DV_INT 22 */
|
|
6, /* PNX833X_PIC_TS_IN1_DMA_INT 23 */
|
|
4, /* PNX833X_PIC_SGDX_DMA_INT 24 */
|
|
4, /* PNX833X_PIC_TS_OUT_INT 25 */
|
|
4, /* PNX833X_PIC_IR_INT 26 */
|
|
3, /* PNX833X_PIC_VMSP1_INT 27 */
|
|
3, /* PNX833X_PIC_VMSP2_INT 28 */
|
|
4, /* PNX833X_PIC_PIBC_INT 29 */
|
|
4, /* PNX833X_PIC_TS_IN0_TRD_INT 30 */
|
|
4, /* PNX833X_PIC_SGDX_TPD_INT 31 */
|
|
5, /* PNX833X_PIC_USB_INT 32 */
|
|
4, /* PNX833X_PIC_TS_IN1_TRD_INT 33 */
|
|
4, /* PNX833X_PIC_CLOCK_INT 34 */
|
|
4, /* PNX833X_PIC_SGDX_PARSER_INT 35 */
|
|
4, /* PNX833X_PIC_VMSP_DMA_INT 36 */
|
|
#if defined(CONFIG_SOC_PNX8335)
|
|
4, /* PNX8335_PIC_MIU_INT 37 */
|
|
4, /* PNX8335_PIC_AVCHIP_IRQ_INT 38 */
|
|
9, /* PNX8335_PIC_SYNC_HD_INT 39 */
|
|
9, /* PNX8335_PIC_DISP_HD_INT 40 */
|
|
9, /* PNX8335_PIC_DISP_SCALER_INT 41 */
|
|
4, /* PNX8335_PIC_OSD_HD1_INT 42 */
|
|
4, /* PNX8335_PIC_DTL_WRITER_Y_INT 43 */
|
|
4, /* PNX8335_PIC_DTL_WRITER_C_INT 44 */
|
|
4, /* PNX8335_PIC_DTL_EMULATOR_Y_IR_INT 45 */
|
|
4, /* PNX8335_PIC_DTL_EMULATOR_C_IR_INT 46 */
|
|
4, /* PNX8335_PIC_DENC_TTX_INT 47 */
|
|
4, /* PNX8335_PIC_MMI_SIF0_INT 48 */
|
|
4, /* PNX8335_PIC_MMI_SIF1_INT 49 */
|
|
4, /* PNX8335_PIC_MMI_CDMMU_INT 50 */
|
|
4, /* PNX8335_PIC_PIBCS_INT 51 */
|
|
12, /* PNX8335_PIC_ETHERNET_INT 52 */
|
|
3, /* PNX8335_PIC_VMSP1_0_INT 53 */
|
|
3, /* PNX8335_PIC_VMSP1_1_INT 54 */
|
|
4, /* PNX8335_PIC_VMSP1_DMA_INT 55 */
|
|
4, /* PNX8335_PIC_TDGR_DE_INT 56 */
|
|
4, /* PNX8335_PIC_IR1_IRQ_INT 57 */
|
|
#endif
|
|
};
|
|
|
|
static void pnx833x_timer_dispatch(void)
|
|
{
|
|
do_IRQ(mips_cpu_timer_irq);
|
|
}
|
|
|
|
static void pic_dispatch(void)
|
|
{
|
|
unsigned int irq = PNX833X_REGFIELD(PIC_INT_SRC, INT_SRC);
|
|
|
|
if ((irq >= 1) && (irq < (PNX833X_PIC_NUM_IRQ))) {
|
|
unsigned long priority = PNX833X_PIC_INT_PRIORITY;
|
|
PNX833X_PIC_INT_PRIORITY = irq_prio[irq];
|
|
|
|
if (irq == PNX833X_PIC_GPIO_INT) {
|
|
unsigned long mask = PNX833X_PIO_INT_STATUS & PNX833X_PIO_INT_ENABLE;
|
|
int pin;
|
|
while ((pin = ffs(mask & 0xffff))) {
|
|
pin -= 1;
|
|
do_IRQ(PNX833X_GPIO_IRQ_BASE + pin);
|
|
mask &= ~(1 << pin);
|
|
}
|
|
} else {
|
|
do_IRQ(irq + PNX833X_PIC_IRQ_BASE);
|
|
}
|
|
|
|
PNX833X_PIC_INT_PRIORITY = priority;
|
|
} else {
|
|
printk(KERN_ERR "plat_irq_dispatch: unexpected irq %u\n", irq);
|
|
}
|
|
}
|
|
|
|
asmlinkage void plat_irq_dispatch(void)
|
|
{
|
|
unsigned int pending = read_c0_status() & read_c0_cause();
|
|
|
|
if (pending & STATUSF_IP4)
|
|
pic_dispatch();
|
|
else if (pending & STATUSF_IP7)
|
|
do_IRQ(PNX833X_TIMER_IRQ);
|
|
else
|
|
spurious_interrupt();
|
|
}
|
|
|
|
static inline void pnx833x_hard_enable_pic_irq(unsigned int irq)
|
|
{
|
|
/* Currently we do this by setting IRQ priority to 1.
|
|
If priority support is being implemented, 1 should be repalced
|
|
by a better value. */
|
|
PNX833X_PIC_INT_REG(irq) = irq_prio[irq];
|
|
}
|
|
|
|
static inline void pnx833x_hard_disable_pic_irq(unsigned int irq)
|
|
{
|
|
/* Disable IRQ by writing setting it's priority to 0 */
|
|
PNX833X_PIC_INT_REG(irq) = 0;
|
|
}
|
|
|
|
static int irqflags[PNX833X_PIC_NUM_IRQ]; /* initialized by zeroes */
|
|
#define IRQFLAG_STARTED 1
|
|
#define IRQFLAG_DISABLED 2
|
|
|
|
static DEFINE_RAW_SPINLOCK(pnx833x_irq_lock);
|
|
|
|
static unsigned int pnx833x_startup_pic_irq(unsigned int irq)
|
|
{
|
|
unsigned long flags;
|
|
unsigned int pic_irq = irq - PNX833X_PIC_IRQ_BASE;
|
|
|
|
raw_spin_lock_irqsave(&pnx833x_irq_lock, flags);
|
|
|
|
irqflags[pic_irq] = IRQFLAG_STARTED; /* started, not disabled */
|
|
pnx833x_hard_enable_pic_irq(pic_irq);
|
|
|
|
raw_spin_unlock_irqrestore(&pnx833x_irq_lock, flags);
|
|
return 0;
|
|
}
|
|
|
|
static void pnx833x_shutdown_pic_irq(unsigned int irq)
|
|
{
|
|
unsigned long flags;
|
|
unsigned int pic_irq = irq - PNX833X_PIC_IRQ_BASE;
|
|
|
|
raw_spin_lock_irqsave(&pnx833x_irq_lock, flags);
|
|
|
|
irqflags[pic_irq] = 0; /* not started */
|
|
pnx833x_hard_disable_pic_irq(pic_irq);
|
|
|
|
raw_spin_unlock_irqrestore(&pnx833x_irq_lock, flags);
|
|
}
|
|
|
|
static void pnx833x_enable_pic_irq(unsigned int irq)
|
|
{
|
|
unsigned long flags;
|
|
unsigned int pic_irq = irq - PNX833X_PIC_IRQ_BASE;
|
|
|
|
raw_spin_lock_irqsave(&pnx833x_irq_lock, flags);
|
|
|
|
irqflags[pic_irq] &= ~IRQFLAG_DISABLED;
|
|
if (irqflags[pic_irq] == IRQFLAG_STARTED)
|
|
pnx833x_hard_enable_pic_irq(pic_irq);
|
|
|
|
raw_spin_unlock_irqrestore(&pnx833x_irq_lock, flags);
|
|
}
|
|
|
|
static void pnx833x_disable_pic_irq(unsigned int irq)
|
|
{
|
|
unsigned long flags;
|
|
unsigned int pic_irq = irq - PNX833X_PIC_IRQ_BASE;
|
|
|
|
raw_spin_lock_irqsave(&pnx833x_irq_lock, flags);
|
|
|
|
irqflags[pic_irq] |= IRQFLAG_DISABLED;
|
|
pnx833x_hard_disable_pic_irq(pic_irq);
|
|
|
|
raw_spin_unlock_irqrestore(&pnx833x_irq_lock, flags);
|
|
}
|
|
|
|
static void pnx833x_ack_pic_irq(unsigned int irq)
|
|
{
|
|
}
|
|
|
|
static void pnx833x_end_pic_irq(unsigned int irq)
|
|
{
|
|
}
|
|
|
|
static DEFINE_RAW_SPINLOCK(pnx833x_gpio_pnx833x_irq_lock);
|
|
|
|
static unsigned int pnx833x_startup_gpio_irq(unsigned int irq)
|
|
{
|
|
int pin = irq - PNX833X_GPIO_IRQ_BASE;
|
|
unsigned long flags;
|
|
raw_spin_lock_irqsave(&pnx833x_gpio_pnx833x_irq_lock, flags);
|
|
pnx833x_gpio_enable_irq(pin);
|
|
raw_spin_unlock_irqrestore(&pnx833x_gpio_pnx833x_irq_lock, flags);
|
|
return 0;
|
|
}
|
|
|
|
static void pnx833x_enable_gpio_irq(unsigned int irq)
|
|
{
|
|
int pin = irq - PNX833X_GPIO_IRQ_BASE;
|
|
unsigned long flags;
|
|
raw_spin_lock_irqsave(&pnx833x_gpio_pnx833x_irq_lock, flags);
|
|
pnx833x_gpio_enable_irq(pin);
|
|
raw_spin_unlock_irqrestore(&pnx833x_gpio_pnx833x_irq_lock, flags);
|
|
}
|
|
|
|
static void pnx833x_disable_gpio_irq(unsigned int irq)
|
|
{
|
|
int pin = irq - PNX833X_GPIO_IRQ_BASE;
|
|
unsigned long flags;
|
|
raw_spin_lock_irqsave(&pnx833x_gpio_pnx833x_irq_lock, flags);
|
|
pnx833x_gpio_disable_irq(pin);
|
|
raw_spin_unlock_irqrestore(&pnx833x_gpio_pnx833x_irq_lock, flags);
|
|
}
|
|
|
|
static void pnx833x_ack_gpio_irq(unsigned int irq)
|
|
{
|
|
}
|
|
|
|
static void pnx833x_end_gpio_irq(unsigned int irq)
|
|
{
|
|
int pin = irq - PNX833X_GPIO_IRQ_BASE;
|
|
unsigned long flags;
|
|
raw_spin_lock_irqsave(&pnx833x_gpio_pnx833x_irq_lock, flags);
|
|
pnx833x_gpio_clear_irq(pin);
|
|
raw_spin_unlock_irqrestore(&pnx833x_gpio_pnx833x_irq_lock, flags);
|
|
}
|
|
|
|
static int pnx833x_set_type_gpio_irq(unsigned int irq, unsigned int flow_type)
|
|
{
|
|
int pin = irq - PNX833X_GPIO_IRQ_BASE;
|
|
int gpio_mode;
|
|
|
|
switch (flow_type) {
|
|
case IRQ_TYPE_EDGE_RISING:
|
|
gpio_mode = GPIO_INT_EDGE_RISING;
|
|
break;
|
|
case IRQ_TYPE_EDGE_FALLING:
|
|
gpio_mode = GPIO_INT_EDGE_FALLING;
|
|
break;
|
|
case IRQ_TYPE_EDGE_BOTH:
|
|
gpio_mode = GPIO_INT_EDGE_BOTH;
|
|
break;
|
|
case IRQ_TYPE_LEVEL_HIGH:
|
|
gpio_mode = GPIO_INT_LEVEL_HIGH;
|
|
break;
|
|
case IRQ_TYPE_LEVEL_LOW:
|
|
gpio_mode = GPIO_INT_LEVEL_LOW;
|
|
break;
|
|
default:
|
|
gpio_mode = GPIO_INT_NONE;
|
|
break;
|
|
}
|
|
|
|
pnx833x_gpio_setup_irq(gpio_mode, pin);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct irq_chip pnx833x_pic_irq_type = {
|
|
.name = "PNX-PIC",
|
|
.startup = pnx833x_startup_pic_irq,
|
|
.shutdown = pnx833x_shutdown_pic_irq,
|
|
.enable = pnx833x_enable_pic_irq,
|
|
.disable = pnx833x_disable_pic_irq,
|
|
.ack = pnx833x_ack_pic_irq,
|
|
.end = pnx833x_end_pic_irq
|
|
};
|
|
|
|
static struct irq_chip pnx833x_gpio_irq_type = {
|
|
.name = "PNX-GPIO",
|
|
.startup = pnx833x_startup_gpio_irq,
|
|
.shutdown = pnx833x_disable_gpio_irq,
|
|
.enable = pnx833x_enable_gpio_irq,
|
|
.disable = pnx833x_disable_gpio_irq,
|
|
.ack = pnx833x_ack_gpio_irq,
|
|
.end = pnx833x_end_gpio_irq,
|
|
.set_type = pnx833x_set_type_gpio_irq
|
|
};
|
|
|
|
void __init arch_init_irq(void)
|
|
{
|
|
unsigned int irq;
|
|
|
|
/* setup standard internal cpu irqs */
|
|
mips_cpu_irq_init();
|
|
|
|
/* Set IRQ information in irq_desc */
|
|
for (irq = PNX833X_PIC_IRQ_BASE; irq < (PNX833X_PIC_IRQ_BASE + PNX833X_PIC_NUM_IRQ); irq++) {
|
|
pnx833x_hard_disable_pic_irq(irq);
|
|
set_irq_chip_and_handler(irq, &pnx833x_pic_irq_type, handle_simple_irq);
|
|
}
|
|
|
|
for (irq = PNX833X_GPIO_IRQ_BASE; irq < (PNX833X_GPIO_IRQ_BASE + PNX833X_GPIO_NUM_IRQ); irq++)
|
|
set_irq_chip_and_handler(irq, &pnx833x_gpio_irq_type, handle_simple_irq);
|
|
|
|
/* Set PIC priority limiter register to 0 */
|
|
PNX833X_PIC_INT_PRIORITY = 0;
|
|
|
|
/* Setup GPIO IRQ dispatching */
|
|
pnx833x_startup_pic_irq(PNX833X_PIC_GPIO_INT);
|
|
|
|
/* Enable PIC IRQs (HWIRQ2) */
|
|
if (cpu_has_vint)
|
|
set_vi_handler(4, pic_dispatch);
|
|
|
|
write_c0_status(read_c0_status() | IE_IRQ2);
|
|
}
|
|
|
|
unsigned int __cpuinit get_c0_compare_int(void)
|
|
{
|
|
if (cpu_has_vint)
|
|
set_vi_handler(cp0_compare_irq, pnx833x_timer_dispatch);
|
|
|
|
mips_cpu_timer_irq = MIPS_CPU_IRQ_BASE + cp0_compare_irq;
|
|
return mips_cpu_timer_irq;
|
|
}
|
|
|
|
void __init plat_time_init(void)
|
|
{
|
|
/* calculate mips_hpt_frequency based on PNX833X_CLOCK_CPUCP_CTL reg */
|
|
|
|
extern unsigned long mips_hpt_frequency;
|
|
unsigned long reg = PNX833X_CLOCK_CPUCP_CTL;
|
|
|
|
if (!(PNX833X_BIT(reg, CLOCK_CPUCP_CTL, EXIT_RESET))) {
|
|
/* Functional clock is disabled so use crystal frequency */
|
|
mips_hpt_frequency = 25;
|
|
} else {
|
|
#if defined(CONFIG_SOC_PNX8335)
|
|
/* Functional clock is enabled, so get clock multiplier */
|
|
mips_hpt_frequency = 90 + (10 * PNX8335_REGFIELD(CLOCK_PLL_CPU_CTL, FREQ));
|
|
#else
|
|
static const unsigned long int freq[4] = {240, 160, 120, 80};
|
|
mips_hpt_frequency = freq[PNX833X_FIELD(reg, CLOCK_CPUCP_CTL, DIV_CLOCK)];
|
|
#endif
|
|
}
|
|
|
|
printk(KERN_INFO "CPU clock is %ld MHz\n", mips_hpt_frequency);
|
|
|
|
mips_hpt_frequency *= 500000;
|
|
}
|