1
2
3
4
5
6
7
8
9#include <common.h>
10#include <clk.h>
11#include <dm.h>
12#include <log.h>
13#include <linux/bitops.h>
14#include <linux/compat.h>
15#include <malloc.h>
16#include <spi.h>
17
18#include <asm/types.h>
19#include <asm/io.h>
20#include <asm/gpio.h>
21#include <dt-bindings/clock/microchip,clock.h>
22#include <mach/pic32.h>
23
24DECLARE_GLOBAL_DATA_PTR;
25
26
27struct pic32_reg_spi {
28 struct pic32_reg_atomic ctrl;
29 struct pic32_reg_atomic status;
30 struct pic32_reg_atomic buf;
31 struct pic32_reg_atomic baud;
32 struct pic32_reg_atomic ctrl2;
33};
34
35
36#define PIC32_SPI_CTRL_MSTEN BIT(5)
37#define PIC32_SPI_CTRL_CKP BIT(6)
38#define PIC32_SPI_CTRL_CKE BIT(8)
39#define PIC32_SPI_CTRL_SMP BIT(9)
40#define PIC32_SPI_CTRL_BPW_MASK 0x03
41#define PIC32_SPI_CTRL_BPW_8 0x0
42#define PIC32_SPI_CTRL_BPW_16 0x1
43#define PIC32_SPI_CTRL_BPW_32 0x2
44#define PIC32_SPI_CTRL_BPW_SHIFT 10
45#define PIC32_SPI_CTRL_ON BIT(15)
46#define PIC32_SPI_CTRL_ENHBUF BIT(16)
47#define PIC32_SPI_CTRL_MCLKSEL BIT(23)
48#define PIC32_SPI_CTRL_MSSEN BIT(28)
49#define PIC32_SPI_CTRL_FRMEN BIT(31)
50
51
52#define PIC32_SPI_STAT_RX_OV BIT(6)
53#define PIC32_SPI_STAT_TF_LVL_MASK 0x1f
54#define PIC32_SPI_STAT_TF_LVL_SHIFT 16
55#define PIC32_SPI_STAT_RF_LVL_MASK 0x1f
56#define PIC32_SPI_STAT_RF_LVL_SHIFT 24
57
58
59#define PIC32_SPI_BAUD_MASK 0x1ff
60
61struct pic32_spi_priv {
62 struct pic32_reg_spi *regs;
63 u32 fifo_depth;
64 u32 fifo_n_word;
65 struct gpio_desc cs_gpio;
66
67
68 ulong clk_rate;
69 u32 speed_hz;
70 int mode;
71
72
73 const void *tx;
74 const void *tx_end;
75 const void *rx;
76 const void *rx_end;
77 u32 len;
78
79
80 void (*rx_fifo)(struct pic32_spi_priv *);
81 void (*tx_fifo)(struct pic32_spi_priv *);
82};
83
84static inline void pic32_spi_enable(struct pic32_spi_priv *priv)
85{
86 writel(PIC32_SPI_CTRL_ON, &priv->regs->ctrl.set);
87}
88
89static inline void pic32_spi_disable(struct pic32_spi_priv *priv)
90{
91 writel(PIC32_SPI_CTRL_ON, &priv->regs->ctrl.clr);
92}
93
94static inline u32 pic32_spi_rx_fifo_level(struct pic32_spi_priv *priv)
95{
96 u32 sr = readl(&priv->regs->status.raw);
97
98 return (sr >> PIC32_SPI_STAT_RF_LVL_SHIFT) & PIC32_SPI_STAT_RF_LVL_MASK;
99}
100
101static inline u32 pic32_spi_tx_fifo_level(struct pic32_spi_priv *priv)
102{
103 u32 sr = readl(&priv->regs->status.raw);
104
105 return (sr >> PIC32_SPI_STAT_TF_LVL_SHIFT) & PIC32_SPI_STAT_TF_LVL_MASK;
106}
107
108
109static u32 pic32_tx_max(struct pic32_spi_priv *priv, int n_bytes)
110{
111 u32 tx_left, tx_room, rxtx_gap;
112
113 tx_left = (priv->tx_end - priv->tx) / n_bytes;
114 tx_room = priv->fifo_n_word - pic32_spi_tx_fifo_level(priv);
115
116 rxtx_gap = (priv->rx_end - priv->rx) - (priv->tx_end - priv->tx);
117 rxtx_gap /= n_bytes;
118 return min3(tx_left, tx_room, (u32)(priv->fifo_n_word - rxtx_gap));
119}
120
121
122static u32 pic32_rx_max(struct pic32_spi_priv *priv, int n_bytes)
123{
124 u32 rx_left = (priv->rx_end - priv->rx) / n_bytes;
125
126 return min_t(u32, rx_left, pic32_spi_rx_fifo_level(priv));
127}
128
129#define BUILD_SPI_FIFO_RW(__name, __type, __bwl) \
130static void pic32_spi_rx_##__name(struct pic32_spi_priv *priv) \
131{ \
132 __type val; \
133 u32 mx = pic32_rx_max(priv, sizeof(__type)); \
134 \
135 for (; mx; mx--) { \
136 val = read##__bwl(&priv->regs->buf.raw); \
137 if (priv->rx_end - priv->len) \
138 *(__type *)(priv->rx) = val; \
139 priv->rx += sizeof(__type); \
140 } \
141} \
142 \
143static void pic32_spi_tx_##__name(struct pic32_spi_priv *priv) \
144{ \
145 __type val; \
146 u32 mx = pic32_tx_max(priv, sizeof(__type)); \
147 \
148 for (; mx ; mx--) { \
149 val = (__type) ~0U; \
150 if (priv->tx_end - priv->len) \
151 val = *(__type *)(priv->tx); \
152 write##__bwl(val, &priv->regs->buf.raw); \
153 priv->tx += sizeof(__type); \
154 } \
155}
156BUILD_SPI_FIFO_RW(byte, u8, b);
157BUILD_SPI_FIFO_RW(word, u16, w);
158BUILD_SPI_FIFO_RW(dword, u32, l);
159
160static int pic32_spi_set_word_size(struct pic32_spi_priv *priv,
161 unsigned int wordlen)
162{
163 u32 bits_per_word;
164 u32 val;
165
166 switch (wordlen) {
167 case 8:
168 priv->rx_fifo = pic32_spi_rx_byte;
169 priv->tx_fifo = pic32_spi_tx_byte;
170 bits_per_word = PIC32_SPI_CTRL_BPW_8;
171 break;
172 case 16:
173 priv->rx_fifo = pic32_spi_rx_word;
174 priv->tx_fifo = pic32_spi_tx_word;
175 bits_per_word = PIC32_SPI_CTRL_BPW_16;
176 break;
177 case 32:
178 priv->rx_fifo = pic32_spi_rx_dword;
179 priv->tx_fifo = pic32_spi_tx_dword;
180 bits_per_word = PIC32_SPI_CTRL_BPW_32;
181 break;
182 default:
183 printf("pic32-spi: unsupported wordlen\n");
184 return -EINVAL;
185 }
186
187
188 val = readl(&priv->regs->ctrl.raw);
189 val &= ~(PIC32_SPI_CTRL_BPW_MASK << PIC32_SPI_CTRL_BPW_SHIFT);
190 val |= bits_per_word << PIC32_SPI_CTRL_BPW_SHIFT;
191 writel(val, &priv->regs->ctrl.raw);
192
193
194 priv->fifo_n_word = DIV_ROUND_UP(priv->fifo_depth, wordlen / 8);
195
196 return 0;
197}
198
199static int pic32_spi_claim_bus(struct udevice *slave)
200{
201 struct pic32_spi_priv *priv = dev_get_priv(slave->parent);
202
203
204 pic32_spi_enable(priv);
205
206 return 0;
207}
208
209static int pic32_spi_release_bus(struct udevice *slave)
210{
211 struct pic32_spi_priv *priv = dev_get_priv(slave->parent);
212
213
214 pic32_spi_disable(priv);
215
216 return 0;
217}
218
219static void spi_cs_activate(struct pic32_spi_priv *priv)
220{
221 if (!dm_gpio_is_valid(&priv->cs_gpio))
222 return;
223
224 dm_gpio_set_value(&priv->cs_gpio, 1);
225}
226
227static void spi_cs_deactivate(struct pic32_spi_priv *priv)
228{
229 if (!dm_gpio_is_valid(&priv->cs_gpio))
230 return;
231
232 dm_gpio_set_value(&priv->cs_gpio, 0);
233}
234
235static int pic32_spi_xfer(struct udevice *slave, unsigned int bitlen,
236 const void *tx_buf, void *rx_buf,
237 unsigned long flags)
238{
239 struct dm_spi_slave_platdata *slave_plat;
240 struct udevice *bus = slave->parent;
241 struct pic32_spi_priv *priv;
242 int len = bitlen / 8;
243 int ret = 0;
244 ulong tbase;
245
246 priv = dev_get_priv(bus);
247 slave_plat = dev_get_parent_platdata(slave);
248
249 debug("spi_xfer: bus:%i cs:%i flags:%lx\n",
250 bus->seq, slave_plat->cs, flags);
251 debug("msg tx %p, rx %p submitted of %d byte(s)\n",
252 tx_buf, rx_buf, len);
253
254
255 if (flags & SPI_XFER_BEGIN)
256 spi_cs_activate(priv);
257
258
259 priv->tx = tx_buf;
260 priv->rx = rx_buf;
261 priv->tx_end = priv->tx + len;
262 priv->rx_end = priv->rx + len;
263 priv->len = len;
264
265
266 tbase = get_timer(0);
267 for (;;) {
268 priv->tx_fifo(priv);
269 priv->rx_fifo(priv);
270
271
272 if (priv->rx >= priv->rx_end) {
273 ret = 0;
274 break;
275 }
276
277 if (get_timer(tbase) > 5 * CONFIG_SYS_HZ) {
278 printf("pic32_spi: error, xfer timedout.\n");
279 flags |= SPI_XFER_END;
280 ret = -ETIMEDOUT;
281 break;
282 }
283 }
284
285
286 if (flags & SPI_XFER_END)
287 spi_cs_deactivate(priv);
288
289 return ret;
290}
291
292static int pic32_spi_set_speed(struct udevice *bus, uint speed)
293{
294 struct pic32_spi_priv *priv = dev_get_priv(bus);
295 u32 div;
296
297 debug("%s: %s, speed %u\n", __func__, bus->name, speed);
298
299
300 div = (priv->clk_rate / 2 / speed) - 1;
301 div &= PIC32_SPI_BAUD_MASK;
302 writel(div, &priv->regs->baud.raw);
303
304 priv->speed_hz = speed;
305
306 return 0;
307}
308
309static int pic32_spi_set_mode(struct udevice *bus, uint mode)
310{
311 struct pic32_spi_priv *priv = dev_get_priv(bus);
312 u32 val;
313
314 debug("%s: %s, mode %d\n", __func__, bus->name, mode);
315
316
317 val = readl(&priv->regs->ctrl.raw);
318
319 if (mode & SPI_CPOL)
320 val |= PIC32_SPI_CTRL_CKP;
321 else
322 val &= ~PIC32_SPI_CTRL_CKP;
323
324
325 if (mode & SPI_CPHA)
326 val &= ~PIC32_SPI_CTRL_CKE;
327 else
328 val |= PIC32_SPI_CTRL_CKE;
329
330
331 val |= PIC32_SPI_CTRL_SMP;
332 writel(val, &priv->regs->ctrl.raw);
333
334 priv->mode = mode;
335
336 return 0;
337}
338
339static int pic32_spi_set_wordlen(struct udevice *slave, unsigned int wordlen)
340{
341 struct pic32_spi_priv *priv = dev_get_priv(slave->parent);
342
343 return pic32_spi_set_word_size(priv, wordlen);
344}
345
346static void pic32_spi_hw_init(struct pic32_spi_priv *priv)
347{
348 u32 val;
349
350
351 pic32_spi_disable(priv);
352
353 val = readl(&priv->regs->ctrl);
354
355
356 val |= PIC32_SPI_CTRL_ENHBUF;
357 priv->fifo_depth = 16;
358
359
360 val &= ~PIC32_SPI_CTRL_FRMEN;
361
362
363 val |= PIC32_SPI_CTRL_MSTEN;
364
365
366 val &= ~PIC32_SPI_CTRL_MCLKSEL;
367
368
369 val &= ~PIC32_SPI_CTRL_MSSEN;
370
371 writel(val, &priv->regs->ctrl);
372
373
374 writel(PIC32_SPI_STAT_RX_OV, &priv->regs->status.clr);
375}
376
377static int pic32_spi_probe(struct udevice *bus)
378{
379 struct pic32_spi_priv *priv = dev_get_priv(bus);
380 struct dm_spi_bus *dm_spi = dev_get_uclass_priv(bus);
381 int node = dev_of_offset(bus);
382 struct udevice *clkdev;
383 fdt_addr_t addr;
384 fdt_size_t size;
385 int ret;
386
387 debug("%s: %d, bus: %i\n", __func__, __LINE__, bus->seq);
388 addr = fdtdec_get_addr_size(gd->fdt_blob, node, "reg", &size);
389 if (addr == FDT_ADDR_T_NONE)
390 return -EINVAL;
391
392 priv->regs = ioremap(addr, size);
393 if (!priv->regs)
394 return -EINVAL;
395
396 dm_spi->max_hz = fdtdec_get_int(gd->fdt_blob, node, "spi-max-frequency",
397 250000000);
398
399 ret = clk_get_by_index(bus, 0, &clkdev);
400 if (ret < 0) {
401 printf("pic32-spi: error, clk not found\n");
402 return ret;
403 }
404 priv->clk_rate = clk_get_periph_rate(clkdev, ret);
405
406
407 pic32_spi_hw_init(priv);
408
409
410 pic32_spi_set_word_size(priv, SPI_DEFAULT_WORDLEN);
411
412
413
414
415
416
417
418 ret = gpio_request_by_name_nodev(offset_to_ofnode(node), "cs-gpios", 0,
419 &priv->cs_gpio, GPIOD_IS_OUT);
420 if (ret) {
421 printf("pic32-spi: error, cs-gpios not found\n");
422 return ret;
423 }
424
425 return 0;
426}
427
428static const struct dm_spi_ops pic32_spi_ops = {
429 .claim_bus = pic32_spi_claim_bus,
430 .release_bus = pic32_spi_release_bus,
431 .xfer = pic32_spi_xfer,
432 .set_speed = pic32_spi_set_speed,
433 .set_mode = pic32_spi_set_mode,
434 .set_wordlen = pic32_spi_set_wordlen,
435};
436
437static const struct udevice_id pic32_spi_ids[] = {
438 { .compatible = "microchip,pic32mzda-spi" },
439 { }
440};
441
442U_BOOT_DRIVER(pic32_spi) = {
443 .name = "pic32_spi",
444 .id = UCLASS_SPI,
445 .of_match = pic32_spi_ids,
446 .ops = &pic32_spi_ops,
447 .priv_auto_alloc_size = sizeof(struct pic32_spi_priv),
448 .probe = pic32_spi_probe,
449};
450