This source file includes following definitions.
- sp_get_of_version
- sp_get_acpi_version
- sp_get_irqs
- sp_platform_probe
- sp_platform_remove
- sp_platform_suspend
- sp_platform_resume
- sp_platform_init
- sp_platform_exit
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
28 struct sp_platform {
29 int coherent;
30 unsigned int irq_count;
31 };
32
33 static 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
43 static const struct acpi_device_id sp_acpi_match[] = {
44 { "AMDI0C00", (kernel_ulong_t)&dev_vdata[0] },
45 { },
46 };
47 MODULE_DEVICE_TABLE(acpi, sp_acpi_match);
48 #endif
49
50 #ifdef CONFIG_OF
51 static const struct of_device_id sp_of_match[] = {
52 { .compatible = "amd,ccp-seattle-v1a",
53 .data = (const void *)&dev_vdata[0] },
54 { },
55 };
56 MODULE_DEVICE_TABLE(of, sp_of_match);
57 #endif
58
59 static 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
71 static 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
83 static 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
122 static 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
186 e_err:
187 dev_notice(dev, "initialization failed\n");
188 return ret;
189 }
190
191 static 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
204 static 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, state);
211 }
212
213 static 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
222 static 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
240 int sp_platform_init(void)
241 {
242 return platform_driver_register(&sp_platform_driver);
243 }
244
245 void sp_platform_exit(void)
246 {
247 platform_driver_unregister(&sp_platform_driver);
248 }