IssueNo: #I3EPPI
Description: platform directory refactoring Sig: kernel Feature or Bugfix: Feature Binary Source: No
This commit is contained in:
48
arch/arm/gic/Makefile
Executable file
48
arch/arm/gic/Makefile
Executable file
@@ -0,0 +1,48 @@
|
||||
# Copyright (c) 2013-2019 Huawei Technologies Co., Ltd. All rights reserved.
|
||||
# Copyright (c) 2020-2021 Huawei Device Co., Ltd. All rights reserved.
|
||||
#
|
||||
# Redistribution and use in source and binary forms, with or without modification,
|
||||
# are permitted provided that the following conditions are met:
|
||||
#
|
||||
# 1. Redistributions of source code must retain the above copyright notice, this list of
|
||||
# conditions and the following disclaimer.
|
||||
#
|
||||
# 2. Redistributions in binary form must reproduce the above copyright notice, this list
|
||||
# of conditions and the following disclaimer in the documentation and/or other materials
|
||||
# provided with the distribution.
|
||||
#
|
||||
# 3. Neither the name of the copyright holder nor the names of its contributors may be used
|
||||
# to endorse or promote products derived from this software without specific prior written
|
||||
# permission.
|
||||
#
|
||||
# THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
# "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
|
||||
# THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
||||
# PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
|
||||
# CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
||||
# EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
||||
# PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
|
||||
# OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
||||
# WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
|
||||
# OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
|
||||
# ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
|
||||
include $(LITEOSTOPDIR)/config.mk
|
||||
|
||||
MODULE_NAME := $(notdir $(shell pwd))
|
||||
|
||||
# LOCAL_SRCS := $(wildcard *.c)
|
||||
|
||||
ifeq ($(LOSCFG_PLATFORM_BSP_GIC_V2), y)
|
||||
LOCAL_SRCS := gic_v2.c
|
||||
else ifeq ($(LOSCFG_PLATFORM_BSP_GIC_V3), y)
|
||||
LOCAL_SRCS := gic_v3.c
|
||||
endif
|
||||
|
||||
LOCAL_INCLUDE := \
|
||||
-I $(LITEOSTOPDIR)/kernel/base/include \
|
||||
-I $(LITEOSTOPDIR)/arch/arm/include \
|
||||
-I $(LITEOSTOPDIR)/arch/arm/arm/src/include \
|
||||
|
||||
LOCAL_FLAGS := $(LOCAL_INCLUDE)
|
||||
include $(MODULE)
|
||||
194
arch/arm/gic/gic_v2.c
Normal file
194
arch/arm/gic/gic_v2.c
Normal file
@@ -0,0 +1,194 @@
|
||||
/*
|
||||
* Copyright (c) 2013-2019 Huawei Technologies Co., Ltd. All rights reserved.
|
||||
* Copyright (c) 2020-2021 Huawei Device Co., Ltd. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without modification,
|
||||
* are permitted provided that the following conditions are met:
|
||||
*
|
||||
* 1. Redistributions of source code must retain the above copyright notice, this list of
|
||||
* conditions and the following disclaimer.
|
||||
*
|
||||
* 2. Redistributions in binary form must reproduce the above copyright notice, this list
|
||||
* of conditions and the following disclaimer in the documentation and/or other materials
|
||||
* provided with the distribution.
|
||||
*
|
||||
* 3. Neither the name of the copyright holder nor the names of its contributors may be used
|
||||
* to endorse or promote products derived from this software without specific prior written
|
||||
* permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
|
||||
* THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
||||
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
|
||||
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
||||
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
||||
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
|
||||
* OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
||||
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
|
||||
* OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
|
||||
* ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*/
|
||||
|
||||
#include "gic_common.h"
|
||||
#include "los_hwi.h"
|
||||
#include "los_hwi_pri.h"
|
||||
#include "los_mp.h"
|
||||
|
||||
STATIC_ASSERT(OS_USER_HWI_MAX <= 1020, "hwi max is too large!");
|
||||
|
||||
#ifdef LOSCFG_PLATFORM_BSP_GIC_V2
|
||||
|
||||
STATIC UINT32 g_curIrqNum = 0;
|
||||
|
||||
#if (LOSCFG_KERNEL_SMP == YES)
|
||||
/*
|
||||
* filter description
|
||||
* 0b00: forward to the cpu interfaces specified in cpu_mask
|
||||
* 0b01: forward to all cpu interfaces
|
||||
* 0b10: forward only to the cpu interface that request the irq
|
||||
*/
|
||||
STATIC VOID GicWriteSgi(UINT32 vector, UINT32 cpuMask, UINT32 filter)
|
||||
{
|
||||
UINT32 val = ((filter & 0x3) << 24) | ((cpuMask & 0xFF) << 16) |
|
||||
(vector & 0xF);
|
||||
|
||||
GIC_REG_32(GICD_SGIR) = val;
|
||||
}
|
||||
|
||||
VOID HalIrqSendIpi(UINT32 target, UINT32 ipi)
|
||||
{
|
||||
GicWriteSgi(ipi, target, 0);
|
||||
}
|
||||
|
||||
VOID HalIrqSetAffinity(UINT32 vector, UINT32 cpuMask)
|
||||
{
|
||||
UINT32 offset = vector / 4;
|
||||
UINT32 index = vector & 0x3;
|
||||
|
||||
GIC_REG_8(GICD_ITARGETSR(offset) + index) = cpuMask;
|
||||
}
|
||||
#endif
|
||||
|
||||
UINT32 HalCurIrqGet(VOID)
|
||||
{
|
||||
return g_curIrqNum;
|
||||
}
|
||||
|
||||
VOID HalIrqMask(UINT32 vector)
|
||||
{
|
||||
if ((vector > OS_USER_HWI_MAX) || (vector < OS_USER_HWI_MIN)) {
|
||||
return;
|
||||
}
|
||||
|
||||
GIC_REG_32(GICD_ICENABLER(vector / 32)) = 1U << (vector % 32);
|
||||
}
|
||||
|
||||
VOID HalIrqUnmask(UINT32 vector)
|
||||
{
|
||||
if ((vector > OS_USER_HWI_MAX) || (vector < OS_USER_HWI_MIN)) {
|
||||
return;
|
||||
}
|
||||
|
||||
GIC_REG_32(GICD_ISENABLER(vector >> 5)) = 1U << (vector % 32);
|
||||
}
|
||||
|
||||
VOID HalIrqPending(UINT32 vector)
|
||||
{
|
||||
if ((vector > OS_USER_HWI_MAX) || (vector < OS_USER_HWI_MIN)) {
|
||||
return;
|
||||
}
|
||||
|
||||
GIC_REG_32(GICD_ISPENDR(vector >> 5)) = 1U << (vector % 32);
|
||||
}
|
||||
|
||||
VOID HalIrqClear(UINT32 vector)
|
||||
{
|
||||
GIC_REG_32(GICC_EOIR) = vector;
|
||||
}
|
||||
|
||||
VOID HalIrqInitPercpu(VOID)
|
||||
{
|
||||
/* unmask interrupts */
|
||||
GIC_REG_32(GICC_PMR) = 0xFF;
|
||||
|
||||
/* enable gic cpu interface */
|
||||
GIC_REG_32(GICC_CTLR) = 1;
|
||||
}
|
||||
|
||||
VOID HalIrqInit(VOID)
|
||||
{
|
||||
UINT32 i;
|
||||
|
||||
/* set externel interrupts to be level triggered, active low. */
|
||||
for (i = 32; i < OS_HWI_MAX_NUM; i += 16) {
|
||||
GIC_REG_32(GICD_ICFGR(i / 16)) = 0;
|
||||
}
|
||||
|
||||
/* set externel interrupts to CPU 0 */
|
||||
for (i = 32; i < OS_HWI_MAX_NUM; i += 4) {
|
||||
GIC_REG_32(GICD_ITARGETSR(i / 4)) = 0x01010101;
|
||||
}
|
||||
|
||||
/* set priority on all interrupts */
|
||||
for (i = 0; i < OS_HWI_MAX_NUM; i += 4) {
|
||||
GIC_REG_32(GICD_IPRIORITYR(i / 4)) = GICD_INT_DEF_PRI_X4;
|
||||
}
|
||||
|
||||
/* disable all interrupts. */
|
||||
for (i = 0; i < OS_HWI_MAX_NUM; i += 32) {
|
||||
GIC_REG_32(GICD_ICENABLER(i / 32)) = ~0;
|
||||
}
|
||||
|
||||
HalIrqInitPercpu();
|
||||
|
||||
/* enable gic distributor control */
|
||||
GIC_REG_32(GICD_CTLR) = 1;
|
||||
|
||||
#if (LOSCFG_KERNEL_SMP == YES)
|
||||
/* register inter-processor interrupt */
|
||||
(VOID)LOS_HwiCreate(LOS_MP_IPI_WAKEUP, 0xa0, 0, OsMpWakeHandler, 0);
|
||||
(VOID)LOS_HwiCreate(LOS_MP_IPI_SCHEDULE, 0xa0, 0, OsMpScheduleHandler, 0);
|
||||
(VOID)LOS_HwiCreate(LOS_MP_IPI_HALT, 0xa0, 0, OsMpHaltHandler, 0);
|
||||
#endif
|
||||
}
|
||||
|
||||
VOID HalIrqHandler(VOID)
|
||||
{
|
||||
UINT32 iar = GIC_REG_32(GICC_IAR);
|
||||
UINT32 vector = iar & 0x3FFU;
|
||||
|
||||
/*
|
||||
* invalid irq number, mainly the spurious interrupts 0x3ff,
|
||||
* gicv2 valid irq ranges from 0~1019, we use OS_HWI_MAX_NUM
|
||||
* to do the checking.
|
||||
*/
|
||||
if (vector >= OS_HWI_MAX_NUM) {
|
||||
return;
|
||||
}
|
||||
g_curIrqNum = vector;
|
||||
|
||||
OsInterrupt(vector);
|
||||
|
||||
/* use orignal iar to do the EOI */
|
||||
GIC_REG_32(GICC_EOIR) = iar;
|
||||
}
|
||||
|
||||
CHAR *HalIrqVersion(VOID)
|
||||
{
|
||||
UINT32 pidr = GIC_REG_32(GICD_PIDR2V2);
|
||||
CHAR *irqVerString = NULL;
|
||||
|
||||
switch (pidr >> GIC_REV_OFFSET) {
|
||||
case GICV1:
|
||||
irqVerString = "GICv1";
|
||||
break;
|
||||
case GICV2:
|
||||
irqVerString = "GICv2";
|
||||
break;
|
||||
default:
|
||||
irqVerString = "unknown";
|
||||
}
|
||||
return irqVerString;
|
||||
}
|
||||
|
||||
#endif
|
||||
447
arch/arm/gic/gic_v3.c
Normal file
447
arch/arm/gic/gic_v3.c
Normal file
@@ -0,0 +1,447 @@
|
||||
/*
|
||||
* Copyright (c) 2013-2019 Huawei Technologies Co., Ltd. All rights reserved.
|
||||
* Copyright (c) 2020-2021 Huawei Device Co., Ltd. All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without modification,
|
||||
* are permitted provided that the following conditions are met:
|
||||
*
|
||||
* 1. Redistributions of source code must retain the above copyright notice, this list of
|
||||
* conditions and the following disclaimer.
|
||||
*
|
||||
* 2. Redistributions in binary form must reproduce the above copyright notice, this list
|
||||
* of conditions and the following disclaimer in the documentation and/or other materials
|
||||
* provided with the distribution.
|
||||
*
|
||||
* 3. Neither the name of the copyright holder nor the names of its contributors may be used
|
||||
* to endorse or promote products derived from this software without specific prior written
|
||||
* permission.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
|
||||
* THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
||||
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
|
||||
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
||||
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
||||
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
|
||||
* OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
||||
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
|
||||
* OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
|
||||
* ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||
*/
|
||||
|
||||
#include "gic_common.h"
|
||||
#include "gic_v3.h"
|
||||
#include "los_typedef.h"
|
||||
#include "los_hwi.h"
|
||||
#include "los_hwi_pri.h"
|
||||
#include "los_mp.h"
|
||||
|
||||
#ifdef LOSCFG_PLATFORM_BSP_GIC_V3
|
||||
|
||||
STATIC UINT32 g_curIrqNum = 0;
|
||||
|
||||
STATIC INLINE UINT64 MpidrToAffinity(UINT64 mpidr)
|
||||
{
|
||||
return ((MPIDR_AFF_LEVEL(mpidr, 3) << 32) |
|
||||
(MPIDR_AFF_LEVEL(mpidr, 2) << 16) |
|
||||
(MPIDR_AFF_LEVEL(mpidr, 1) << 8) |
|
||||
(MPIDR_AFF_LEVEL(mpidr, 0)));
|
||||
}
|
||||
|
||||
#if (LOSCFG_KERNEL_SMP == YES)
|
||||
|
||||
STATIC UINT32 NextCpu(UINT32 cpu, UINT32 cpuMask)
|
||||
{
|
||||
UINT32 next = cpu + 1;
|
||||
|
||||
while (next < LOSCFG_KERNEL_CORE_NUM) {
|
||||
if (cpuMask & (1U << next)) {
|
||||
goto OUT;
|
||||
}
|
||||
|
||||
next++;
|
||||
}
|
||||
|
||||
OUT:
|
||||
return next;
|
||||
}
|
||||
|
||||
STATIC UINT16 GicTargetList(UINT32 *base, UINT32 cpuMask, UINT64 cluster)
|
||||
{
|
||||
UINT32 nextCpu;
|
||||
UINT16 tList = 0;
|
||||
UINT32 cpu = *base;
|
||||
UINT64 mpidr = CPU_MAP_GET(cpu);
|
||||
while (cpu < LOSCFG_KERNEL_CORE_NUM) {
|
||||
tList |= 1U << (mpidr & 0xf);
|
||||
|
||||
nextCpu = NextCpu(cpu, cpuMask);
|
||||
if (nextCpu >= LOSCFG_KERNEL_CORE_NUM) {
|
||||
goto out;
|
||||
}
|
||||
|
||||
cpu = nextCpu;
|
||||
mpidr = CPU_MAP_GET(cpu);
|
||||
if (cluster != (mpidr & ~0xffUL)) {
|
||||
cpu--;
|
||||
goto out;
|
||||
}
|
||||
}
|
||||
|
||||
out:
|
||||
*base = cpu;
|
||||
return tList;
|
||||
}
|
||||
|
||||
STATIC VOID GicSgi(UINT32 irq, UINT32 cpuMask)
|
||||
{
|
||||
UINT16 tList;
|
||||
UINT32 cpu = 0;
|
||||
UINT64 val, cluster;
|
||||
|
||||
while (cpuMask && (cpu < LOSCFG_KERNEL_CORE_NUM)) {
|
||||
if (cpuMask & (1U << cpu)) {
|
||||
cluster = CPU_MAP_GET(cpu) & ~0xffUL;
|
||||
|
||||
tList = GicTargetList(&cpu, cpuMask, cluster);
|
||||
|
||||
/* Generates a Group 1 interrupt for the current security state */
|
||||
val = ((MPIDR_AFF_LEVEL(cluster, 3) << 48) |
|
||||
(MPIDR_AFF_LEVEL(cluster, 2) << 32) |
|
||||
(MPIDR_AFF_LEVEL(cluster, 1) << 16) |
|
||||
(irq << 24) | tList);
|
||||
|
||||
GiccSetSgi1r(val);
|
||||
}
|
||||
|
||||
cpu++;
|
||||
}
|
||||
}
|
||||
|
||||
VOID HalIrqSendIpi(UINT32 target, UINT32 ipi)
|
||||
{
|
||||
GicSgi(ipi, target);
|
||||
}
|
||||
|
||||
VOID HalIrqSetAffinity(UINT32 irq, UINT32 cpuMask)
|
||||
{
|
||||
UINT64 affinity = MpidrToAffinity(NextCpu(0, cpuMask));
|
||||
|
||||
/* When ARE is on, use router */
|
||||
GIC_REG_64(GICD_IROUTER(irq)) = affinity;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
STATIC VOID GicWaitForRwp(UINT64 reg)
|
||||
{
|
||||
INT32 count = 1000000; /* 1s */
|
||||
|
||||
while (GIC_REG_32(reg) & GICD_CTLR_RWP) {
|
||||
count -= 1;
|
||||
if (!count) {
|
||||
PRINTK("gic_v3: rwp timeout 0x%x\n", GIC_REG_32(reg));
|
||||
return;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
STATIC INLINE VOID GicdSetGroup(UINT32 irq)
|
||||
{
|
||||
/* configure spi as group 0 on secure mode and group 1 on unsecure mode */
|
||||
#ifdef LOSCFG_ARCH_SECURE_MONITOR_MODE
|
||||
GIC_REG_32(GICD_IGROUPR(irq / 32)) = 0;
|
||||
#else
|
||||
GIC_REG_32(GICD_IGROUPR(irq / 32)) = 0xffffffff;
|
||||
#endif
|
||||
}
|
||||
|
||||
STATIC INLINE VOID GicrSetWaker(UINT32 cpu)
|
||||
{
|
||||
GIC_REG_32(GICR_WAKER(cpu)) &= ~GICR_WAKER_PROCESSORSLEEP;
|
||||
DSB;
|
||||
ISB;
|
||||
while ((GIC_REG_32(GICR_WAKER(cpu)) & 0x4) == GICR_WAKER_CHILDRENASLEEP);
|
||||
}
|
||||
|
||||
STATIC INLINE VOID GicrSetGroup(UINT32 cpu)
|
||||
{
|
||||
/* configure sgi/ppi as group 0 on secure mode and group 1 on unsecure mode */
|
||||
#ifdef LOSCFG_ARCH_SECURE_MONITOR_MODE
|
||||
GIC_REG_32(GICR_IGROUPR0(cpu)) = 0;
|
||||
GIC_REG_32(GICR_IGRPMOD0(cpu)) = 0;
|
||||
#else
|
||||
GIC_REG_32(GICR_IGROUPR0(cpu)) = 0xffffffff;
|
||||
#endif
|
||||
}
|
||||
|
||||
STATIC VOID GicdSetPmr(UINT32 irq, UINT8 priority)
|
||||
{
|
||||
UINT32 pos = irq >> 2; /* one irq have the 8-bit interrupt priority field */
|
||||
UINT32 newPri = GIC_REG_32(GICD_IPRIORITYR(pos));
|
||||
|
||||
/* Shift and mask the correct bits for the priority */
|
||||
newPri &= ~(GIC_PRIORITY_MASK << ((irq % 4) * GIC_PRIORITY_OFFSET));
|
||||
newPri |= priority << ((irq % 4) * GIC_PRIORITY_OFFSET);
|
||||
|
||||
GIC_REG_32(GICD_IPRIORITYR(pos)) = newPri;
|
||||
}
|
||||
|
||||
STATIC VOID GicrSetPmr(UINT32 irq, UINT8 priority)
|
||||
{
|
||||
UINT32 cpu = ArchCurrCpuid();
|
||||
UINT32 pos = irq >> 2; /* one irq have the 8-bit interrupt priority field */
|
||||
UINT32 newPri = GIC_REG_32(GICR_IPRIORITYR0(cpu) + pos * 4);
|
||||
|
||||
/* Clear priority offset bits and set new priority */
|
||||
newPri &= ~(GIC_PRIORITY_MASK << ((irq % 4) * GIC_PRIORITY_OFFSET));
|
||||
newPri |= priority << ((irq % 4) * GIC_PRIORITY_OFFSET);
|
||||
|
||||
GIC_REG_32(GICR_IPRIORITYR0(cpu) + pos * 4) = newPri;
|
||||
}
|
||||
|
||||
STATIC VOID GiccInitPercpu(VOID)
|
||||
{
|
||||
/* enable system register interface */
|
||||
UINT32 sre = GiccGetSre();
|
||||
if (!(sre & 0x1)) {
|
||||
GiccSetSre(sre | 0x1);
|
||||
|
||||
/*
|
||||
* Need to check that the SRE bit has actually been set. If
|
||||
* not, it means that SRE is disabled at up EL level. We're going to
|
||||
* die painfully, and there is nothing we can do about it.
|
||||
*/
|
||||
sre = GiccGetSre();
|
||||
LOS_ASSERT(sre & 0x1);
|
||||
}
|
||||
|
||||
#ifdef LOSCFG_ARCH_SECURE_MONITOR_MODE
|
||||
/* Enable group 0 and disable grp1ns grp1s interrupts */
|
||||
GiccSetIgrpen0(1);
|
||||
GiccSetIgrpen1(0);
|
||||
|
||||
/*
|
||||
* For priority grouping.
|
||||
* The value of this field control show the 8-bit interrupt priority field
|
||||
* is split into a group priority field, that determines interrupt preemption,
|
||||
* and a subpriority field.
|
||||
*/
|
||||
GiccSetBpr0(MAX_BINARY_POINT_VALUE);
|
||||
#else
|
||||
/* enable group 1 interrupts */
|
||||
GiccSetIgrpen1(1);
|
||||
#endif
|
||||
|
||||
/* set priority threshold to max */
|
||||
GiccSetPmr(0xff);
|
||||
|
||||
/* EOI deactivates interrupt too (mode 0) */
|
||||
GiccSetCtlr(0);
|
||||
}
|
||||
|
||||
UINT32 HalCurIrqGet(VOID)
|
||||
{
|
||||
return g_curIrqNum;
|
||||
}
|
||||
|
||||
VOID HalIrqMask(UINT32 vector)
|
||||
{
|
||||
INT32 i;
|
||||
const UINT32 mask = 1U << (vector % 32);
|
||||
|
||||
if ((vector > OS_USER_HWI_MAX) || (vector < OS_USER_HWI_MIN)) {
|
||||
return;
|
||||
}
|
||||
|
||||
if (vector < 32) {
|
||||
for (i = 0; i < LOSCFG_KERNEL_CORE_NUM; i++) {
|
||||
GIC_REG_32(GICR_ICENABLER0(i)) = mask;
|
||||
GicWaitForRwp(GICR_CTLR(i));
|
||||
}
|
||||
} else {
|
||||
GIC_REG_32(GICD_ICENABLER(vector >> 5)) = mask;
|
||||
GicWaitForRwp(GICD_CTLR);
|
||||
}
|
||||
}
|
||||
|
||||
VOID HalIrqUnmask(UINT32 vector)
|
||||
{
|
||||
INT32 i;
|
||||
const UINT32 mask = 1U << (vector % 32);
|
||||
|
||||
if ((vector > OS_USER_HWI_MAX) || (vector < OS_USER_HWI_MIN)) {
|
||||
return;
|
||||
}
|
||||
|
||||
if (vector < 32) {
|
||||
for (i = 0; i < LOSCFG_KERNEL_CORE_NUM; i++) {
|
||||
GIC_REG_32(GICR_ISENABLER0(i)) = mask;
|
||||
GicWaitForRwp(GICR_CTLR(i));
|
||||
}
|
||||
} else {
|
||||
GIC_REG_32(GICD_ISENABLER(vector >> 5)) = mask;
|
||||
GicWaitForRwp(GICD_CTLR);
|
||||
}
|
||||
}
|
||||
|
||||
VOID HalIrqPending(UINT32 vector)
|
||||
{
|
||||
if ((vector > OS_USER_HWI_MAX) || (vector < OS_USER_HWI_MIN)) {
|
||||
return;
|
||||
}
|
||||
|
||||
GIC_REG_32(GICD_ISPENDR(vector >> 5)) = 1U << (vector % 32);
|
||||
}
|
||||
|
||||
VOID HalIrqClear(UINT32 vector)
|
||||
{
|
||||
GiccSetEoir(vector);
|
||||
ISB;
|
||||
}
|
||||
|
||||
UINT32 HalIrqSetPrio(UINT32 vector, UINT8 priority)
|
||||
{
|
||||
UINT8 prio = priority;
|
||||
|
||||
if (vector > OS_HWI_MAX_NUM) {
|
||||
PRINT_ERR("Invalid irq value %u, max irq is %u\n", vector, OS_HWI_MAX_NUM);
|
||||
return LOS_NOK;
|
||||
}
|
||||
|
||||
prio = prio & (UINT8)GIC_INTR_PRIO_MASK;
|
||||
|
||||
if (vector >= GIC_MIN_SPI_NUM) {
|
||||
GicdSetPmr(vector, prio);
|
||||
} else {
|
||||
GicrSetPmr(vector, prio);
|
||||
}
|
||||
|
||||
return LOS_OK;
|
||||
}
|
||||
|
||||
VOID HalIrqInitPercpu(VOID)
|
||||
{
|
||||
INT32 idx;
|
||||
UINT32 cpu = ArchCurrCpuid();
|
||||
|
||||
/* GICR init */
|
||||
GicrSetWaker(cpu);
|
||||
GicrSetGroup(cpu);
|
||||
GicWaitForRwp(GICR_CTLR(cpu));
|
||||
|
||||
/* GICR: clear and mask sgi/ppi */
|
||||
GIC_REG_32(GICR_ICENABLER0(cpu)) = 0xffffffff;
|
||||
GIC_REG_32(GICR_ICPENDR0(cpu)) = 0xffffffff;
|
||||
|
||||
GIC_REG_32(GICR_ISENABLER0(cpu)) = 0xffffffff;
|
||||
|
||||
for (idx = 0; idx < GIC_MIN_SPI_NUM; idx += 1) {
|
||||
GicrSetPmr(idx, MIN_INTERRUPT_PRIORITY);
|
||||
}
|
||||
|
||||
GicWaitForRwp(GICR_CTLR(cpu));
|
||||
|
||||
/* GICC init */
|
||||
GiccInitPercpu();
|
||||
|
||||
#ifdef LOSCFG_KERNEL_SMP
|
||||
/* unmask ipi interrupts */
|
||||
HalIrqUnmask(LOS_MP_IPI_WAKEUP);
|
||||
HalIrqUnmask(LOS_MP_IPI_HALT);
|
||||
#endif
|
||||
}
|
||||
|
||||
VOID HalIrqInit(VOID)
|
||||
{
|
||||
UINT32 i;
|
||||
UINT64 affinity;
|
||||
|
||||
/* disable distributor */
|
||||
GIC_REG_32(GICD_CTLR) = 0;
|
||||
GicWaitForRwp(GICD_CTLR);
|
||||
ISB;
|
||||
|
||||
/* set externel interrupts to be level triggered, active low. */
|
||||
for (i = 32; i < OS_HWI_MAX_NUM; i += 16) {
|
||||
GIC_REG_32(GICD_ICFGR(i / 16)) = 0;
|
||||
}
|
||||
|
||||
/* config distributer, mask and clear all spis, set group x */
|
||||
for (i = 32; i < OS_HWI_MAX_NUM; i += 32) {
|
||||
GIC_REG_32(GICD_ICENABLER(i / 32)) = 0xffffffff;
|
||||
GIC_REG_32(GICD_ICPENDR(i / 32)) = 0xffffffff;
|
||||
GIC_REG_32(GICD_IGRPMODR(i / 32)) = 0;
|
||||
|
||||
GicdSetGroup(i);
|
||||
}
|
||||
|
||||
/* set spi priority as default */
|
||||
for (i = 32; i < OS_HWI_MAX_NUM; i++) {
|
||||
GicdSetPmr(i, MIN_INTERRUPT_PRIORITY);
|
||||
}
|
||||
|
||||
GicWaitForRwp(GICD_CTLR);
|
||||
|
||||
/* disable all interrupts. */
|
||||
for (i = 0; i < OS_HWI_MAX_NUM; i += 32) {
|
||||
GIC_REG_32(GICD_ICENABLER(i / 32)) = 0xffffffff;
|
||||
}
|
||||
|
||||
/* enable distributor with ARE, group 1 enabled */
|
||||
GIC_REG_32(GICD_CTLR) = CTLR_ENALBE_G0 | CTLR_ENABLE_G1NS | CTLR_ARE_S;
|
||||
|
||||
/* set spi to boot cpu only. ARE must be enabled */
|
||||
affinity = MpidrToAffinity(AARCH64_SYSREG_READ(mpidr_el1));
|
||||
for (i = 32; i < OS_HWI_MAX_NUM; i++) {
|
||||
GIC_REG_64(GICD_IROUTER(i)) = affinity;
|
||||
}
|
||||
|
||||
HalIrqInitPercpu();
|
||||
|
||||
#if (LOSCFG_KERNEL_SMP == YES)
|
||||
/* register inter-processor interrupt */
|
||||
LOS_HwiCreate(LOS_MP_IPI_WAKEUP, 0xa0, 0, OsMpWakeHandler, 0);
|
||||
LOS_HwiCreate(LOS_MP_IPI_SCHEDULE, 0xa0, 0, OsMpScheduleHandler, 0);
|
||||
LOS_HwiCreate(LOS_MP_IPI_HALT, 0xa0, 0, OsMpScheduleHandler, 0);
|
||||
#endif
|
||||
}
|
||||
|
||||
VOID HalIrqHandler(VOID)
|
||||
{
|
||||
UINT32 iar = GiccGetIar();
|
||||
UINT32 vector = iar & 0x3FFU;
|
||||
|
||||
/*
|
||||
* invalid irq number, mainly the spurious interrupts 0x3ff,
|
||||
* valid irq ranges from 0~1019, we use OS_HWI_MAX_NUM to do
|
||||
* the checking.
|
||||
*/
|
||||
if (vector >= OS_HWI_MAX_NUM) {
|
||||
return;
|
||||
}
|
||||
g_curIrqNum = vector;
|
||||
|
||||
OsInterrupt(vector);
|
||||
GiccSetEoir(vector);
|
||||
}
|
||||
|
||||
CHAR *HalIrqVersion(VOID)
|
||||
{
|
||||
UINT32 pidr = GIC_REG_32(GICD_PIDR2V3);
|
||||
CHAR *irqVerString = NULL;
|
||||
|
||||
switch (pidr >> GIC_REV_OFFSET) {
|
||||
case GICV3:
|
||||
irqVerString = "GICv3";
|
||||
break;
|
||||
case GICV4:
|
||||
irqVerString = "GICv4";
|
||||
break;
|
||||
default:
|
||||
irqVerString = "unknown";
|
||||
}
|
||||
return irqVerString;
|
||||
}
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user