treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / crypto / ccp / psp-dev.c
blobe95e7aa5dbf11041e240d2f282e3de22f1536c3f
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * AMD Platform Security Processor (PSP) interface
5 * Copyright (C) 2016,2019 Advanced Micro Devices, Inc.
7 * Author: Brijesh Singh <brijesh.singh@amd.com>
8 */
10 #include <linux/kernel.h>
11 #include <linux/irqreturn.h>
13 #include "sp-dev.h"
14 #include "psp-dev.h"
15 #include "sev-dev.h"
16 #include "tee-dev.h"
18 struct psp_device *psp_master;
20 static struct psp_device *psp_alloc_struct(struct sp_device *sp)
22 struct device *dev = sp->dev;
23 struct psp_device *psp;
25 psp = devm_kzalloc(dev, sizeof(*psp), GFP_KERNEL);
26 if (!psp)
27 return NULL;
29 psp->dev = dev;
30 psp->sp = sp;
32 snprintf(psp->name, sizeof(psp->name), "psp-%u", sp->ord);
34 return psp;
37 static irqreturn_t psp_irq_handler(int irq, void *data)
39 struct psp_device *psp = data;
40 unsigned int status;
42 /* Read the interrupt status: */
43 status = ioread32(psp->io_regs + psp->vdata->intsts_reg);
45 /* invoke subdevice interrupt handlers */
46 if (status) {
47 if (psp->sev_irq_handler)
48 psp->sev_irq_handler(irq, psp->sev_irq_data, status);
50 if (psp->tee_irq_handler)
51 psp->tee_irq_handler(irq, psp->tee_irq_data, status);
54 /* Clear the interrupt status by writing the same value we read. */
55 iowrite32(status, psp->io_regs + psp->vdata->intsts_reg);
57 return IRQ_HANDLED;
60 static unsigned int psp_get_capability(struct psp_device *psp)
62 unsigned int val = ioread32(psp->io_regs + psp->vdata->feature_reg);
65 * Check for a access to the registers. If this read returns
66 * 0xffffffff, it's likely that the system is running a broken
67 * BIOS which disallows access to the device. Stop here and
68 * fail the PSP initialization (but not the load, as the CCP
69 * could get properly initialized).
71 if (val == 0xffffffff) {
72 dev_notice(psp->dev, "psp: unable to access the device: you might be running a broken BIOS.\n");
73 return 0;
76 return val;
79 static int psp_check_sev_support(struct psp_device *psp,
80 unsigned int capability)
82 /* Check if device supports SEV feature */
83 if (!(capability & 1)) {
84 dev_dbg(psp->dev, "psp does not support SEV\n");
85 return -ENODEV;
88 return 0;
91 static int psp_check_tee_support(struct psp_device *psp,
92 unsigned int capability)
94 /* Check if device supports TEE feature */
95 if (!(capability & 2)) {
96 dev_dbg(psp->dev, "psp does not support TEE\n");
97 return -ENODEV;
100 return 0;
103 static int psp_check_support(struct psp_device *psp,
104 unsigned int capability)
106 int sev_support = psp_check_sev_support(psp, capability);
107 int tee_support = psp_check_tee_support(psp, capability);
109 /* Return error if device neither supports SEV nor TEE */
110 if (sev_support && tee_support)
111 return -ENODEV;
113 return 0;
116 static int psp_init(struct psp_device *psp, unsigned int capability)
118 int ret;
120 if (!psp_check_sev_support(psp, capability)) {
121 ret = sev_dev_init(psp);
122 if (ret)
123 return ret;
126 if (!psp_check_tee_support(psp, capability)) {
127 ret = tee_dev_init(psp);
128 if (ret)
129 return ret;
132 return 0;
135 int psp_dev_init(struct sp_device *sp)
137 struct device *dev = sp->dev;
138 struct psp_device *psp;
139 unsigned int capability;
140 int ret;
142 ret = -ENOMEM;
143 psp = psp_alloc_struct(sp);
144 if (!psp)
145 goto e_err;
147 sp->psp_data = psp;
149 psp->vdata = (struct psp_vdata *)sp->dev_vdata->psp_vdata;
150 if (!psp->vdata) {
151 ret = -ENODEV;
152 dev_err(dev, "missing driver data\n");
153 goto e_err;
156 psp->io_regs = sp->io_map;
158 capability = psp_get_capability(psp);
159 if (!capability)
160 goto e_disable;
162 ret = psp_check_support(psp, capability);
163 if (ret)
164 goto e_disable;
166 /* Disable and clear interrupts until ready */
167 iowrite32(0, psp->io_regs + psp->vdata->inten_reg);
168 iowrite32(-1, psp->io_regs + psp->vdata->intsts_reg);
170 /* Request an irq */
171 ret = sp_request_psp_irq(psp->sp, psp_irq_handler, psp->name, psp);
172 if (ret) {
173 dev_err(dev, "psp: unable to allocate an IRQ\n");
174 goto e_err;
177 ret = psp_init(psp, capability);
178 if (ret)
179 goto e_irq;
181 if (sp->set_psp_master_device)
182 sp->set_psp_master_device(sp);
184 /* Enable interrupt */
185 iowrite32(-1, psp->io_regs + psp->vdata->inten_reg);
187 dev_notice(dev, "psp enabled\n");
189 return 0;
191 e_irq:
192 sp_free_psp_irq(psp->sp, psp);
193 e_err:
194 sp->psp_data = NULL;
196 dev_notice(dev, "psp initialization failed\n");
198 return ret;
200 e_disable:
201 sp->psp_data = NULL;
203 return ret;
206 void psp_dev_destroy(struct sp_device *sp)
208 struct psp_device *psp = sp->psp_data;
210 if (!psp)
211 return;
213 sev_dev_destroy(psp);
215 tee_dev_destroy(psp);
217 sp_free_psp_irq(sp, psp);
220 void psp_set_sev_irq_handler(struct psp_device *psp, psp_irq_handler_t handler,
221 void *data)
223 psp->sev_irq_data = data;
224 psp->sev_irq_handler = handler;
227 void psp_clear_sev_irq_handler(struct psp_device *psp)
229 psp_set_sev_irq_handler(psp, NULL, NULL);
232 void psp_set_tee_irq_handler(struct psp_device *psp, psp_irq_handler_t handler,
233 void *data)
235 psp->tee_irq_data = data;
236 psp->tee_irq_handler = handler;
239 void psp_clear_tee_irq_handler(struct psp_device *psp)
241 psp_set_tee_irq_handler(psp, NULL, NULL);
244 struct psp_device *psp_get_master_device(void)
246 struct sp_device *sp = sp_get_psp_master_device();
248 return sp ? sp->psp_data : NULL;
251 void psp_pci_init(void)
253 psp_master = psp_get_master_device();
255 if (!psp_master)
256 return;
258 sev_pci_init();
261 void psp_pci_exit(void)
263 if (!psp_master)
264 return;
266 sev_pci_exit();