1
2
3
4
5
6
7
8
9
10#include <linux/module.h>
11#include <linux/kernel.h>
12#include <linux/device.h>
13#include <linux/platform_device.h>
14#include <linux/ioport.h>
15#include <linux/dma-mapping.h>
16#include <linux/kthread.h>
17#include <linux/sched.h>
18#include <linux/interrupt.h>
19#include <linux/spinlock.h>
20#include <linux/delay.h>
21#include <linux/ccp.h>
22#include <linux/of.h>
23#include <linux/of_address.h>
24#include <linux/acpi.h>
25
26#include "ccp-dev.h"
27
28struct sp_platform {
29 int coherent;
30 unsigned int irq_count;
31};
32
33static const struct sp_dev_vdata dev_vdata[] = {
34 {
35 .bar = 0,
36#ifdef CONFIG_CRYPTO_DEV_SP_CCP
37 .ccp_vdata = &ccpv3_platform,
38#endif
39 },
40};
41
42#ifdef CONFIG_ACPI
43static const struct acpi_device_id sp_acpi_match[] = {
44 { "AMDI0C00", (kernel_ulong_t)&dev_vdata[0] },
45 { },
46};
47MODULE_DEVICE_TABLE(acpi, sp_acpi_match);
48#endif
49
50#ifdef CONFIG_OF
51static const struct of_device_id sp_of_match[] = {
52 { .compatible = "amd,ccp-seattle-v1a",
53 .data = (const void *)&dev_vdata[0] },
54 { },
55};
56MODULE_DEVICE_TABLE(of, sp_of_match);
57#endif
58
59static struct sp_dev_vdata *sp_get_of_version(struct platform_device *pdev)
60{
61#ifdef CONFIG_OF
62 const struct of_device_id *match;
63
64 match = of_match_node(sp_of_match, pdev->dev.of_node);
65 if (match && match->data)
66 return (struct sp_dev_vdata *)match->data;
67#endif
68 return NULL;
69}
70
71static struct sp_dev_vdata *sp_get_acpi_version(struct platform_device *pdev)
72{
73#ifdef CONFIG_ACPI
74 const struct acpi_device_id *match;
75
76 match = acpi_match_device(sp_acpi_match, &pdev->dev);
77 if (match && match->driver_data)
78 return (struct sp_dev_vdata *)match->driver_data;
79#endif
80 return NULL;
81}
82
83static int sp_get_irqs(struct sp_device *sp)
84{
85 struct sp_platform *sp_platform = sp->dev_specific;
86 struct device *dev = sp->dev;
87 struct platform_device *pdev = to_platform_device(dev);
88 unsigned int i, count;
89 int ret;
90
91 for (i = 0, count = 0; i < pdev->num_resources; i++) {
92 struct resource *res = &pdev->resource[i];
93
94 if (resource_type(res) == IORESOURCE_IRQ)
95 count++;
96 }
97
98 sp_platform->irq_count = count;
99
100 ret = platform_get_irq(pdev, 0);
101 if (ret < 0) {
102 dev_notice(dev, "unable to get IRQ (%d)\n", ret);
103 return ret;
104 }
105
106 sp->psp_irq = ret;
107 if (count == 1) {
108 sp->ccp_irq = ret;
109 } else {
110 ret = platform_get_irq(pdev, 1);
111 if (ret < 0) {
112 dev_notice(dev, "unable to get IRQ (%d)\n", ret);
113 return ret;
114 }
115
116 sp->ccp_irq = ret;
117 }
118
119 return 0;
120}
121
122static int sp_platform_probe(struct platform_device *pdev)
123{
124 struct sp_device *sp;
125 struct sp_platform *sp_platform;
126 struct device *dev = &pdev->dev;
127 enum dev_dma_attr attr;
128 int ret;
129
130 ret = -ENOMEM;
131 sp = sp_alloc_struct(dev);
132 if (!sp)
133 goto e_err;
134
135 sp_platform = devm_kzalloc(dev, sizeof(*sp_platform), GFP_KERNEL);
136 if (!sp_platform)
137 goto e_err;
138
139 sp->dev_specific = sp_platform;
140 sp->dev_vdata = pdev->dev.of_node ? sp_get_of_version(pdev)
141 : sp_get_acpi_version(pdev);
142 if (!sp->dev_vdata) {
143 ret = -ENODEV;
144 dev_err(dev, "missing driver data\n");
145 goto e_err;
146 }
147
148 sp->io_map = devm_platform_ioremap_resource(pdev, 0);
149 if (IS_ERR(sp->io_map)) {
150 ret = PTR_ERR(sp->io_map);
151 goto e_err;
152 }
153
154 attr = device_get_dma_attr(dev);
155 if (attr == DEV_DMA_NOT_SUPPORTED) {
156 dev_err(dev, "DMA is not supported");
157 goto e_err;
158 }
159
160 sp_platform->coherent = (attr == DEV_DMA_COHERENT);
161 if (sp_platform->coherent)
162 sp->axcache = CACHE_WB_NO_ALLOC;
163 else
164 sp->axcache = CACHE_NONE;
165
166 ret = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(48));
167 if (ret) {
168 dev_err(dev, "dma_set_mask_and_coherent failed (%d)\n", ret);
169 goto e_err;
170 }
171
172 ret = sp_get_irqs(sp);
173 if (ret)
174 goto e_err;
175
176 dev_set_drvdata(dev, sp);
177
178 ret = sp_init(sp);
179 if (ret)
180 goto e_err;
181
182 dev_notice(dev, "enabled\n");
183
184 return 0;
185
186e_err:
187 dev_notice(dev, "initialization failed\n");
188 return ret;
189}
190
191static int sp_platform_remove(struct platform_device *pdev)
192{
193 struct device *dev = &pdev->dev;
194 struct sp_device *sp = dev_get_drvdata(dev);
195
196 sp_destroy(sp);
197
198 dev_notice(dev, "disabled\n");
199
200 return 0;
201}
202
203#ifdef CONFIG_PM
204static int sp_platform_suspend(struct platform_device *pdev,
205 pm_message_t state)
206{
207 struct device *dev = &pdev->dev;
208 struct sp_device *sp = dev_get_drvdata(dev);
209
210 return sp_suspend(sp);
211}
212
213static int sp_platform_resume(struct platform_device *pdev)
214{
215 struct device *dev = &pdev->dev;
216 struct sp_device *sp = dev_get_drvdata(dev);
217
218 return sp_resume(sp);
219}
220#endif
221
222static struct platform_driver sp_platform_driver = {
223 .driver = {
224 .name = "ccp",
225#ifdef CONFIG_ACPI
226 .acpi_match_table = sp_acpi_match,
227#endif
228#ifdef CONFIG_OF
229 .of_match_table = sp_of_match,
230#endif
231 },
232 .probe = sp_platform_probe,
233 .remove = sp_platform_remove,
234#ifdef CONFIG_PM
235 .suspend = sp_platform_suspend,
236 .resume = sp_platform_resume,
237#endif
238};
239
240int sp_platform_init(void)
241{
242 return platform_driver_register(&sp_platform_driver);
243}
244
245void sp_platform_exit(void)
246{
247 platform_driver_unregister(&sp_platform_driver);
248}
249
