mirror of
git://nv-tegra.nvidia.com/linux-nv-oot.git
synced 2025-12-22 09:11:26 +03:00
drivers/platform/tegra: Add tegra-epl driver
Add tegra-epl driver. It is used to report software detected errors via HSP mailbox or MISC-EC registers to safety service module running on the Functional Safety Island (FSI) Bug 3583609 Change-Id: I5bd3e4bd261d00a353743b01c83ed8df6f00e90a Signed-off-by: Rahul Bedarkar <rabedarkar@nvidia.com> Reviewed-on: https://git-master.nvidia.com/r/c/linux-nv-oot/+/2710277 Reviewed-by: Laxman Dewangan <ldewangan@nvidia.com> GVS: Gerrit_Virtual_Submit
This commit is contained in:
Rahul Bedarkar
committed by
mobile promotions
mobile promotions
parent
a767295929
commit
6f854558c1
@@ -13,4 +13,5 @@ obj-m += tegra-bootloader-debug.o
|
|||||||
tegra-cactmon-objs := cactmon.o
|
tegra-cactmon-objs := cactmon.o
|
||||||
tegra-cactmon-objs += actmon_common.o
|
tegra-cactmon-objs += actmon_common.o
|
||||||
obj-m += tegra-cactmon.o
|
obj-m += tegra-cactmon.o
|
||||||
|
obj-m += tegra-epl.o
|
||||||
obj-m += tegra-fsicom.o
|
obj-m += tegra-fsicom.o
|
||||||
|
|||||||
315
drivers/platform/tegra/tegra-epl.c
Normal file
315
drivers/platform/tegra/tegra-epl.c
Normal file
@@ -0,0 +1,315 @@
|
|||||||
|
// SPDX-License-Identifier: GPL-2.0
|
||||||
|
// Copyright (c) 2021-2022, NVIDIA CORPORATION. All rights reserved.
|
||||||
|
|
||||||
|
#include <linux/module.h>
|
||||||
|
#include <linux/fs.h>
|
||||||
|
#include <linux/types.h>
|
||||||
|
#include <linux/platform_device.h>
|
||||||
|
#include <linux/of_device.h>
|
||||||
|
#include <linux/dma-buf.h>
|
||||||
|
#include <linux/device.h>
|
||||||
|
#include <linux/kdev_t.h>
|
||||||
|
#include <linux/mailbox_client.h>
|
||||||
|
#include <linux/tegra-epl.h>
|
||||||
|
#include <linux/pm.h>
|
||||||
|
|
||||||
|
/* Timeout in milliseconds */
|
||||||
|
#define TIMEOUT 1000
|
||||||
|
|
||||||
|
/* 32bit data Length */
|
||||||
|
#define MAX_LEN 4
|
||||||
|
|
||||||
|
/* Macro indicating total number of Misc Sw generic errors in Misc EC */
|
||||||
|
#define NUM_SW_GENERIC_ERR 5U
|
||||||
|
|
||||||
|
/* Error index offset in mission status register */
|
||||||
|
#define ERROR_INDEX_OFFSET 24U
|
||||||
|
|
||||||
|
/* Data type for mailbox client and channel details */
|
||||||
|
struct epl_hsp_sm {
|
||||||
|
struct mbox_client client;
|
||||||
|
struct mbox_chan *chan;
|
||||||
|
};
|
||||||
|
|
||||||
|
/* Data type for accessing TOP2 HSP */
|
||||||
|
struct epl_hsp {
|
||||||
|
struct epl_hsp_sm tx;
|
||||||
|
struct device dev;
|
||||||
|
};
|
||||||
|
|
||||||
|
/* Data type to store Misc Sw Generic error configuration */
|
||||||
|
struct epl_misc_sw_err_cfg {
|
||||||
|
void __iomem *err_code_va;
|
||||||
|
void __iomem *err_assert_va;
|
||||||
|
const char *dev_configured;
|
||||||
|
};
|
||||||
|
|
||||||
|
static int device_file_major_number;
|
||||||
|
static const char device_name[] = "epdaemon";
|
||||||
|
|
||||||
|
static struct platform_device *pdev_local;
|
||||||
|
|
||||||
|
static struct epl_hsp *epl_hsp_v;
|
||||||
|
|
||||||
|
static void __iomem *mission_err_status_va;
|
||||||
|
|
||||||
|
static bool isAddrMappOk = true;
|
||||||
|
|
||||||
|
static struct epl_misc_sw_err_cfg miscerr_cfg[NUM_SW_GENERIC_ERR];
|
||||||
|
|
||||||
|
static void tegra_hsp_tx_empty_notify(struct mbox_client *cl,
|
||||||
|
void *data, int empty_value)
|
||||||
|
{
|
||||||
|
pr_debug("EPL: TX empty callback came\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
static int tegra_hsp_mb_init(struct device *dev)
|
||||||
|
{
|
||||||
|
int err;
|
||||||
|
|
||||||
|
epl_hsp_v = devm_kzalloc(dev, sizeof(*epl_hsp_v), GFP_KERNEL);
|
||||||
|
if (!epl_hsp_v)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
epl_hsp_v->tx.client.dev = dev;
|
||||||
|
epl_hsp_v->tx.client.tx_block = true;
|
||||||
|
epl_hsp_v->tx.client.tx_tout = TIMEOUT;
|
||||||
|
epl_hsp_v->tx.client.tx_done = tegra_hsp_tx_empty_notify;
|
||||||
|
|
||||||
|
epl_hsp_v->tx.chan = mbox_request_channel_byname(&epl_hsp_v->tx.client,
|
||||||
|
"epl-tx");
|
||||||
|
if (IS_ERR(epl_hsp_v->tx.chan)) {
|
||||||
|
err = PTR_ERR(epl_hsp_v->tx.chan);
|
||||||
|
dev_err(dev, "failed to get tx mailbox: %d\n", err);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static ssize_t device_file_ioctl(
|
||||||
|
struct file *fp, unsigned int cmd, unsigned long arg)
|
||||||
|
{
|
||||||
|
uint32_t lData[MAX_LEN];
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (copy_from_user(lData, (uint8_t *)arg,
|
||||||
|
MAX_LEN * sizeof(uint32_t)))
|
||||||
|
return -EACCES;
|
||||||
|
|
||||||
|
switch (cmd) {
|
||||||
|
|
||||||
|
case EPL_REPORT_ERROR_CMD:
|
||||||
|
ret = mbox_send_message(epl_hsp_v->tx.chan,
|
||||||
|
(void *) lData);
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
int epl_get_misc_ec_err_status(struct device *dev, uint8_t err_number, bool *status)
|
||||||
|
{
|
||||||
|
int ret = -EINVAL;
|
||||||
|
|
||||||
|
if (dev && status && (err_number < NUM_SW_GENERIC_ERR)) {
|
||||||
|
uint32_t mission_err_status = 0U;
|
||||||
|
uint32_t mask = 0U;
|
||||||
|
const char *dev_str;
|
||||||
|
|
||||||
|
if (miscerr_cfg[err_number].dev_configured == NULL || isAddrMappOk == false)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
dev_str = dev_driver_string(dev);
|
||||||
|
|
||||||
|
if (strcmp(dev_str, miscerr_cfg[err_number].dev_configured) != 0)
|
||||||
|
return -EACCES;
|
||||||
|
|
||||||
|
mask = (1U << ((ERROR_INDEX_OFFSET + err_number) % 32U));
|
||||||
|
mission_err_status = readl(mission_err_status_va);
|
||||||
|
|
||||||
|
if ((mission_err_status & mask) != 0U)
|
||||||
|
*status = false;
|
||||||
|
else
|
||||||
|
*status = true;
|
||||||
|
|
||||||
|
ret = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(epl_get_misc_ec_err_status);
|
||||||
|
|
||||||
|
int epl_report_misc_ec_error(struct device *dev, uint8_t err_number,
|
||||||
|
uint32_t sw_error_code)
|
||||||
|
{
|
||||||
|
int ret = -EINVAL;
|
||||||
|
bool status = false;
|
||||||
|
|
||||||
|
ret = epl_get_misc_ec_err_status(dev, err_number, &status);
|
||||||
|
|
||||||
|
if (ret != 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
if (status == false)
|
||||||
|
return -EAGAIN;
|
||||||
|
|
||||||
|
/* Updating error code */
|
||||||
|
writel(sw_error_code, miscerr_cfg[err_number].err_code_va);
|
||||||
|
|
||||||
|
/* triggering SW generic error */
|
||||||
|
writel(0x1U, miscerr_cfg[err_number].err_assert_va);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(epl_report_misc_ec_error);
|
||||||
|
|
||||||
|
int epl_report_error(struct epl_error_report_frame error_report)
|
||||||
|
{
|
||||||
|
int ret = -EINVAL;
|
||||||
|
|
||||||
|
if (epl_hsp_v == NULL)
|
||||||
|
return -ENODEV;
|
||||||
|
|
||||||
|
ret = mbox_send_message(epl_hsp_v->tx.chan, (void *)&error_report);
|
||||||
|
|
||||||
|
return ret < 0 ? ret : 0;
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL_GPL(epl_report_error);
|
||||||
|
|
||||||
|
static int __maybe_unused epl_client_suspend(struct device *dev)
|
||||||
|
{
|
||||||
|
pr_debug("tegra-epl: suspend called\n");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int __maybe_unused epl_client_resume(struct device *dev)
|
||||||
|
{
|
||||||
|
pr_debug("tegra-epl: resume called\n");
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
static SIMPLE_DEV_PM_OPS(epl_client_pm, epl_client_suspend, epl_client_resume);
|
||||||
|
|
||||||
|
static const struct of_device_id epl_client_dt_match[] = {
|
||||||
|
{ .compatible = "nvidia,tegra234-epl-client"},
|
||||||
|
{}
|
||||||
|
};
|
||||||
|
|
||||||
|
MODULE_DEVICE_TABLE(of, epl_client_dt_match);
|
||||||
|
|
||||||
|
/* File operations */
|
||||||
|
static const struct file_operations epl_driver_fops = {
|
||||||
|
.owner = THIS_MODULE,
|
||||||
|
.unlocked_ioctl = device_file_ioctl,
|
||||||
|
};
|
||||||
|
|
||||||
|
static int epl_register_device(void)
|
||||||
|
{
|
||||||
|
int result = 0;
|
||||||
|
struct class *dev_class;
|
||||||
|
|
||||||
|
result = register_chrdev(0, device_name, &epl_driver_fops);
|
||||||
|
if (result < 0) {
|
||||||
|
pr_err("%s> register_chrdev code = %i\n", device_name, result);
|
||||||
|
return result;
|
||||||
|
}
|
||||||
|
device_file_major_number = result;
|
||||||
|
dev_class = class_create(THIS_MODULE, device_name);
|
||||||
|
if (dev_class == NULL) {
|
||||||
|
pr_err("%s> Could not create class for device\n", device_name);
|
||||||
|
goto class_fail;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ((device_create(dev_class, NULL,
|
||||||
|
MKDEV(device_file_major_number, 0),
|
||||||
|
NULL, device_name)) == NULL) {
|
||||||
|
pr_err("%s> Could not create device node\n", device_name);
|
||||||
|
goto device_failure;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
device_failure:
|
||||||
|
class_destroy(dev_class);
|
||||||
|
class_fail:
|
||||||
|
unregister_chrdev(device_file_major_number, device_name);
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void epl_unregister_device(void)
|
||||||
|
{
|
||||||
|
if (device_file_major_number != 0)
|
||||||
|
unregister_chrdev(device_file_major_number, device_name);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int epl_client_probe(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
int ret = 0;
|
||||||
|
struct device *dev = &pdev->dev;
|
||||||
|
const struct device_node *np = dev->of_node;
|
||||||
|
int iterator = 0;
|
||||||
|
char name[32] = "client-misc-sw-generic-err";
|
||||||
|
|
||||||
|
epl_register_device();
|
||||||
|
ret = tegra_hsp_mb_init(dev);
|
||||||
|
pdev_local = pdev;
|
||||||
|
|
||||||
|
for (iterator = 0; iterator < NUM_SW_GENERIC_ERR; iterator++) {
|
||||||
|
name[26] = (char)(iterator+48U);
|
||||||
|
name[27] = '\0';
|
||||||
|
if (of_property_read_string(np, name, &miscerr_cfg[iterator].dev_configured) == 0) {
|
||||||
|
pr_info("Misc Sw Generic Err #%d configured to client %s\n",
|
||||||
|
iterator, miscerr_cfg[iterator].dev_configured);
|
||||||
|
|
||||||
|
/* Mapping registers to process address space */
|
||||||
|
miscerr_cfg[iterator].err_code_va =
|
||||||
|
devm_platform_ioremap_resource(pdev, (iterator * 2));
|
||||||
|
miscerr_cfg[iterator].err_assert_va =
|
||||||
|
devm_platform_ioremap_resource(pdev, (iterator * 2) + 1);
|
||||||
|
|
||||||
|
if (IS_ERR(miscerr_cfg[iterator].err_code_va) ||
|
||||||
|
IS_ERR(miscerr_cfg[iterator].err_assert_va)) {
|
||||||
|
isAddrMappOk = false;
|
||||||
|
ret = -1;
|
||||||
|
dev_err(&pdev->dev, "error in mapping misc err register for err #%d\n",
|
||||||
|
iterator);
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
pr_info("Misc Sw Generic Err %d not configured for any client\n", iterator);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
mission_err_status_va = devm_platform_ioremap_resource(pdev, (NUM_SW_GENERIC_ERR * 2) + 1);
|
||||||
|
if (IS_ERR(mission_err_status_va)) {
|
||||||
|
isAddrMappOk = false;
|
||||||
|
dev_err(&pdev->dev, "error in mapping mission error status register\n");
|
||||||
|
return PTR_ERR(mission_err_status_va);
|
||||||
|
}
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int epl_client_remove(struct platform_device *pdev)
|
||||||
|
{
|
||||||
|
epl_unregister_device();
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct platform_driver epl_client = {
|
||||||
|
.driver = {
|
||||||
|
.name = "epl_client",
|
||||||
|
.probe_type = PROBE_PREFER_ASYNCHRONOUS,
|
||||||
|
.of_match_table = of_match_ptr(epl_client_dt_match),
|
||||||
|
.pm = pm_ptr(&epl_client_pm),
|
||||||
|
},
|
||||||
|
.probe = epl_client_probe,
|
||||||
|
.remove = epl_client_remove,
|
||||||
|
};
|
||||||
|
|
||||||
|
module_platform_driver(epl_client);
|
||||||
|
|
||||||
|
MODULE_DESCRIPTION("tegra: Error Propagation Library driver");
|
||||||
|
MODULE_AUTHOR("Prashant Shaw <pshaw@nvidia.com>");
|
||||||
|
MODULE_LICENSE("GPL v2");
|
||||||
83
include/linux/tegra-epl.h
Normal file
83
include/linux/tegra-epl.h
Normal file
@@ -0,0 +1,83 @@
|
|||||||
|
/* SPDX-License-Identifier: GPL-2.0
|
||||||
|
*
|
||||||
|
* Copyright (c) 2021-2022, NVIDIA CORPORATION, All rights reserved.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _TEGRA_EPL_H_
|
||||||
|
#define _TEGRA_EPL_H_
|
||||||
|
|
||||||
|
#include <uapi/linux/tegra-epl.h>
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Error report frame
|
||||||
|
*/
|
||||||
|
struct epl_error_report_frame {
|
||||||
|
/* Error code indicates error reported by corresponding reporter_id */
|
||||||
|
uint32_t error_code;
|
||||||
|
|
||||||
|
/* Extra information for SEH to understand error */
|
||||||
|
uint32_t error_attribute;
|
||||||
|
|
||||||
|
/* LSB 32-bit TSC counter when error is detected */
|
||||||
|
uint32_t timestamp;
|
||||||
|
|
||||||
|
/* Indicates source of error */
|
||||||
|
uint16_t reporter_id;
|
||||||
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief API to check if SW error can be reported via Misc EC
|
||||||
|
* by reading and checking Misc EC error status register value.
|
||||||
|
*
|
||||||
|
* @param[in] dev pointer to the device structure for the kernel driver
|
||||||
|
* from where API is called.
|
||||||
|
* @param[in] err_number Generic SW error number for which status needs to
|
||||||
|
* enquired - [0 to 4].
|
||||||
|
* @param[out] status out param updated by API as follows:
|
||||||
|
* true - SW error can be reported
|
||||||
|
* false - SW error can not be reported because previous error
|
||||||
|
* is still active. Client needs to retry later.
|
||||||
|
*
|
||||||
|
* @returns
|
||||||
|
* 0 (success)
|
||||||
|
* -EINVAL (On invalid arguments)
|
||||||
|
* -ENODEV (On device driver not loaded or Misc EC not configured)
|
||||||
|
* -EACCESS (On client not allowed to report error via given Misc EC)
|
||||||
|
* -EAGAIN (On Misc EC busy, client should retry)
|
||||||
|
*/
|
||||||
|
int epl_get_misc_ec_err_status(struct device *dev, uint8_t err_number, bool *status);
|
||||||
|
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief API to report SW error to FSI using Misc Generic SW error lines connected to
|
||||||
|
* the Misc error collator.
|
||||||
|
*
|
||||||
|
* @param[in] dev pointer to the device structure for the kernel driver
|
||||||
|
* from where API is called.
|
||||||
|
* @param[in] err_number Generic SW error number through which error
|
||||||
|
* needs to be reported.
|
||||||
|
* @param[in] sw_error_code Client Defined Error Code, which will be
|
||||||
|
* forwarded to the application on FSI.
|
||||||
|
*
|
||||||
|
* @returns
|
||||||
|
* 0 (success)
|
||||||
|
* -EINVAL (On invalid arguments)
|
||||||
|
* -ENODEV (On device driver not loaded or Misc EC not configured)
|
||||||
|
* -EACCESS (On client not allowed to report error via given Misc EC)
|
||||||
|
* -EAGAIN (On Misc EC busy, client should retry)
|
||||||
|
*/
|
||||||
|
int epl_report_misc_ec_error(struct device *dev, uint8_t err_number, uint32_t sw_error_code);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief API to report SW error via TOP2 HSP
|
||||||
|
*
|
||||||
|
* @param[in] error_report Error frame to be reported
|
||||||
|
*
|
||||||
|
* @return
|
||||||
|
* 0 (Success)
|
||||||
|
* -ENODEV (On device driver not loaded or not configured)
|
||||||
|
* -ETIME (On timeout)
|
||||||
|
*/
|
||||||
|
int epl_report_error(struct epl_error_report_frame error_report);
|
||||||
|
|
||||||
|
#endif /* _TEGRA_EPL_H_ */
|
||||||
14
include/uapi/linux/tegra-epl.h
Normal file
14
include/uapi/linux/tegra-epl.h
Normal file
@@ -0,0 +1,14 @@
|
|||||||
|
/* SPDX-License-Identifier: (GPL-2.0 WITH Linux-syscall-note)
|
||||||
|
*
|
||||||
|
* Copyright (c) 2021-2022, NVIDIA CORPORATION, All rights reserved.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _UAPI_TEGRA_EPL_H_
|
||||||
|
#define _UAPI_TEGRA_EPL_H_
|
||||||
|
|
||||||
|
#include <linux/ioctl.h>
|
||||||
|
|
||||||
|
/* ioctl call macros */
|
||||||
|
#define EPL_REPORT_ERROR_CMD _IOWR('q', 1, uint8_t *)
|
||||||
|
|
||||||
|
#endif /* _UAPI_TEGRA_EPL_H_ */
|
||||||
Reference in New Issue
Block a user