static void __init gic_init_irq(void)
{
if (core_tile_eb11mp() || core_tile_a9mp()) {
unsigned int pldctrl;
/* new irq mode */
writel(0x0000a05f, __io_address(REALVIEW_SYS_LOCK));
pldctrl = readl(__io_address(REALVIEW_SYS_BASE) + REALVIEW_EB11MP_SYS_PLD_CTRL1);
pldctrl |= 0x00800000;
writel(pldctrl, __io_address(REALVIEW_SYS_BASE) + REALVIEW_EB11MP_SYS_PLD_CTRL1);
writel(0x00000000, __io_address(REALVIEW_SYS_LOCK));
/* core tile GIC, primary */
gic_cpu_base_addr = __io_address(REALVIEW_EB11MP_GIC_CPU_BASE);
gic_dist_init(0, __io_address(REALVIEW_EB11MP_GIC_DIST_BASE), 29);
gic_cpu_init(0, gic_cpu_base_addr);
#ifndef CONFIG_REALVIEW_EB_ARM11MP_REVB
/* board GIC, secondary */
gic_dist_init(1, __io_address(REALVIEW_EB_GIC_DIST_BASE), 64);
gic_cpu_init(1, __io_address(REALVIEW_EB_GIC_CPU_BASE));
gic_cascade_irq(1, IRQ_EB11MP_EB_IRQ1);
#endif
} else {
/* board GIC, primary */
gic_cpu_base_addr = __io_address(REALVIEW_EB_GIC_CPU_BASE);
gic_dist_init(0, __io_address(REALVIEW_EB_GIC_DIST_BASE), 29);
gic_cpu_init(0, gic_cpu_base_addr);
}
}
static void __init gic_init_irq(void)
{
gic_cpu_base_addr = __io_address(REALVIEW_DC1176_GIC_CPU_BASE);
gic_dist_init(0, __io_address(REALVIEW_DC1176_GIC_DIST_BASE), IRQ_DC1176_GIC_START);
gic_cpu_init(0, gic_cpu_base_addr);
gic_dist_init(1, __io_address(REALVIEW_PB1176_GIC_DIST_BASE), IRQ_PB1176_GIC_START);
gic_cpu_init(1, __io_address(REALVIEW_PB1176_GIC_CPU_BASE));
gic_cascade_irq(1, IRQ_DC1176_PB_IRQ1);
}
static void __init gic_init_irq(void)
{
/* ARM1176 DevChip GIC, primary */
gic_cpu_base_addr = __io_address(REALVIEW_DC1176_GIC_CPU_BASE);
gic_dist_init(0, __io_address(REALVIEW_DC1176_GIC_DIST_BASE), IRQ_DC1176_GIC_START);
gic_cpu_init(0, gic_cpu_base_addr);
/* board GIC, secondary */
gic_dist_init(1, __io_address(REALVIEW_PB1176_GIC_DIST_BASE), IRQ_PB1176_GIC_START);
gic_cpu_init(1, __io_address(REALVIEW_PB1176_GIC_CPU_BASE));
gic_cascade_irq(1, IRQ_DC1176_PB_IRQ1);
}
static void __init gic_init_irq(void)
{
if (core_tile_pbx11mp() || core_tile_pbxa9mp()) {
gic_cpu_base_addr = __io_address(REALVIEW_PBX_TILE_GIC_CPU_BASE);
gic_dist_init(0, __io_address(REALVIEW_PBX_TILE_GIC_DIST_BASE),
29);
gic_cpu_init(0, __io_address(REALVIEW_PBX_TILE_GIC_CPU_BASE));
} else {
gic_cpu_base_addr = __io_address(REALVIEW_PBX_GIC_CPU_BASE);
gic_dist_init(0, __io_address(REALVIEW_PBX_GIC_DIST_BASE),
IRQ_PBX_GIC_START);
gic_cpu_init(0, __io_address(REALVIEW_PBX_GIC_CPU_BASE));
}
}
void __init tegra_init_irq(void)
{
struct irq_chip *gic;
unsigned int i;
for (i=0; i<PPI_NR; i++) {
writel(~0, ictlr_to_virt(i) + ICTLR_CPU_IER_CLR);
writel(0, ictlr_to_virt(i) + ICTLR_CPU_IEP_CLASS);
}
gic_dist_init(0, IO_ADDRESS(TEGRA_ARM_INT_DIST_BASE), 29);
gic_cpu_init(0, IO_ADDRESS(TEGRA_ARM_PERIF_BASE + 0x100));
gic = get_irq_chip(29);
gic_unmask_irq = gic->unmask;
gic_mask_irq = gic->mask;
tegra_irq.ack = gic->ack;
#ifdef CONFIG_SMP
tegra_irq.set_affinity = gic->set_affinity;
#endif
for (i=INT_PRI_BASE; i<INT_SYNCPT_THRESH_BASE; i++) {
set_irq_chip(i, &tegra_irq);
set_irq_handler(i, handle_level_irq);
set_irq_flags(i, IRQF_VALID);
}
syncpt_init_irq();
}
static void __init gic_init_irq(void)
{
/* ARM PB-A8 on-board GIC */
gic_cpu_base_addr = __io_address(REALVIEW_PBA8_GIC_CPU_BASE);
gic_dist_init(0, __io_address(REALVIEW_PBA8_GIC_DIST_BASE), IRQ_PBA8_GIC_START);
gic_cpu_init(0, __io_address(REALVIEW_PBA8_GIC_CPU_BASE));
}
void __init msm8x60_init_irq(void)
{
unsigned int i;
gic_dist_init(0, MSM_QGIC_DIST_BASE, GIC_PPI_START);
gic_cpu_base_addr = (void *)MSM_QGIC_CPU_BASE;
gic_cpu_init(0, MSM_QGIC_CPU_BASE);
/* Edge trigger PPIs except AVS_SVICINT and AVS_SVICINTSWDONE */
writel(0xFFFFD7FF, MSM_QGIC_DIST_BASE + GIC_DIST_CONFIG + 4);
/* QGIC does not adhere to GIC spec by enabling STIs by default.
* Enable/clear is supposed to be RO for STIs, but is RW on QGIC.
*/
if (!machine_is_msm8x60_sim())
writel(0x0000FFFF, MSM_QGIC_DIST_BASE + GIC_DIST_ENABLE_SET);
/* FIXME: Not installing AVS_SVICINT and AVS_SVICINTSWDONE yet
* as they are configured as level, which does not play nice with
* handle_percpu_irq.
*/
for (i = GIC_PPI_START; i < GIC_SPI_START; i++) {
if (i != AVS_SVICINT && i != AVS_SVICINTSWDONE)
set_irq_handler(i, handle_percpu_irq);
}
}
//----------------------------------------------------------------
static
void zynq_irq_init()
{
gic_cpu_base_addr = (void *)(IO_ADDRESS(ZYNQ_GIC_CPU_PHYS_BASE));
gic_dist_init(0, IO_ADDRESS(ZYNQ_GIC_DIST_PHYS_BASE), INT_PPI_2_PTIMER);
gic_cpu_init(0, IO_ADDRESS(ZYNQ_GIC_CPU_PHYS_BASE));
}
static void __init gic_init_irq(void)
{
#ifdef CONFIG_REALVIEW_MPCORE
unsigned int pldctrl;
writel(0x0000a05f, __io_address(REALVIEW_SYS_LOCK));
pldctrl = readl(__io_address(REALVIEW_SYS_BASE) + REALVIEW_MPCORE_SYS_PLD_CTRL1);
pldctrl |= 0x00800000; /* New irq mode */
writel(pldctrl, __io_address(REALVIEW_SYS_BASE) + REALVIEW_MPCORE_SYS_PLD_CTRL1);
writel(0x00000000, __io_address(REALVIEW_SYS_LOCK));
#endif
gic_dist_init(0, __io_address(REALVIEW_GIC_DIST_BASE), 29);
gic_cpu_init(0, __io_address(REALVIEW_GIC_CPU_BASE));
#if defined(CONFIG_REALVIEW_MPCORE) && !defined(CONFIG_REALVIEW_MPCORE_REVB)
gic_dist_init(1, __io_address(REALVIEW_GIC1_DIST_BASE), 64);
gic_cpu_init(1, __io_address(REALVIEW_GIC1_CPU_BASE));
gic_cascade_irq(1, IRQ_EB_IRQ1);
#endif
}
void __init s5pv310_init_irq(void)
{
int irq;
#ifdef CONFIG_USE_EXT_GIC
gic_cpu_base_addr = S5P_VA_EXTGIC_CPU;
gic_dist_init(0, S5P_VA_EXTGIC_DIST, IRQ_SPI(0));
gic_cpu_init(0, S5P_VA_EXTGIC_CPU);
#else
gic_cpu_base_addr = S5P_VA_GIC_CPU;
gic_dist_init(0, S5P_VA_GIC_DIST, IRQ_SPI(0));
gic_cpu_init(0, S5P_VA_GIC_CPU);
#endif
for (irq = 0; irq < MAX_COMBINER_NR; irq++) {
#ifdef CONFIG_CPU_S5PV310_EVT1
/* From SPI(0) to SPI(39) and SPI(51), SPI(53)
* are connected to the interrupt combiner. These irqs
* should be initialized to support cascade interrupt.
*/
if ((irq >= 40) && !(irq == 51) && !(irq == 53))
continue;
#endif
#ifdef CONFIG_USE_EXT_GIC
combiner_init(irq, (void __iomem *)S5P_VA_EXTCOMBINER(irq),
COMBINER_IRQ(irq, 0));
#else
combiner_init(irq, (void __iomem *)S5P_VA_COMBINER(irq),
COMBINER_IRQ(irq, 0));
#endif
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 S5PV310
* uses GIC instead of VIC.
*/
s5p_init_irq(NULL, 0);
/* Set s3c_irq_wake as set_wake() of GIC irq_chip */
get_irq_chip(IRQ_RTC_ALARM)->set_wake = s3c_irq_wake;
}
static void __init gic_init_irq(void)
{
#ifdef CONFIG_REALVIEW_MPCORE
writel(0x0000a05f, __io_address(REALVIEW_SYS_LOCK));
writel(0x008003c0, __io_address(REALVIEW_SYS_BASE) + 0xd8);
writel(0x00000000, __io_address(REALVIEW_SYS_LOCK));
#endif
gic_dist_init(__io_address(REALVIEW_GIC_DIST_BASE));
gic_cpu_init(__io_address(REALVIEW_GIC_CPU_BASE));
}
void __init ux500_init_irq(void)
{
gic_dist_init(0, __io_address(UX500_GIC_DIST_BASE), 29);
gic_cpu_init(0, __io_address(UX500_GIC_CPU_BASE));
/*
* Init clocks here so that they are available for system timer
* initialization.
*/
clk_init();
}
/*
* Code to setup the interrupts
*/
static void __init oxnas_init_irq(void)
{
/* initialise the RPS interrupt controller */
OX820_RPS_init_irq(OX820_RPS_IRQ_START, OX820_RPS_IRQ_START + NR_RPS_IRQS);
/* initialise the GIC */
gic_cpu_base_addr = __io_address(OX820_GIC_CPU_BASE_ADDR);
gic_dist_init(0, __io_address(OX820_GIC_DIST_BASE_ADDR), 29);
gic_cpu_init(0, gic_cpu_base_addr);
OX820_RPS_cascade_irq( RPSA_IRQ_INTERRUPT);
}
void __init gic_init_irq(void)
{
/* Static mapping, never released */
gic_dist_base_addr = ioremap(OMAP44XX_GIC_DIST_BASE, SZ_4K);
BUG_ON(!gic_dist_base_addr);
gic_dist_init(0, gic_dist_base_addr, 29);
/* Static mapping, never released */
gic_cpu_base_addr = ioremap(OMAP44XX_GIC_CPU_BASE, SZ_512);
BUG_ON(!gic_cpu_base_addr);
gic_cpu_init(0, gic_cpu_base_addr);
}
static void __init gic_init_irq(void)
{
/* irq mode with no DCC */
/* ARM11 MPCore test chip GIC */
gic_cpu_base_addr = (void __iomem *) CNS3XXX_TC11MP_GIC_CPU_BASE_VIRT;
gic_dist_init(0, (void __iomem *) CNS3XXX_TC11MP_GIC_DIST_BASE_VIRT, 29);
gic_cpu_init(0, gic_cpu_base_addr);
}
static void __init gic_init_irq(void)
{
#ifdef CONFIG_REALVIEW_MPCORE
unsigned int pldctrl;
writel(0x0000a05f, __io_address(REALVIEW_SYS_LOCK));
pldctrl = readl(__io_address(REALVIEW_SYS_BASE) + 0xd8);
pldctrl |= 0x00800000; /* New irq mode */
writel(pldctrl, __io_address(REALVIEW_SYS_BASE) + 0xd8);
writel(0x00000000, __io_address(REALVIEW_SYS_LOCK));
#endif
gic_dist_init(__io_address(REALVIEW_GIC_DIST_BASE));
gic_cpu_init(__io_address(REALVIEW_GIC_CPU_BASE));
}
void gic_dev_init(unsigned int nr, int start,
void __iomem *dist_base, void __iomem *cpu_base)
{
struct gic_chip_data *gic;
gic = &gic_data[nr];
gic->dist_base = dist_base;
gic->cpu_base = cpu_base;
#ifndef SKIP_GIC_INIT
gic_dist_init(gic);
gic_cpu_init(gic);
#endif
}
static int __init gic_init_bases(struct vmm_devtree_node *node,
u32 gic_nr,
bool eoimode,
u32 irq_start,
virtual_addr_t cpu_base,
virtual_addr_t cpu2_base,
virtual_addr_t dist_base)
{
u32 max_irqs;
struct gic_chip_data *gic;
BUG_ON(gic_nr >= GIC_MAX_NR);
gic = &gic_data[gic_nr];
gic->eoimode = eoimode;
/* For primary GICs, skip over SGIs.
* For secondary GICs, skip over PPIs, too.
*/
gic->hwirq_base = (gic_nr == 0) ? 16 : 32;
gic->dist_base = dist_base;
gic->cpu_base = cpu_base;
gic->cpu2_base = cpu2_base;
/*
* Find out how many interrupts are supported.
* The GIC only supports up to 1020 interrupt sources.
*/
max_irqs = gic_read(gic->dist_base + GICD_CTR) & 0x1f;
max_irqs = (max_irqs + 1) * 32;
if (max_irqs > 1020)
max_irqs = 1020;
gic->max_irqs = max_irqs;
gic->domain = vmm_host_irqdomain_add(node, (int)irq_start, max_irqs,
&gic_ops, gic);
if (!gic->domain) {
return VMM_EFAIL;
}
gic_dist_init(gic);
gic_cpu_init(gic);
return VMM_OK;
}
int arm_board_pic_init(void)
{
int rc;
/*
* Initialize Generic Interrupt Controller
*/
rc = gic_dist_init(0, A9_MPCORE_GIC_DIST, IRQ_CA9X4_GIC_START);
if (rc) {
return rc;
}
rc = gic_cpu_init(0, A9_MPCORE_GIC_CPU);
if (rc) {
return rc;
}
return 0;
}
static int __init gic_init_bases(u32 gic_nr,
bool eoimode,
u32 irq_start,
virtual_addr_t cpu_base,
virtual_addr_t cpu2_base,
virtual_addr_t dist_base)
{
u32 max_irqs;
struct gic_chip_data *gic;
BUG_ON(gic_nr >= GIC_MAX_NR);
gic = &gic_data[gic_nr];
gic->eoimode = eoimode;
gic->irq_start = irq_start;
/* For primary GICs, skip over SGIs.
* For secondary GICs, skip over PPIs, too.
*/
gic->hwirq_base = (gic_nr == 0) ? 16 : 32;
gic->dist_base = dist_base;
gic->cpu_base = cpu_base;
gic->cpu2_base = cpu2_base;
/*
* Find out how many interrupts are supported.
* The GIC only supports up to 1020 interrupt sources.
*/
max_irqs = gic_read(gic->dist_base + GIC_DIST_CTR) & 0x1f;
max_irqs = (max_irqs + 1) * 32;
if (max_irqs > 1020)
max_irqs = 1020;
/*
* Limit number of interrupts registered to the platform maximum
*/
BUG_ON((max_irqs + gic->irq_start) > CONFIG_HOST_IRQ_COUNT);
gic->max_irqs = max_irqs;
gic_dist_init(gic);
gic_cpu_init(gic);
return VMM_OK;
}
int __init gic_init(u32 gic_nr, u32 irq_start,
virtual_addr_t cpu_base, virtual_addr_t dist_base)
{
struct gic_chip_data *gic;
if (gic_nr >= GIC_MAX_NR) {
return VMM_EFAIL;
}
gic = &gic_data[gic_nr];
gic->dist_base = dist_base;
gic->cpu_base = cpu_base;
gic->irq_offset = (irq_start - 1) & ~31;
gic_dist_init(gic, irq_start);
gic_cpu_init(gic);
return VMM_OK;
}
void __init s5pv310_init_irq(void)
{
int irq;
gic_cpu_base_addr = S5P_VA_GIC_CPU;
gic_dist_init(0, S5P_VA_GIC_DIST, IRQ_LOCALTIMER);
gic_cpu_init(0, S5P_VA_GIC_CPU);
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 S5PV310
* uses GIC instead of VIC.
*/
s5p_init_irq(NULL, 0);
}
void __init tegra_init_irq(void) {
/*int i;*/
printk("%s\n", __FUNCTION__);
gic_dist_init(0, IO_ADDRESS(TEGRA_ARM_INT_DIST_BASE), 32);
gic_cpu_init(0, IO_ADDRESS(TEGRA_ARM_PERIF_BASE + 0x100));
/*for (i=0; i<4; i++) {
__raw_writel(~0UL, ictlr_reg_base[i] + ICTLR_CPU_IER_CLR);
__raw_writel(0, ictlr_reg_base[i] + ICTLR_CPU_IEP_CLASS);
}
for (i=32; i<NR_IRQS; i++) {
if (set_irq_chip(i, &tegra_irq_chip))
BUG();
set_irq_handler(i, handle_level_irq);
}*/
tegra_init_clock();
}
void __init gic_init(unsigned int gic_nr, unsigned int irq_start,
void __iomem *dist_base, void __iomem *cpu_base)
{
struct gic_chip_data *gic;
BUG_ON(gic_nr >= MAX_GIC_NR);
gic = &gic_data[gic_nr];
gic->dist_base = dist_base;
gic->cpu_base = cpu_base;
gic->irq_offset = (irq_start - 1) & ~31;
if (gic_nr == 0)
gic_cpu_base_addr = cpu_base;
gic_chip.flags |= gic_arch_extn.flags;
gic_dist_init(gic, irq_start);
gic_cpu_init(gic);
gic_pm_init(gic);
}
void __init chip_init_irq(void)
{
unsigned long temp;
#if 1
gic_init(0,29,_gic_dist_base_addr,_gic_cpu_base_addr);
#else
gic_dist_init(0, gic_dist_base_addr , 29);
gic_cpu_init(0, gic_cpu_base_addr);
#endif
#if defined(CONFIG_MP_PLATFORM_MSTAR_LEGANCY_INTR)
arm_interrupt_chain_setup(INT_PPI_IRQ);
#else
//GIC Interrupt Set Enable Register for MSTAR controller
temp=PERI_R(GIC_DIST_SET_EANBLE);
temp= temp | (0x1 << INT_PPI_IRQ );
PERI_W(GIC_DIST_SET_EANBLE,temp);
#endif /* CONFIG_MP_PLATFORM_MSTAR_LEGANCY_INTR */
}
void __init ux500_init_irq(void)
{
void __iomem *dist_base;
if (cpu_is_u5500()) {
gic_cpu_base_addr = __io_address(U5500_GIC_CPU_BASE);
dist_base = __io_address(U5500_GIC_DIST_BASE);
} else if (cpu_is_u8500()) {
gic_cpu_base_addr = __io_address(U8500_GIC_CPU_BASE);
dist_base = __io_address(U8500_GIC_DIST_BASE);
} else
ux500_unknown_soc();
gic_dist_init(0, dist_base, 29);
gic_cpu_init(0, gic_cpu_base_addr);
/*
* Init clocks here so that they are available for system timer
* initialization.
*/
prcmu_early_init();
arm_pm_restart = ux500_restart;
clk_init();
}
static BT_HANDLE gic_probe(const BT_INTEGRATED_DEVICE *pDevice, BT_ERROR *pError) {
BT_ERROR Error;
if(g_hActiveHandle) {
if(pError) {
*pError = BT_ERR_GENERIC;
}
return NULL;
}
BT_HANDLE hGic = BT_CreateHandle(&oHandleInterface, sizeof(struct _BT_OPAQUE_HANDLE), pError);
if(!hGic) {
goto err_out;
}
const BT_RESOURCE *pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_MEM, 0);
if(!pResource) {
Error = BT_ERR_NO_MEMORY;
goto err_free_chip;
}
hGic->pGICC = (GICC_REGS *) bt_ioremap((void *)pResource->ulStart, BT_SIZE_4K);
pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_MEM, 1);
if(!pResource) {
Error = BT_ERR_GENERIC;
goto err_free_chip;
}
hGic->pGICD = (GICD_REGS *) bt_ioremap((void *)pResource->ulStart, BT_SIZE_4K);
// Set private members.
pResource = BT_GetIntegratedResource(pDevice, BT_RESOURCE_IRQ, 0);
if(!pResource) {
Error = BT_ERR_GENERIC;
goto err_free_chip;
}
BT_u32 base = pResource->ulStart;
BT_u32 total = (pResource->ulEnd - pResource->ulStart) + 1;
hGic->ulBaseIRQ = base;
BT_u32 i;
for(i = 0; i < total; i++) {
g_oVectorTable[i].pfnHandler = gic_stubhandler;
g_oVectorTable[i].pParam = NULL;
}
Error = BT_RegisterInterruptController(base, total, hGic);
if(Error) {
goto err_free_chip;
}
g_hActiveHandle = hGic;
// Enable the Distributor and CPU interfaces.
BT_u32 ulGicIRQs = (hGic->pGICD->TYPER & 0x1F);
ulGicIRQs = (ulGicIRQs + 1) * 32;
/*
* GIC can support a mximum 1020 IRQs.
*/
if(ulGicIRQs > 1020) {
ulGicIRQs = 1020;
}
hGic->ulGicIRQs = ulGicIRQs;
//#ifdef BT_CONFIG_ARCH_ARM_GIC_INIT_DISTRIBUTOR
gic_dist_init(hGic);
//#endif
gic_cpu_init(hGic);
return hGic;
err_free_chip:
BT_DestroyHandle(hGic);
if(pError) {
*pError = Error;
}
err_out:
return NULL;
}
static void __init ct_ca9x4_init_irq(void)
{
gic_cpu_base_addr = MMIO_P2V(A9_MPCORE_GIC_CPU);
gic_dist_init(0, MMIO_P2V(A9_MPCORE_GIC_DIST), 29);
gic_cpu_init(0, gic_cpu_base_addr);
}
static void __init emev_init_irq(void)
{
/* core tile GIC, primary */
gic_dist_init(0, __io_address(EMXX_INTA_DIST_BASE), INT_CPU_TIM);
gic_cpu_init(0, __io_address(EMXX_INTA_CPU_BASE));
}
static void __init gic_init_irq(void)
{
gic_dist_init(0, OMAP2_IO_ADDRESS(OMAP44XX_GIC_DIST_BASE), 29);
gic_cpu_init(0, OMAP2_IO_ADDRESS(OMAP44XX_GIC_CPU_BASE));
}
