240 lines
7.3 KiB
C
240 lines
7.3 KiB
C
/*
|
|
* COPYRIGHT (C) 2013-2014, Shanghai Real-Thread Technology Co., Ltd
|
|
*
|
|
* All rights reserved.
|
|
*
|
|
* 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.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
|
*/
|
|
|
|
#include <rtthread.h>
|
|
#include <board.h>
|
|
|
|
#include "gic.h"
|
|
#include "cp15.h"
|
|
|
|
struct arm_gic
|
|
{
|
|
rt_uint32_t offset;
|
|
|
|
rt_uint32_t dist_hw_base;
|
|
rt_uint32_t cpu_hw_base;
|
|
};
|
|
static struct arm_gic _gic_table[ARM_GIC_MAX_NR];
|
|
|
|
#define GIC_CPU_CTRL(hw_base) __REG32((hw_base) + 0x00)
|
|
#define GIC_CPU_PRIMASK(hw_base) __REG32((hw_base) + 0x04)
|
|
#define GIC_CPU_BINPOINT(hw_base) __REG32((hw_base) + 0x08)
|
|
#define GIC_CPU_INTACK(hw_base) __REG32((hw_base) + 0x0c)
|
|
#define GIC_CPU_EOI(hw_base) __REG32((hw_base) + 0x10)
|
|
#define GIC_CPU_RUNNINGPRI(hw_base) __REG32((hw_base) + 0x14)
|
|
#define GIC_CPU_HIGHPRI(hw_base) __REG32((hw_base) + 0x18)
|
|
|
|
#define GIC_DIST_CTRL(hw_base) __REG32((hw_base) + 0x000)
|
|
#define GIC_DIST_TYPE(hw_base) __REG32((hw_base) + 0x004)
|
|
#define GIC_DIST_IGROUP(hw_base, n) __REG32((hw_base) + 0x080 + (n/32) * 4)
|
|
#define GIC_DIST_ENABLE_SET(hw_base, n) __REG32((hw_base) + 0x100 + (n/32) * 4)
|
|
#define GIC_DIST_ENABLE_CLEAR(hw_base, n) __REG32((hw_base) + 0x180 + (n/32) * 4)
|
|
#define GIC_DIST_PENDING_SET(hw_base, n) __REG32((hw_base) + 0x200)
|
|
#define GIC_DIST_PENDING_CLEAR(hw_base, n) __REG32((hw_base) + 0x280)
|
|
#define GIC_DIST_ACTIVE_BIT(hw_base) __REG32((hw_base) + 0x300)
|
|
#define GIC_DIST_PRI(hw_base, n) __REG32((hw_base) + 0x400 + (n/4) * 4)
|
|
#define GIC_DIST_TARGET(hw_base, n) __REG32((hw_base) + 0x800 + (n/4) * 4)
|
|
#define GIC_DIST_CONFIG(hw_base, n) __REG32((hw_base) + 0xc00 + (n/16) * 4)
|
|
#define GIC_DIST_SOFTINT(hw_base) __REG32((hw_base) + 0xf00)
|
|
#define GIC_DIST_CPENDSGI(hw_base, n) __REG32((hw_base) + 0xf10 + (n/4) * 4)
|
|
#define GIC_DIST_ICPIDR2(hw_base) __REG32((hw_base) + 0xfe8)
|
|
|
|
static unsigned int _gic_max_irq;
|
|
|
|
int arm_gic_get_active_irq(rt_uint32_t index)
|
|
{
|
|
int irq;
|
|
|
|
RT_ASSERT(index < ARM_GIC_MAX_NR);
|
|
|
|
irq = GIC_CPU_INTACK(_gic_table[index].cpu_hw_base);
|
|
irq += _gic_table[index].offset;
|
|
return irq;
|
|
}
|
|
|
|
void arm_gic_ack(rt_uint32_t index, int irq)
|
|
{
|
|
rt_uint32_t mask = 1 << (irq % 32);
|
|
|
|
RT_ASSERT(index < ARM_GIC_MAX_NR);
|
|
|
|
irq = irq - _gic_table[index].offset;
|
|
RT_ASSERT(irq >= 0);
|
|
|
|
GIC_DIST_ENABLE_CLEAR(_gic_table[index].dist_hw_base, irq) = mask;
|
|
GIC_CPU_EOI(_gic_table[index].cpu_hw_base) = irq;
|
|
GIC_DIST_ENABLE_SET(_gic_table[index].dist_hw_base, irq) = mask;
|
|
}
|
|
|
|
void arm_gic_mask(rt_uint32_t index, int irq)
|
|
{
|
|
rt_uint32_t mask = 1 << (irq % 32);
|
|
|
|
RT_ASSERT(index < ARM_GIC_MAX_NR);
|
|
|
|
irq = irq - _gic_table[index].offset;
|
|
RT_ASSERT(irq >= 0);
|
|
|
|
GIC_DIST_ENABLE_CLEAR(_gic_table[index].dist_hw_base, irq) = mask;
|
|
}
|
|
|
|
void arm_gic_set_cpu(rt_uint32_t index, int irq, unsigned int cpumask)
|
|
{
|
|
rt_uint32_t old_tgt;
|
|
|
|
RT_ASSERT(index < ARM_GIC_MAX_NR);
|
|
|
|
irq = irq - _gic_table[index].offset;
|
|
RT_ASSERT(irq >= 0);
|
|
|
|
old_tgt = GIC_DIST_TARGET(_gic_table[index].dist_hw_base, irq);
|
|
|
|
old_tgt &= ~(0x0FFUL << ((irq % 4)*8));
|
|
old_tgt |= cpumask << ((irq % 4)*8);
|
|
|
|
GIC_DIST_TARGET(_gic_table[index].dist_hw_base, irq) = old_tgt;
|
|
}
|
|
|
|
void arm_gic_umask(rt_uint32_t index, int irq)
|
|
{
|
|
rt_uint32_t mask = 1 << (irq % 32);
|
|
|
|
RT_ASSERT(index < ARM_GIC_MAX_NR);
|
|
|
|
irq = irq - _gic_table[index].offset;
|
|
RT_ASSERT(irq >= 0);
|
|
|
|
GIC_DIST_ENABLE_SET(_gic_table[index].dist_hw_base, irq) = mask;
|
|
}
|
|
|
|
void arm_gic_dump_type(rt_uint32_t index)
|
|
{
|
|
unsigned int gic_type;
|
|
|
|
gic_type = GIC_DIST_TYPE(_gic_table[index].dist_hw_base);
|
|
rt_kprintf("GICv%d on %p, max IRQs: %d, %s security extension(%08x)\n",
|
|
(GIC_DIST_ICPIDR2(_gic_table[index].dist_hw_base) >> 4) & 0xf,
|
|
_gic_table[index].dist_hw_base,
|
|
_gic_max_irq,
|
|
gic_type & (1 << 10) ? "has" : "no",
|
|
gic_type);
|
|
}
|
|
|
|
int arm_gic_dist_init(rt_uint32_t index, rt_uint32_t dist_base, int irq_start)
|
|
{
|
|
unsigned int gic_type, i;
|
|
rt_uint32_t cpumask = 1 << 0;
|
|
|
|
RT_ASSERT(index < ARM_GIC_MAX_NR);
|
|
|
|
_gic_table[index].dist_hw_base = dist_base;
|
|
_gic_table[index].offset = irq_start;
|
|
|
|
/* Find out how many interrupts are supported. */
|
|
gic_type = GIC_DIST_TYPE(dist_base);
|
|
_gic_max_irq = ((gic_type & 0x1f) + 1) * 32;
|
|
|
|
/*
|
|
* The GIC only supports up to 1020 interrupt sources.
|
|
* Limit this to either the architected maximum, or the
|
|
* platform maximum.
|
|
*/
|
|
if (_gic_max_irq > 1020)
|
|
_gic_max_irq = 1020;
|
|
if (_gic_max_irq > ARM_GIC_NR_IRQS)
|
|
_gic_max_irq = ARM_GIC_NR_IRQS;
|
|
|
|
cpumask |= cpumask << 8;
|
|
cpumask |= cpumask << 16;
|
|
|
|
GIC_DIST_CTRL(dist_base) = 0x0;
|
|
|
|
/* Set all global interrupts to be level triggered, active low. */
|
|
for (i = 32; i < _gic_max_irq; i += 16)
|
|
GIC_DIST_CONFIG(dist_base, i) = 0x0;
|
|
|
|
/* Set all global interrupts to this CPU only. */
|
|
for (i = 32; i < _gic_max_irq; i += 4)
|
|
GIC_DIST_TARGET(dist_base, i) = cpumask;
|
|
|
|
/* Set priority on all interrupts. */
|
|
for (i = 0; i < _gic_max_irq; i += 4)
|
|
GIC_DIST_PRI(dist_base, i) = 0xa0a0a0a0;
|
|
|
|
/* Disable all interrupts. */
|
|
for (i = 0; i < _gic_max_irq; i += 32)
|
|
GIC_DIST_ENABLE_CLEAR(dist_base, i) = 0xffffffff;
|
|
|
|
/* Set the FIQEn bit, signal FIQ for IGROUP0. */
|
|
GIC_DIST_CTRL(dist_base) = 0x01;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int arm_gic_cpu_init(rt_uint32_t index, rt_uint32_t cpu_base)
|
|
{
|
|
RT_ASSERT(index < ARM_GIC_MAX_NR);
|
|
|
|
_gic_table[index].cpu_hw_base = cpu_base;
|
|
|
|
GIC_CPU_PRIMASK(cpu_base) = 0xf0;
|
|
/* Enable CPU interrupt */
|
|
GIC_CPU_CTRL(cpu_base) = 0x01;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void arm_gic_set_group(rt_uint32_t index, int vector, int group)
|
|
{
|
|
/* As for GICv2, there are only group0 and group1. */
|
|
RT_ASSERT(group <= 1);
|
|
RT_ASSERT(vector < _gic_max_irq);
|
|
|
|
if (group == 0)
|
|
{
|
|
GIC_DIST_IGROUP(_gic_table[index].dist_hw_base,
|
|
vector) &= ~(1 << (vector % 32));
|
|
}
|
|
else if (group == 1)
|
|
{
|
|
GIC_DIST_IGROUP(_gic_table[index].dist_hw_base,
|
|
vector) |= (1 << (vector % 32));
|
|
}
|
|
}
|
|
|
|
void arm_gic_trigger(rt_uint32_t index, int target_cpu, int irq)
|
|
{
|
|
unsigned int reg;
|
|
|
|
RT_ASSERT(irq <= 15);
|
|
RT_ASSERT(target_cpu <= 255);
|
|
|
|
reg = (target_cpu << 16) | irq;
|
|
GIC_DIST_SOFTINT(_gic_table[index].dist_hw_base) = reg;
|
|
}
|
|
|
|
void arm_gic_clear_sgi(rt_uint32_t index, int target_cpu, int irq)
|
|
{
|
|
RT_ASSERT(irq <= 15);
|
|
RT_ASSERT(target_cpu <= 255);
|
|
|
|
GIC_DIST_CPENDSGI(_gic_table[index].dist_hw_base, irq) = target_cpu << (irq % 4);
|
|
}
|