2011-12-27 11:18:36 +04:00
/*
* Copyright ( c ) 2010 - 2011 Samsung Electronics Co . , Ltd .
* http : //www.samsung.com
*
* Common Codes for EXYNOS
*
* This program is free software ; you can redistribute it and / or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation .
*/
# include <linux/kernel.h>
# include <linux/interrupt.h>
# include <linux/irq.h>
# include <linux/io.h>
2012-01-08 00:03:30 +04:00
# include <linux/device.h>
2011-12-27 11:18:36 +04:00
# include <linux/gpio.h>
# include <linux/sched.h>
# include <linux/serial_core.h>
2012-01-07 16:30:20 +04:00
# include <linux/of.h>
# include <linux/of_irq.h>
2011-12-27 11:18:36 +04:00
# include <asm/proc-fns.h>
2012-01-07 15:51:28 +04:00
# include <asm/exception.h>
2011-12-27 11:18:36 +04:00
# include <asm/hardware/cache-l2x0.h>
# include <asm/hardware/gic.h>
# include <asm/mach/map.h>
# include <asm/mach/irq.h>
# include <mach/regs-irq.h>
# include <mach/regs-pmu.h>
# include <mach/regs-gpio.h>
# include <plat/cpu.h>
# include <plat/clock.h>
# include <plat/devs.h>
# include <plat/pm.h>
# include <plat/sdhci.h>
# include <plat/gpio-cfg.h>
# include <plat/adc-core.h>
# include <plat/fb-core.h>
# include <plat/fimc-core.h>
# include <plat/iic-core.h>
# include <plat/tv-core.h>
# include <plat/regs-serial.h>
# include "common.h"
static const char name_exynos4210 [ ] = " EXYNOS4210 " ;
static const char name_exynos4212 [ ] = " EXYNOS4212 " ;
static const char name_exynos4412 [ ] = " EXYNOS4412 " ;
static struct cpu_table cpu_ids [ ] __initdata = {
{
. idcode = EXYNOS4210_CPU_ID ,
. idmask = EXYNOS4_CPU_MASK ,
. map_io = exynos4_map_io ,
. init_clocks = exynos4_init_clocks ,
. init_uarts = exynos4_init_uarts ,
. init = exynos_init ,
. name = name_exynos4210 ,
} , {
. idcode = EXYNOS4212_CPU_ID ,
. idmask = EXYNOS4_CPU_MASK ,
. map_io = exynos4_map_io ,
. init_clocks = exynos4_init_clocks ,
. init_uarts = exynos4_init_uarts ,
. init = exynos_init ,
. name = name_exynos4212 ,
} , {
. idcode = EXYNOS4412_CPU_ID ,
. idmask = EXYNOS4_CPU_MASK ,
. map_io = exynos4_map_io ,
. init_clocks = exynos4_init_clocks ,
. init_uarts = exynos4_init_uarts ,
. init = exynos_init ,
. name = name_exynos4412 ,
} ,
} ;
/* Initial IO mappings */
static struct map_desc exynos_iodesc [ ] __initdata = {
{
. virtual = ( unsigned long ) S5P_VA_CHIPID ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_CHIPID ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S3C_VA_SYS ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_SYSCON ) ,
. length = SZ_64K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S3C_VA_TIMER ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_TIMER ) ,
. length = SZ_16K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S3C_VA_WATCHDOG ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_WATCHDOG ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_SROMC ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_SROMC ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_SYSTIMER ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_SYSTIMER ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_PMU ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_PMU ) ,
. length = SZ_64K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_COMBINER_BASE ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_COMBINER ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_GIC_CPU ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_GIC_CPU ) ,
. length = SZ_64K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_GIC_DIST ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_GIC_DIST ) ,
. length = SZ_64K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S3C_VA_UART ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_UART ) ,
. length = SZ_512K ,
. type = MT_DEVICE ,
} ,
} ;
static struct map_desc exynos4_iodesc [ ] __initdata = {
{
. virtual = ( unsigned long ) S5P_VA_CMU ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_CMU ) ,
. length = SZ_128K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_COREPERI_BASE ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_COREPERI ) ,
. length = SZ_8K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_L2CC ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_L2CC ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_GPIO1 ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_GPIO1 ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_GPIO2 ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_GPIO2 ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_GPIO3 ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_GPIO3 ) ,
. length = SZ_256 ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S5P_VA_DMC0 ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_DMC0 ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} , {
. virtual = ( unsigned long ) S3C_VA_USB_HSPHY ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_HSPHY ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} ,
} ;
static struct map_desc exynos4_iodesc0 [ ] __initdata = {
{
. virtual = ( unsigned long ) S5P_VA_SYSRAM ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_SYSRAM0 ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} ,
} ;
static struct map_desc exynos4_iodesc1 [ ] __initdata = {
{
. virtual = ( unsigned long ) S5P_VA_SYSRAM ,
. pfn = __phys_to_pfn ( EXYNOS4_PA_SYSRAM1 ) ,
. length = SZ_4K ,
. type = MT_DEVICE ,
} ,
} ;
static void exynos_idle ( void )
{
if ( ! need_resched ( ) )
cpu_do_idle ( ) ;
local_irq_enable ( ) ;
}
2012-01-03 14:56:53 +04:00
void exynos4_restart ( char mode , const char * cmd )
2011-12-27 11:18:36 +04:00
{
__raw_writel ( 0x1 , S5P_SWRESET ) ;
}
/*
* exynos_map_io
*
* register the standard cpu IO areas
*/
void __init exynos_init_io ( struct map_desc * mach_desc , int size )
{
/* initialize the io descriptors we need for initialization */
iotable_init ( exynos_iodesc , ARRAY_SIZE ( exynos_iodesc ) ) ;
if ( mach_desc )
iotable_init ( mach_desc , size ) ;
/* detect cpu id and rev. */
s5p_init_cpu ( S5P_VA_CHIPID ) ;
s3c_init_cpu ( samsung_cpu_id , cpu_ids , ARRAY_SIZE ( cpu_ids ) ) ;
}
void __init exynos4_map_io ( void )
{
iotable_init ( exynos4_iodesc , ARRAY_SIZE ( exynos4_iodesc ) ) ;
if ( soc_is_exynos4210 ( ) & & samsung_rev ( ) = = EXYNOS4210_REV_0 )
iotable_init ( exynos4_iodesc0 , ARRAY_SIZE ( exynos4_iodesc0 ) ) ;
else
iotable_init ( exynos4_iodesc1 , ARRAY_SIZE ( exynos4_iodesc1 ) ) ;
/* initialize device information early */
exynos4_default_sdhci0 ( ) ;
exynos4_default_sdhci1 ( ) ;
exynos4_default_sdhci2 ( ) ;
exynos4_default_sdhci3 ( ) ;
s3c_adc_setname ( " samsung-adc-v3 " ) ;
s3c_fimc_setname ( 0 , " exynos4-fimc " ) ;
s3c_fimc_setname ( 1 , " exynos4-fimc " ) ;
s3c_fimc_setname ( 2 , " exynos4-fimc " ) ;
s3c_fimc_setname ( 3 , " exynos4-fimc " ) ;
/* The I2C bus controllers are directly compatible with s3c2440 */
s3c_i2c0_setname ( " s3c2440-i2c " ) ;
s3c_i2c1_setname ( " s3c2440-i2c " ) ;
s3c_i2c2_setname ( " s3c2440-i2c " ) ;
s5p_fb_setname ( 0 , " exynos4-fb " ) ;
s5p_hdmi_setname ( " exynos4-hdmi " ) ;
}
void __init exynos4_init_clocks ( int xtal )
{
printk ( KERN_DEBUG " %s: initializing clocks \n " , __func__ ) ;
s3c24xx_register_baseclocks ( xtal ) ;
s5p_register_clocks ( xtal ) ;
if ( soc_is_exynos4210 ( ) )
exynos4210_register_clocks ( ) ;
else if ( soc_is_exynos4212 ( ) | | soc_is_exynos4412 ( ) )
exynos4212_register_clocks ( ) ;
exynos4_register_clocks ( ) ;
exynos4_setup_clocks ( ) ;
}
# define COMBINER_ENABLE_SET 0x0
# define COMBINER_ENABLE_CLEAR 0x4
# define COMBINER_INT_STATUS 0xC
static DEFINE_SPINLOCK ( irq_controller_lock ) ;
struct combiner_chip_data {
unsigned int irq_offset ;
unsigned int irq_mask ;
void __iomem * base ;
} ;
static struct combiner_chip_data combiner_data [ MAX_COMBINER_NR ] ;
static inline void __iomem * combiner_base ( struct irq_data * data )
{
struct combiner_chip_data * combiner_data =
irq_data_get_irq_chip_data ( data ) ;
return combiner_data - > base ;
}
static void combiner_mask_irq ( struct irq_data * data )
{
u32 mask = 1 < < ( data - > irq % 32 ) ;
__raw_writel ( mask , combiner_base ( data ) + COMBINER_ENABLE_CLEAR ) ;
}
static void combiner_unmask_irq ( struct irq_data * data )
{
u32 mask = 1 < < ( data - > irq % 32 ) ;
__raw_writel ( mask , combiner_base ( data ) + COMBINER_ENABLE_SET ) ;
}
static void combiner_handle_cascade_irq ( unsigned int irq , struct irq_desc * desc )
{
struct combiner_chip_data * chip_data = irq_get_handler_data ( irq ) ;
struct irq_chip * chip = irq_get_chip ( irq ) ;
unsigned int cascade_irq , combiner_irq ;
unsigned long status ;
chained_irq_enter ( chip , desc ) ;
spin_lock ( & irq_controller_lock ) ;
status = __raw_readl ( chip_data - > base + COMBINER_INT_STATUS ) ;
spin_unlock ( & irq_controller_lock ) ;
status & = chip_data - > irq_mask ;
if ( status = = 0 )
goto out ;
combiner_irq = __ffs ( status ) ;
cascade_irq = combiner_irq + ( chip_data - > irq_offset & ~ 31 ) ;
if ( unlikely ( cascade_irq > = NR_IRQS ) )
do_bad_IRQ ( cascade_irq , desc ) ;
else
generic_handle_irq ( cascade_irq ) ;
out :
chained_irq_exit ( chip , desc ) ;
}
static struct irq_chip combiner_chip = {
. name = " COMBINER " ,
. irq_mask = combiner_mask_irq ,
. irq_unmask = combiner_unmask_irq ,
} ;
static void __init combiner_cascade_irq ( unsigned int combiner_nr , unsigned int irq )
{
if ( combiner_nr > = MAX_COMBINER_NR )
BUG ( ) ;
if ( irq_set_handler_data ( irq , & combiner_data [ combiner_nr ] ) ! = 0 )
BUG ( ) ;
irq_set_chained_handler ( irq , combiner_handle_cascade_irq ) ;
}
static void __init combiner_init ( unsigned int combiner_nr , void __iomem * base ,
unsigned int irq_start )
{
unsigned int i ;
if ( combiner_nr > = MAX_COMBINER_NR )
BUG ( ) ;
combiner_data [ combiner_nr ] . base = base ;
combiner_data [ combiner_nr ] . irq_offset = irq_start ;
combiner_data [ combiner_nr ] . irq_mask = 0xff < < ( ( combiner_nr % 4 ) < < 3 ) ;
/* Disable all interrupts */
__raw_writel ( combiner_data [ combiner_nr ] . irq_mask ,
base + COMBINER_ENABLE_CLEAR ) ;
/* Setup the Linux IRQ subsystem */
for ( i = irq_start ; i < combiner_data [ combiner_nr ] . irq_offset
+ MAX_IRQ_IN_COMBINER ; i + + ) {
irq_set_chip_and_handler ( i , & combiner_chip , handle_level_irq ) ;
irq_set_chip_data ( i , & combiner_data [ combiner_nr ] ) ;
set_irq_flags ( i , IRQF_VALID | IRQF_PROBE ) ;
}
}
2012-01-07 16:30:20 +04:00
# ifdef CONFIG_OF
static const struct of_device_id exynos4_dt_irq_match [ ] = {
{ . compatible = " arm,cortex-a9-gic " , . data = gic_of_init , } ,
{ } ,
} ;
# endif
2011-12-27 11:18:36 +04:00
void __init exynos4_init_irq ( void )
{
int irq ;
2012-01-07 15:51:28 +04:00
unsigned int gic_bank_offset ;
2011-12-27 11:18:36 +04:00
gic_bank_offset = soc_is_exynos4412 ( ) ? 0x4000 : 0x8000 ;
2012-01-07 16:30:20 +04:00
if ( ! of_have_populated_dt ( ) )
gic_init_bases ( 0 , IRQ_PPI ( 0 ) , S5P_VA_GIC_DIST , S5P_VA_GIC_CPU , gic_bank_offset ) ;
# ifdef CONFIG_OF
else
of_irq_init ( exynos4_dt_irq_match ) ;
# endif
2011-12-27 11:18:36 +04:00
for ( irq = 0 ; irq < MAX_COMBINER_NR ; irq + + ) {
combiner_init ( irq , ( void __iomem * ) S5P_VA_COMBINER ( irq ) ,
COMBINER_IRQ ( irq , 0 ) ) ;
combiner_cascade_irq ( irq , IRQ_SPI ( irq ) ) ;
}
/*
* The parameters of s5p_init_irq ( ) are for VIC init .
* Theses parameters should be NULL and 0 because EXYNOS4
* uses GIC instead of VIC .
*/
s5p_init_irq ( NULL , 0 ) ;
}
2012-01-08 00:03:30 +04:00
struct bus_type exynos4_subsys = {
. name = " exynos4-core " ,
. dev_name = " exynos4-core " ,
2011-12-27 11:18:36 +04:00
} ;
2012-01-08 00:03:30 +04:00
static struct device exynos4_dev = {
. bus = & exynos4_subsys ,
2011-12-27 11:18:36 +04:00
} ;
static int __init exynos4_core_init ( void )
{
2012-01-08 00:03:30 +04:00
return subsys_system_register ( & exynos4_subsys , NULL ) ;
2011-12-27 11:18:36 +04:00
}
core_initcall ( exynos4_core_init ) ;
# ifdef CONFIG_CACHE_L2X0
static int __init exynos4_l2x0_cache_init ( void )
{
/* TAG, Data Latency Control: 2cycle */
__raw_writel ( 0x110 , S5P_VA_L2CC + L2X0_TAG_LATENCY_CTRL ) ;
if ( soc_is_exynos4210 ( ) )
__raw_writel ( 0x110 , S5P_VA_L2CC + L2X0_DATA_LATENCY_CTRL ) ;
else if ( soc_is_exynos4212 ( ) | | soc_is_exynos4412 ( ) )
__raw_writel ( 0x120 , S5P_VA_L2CC + L2X0_DATA_LATENCY_CTRL ) ;
/* L2X0 Prefetch Control */
__raw_writel ( 0x30000007 , S5P_VA_L2CC + L2X0_PREFETCH_CTRL ) ;
/* L2X0 Power Control */
__raw_writel ( L2X0_DYNAMIC_CLK_GATING_EN | L2X0_STNDBY_MODE_EN ,
S5P_VA_L2CC + L2X0_POWER_CTRL ) ;
l2x0_init ( S5P_VA_L2CC , 0x7C470001 , 0xC200ffff ) ;
return 0 ;
}
early_initcall ( exynos4_l2x0_cache_init ) ;
# endif
int __init exynos_init ( void )
{
printk ( KERN_INFO " EXYNOS: Initializing architecture \n " ) ;
/* set idle function */
pm_idle = exynos_idle ;
2012-01-08 00:03:30 +04:00
return device_register ( & exynos4_dev ) ;
2011-12-27 11:18:36 +04:00
}
/* uart registration process */
void __init exynos4_init_uarts ( struct s3c2410_uartcfg * cfg , int no )
{
struct s3c2410_uartcfg * tcfg = cfg ;
u32 ucnt ;
2012-01-07 16:30:20 +04:00
for ( ucnt = 0 ; ucnt < no ; ucnt + + , tcfg + + )
tcfg - > has_fracval = 1 ;
2011-12-27 11:18:36 +04:00
2012-01-07 16:30:20 +04:00
s3c24xx_init_uartdevs ( " exynos4210-uart " , s5p_uart_resources , cfg , no ) ;
2011-12-27 11:18:36 +04:00
}
static DEFINE_SPINLOCK ( eint_lock ) ;
static unsigned int eint0_15_data [ 16 ] ;
static unsigned int exynos4_get_irq_nr ( unsigned int number )
{
u32 ret = 0 ;
switch ( number ) {
case 0 . . . 3 :
ret = ( number + IRQ_EINT0 ) ;
break ;
case 4 . . . 7 :
ret = ( number + ( IRQ_EINT4 - 4 ) ) ;
break ;
case 8 . . . 15 :
ret = ( number + ( IRQ_EINT8 - 8 ) ) ;
break ;
default :
printk ( KERN_ERR " number available : %d \n " , number ) ;
}
return ret ;
}
static inline void exynos4_irq_eint_mask ( struct irq_data * data )
{
u32 mask ;
spin_lock ( & eint_lock ) ;
mask = __raw_readl ( S5P_EINT_MASK ( EINT_REG_NR ( data - > irq ) ) ) ;
mask | = eint_irq_to_bit ( data - > irq ) ;
__raw_writel ( mask , S5P_EINT_MASK ( EINT_REG_NR ( data - > irq ) ) ) ;
spin_unlock ( & eint_lock ) ;
}
static void exynos4_irq_eint_unmask ( struct irq_data * data )
{
u32 mask ;
spin_lock ( & eint_lock ) ;
mask = __raw_readl ( S5P_EINT_MASK ( EINT_REG_NR ( data - > irq ) ) ) ;
mask & = ~ ( eint_irq_to_bit ( data - > irq ) ) ;
__raw_writel ( mask , S5P_EINT_MASK ( EINT_REG_NR ( data - > irq ) ) ) ;
spin_unlock ( & eint_lock ) ;
}
static inline void exynos4_irq_eint_ack ( struct irq_data * data )
{
__raw_writel ( eint_irq_to_bit ( data - > irq ) ,
S5P_EINT_PEND ( EINT_REG_NR ( data - > irq ) ) ) ;
}
static void exynos4_irq_eint_maskack ( struct irq_data * data )
{
exynos4_irq_eint_mask ( data ) ;
exynos4_irq_eint_ack ( data ) ;
}
static int exynos4_irq_eint_set_type ( struct irq_data * data , unsigned int type )
{
int offs = EINT_OFFSET ( data - > irq ) ;
int shift ;
u32 ctrl , mask ;
u32 newvalue = 0 ;
switch ( type ) {
case IRQ_TYPE_EDGE_RISING :
newvalue = S5P_IRQ_TYPE_EDGE_RISING ;
break ;
case IRQ_TYPE_EDGE_FALLING :
newvalue = S5P_IRQ_TYPE_EDGE_FALLING ;
break ;
case IRQ_TYPE_EDGE_BOTH :
newvalue = S5P_IRQ_TYPE_EDGE_BOTH ;
break ;
case IRQ_TYPE_LEVEL_LOW :
newvalue = S5P_IRQ_TYPE_LEVEL_LOW ;
break ;
case IRQ_TYPE_LEVEL_HIGH :
newvalue = S5P_IRQ_TYPE_LEVEL_HIGH ;
break ;
default :
printk ( KERN_ERR " No such irq type %d " , type ) ;
return - EINVAL ;
}
shift = ( offs & 0x7 ) * 4 ;
mask = 0x7 < < shift ;
spin_lock ( & eint_lock ) ;
ctrl = __raw_readl ( S5P_EINT_CON ( EINT_REG_NR ( data - > irq ) ) ) ;
ctrl & = ~ mask ;
ctrl | = newvalue < < shift ;
__raw_writel ( ctrl , S5P_EINT_CON ( EINT_REG_NR ( data - > irq ) ) ) ;
spin_unlock ( & eint_lock ) ;
switch ( offs ) {
case 0 . . . 7 :
s3c_gpio_cfgpin ( EINT_GPIO_0 ( offs & 0x7 ) , EINT_MODE ) ;
break ;
case 8 . . . 15 :
s3c_gpio_cfgpin ( EINT_GPIO_1 ( offs & 0x7 ) , EINT_MODE ) ;
break ;
case 16 . . . 23 :
s3c_gpio_cfgpin ( EINT_GPIO_2 ( offs & 0x7 ) , EINT_MODE ) ;
break ;
case 24 . . . 31 :
s3c_gpio_cfgpin ( EINT_GPIO_3 ( offs & 0x7 ) , EINT_MODE ) ;
break ;
default :
printk ( KERN_ERR " No such irq number %d " , offs ) ;
}
return 0 ;
}
static struct irq_chip exynos4_irq_eint = {
. name = " exynos4-eint " ,
. irq_mask = exynos4_irq_eint_mask ,
. irq_unmask = exynos4_irq_eint_unmask ,
. irq_mask_ack = exynos4_irq_eint_maskack ,
. irq_ack = exynos4_irq_eint_ack ,
. irq_set_type = exynos4_irq_eint_set_type ,
# ifdef CONFIG_PM
. irq_set_wake = s3c_irqext_wake ,
# endif
} ;
/*
* exynos4_irq_demux_eint
*
* This function demuxes the IRQ from from EINTs 16 to 31.
* It is designed to be inlined into the specific handler
* s5p_irq_demux_eintX_Y .
*
* Each EINT pend / mask registers handle eight of them .
*/
static inline void exynos4_irq_demux_eint ( unsigned int start )
{
unsigned int irq ;
u32 status = __raw_readl ( S5P_EINT_PEND ( EINT_REG_NR ( start ) ) ) ;
u32 mask = __raw_readl ( S5P_EINT_MASK ( EINT_REG_NR ( start ) ) ) ;
status & = ~ mask ;
status & = 0xff ;
while ( status ) {
irq = fls ( status ) - 1 ;
generic_handle_irq ( irq + start ) ;
status & = ~ ( 1 < < irq ) ;
}
}
static void exynos4_irq_demux_eint16_31 ( unsigned int irq , struct irq_desc * desc )
{
struct irq_chip * chip = irq_get_chip ( irq ) ;
chained_irq_enter ( chip , desc ) ;
exynos4_irq_demux_eint ( IRQ_EINT ( 16 ) ) ;
exynos4_irq_demux_eint ( IRQ_EINT ( 24 ) ) ;
chained_irq_exit ( chip , desc ) ;
}
static void exynos4_irq_eint0_15 ( unsigned int irq , struct irq_desc * desc )
{
u32 * irq_data = irq_get_handler_data ( irq ) ;
struct irq_chip * chip = irq_get_chip ( irq ) ;
chained_irq_enter ( chip , desc ) ;
chip - > irq_mask ( & desc - > irq_data ) ;
if ( chip - > irq_ack )
chip - > irq_ack ( & desc - > irq_data ) ;
generic_handle_irq ( * irq_data ) ;
chip - > irq_unmask ( & desc - > irq_data ) ;
chained_irq_exit ( chip , desc ) ;
}
int __init exynos4_init_irq_eint ( void )
{
int irq ;
for ( irq = 0 ; irq < = 31 ; irq + + ) {
irq_set_chip_and_handler ( IRQ_EINT ( irq ) , & exynos4_irq_eint ,
handle_level_irq ) ;
set_irq_flags ( IRQ_EINT ( irq ) , IRQF_VALID ) ;
}
irq_set_chained_handler ( IRQ_EINT16_31 , exynos4_irq_demux_eint16_31 ) ;
for ( irq = 0 ; irq < = 15 ; irq + + ) {
eint0_15_data [ irq ] = IRQ_EINT ( irq ) ;
irq_set_handler_data ( exynos4_get_irq_nr ( irq ) ,
& eint0_15_data [ irq ] ) ;
irq_set_chained_handler ( exynos4_get_irq_nr ( irq ) ,
exynos4_irq_eint0_15 ) ;
}
return 0 ;
}
arch_initcall ( exynos4_init_irq_eint ) ;