]>
Commit | Line | Data |
---|---|---|
d7af6a48 SG |
1 | /* |
2 | * Copyright (c) 2014 Google, Inc | |
3 | * | |
4 | * SPDX-License-Identifier: GPL-2.0+ | |
5 | */ | |
6 | ||
7 | #include <common.h> | |
8 | #include <dm.h> | |
9 | #include <errno.h> | |
10 | #include <fdtdec.h> | |
11 | #include <malloc.h> | |
12 | #include <spi.h> | |
13 | #include <dm/device-internal.h> | |
14 | #include <dm/uclass-internal.h> | |
15 | #include <dm/root.h> | |
16 | #include <dm/lists.h> | |
17 | #include <dm/util.h> | |
18 | ||
19 | DECLARE_GLOBAL_DATA_PTR; | |
20 | ||
21 | static int spi_set_speed_mode(struct udevice *bus, int speed, int mode) | |
22 | { | |
23 | struct dm_spi_ops *ops; | |
24 | int ret; | |
25 | ||
26 | ops = spi_get_ops(bus); | |
27 | if (ops->set_speed) | |
28 | ret = ops->set_speed(bus, speed); | |
29 | else | |
30 | ret = -EINVAL; | |
31 | if (ret) { | |
32 | printf("Cannot set speed (err=%d)\n", ret); | |
33 | return ret; | |
34 | } | |
35 | ||
36 | if (ops->set_mode) | |
37 | ret = ops->set_mode(bus, mode); | |
38 | else | |
39 | ret = -EINVAL; | |
40 | if (ret) { | |
41 | printf("Cannot set mode (err=%d)\n", ret); | |
42 | return ret; | |
43 | } | |
44 | ||
45 | return 0; | |
46 | } | |
47 | ||
48 | int spi_claim_bus(struct spi_slave *slave) | |
49 | { | |
50 | struct udevice *dev = slave->dev; | |
51 | struct udevice *bus = dev->parent; | |
52 | struct dm_spi_ops *ops = spi_get_ops(bus); | |
53 | struct dm_spi_bus *spi = bus->uclass_priv; | |
54 | int speed; | |
55 | int ret; | |
56 | ||
57 | speed = slave->max_hz; | |
58 | if (spi->max_hz) { | |
59 | if (speed) | |
60 | speed = min(speed, spi->max_hz); | |
61 | else | |
62 | speed = spi->max_hz; | |
63 | } | |
64 | if (!speed) | |
65 | speed = 100000; | |
66 | ret = spi_set_speed_mode(bus, speed, slave->mode); | |
67 | if (ret) | |
68 | return ret; | |
69 | ||
70 | return ops->claim_bus ? ops->claim_bus(bus) : 0; | |
71 | } | |
72 | ||
73 | void spi_release_bus(struct spi_slave *slave) | |
74 | { | |
75 | struct udevice *dev = slave->dev; | |
76 | struct udevice *bus = dev->parent; | |
77 | struct dm_spi_ops *ops = spi_get_ops(bus); | |
78 | ||
79 | if (ops->release_bus) | |
80 | ops->release_bus(bus); | |
81 | } | |
82 | ||
83 | int spi_xfer(struct spi_slave *slave, unsigned int bitlen, | |
84 | const void *dout, void *din, unsigned long flags) | |
85 | { | |
86 | struct udevice *dev = slave->dev; | |
87 | struct udevice *bus = dev->parent; | |
88 | ||
89 | if (bus->uclass->uc_drv->id != UCLASS_SPI) | |
90 | return -EOPNOTSUPP; | |
91 | ||
92 | return spi_get_ops(bus)->xfer(dev, bitlen, dout, din, flags); | |
93 | } | |
94 | ||
95 | int spi_post_bind(struct udevice *dev) | |
96 | { | |
97 | /* Scan the bus for devices */ | |
98 | return dm_scan_fdt_node(dev, gd->fdt_blob, dev->of_offset, false); | |
99 | } | |
100 | ||
101 | int spi_post_probe(struct udevice *dev) | |
102 | { | |
103 | struct dm_spi_bus *spi = dev->uclass_priv; | |
104 | ||
105 | spi->max_hz = fdtdec_get_int(gd->fdt_blob, dev->of_offset, | |
106 | "spi-max-frequency", 0); | |
107 | ||
108 | return 0; | |
109 | } | |
110 | ||
111 | int spi_chip_select(struct udevice *dev) | |
112 | { | |
113 | struct spi_slave *slave = dev_get_parentdata(dev); | |
114 | ||
115 | return slave ? slave->cs : -ENOENT; | |
116 | } | |
117 | ||
118 | /** | |
119 | * spi_find_chip_select() - Find the slave attached to chip select | |
120 | * | |
121 | * @bus: SPI bus to search | |
122 | * @cs: Chip select to look for | |
123 | * @devp: Returns the slave device if found | |
124 | * @return 0 if found, -ENODEV on error | |
125 | */ | |
126 | static int spi_find_chip_select(struct udevice *bus, int cs, | |
127 | struct udevice **devp) | |
128 | { | |
129 | struct udevice *dev; | |
130 | ||
131 | for (device_find_first_child(bus, &dev); dev; | |
132 | device_find_next_child(&dev)) { | |
133 | struct spi_slave store; | |
134 | struct spi_slave *slave = dev_get_parentdata(dev); | |
135 | ||
136 | if (!slave) { | |
137 | slave = &store; | |
138 | spi_ofdata_to_platdata(gd->fdt_blob, dev->of_offset, | |
139 | slave); | |
140 | } | |
141 | debug("%s: slave=%p, cs=%d\n", __func__, slave, | |
142 | slave ? slave->cs : -1); | |
143 | if (slave && slave->cs == cs) { | |
144 | *devp = dev; | |
145 | return 0; | |
146 | } | |
147 | } | |
148 | ||
149 | return -ENODEV; | |
150 | } | |
151 | ||
152 | int spi_cs_is_valid(unsigned int busnum, unsigned int cs) | |
153 | { | |
154 | struct spi_cs_info info; | |
155 | struct udevice *bus; | |
156 | int ret; | |
157 | ||
158 | ret = uclass_find_device_by_seq(UCLASS_SPI, busnum, false, &bus); | |
159 | if (ret) { | |
160 | debug("%s: No bus %d\n", __func__, busnum); | |
161 | return ret; | |
162 | } | |
163 | ||
164 | return spi_cs_info(bus, cs, &info); | |
165 | } | |
166 | ||
167 | int spi_cs_info(struct udevice *bus, uint cs, struct spi_cs_info *info) | |
168 | { | |
169 | struct spi_cs_info local_info; | |
170 | struct dm_spi_ops *ops; | |
171 | int ret; | |
172 | ||
173 | if (!info) | |
174 | info = &local_info; | |
175 | ||
176 | /* If there is a device attached, return it */ | |
177 | info->dev = NULL; | |
178 | ret = spi_find_chip_select(bus, cs, &info->dev); | |
179 | if (!ret) | |
180 | return 0; | |
181 | ||
182 | /* | |
183 | * Otherwise ask the driver. For the moment we don't have CS info. | |
184 | * When we do we could provide the driver with a helper function | |
185 | * to figure out what chip selects are valid, or just handle the | |
186 | * request. | |
187 | */ | |
188 | ops = spi_get_ops(bus); | |
189 | if (ops->cs_info) | |
190 | return ops->cs_info(bus, cs, info); | |
191 | ||
192 | /* | |
193 | * We could assume there is at least one valid chip select, but best | |
194 | * to be sure and return an error in this case. The driver didn't | |
195 | * care enough to tell us. | |
196 | */ | |
197 | return -ENODEV; | |
198 | } | |
199 | ||
200 | int spi_bind_device(struct udevice *bus, int cs, const char *drv_name, | |
201 | const char *dev_name, struct udevice **devp) | |
202 | { | |
203 | struct driver *drv; | |
204 | int ret; | |
205 | ||
206 | drv = lists_driver_lookup_name(drv_name); | |
207 | if (!drv) { | |
208 | printf("Cannot find driver '%s'\n", drv_name); | |
209 | return -ENOENT; | |
210 | } | |
211 | ret = device_bind(bus, drv, dev_name, NULL, -1, devp); | |
212 | if (ret) { | |
213 | printf("Cannot create device named '%s' (err=%d)\n", | |
214 | dev_name, ret); | |
215 | return ret; | |
216 | } | |
217 | ||
218 | return 0; | |
219 | } | |
220 | ||
221 | int spi_find_bus_and_cs(int busnum, int cs, struct udevice **busp, | |
222 | struct udevice **devp) | |
223 | { | |
224 | struct udevice *bus, *dev; | |
225 | int ret; | |
226 | ||
227 | ret = uclass_find_device_by_seq(UCLASS_SPI, busnum, false, &bus); | |
228 | if (ret) { | |
229 | debug("%s: No bus %d\n", __func__, busnum); | |
230 | return ret; | |
231 | } | |
232 | ret = spi_find_chip_select(bus, cs, &dev); | |
233 | if (ret) { | |
234 | debug("%s: No cs %d\n", __func__, cs); | |
235 | return ret; | |
236 | } | |
237 | *busp = bus; | |
238 | *devp = dev; | |
239 | ||
240 | return ret; | |
241 | } | |
242 | ||
243 | int spi_get_bus_and_cs(int busnum, int cs, int speed, int mode, | |
244 | const char *drv_name, const char *dev_name, | |
245 | struct udevice **busp, struct spi_slave **devp) | |
246 | { | |
247 | struct udevice *bus, *dev; | |
248 | struct spi_slave *slave; | |
249 | bool created = false; | |
250 | int ret; | |
251 | ||
252 | ret = uclass_get_device_by_seq(UCLASS_SPI, busnum, &bus); | |
253 | if (ret) { | |
254 | printf("Invalid bus %d (err=%d)\n", busnum, ret); | |
255 | return ret; | |
256 | } | |
257 | ret = spi_find_chip_select(bus, cs, &dev); | |
258 | ||
259 | /* | |
260 | * If there is no such device, create one automatically. This means | |
261 | * that we don't need a device tree node or platform data for the | |
262 | * SPI flash chip - we will bind to the correct driver. | |
263 | */ | |
264 | if (ret == -ENODEV && drv_name) { | |
265 | debug("%s: Binding new device '%s', busnum=%d, cs=%d, driver=%s\n", | |
266 | __func__, dev_name, busnum, cs, drv_name); | |
267 | ret = spi_bind_device(bus, cs, drv_name, dev_name, &dev); | |
268 | if (ret) | |
269 | return ret; | |
270 | created = true; | |
271 | } else if (ret) { | |
272 | printf("Invalid chip select %d:%d (err=%d)\n", busnum, cs, | |
273 | ret); | |
274 | return ret; | |
275 | } | |
276 | ||
277 | if (!device_active(dev)) { | |
278 | slave = (struct spi_slave *)calloc(1, | |
279 | sizeof(struct spi_slave)); | |
280 | if (!slave) { | |
281 | ret = -ENOMEM; | |
282 | goto err; | |
283 | } | |
284 | ||
285 | ret = spi_ofdata_to_platdata(gd->fdt_blob, dev->of_offset, | |
286 | slave); | |
287 | if (ret) | |
288 | goto err; | |
289 | slave->cs = cs; | |
290 | slave->dev = dev; | |
291 | ret = device_probe_child(dev, slave); | |
292 | free(slave); | |
293 | if (ret) | |
294 | goto err; | |
295 | } | |
296 | ||
297 | ret = spi_set_speed_mode(bus, speed, mode); | |
298 | if (ret) | |
299 | goto err; | |
300 | ||
301 | *busp = bus; | |
302 | *devp = dev_get_parentdata(dev); | |
303 | debug("%s: bus=%p, slave=%p\n", __func__, bus, *devp); | |
304 | ||
305 | return 0; | |
306 | ||
307 | err: | |
308 | if (created) { | |
309 | device_remove(dev); | |
310 | device_unbind(dev); | |
311 | } | |
312 | ||
313 | return ret; | |
314 | } | |
315 | ||
316 | /* Compatibility function - to be removed */ | |
317 | struct spi_slave *spi_setup_slave_fdt(const void *blob, int node, | |
318 | int bus_node) | |
319 | { | |
320 | struct udevice *bus, *dev; | |
321 | int ret; | |
322 | ||
323 | ret = uclass_get_device_by_of_offset(UCLASS_SPI, bus_node, &bus); | |
324 | if (ret) | |
325 | return NULL; | |
326 | ret = device_get_child_by_of_offset(bus, node, &dev); | |
327 | if (ret) | |
328 | return NULL; | |
329 | return dev_get_parentdata(dev); | |
330 | } | |
331 | ||
332 | /* Compatibility function - to be removed */ | |
333 | struct spi_slave *spi_setup_slave(unsigned int busnum, unsigned int cs, | |
334 | unsigned int speed, unsigned int mode) | |
335 | { | |
336 | struct spi_slave *slave; | |
337 | struct udevice *dev; | |
338 | int ret; | |
339 | ||
340 | ret = spi_get_bus_and_cs(busnum, cs, speed, mode, NULL, 0, &dev, | |
341 | &slave); | |
342 | if (ret) | |
343 | return NULL; | |
344 | ||
345 | return slave; | |
346 | } | |
347 | ||
348 | void spi_free_slave(struct spi_slave *slave) | |
349 | { | |
350 | device_remove(slave->dev); | |
351 | slave->dev = NULL; | |
352 | } | |
353 | ||
354 | int spi_ofdata_to_platdata(const void *blob, int node, | |
355 | struct spi_slave *spi) | |
356 | { | |
357 | int mode = 0; | |
358 | ||
359 | spi->cs = fdtdec_get_int(blob, node, "reg", -1); | |
360 | spi->max_hz = fdtdec_get_int(blob, node, "spi-max-frequency", 0); | |
361 | if (fdtdec_get_bool(blob, node, "spi-cpol")) | |
362 | mode |= SPI_CPOL; | |
363 | if (fdtdec_get_bool(blob, node, "spi-cpha")) | |
364 | mode |= SPI_CPHA; | |
365 | if (fdtdec_get_bool(blob, node, "spi-cs-high")) | |
366 | mode |= SPI_CS_HIGH; | |
367 | if (fdtdec_get_bool(blob, node, "spi-half-duplex")) | |
368 | mode |= SPI_PREAMBLE; | |
369 | spi->mode = mode; | |
370 | ||
371 | return 0; | |
372 | } | |
373 | ||
374 | UCLASS_DRIVER(spi) = { | |
375 | .id = UCLASS_SPI, | |
376 | .name = "spi", | |
377 | .post_bind = spi_post_bind, | |
378 | .post_probe = spi_post_probe, | |
379 | .per_device_auto_alloc_size = sizeof(struct dm_spi_bus), | |
380 | }; | |
381 | ||
382 | UCLASS_DRIVER(spi_generic) = { | |
383 | .id = UCLASS_SPI_GENERIC, | |
384 | .name = "spi_generic", | |
385 | }; | |
386 | ||
387 | U_BOOT_DRIVER(spi_generic_drv) = { | |
388 | .name = "spi_generic_drv", | |
389 | .id = UCLASS_SPI_GENERIC, | |
390 | }; |