Update of /cvsroot/gc-linux/linux/arch/powerpc/platforms/embedded6xx
In directory sc8-pr-cvs2.sourceforge.net:/tmp/cvs-serv22144
Added Files:
flipper-pic.h flipper-pic.c
Log Message:
Added irq_host support for flipper-like interrupt controllers.
The controller supports both flipper (gamecube) and hollywood (wii) interrupt
controllers.
--- NEW FILE: flipper-pic.c ---
/*
* arch/powerpc/platforms/embedded6xx/flipper-pic.c
*
* Nintendo GameCube/Wii interrupt controller support.
* Copyright (C) 2004-2008 The GameCube Linux Team
* Copyright (C) 2007,2008 Albert Herranz
*
* 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.
*
*/
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/irq.h>
#include <linux/of.h>
#include <asm/io.h>
#include "flipper-pic.h"
#define DRV_MODULE_NAME "flipper-pic"
#define drv_printk(level, format, arg...) \
printk(level DRV_MODULE_NAME ": " format , ## arg)
static struct irq_host *flipper_irq_host;
/*
*
*/
static void flipper_pic_mask_and_ack(unsigned int virq)
{
int irq = virq_to_hw(virq);
void __iomem *io_base = get_irq_chip_data(virq);
clear_bit(irq, io_base + FLIPPER_IMR);
set_bit(irq, io_base + FLIPPER_ICR);
}
/*
*
*/
static void flipper_pic_ack(unsigned int virq)
{
int irq = virq_to_hw(virq);
void __iomem *io_base = get_irq_chip_data(virq);
set_bit(irq, io_base + FLIPPER_ICR);
}
/*
*
*/
static void flipper_pic_mask(unsigned int virq)
{
int irq = virq_to_hw(virq);
void __iomem *io_base = get_irq_chip_data(virq);
clear_bit(irq, io_base + FLIPPER_IMR);
}
/*
*
*/
static void flipper_pic_unmask(unsigned int virq)
{
int irq = virq_to_hw(virq);
void __iomem *io_base = get_irq_chip_data(virq);
set_bit(irq, io_base + FLIPPER_IMR);
}
/*
*
*/
static struct irq_chip flipper_pic = {
.typename = "flipper-pic",
.ack = flipper_pic_ack,
.mask_ack = flipper_pic_mask_and_ack,
.mask = flipper_pic_mask,
.unmask = flipper_pic_unmask,
};
/*
*
*/
static int flipper_pic_map(struct irq_host *h, unsigned int virq,
irq_hw_number_t hwirq)
{
set_irq_chip_data(virq, h->host_data);
set_irq_chip_and_handler(virq, &flipper_pic, handle_level_irq);
return 0;
}
/*
*
*/
static void flipper_pic_unmap(struct irq_host *h, unsigned int irq)
{
set_irq_chip_data(irq, NULL);
set_irq_chip(irq, NULL);
}
/*
*
*/
static int flipper_pic_match(struct irq_host *h, struct device_node *np)
{
return 1;
}
static struct irq_host_ops flipper_irq_host_ops = {
.map = flipper_pic_map,
.unmap = flipper_pic_unmap,
.match = flipper_pic_match,
};
/*
*
*/
struct irq_host * __init flipper_pic_init(struct device_node *np)
{
struct irq_host *irq_host;
struct resource res;
void __iomem *io_base;
int retval;
retval = of_address_to_resource(np, 0, &res);
if (retval) {
drv_printk(KERN_ERR, "no io memory range found\n");
return NULL;
}
io_base = ioremap(res.start, res.end - res.start + 1);
drv_printk(KERN_INFO, "controller at 0x%08x mapped to 0x%p\n",
res.start, io_base);
/* mask and ack all IRQs */
out_be32(io_base + FLIPPER_IMR, 0x00000000);
out_be32(io_base + FLIPPER_ICR, 0xffffffff);
irq_host = irq_alloc_host(np, IRQ_HOST_MAP_LINEAR, FLIPPER_NR_IRQS,
&flipper_irq_host_ops, -1);
if (!irq_host) {
drv_printk(KERN_ERR, "failed to allocate irq_host\n");
return NULL;
}
irq_host->host_data = io_base;
return irq_host;
}
/*
*
*/
unsigned int flipper_pic_get_irq(void)
{
void __iomem *io_base = flipper_irq_host->host_data;
int irq;
u32 irq_status;
irq_status = in_be32(io_base + FLIPPER_ICR) &
in_be32(io_base + FLIPPER_IMR);
if (irq_status == 0)
return -1; /* no more IRQs pending */
__asm __volatile ("cntlzw %0,%1": "=r"(irq) : "r"(irq_status));
return irq_linear_revmap(flipper_irq_host, 31 - irq);
}
/*
*
*/
void __init flipper_pic_probe(void)
{
struct device_node *np;
np = of_find_compatible_node(NULL, NULL, "nintendo,flipper-pic");
BUG_ON(!np);
flipper_irq_host = flipper_pic_init(np);
BUG_ON(!flipper_irq_host);
irq_set_default_host(flipper_irq_host);
of_node_put(np);
}
/*
* Misc functions provided by the flipper chipset.
*
*/
/*
*
*/
void flipper_platform_reset(void)
{
void __iomem *io_base;
if (flipper_irq_host && flipper_irq_host->host_data) {
io_base = flipper_irq_host->host_data;
out_8(io_base + FLIPPER_RESET, 0x00);
}
}
/*
* Tells if the reset button is pressed.
*/
int flipper_is_reset_button_pressed(void)
{
void __iomem *io_base;
u32 icr;
if (flipper_irq_host && flipper_irq_host->host_data) {
io_base = flipper_irq_host->host_data;
icr = in_be32(io_base + FLIPPER_ICR);
drv_printk(KERN_INFO, "%x\n", icr);
return !(icr & FLIPPER_ICR_RSS);
}
return 0;
}
--- NEW FILE: flipper-pic.h ---
/*
* arch/powerpc/platforms/embedded6xx/flipper-pic.h
*
* Nintendo GameCube/Wii interrupt controller support.
* Copyright (C) 2004-2008 The GameCube Linux Team
* Copyright (C) 2007,2008 Albert Herranz
*
* 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.
*
*/
#ifndef __FLIPPER_PIC_H
#define __FLIPPER_PIC_H
/*
* Each interrupt has a corresponding bit in both
* the Interrupt Cause (ICR) and Interrupt Mask (IMR) registers.
*
* Enabling/disabling an interrupt line involves asserting/clearing
* the corresponding bit in IMR. ACK'ing a request simply involves
* asserting the corresponding bit in ICR.
*/
#ifdef CONFIG_WII
#define FLIPPER_NR_IRQS (15)
#else
#define FLIPPER_NR_IRQS (14)
#endif
#define FLIPPER_ICR 0x00
#define FLIPPER_ICR_RSS (1<<16) /* reset switch state */
#define FLIPPER_IMR 0x04
#define FLIPPER_RESET 0x24
unsigned int flipper_pic_get_irq(void);
void __init flipper_pic_probe(void);
void flipper_platform_reset(void);
int flipper_is_reset_button_pressed(void);
#endif
|
