mirror of
git://nv-tegra.nvidia.com/linux-nv-oot.git
synced 2025-12-22 17:25:35 +03:00
83d81ef365
* Added ioctl for triggering IPIs * Added handler to invoke ASM wfe,wfi commands or NOP Change-Id: I907b6a27f3a7f3ff5b507e9f91066d8695dadbb4 Signed-off-by: Ian Grissom <igrissom@nvidia.com> Reviewed-on: https://git-master.nvidia.com/r/c/linux-nvidia/+/2730675 Reviewed-by: Chris Dragan <kdragan@nvidia.com> Reviewed-by: Bharat Nihalani <bnihalani@nvidia.com> GVS: Gerrit_Virtual_Submit <buildbot_gerritrpt@nvidia.com>
95 lines
2.2 KiB
C
95 lines
2.2 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* This file is part of NVIDIA MODS kernel driver.
|
|
*
|
|
* Copyright (c) 2022, NVIDIA CORPORATION. All rights reserved.
|
|
*
|
|
* NVIDIA MODS kernel driver 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.
|
|
*
|
|
* NVIDIA MODS kernel driver 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 NVIDIA MODS kernel driver.
|
|
* If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "mods_internal.h"
|
|
|
|
#include <asm/barrier.h>
|
|
#include <linux/cpu.h>
|
|
#include <linux/cpumask.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/smp.h>
|
|
|
|
#define MAX_IPI_WFI_LOOPS 5
|
|
#define MAX_IPI_WFE_LOOPS 10
|
|
|
|
static void ipi_wfi_cpu(void *p)
|
|
{
|
|
struct MODS_SEND_IPI *p_ipi = (struct MODS_SEND_IPI *)p;
|
|
u32 i;
|
|
|
|
for (i = 0; i < p_ipi->num_loops; i++)
|
|
wfi();
|
|
}
|
|
|
|
static void ipi_wfe_cpu(void *p)
|
|
{
|
|
struct MODS_SEND_IPI *p_ipi = (struct MODS_SEND_IPI *)p;
|
|
u32 i;
|
|
|
|
for (i = 0; i < p_ipi->num_loops; i++)
|
|
wfe();
|
|
}
|
|
|
|
int esc_mods_send_ipi(struct mods_client *client, struct MODS_SEND_IPI *p)
|
|
{
|
|
LOG_ENT();
|
|
|
|
switch (p->ipi_type) {
|
|
case MODS_IPI_KICK: {
|
|
kick_all_cpus_sync();
|
|
break;
|
|
}
|
|
case MODS_IPI_WFI: {
|
|
if (p->num_loops > MAX_IPI_WFI_LOOPS) {
|
|
cl_error("num_loops %u exceed maximum limit %d for MODS_IPI_WFI\n",
|
|
p->num_loops,
|
|
MAX_IPI_WFI_LOOPS);
|
|
LOG_EXT();
|
|
return -EINVAL;
|
|
}
|
|
preempt_disable();
|
|
smp_call_function_many(cpu_online_mask, ipi_wfi_cpu, (void *)p, 1);
|
|
preempt_enable();
|
|
break;
|
|
}
|
|
case MODS_IPI_WFE: {
|
|
if (p->num_loops > MAX_IPI_WFE_LOOPS) {
|
|
cl_error("num_loops %u exceed maximum limit %d for MODS_IPI_WFE\n",
|
|
p->num_loops,
|
|
MAX_IPI_WFE_LOOPS);
|
|
LOG_EXT();
|
|
return -EINVAL;
|
|
}
|
|
preempt_disable();
|
|
smp_call_function_many(cpu_online_mask, ipi_wfe_cpu, (void *)p, 1);
|
|
preempt_enable();
|
|
break;
|
|
}
|
|
default: {
|
|
cl_error("unsupported MODS_IPI_TYPE\n");
|
|
LOG_EXT();
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
LOG_EXT();
|
|
return 0;
|
|
}
|