1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Driver for Xilinx TMR Inject IP.
4 *
5 * Copyright (C) 2022 Advanced Micro Devices, Inc.
6 *
7 * Description:
8 * This driver is developed for TMR Inject IP,The Triple Modular Redundancy(TMR)
9 * Inject provides fault injection.
10 */
11
12#include <asm/xilinx_mb_manager.h>
13#include <linux/module.h>
14#include <linux/of.h>
15#include <linux/platform_device.h>
16#include <linux/fault-inject.h>
17
18/* TMR Inject Register offsets */
19#define XTMR_INJECT_CR_OFFSET		0x0
20#define XTMR_INJECT_AIR_OFFSET		0x4
21#define XTMR_INJECT_IIR_OFFSET		0xC
22#define XTMR_INJECT_EAIR_OFFSET		0x10
23#define XTMR_INJECT_ERR_OFFSET		0x204
24
25/* Register Bitmasks/shifts */
26#define XTMR_INJECT_CR_CPUID_SHIFT	8
27#define XTMR_INJECT_CR_IE_SHIFT		10
28#define XTMR_INJECT_IIR_ADDR_MASK	GENMASK(31, 16)
29
30#define XTMR_INJECT_MAGIC_MAX_VAL	255
31
32/**
33 * struct xtmr_inject_dev - Driver data for TMR Inject
34 * @regs: device physical base address
35 * @magic: Magic hardware configuration value
36 */
37struct xtmr_inject_dev {
38	void __iomem *regs;
39	u32 magic;
40};
41
42static DECLARE_FAULT_ATTR(inject_fault);
43static char *inject_request;
44module_param(inject_request, charp, 0);
45MODULE_PARM_DESC(inject_request, "default fault injection attributes");
46static struct dentry *dbgfs_root;
47
48/* IO accessors */
49static inline void xtmr_inject_write(struct xtmr_inject_dev *xtmr_inject,
50				     u32 addr, u32 value)
51{
52	iowrite32(value, xtmr_inject->regs + addr);
53}
54
55static inline u32 xtmr_inject_read(struct xtmr_inject_dev *xtmr_inject,
56				   u32 addr)
57{
58	return ioread32(xtmr_inject->regs + addr);
59}
60
61static int xtmr_inject_set(void *data, u64 val)
62{
63	if (val != 1)
64		return -EINVAL;
65
66	xmb_inject_err();
67	return 0;
68}
69DEFINE_DEBUGFS_ATTRIBUTE(xtmr_inject_fops, NULL, xtmr_inject_set, "%llu\n");
70
71static void xtmr_init_debugfs(struct xtmr_inject_dev *xtmr_inject)
72{
73	struct dentry *dir;
74
75	dbgfs_root = debugfs_create_dir("xtmr_inject", NULL);
76	dir = fault_create_debugfs_attr("inject_fault", dbgfs_root,
77					&inject_fault);
78	debugfs_create_file("inject_fault", 0200, dir, NULL,
79			    &xtmr_inject_fops);
80}
81
82static void xtmr_inject_init(struct xtmr_inject_dev *xtmr_inject)
83{
84	u32 cr_val;
85
86	if (inject_request)
87		setup_fault_attr(&inject_fault, inject_request);
88	/* Allow fault injection */
89	cr_val = xtmr_inject->magic |
90		 (1 << XTMR_INJECT_CR_IE_SHIFT) |
91		 (1 << XTMR_INJECT_CR_CPUID_SHIFT);
92	xtmr_inject_write(xtmr_inject, XTMR_INJECT_CR_OFFSET,
93			  cr_val);
94	/* Initialize the address inject and instruction inject registers */
95	xtmr_inject_write(xtmr_inject, XTMR_INJECT_AIR_OFFSET,
96			  XMB_INJECT_ERR_OFFSET);
97	xtmr_inject_write(xtmr_inject, XTMR_INJECT_IIR_OFFSET,
98			  XMB_INJECT_ERR_OFFSET & XTMR_INJECT_IIR_ADDR_MASK);
99}
100
101/**
102 * xtmr_inject_probe - Driver probe function
103 * @pdev: Pointer to the platform_device structure
104 *
105 * This is the driver probe routine. It does all the memory
106 * allocation for the device.
107 *
108 * Return: 0 on success and failure value on error
109 */
110static int xtmr_inject_probe(struct platform_device *pdev)
111{
112	struct xtmr_inject_dev *xtmr_inject;
113	int err;
114
115	xtmr_inject = devm_kzalloc(&pdev->dev, sizeof(*xtmr_inject),
116				   GFP_KERNEL);
117	if (!xtmr_inject)
118		return -ENOMEM;
119
120	xtmr_inject->regs = devm_platform_ioremap_resource(pdev, 0);
121	if (IS_ERR(xtmr_inject->regs))
122		return PTR_ERR(xtmr_inject->regs);
123
124	err = of_property_read_u32(pdev->dev.of_node, "xlnx,magic",
125				   &xtmr_inject->magic);
126	if (err < 0) {
127		dev_err(&pdev->dev, "unable to read xlnx,magic property");
128		return err;
129	}
130
131	if (xtmr_inject->magic > XTMR_INJECT_MAGIC_MAX_VAL) {
132		dev_err(&pdev->dev, "invalid xlnx,magic property value");
133		return -EINVAL;
134	}
135
136	/* Initialize TMR Inject */
137	xtmr_inject_init(xtmr_inject);
138
139	xtmr_init_debugfs(xtmr_inject);
140
141	platform_set_drvdata(pdev, xtmr_inject);
142
143	return 0;
144}
145
146static void xtmr_inject_remove(struct platform_device *pdev)
147{
148	debugfs_remove_recursive(dbgfs_root);
149	dbgfs_root = NULL;
150}
151
152static const struct of_device_id xtmr_inject_of_match[] = {
153	{
154		.compatible = "xlnx,tmr-inject-1.0",
155	},
156	{ /* end of table */ }
157};
158MODULE_DEVICE_TABLE(of, xtmr_inject_of_match);
159
160static struct platform_driver xtmr_inject_driver = {
161	.driver = {
162		.name = "xilinx-tmr_inject",
163		.of_match_table = xtmr_inject_of_match,
164	},
165	.probe = xtmr_inject_probe,
166	.remove_new = xtmr_inject_remove,
167};
168module_platform_driver(xtmr_inject_driver);
169MODULE_AUTHOR("Advanced Micro Devices, Inc");
170MODULE_DESCRIPTION("Xilinx TMR Inject Driver");
171MODULE_LICENSE("GPL");
172