1
2
3
4
5
6#include <linux/spi/spi.h>
7#include <linux/packing.h>
8#include "sja1105.h"
9
10#define SJA1105_SIZE_RESET_CMD 4
11#define SJA1105_SIZE_SPI_MSG_HEADER 4
12#define SJA1105_SIZE_SPI_MSG_MAXLEN (64 * 4)
13
14struct sja1105_chunk {
15 u8 *buf;
16 size_t len;
17 u64 reg_addr;
18};
19
20static void
21sja1105_spi_message_pack(void *buf, const struct sja1105_spi_message *msg)
22{
23 const int size = SJA1105_SIZE_SPI_MSG_HEADER;
24
25 memset(buf, 0, size);
26
27 sja1105_pack(buf, &msg->access, 31, 31, size);
28 sja1105_pack(buf, &msg->read_count, 30, 25, size);
29 sja1105_pack(buf, &msg->address, 24, 4, size);
30}
31
32#define sja1105_hdr_xfer(xfers, chunk) \
33 ((xfers) + 2 * (chunk))
34#define sja1105_chunk_xfer(xfers, chunk) \
35 ((xfers) + 2 * (chunk) + 1)
36#define sja1105_hdr_buf(hdr_bufs, chunk) \
37 ((hdr_bufs) + (chunk) * SJA1105_SIZE_SPI_MSG_HEADER)
38
39
40
41
42
43
44
45static int sja1105_xfer(const struct sja1105_private *priv,
46 sja1105_spi_rw_mode_t rw, u64 reg_addr, u8 *buf,
47 size_t len, struct ptp_system_timestamp *ptp_sts)
48{
49 struct sja1105_chunk chunk = {
50 .len = min_t(size_t, len, SJA1105_SIZE_SPI_MSG_MAXLEN),
51 .reg_addr = reg_addr,
52 .buf = buf,
53 };
54 struct spi_device *spi = priv->spidev;
55 struct spi_transfer *xfers;
56 int num_chunks;
57 int rc, i = 0;
58 u8 *hdr_bufs;
59
60 num_chunks = DIV_ROUND_UP(len, SJA1105_SIZE_SPI_MSG_MAXLEN);
61
62
63
64
65 xfers = kcalloc(2 * num_chunks, sizeof(struct spi_transfer),
66 GFP_KERNEL);
67 if (!xfers)
68 return -ENOMEM;
69
70
71
72
73 hdr_bufs = kcalloc(num_chunks, SJA1105_SIZE_SPI_MSG_HEADER,
74 GFP_KERNEL);
75 if (!hdr_bufs) {
76 kfree(xfers);
77 return -ENOMEM;
78 }
79
80 for (i = 0; i < num_chunks; i++) {
81 struct spi_transfer *chunk_xfer = sja1105_chunk_xfer(xfers, i);
82 struct spi_transfer *hdr_xfer = sja1105_hdr_xfer(xfers, i);
83 u8 *hdr_buf = sja1105_hdr_buf(hdr_bufs, i);
84 struct spi_transfer *ptp_sts_xfer;
85 struct sja1105_spi_message msg;
86
87
88 msg.address = chunk.reg_addr;
89 msg.access = rw;
90 if (rw == SPI_READ)
91 msg.read_count = chunk.len / 4;
92 else
93
94 msg.read_count = 0;
95 sja1105_spi_message_pack(hdr_buf, &msg);
96 hdr_xfer->tx_buf = hdr_buf;
97 hdr_xfer->len = SJA1105_SIZE_SPI_MSG_HEADER;
98
99
100 if (rw == SPI_READ)
101 chunk_xfer->rx_buf = chunk.buf;
102 else
103 chunk_xfer->tx_buf = chunk.buf;
104 chunk_xfer->len = chunk.len;
105
106
107
108
109
110
111
112
113
114
115
116
117
118 if (rw == SPI_READ)
119 ptp_sts_xfer = hdr_xfer;
120 else
121 ptp_sts_xfer = chunk_xfer;
122 ptp_sts_xfer->ptp_sts_word_pre = ptp_sts_xfer->len - 1;
123 ptp_sts_xfer->ptp_sts_word_post = ptp_sts_xfer->len - 1;
124 ptp_sts_xfer->ptp_sts = ptp_sts;
125
126
127 chunk.buf += chunk.len;
128 chunk.reg_addr += chunk.len / 4;
129 chunk.len = min_t(size_t, (ptrdiff_t)(buf + len - chunk.buf),
130 SJA1105_SIZE_SPI_MSG_MAXLEN);
131
132
133 if (chunk.len)
134 chunk_xfer->cs_change = 1;
135 }
136
137 rc = spi_sync_transfer(spi, xfers, 2 * num_chunks);
138 if (rc < 0)
139 dev_err(&spi->dev, "SPI transfer failed: %d\n", rc);
140
141 kfree(hdr_bufs);
142 kfree(xfers);
143
144 return rc;
145}
146
147int sja1105_xfer_buf(const struct sja1105_private *priv,
148 sja1105_spi_rw_mode_t rw, u64 reg_addr,
149 u8 *buf, size_t len)
150{
151 return sja1105_xfer(priv, rw, reg_addr, buf, len, NULL);
152}
153
154
155
156
157
158
159
160
161
162
163int sja1105_xfer_u64(const struct sja1105_private *priv,
164 sja1105_spi_rw_mode_t rw, u64 reg_addr, u64 *value,
165 struct ptp_system_timestamp *ptp_sts)
166{
167 u8 packed_buf[8];
168 int rc;
169
170 if (rw == SPI_WRITE)
171 sja1105_pack(packed_buf, value, 63, 0, 8);
172
173 rc = sja1105_xfer(priv, rw, reg_addr, packed_buf, 8, ptp_sts);
174
175 if (rw == SPI_READ)
176 sja1105_unpack(packed_buf, value, 63, 0, 8);
177
178 return rc;
179}
180
181
182int sja1105_xfer_u32(const struct sja1105_private *priv,
183 sja1105_spi_rw_mode_t rw, u64 reg_addr, u32 *value,
184 struct ptp_system_timestamp *ptp_sts)
185{
186 u8 packed_buf[4];
187 u64 tmp;
188 int rc;
189
190 if (rw == SPI_WRITE) {
191
192
193
194 tmp = *value;
195 sja1105_pack(packed_buf, &tmp, 31, 0, 4);
196 }
197
198 rc = sja1105_xfer(priv, rw, reg_addr, packed_buf, 4, ptp_sts);
199
200 if (rw == SPI_READ) {
201 sja1105_unpack(packed_buf, &tmp, 31, 0, 4);
202 *value = tmp;
203 }
204
205 return rc;
206}
207
208static int sja1105et_reset_cmd(struct dsa_switch *ds)
209{
210 struct sja1105_private *priv = ds->priv;
211 const struct sja1105_regs *regs = priv->info->regs;
212 u8 packed_buf[SJA1105_SIZE_RESET_CMD] = {0};
213 const int size = SJA1105_SIZE_RESET_CMD;
214 u64 cold_rst = 1;
215
216 sja1105_pack(packed_buf, &cold_rst, 3, 3, size);
217
218 return sja1105_xfer_buf(priv, SPI_WRITE, regs->rgu, packed_buf,
219 SJA1105_SIZE_RESET_CMD);
220}
221
222static int sja1105pqrs_reset_cmd(struct dsa_switch *ds)
223{
224 struct sja1105_private *priv = ds->priv;
225 const struct sja1105_regs *regs = priv->info->regs;
226 u8 packed_buf[SJA1105_SIZE_RESET_CMD] = {0};
227 const int size = SJA1105_SIZE_RESET_CMD;
228 u64 cold_rst = 1;
229
230 sja1105_pack(packed_buf, &cold_rst, 2, 2, size);
231
232 return sja1105_xfer_buf(priv, SPI_WRITE, regs->rgu, packed_buf,
233 SJA1105_SIZE_RESET_CMD);
234}
235
236int sja1105_inhibit_tx(const struct sja1105_private *priv,
237 unsigned long port_bitmap, bool tx_inhibited)
238{
239 const struct sja1105_regs *regs = priv->info->regs;
240 u32 inhibit_cmd;
241 int rc;
242
243 rc = sja1105_xfer_u32(priv, SPI_READ, regs->port_control,
244 &inhibit_cmd, NULL);
245 if (rc < 0)
246 return rc;
247
248 if (tx_inhibited)
249 inhibit_cmd |= port_bitmap;
250 else
251 inhibit_cmd &= ~port_bitmap;
252
253 return sja1105_xfer_u32(priv, SPI_WRITE, regs->port_control,
254 &inhibit_cmd, NULL);
255}
256
257struct sja1105_status {
258 u64 configs;
259 u64 crcchkl;
260 u64 ids;
261 u64 crcchkg;
262};
263
264
265
266
267
268static void sja1105_status_unpack(void *buf, struct sja1105_status *status)
269{
270
271 u32 *p = buf;
272
273
274
275
276
277
278 p--;
279 sja1105_unpack(p + 0x1, &status->configs, 31, 31, 4);
280 sja1105_unpack(p + 0x1, &status->crcchkl, 30, 30, 4);
281 sja1105_unpack(p + 0x1, &status->ids, 29, 29, 4);
282 sja1105_unpack(p + 0x1, &status->crcchkg, 28, 28, 4);
283}
284
285static int sja1105_status_get(struct sja1105_private *priv,
286 struct sja1105_status *status)
287{
288 const struct sja1105_regs *regs = priv->info->regs;
289 u8 packed_buf[4];
290 int rc;
291
292 rc = sja1105_xfer_buf(priv, SPI_READ, regs->status, packed_buf, 4);
293 if (rc < 0)
294 return rc;
295
296 sja1105_status_unpack(packed_buf, status);
297
298 return 0;
299}
300
301
302
303
304
305int static_config_buf_prepare_for_upload(struct sja1105_private *priv,
306 void *config_buf, int buf_len)
307{
308 struct sja1105_static_config *config = &priv->static_config;
309 struct sja1105_table_header final_header;
310 sja1105_config_valid_t valid;
311 char *final_header_ptr;
312 int crc_len;
313
314 valid = sja1105_static_config_check_valid(config);
315 if (valid != SJA1105_CONFIG_OK) {
316 dev_err(&priv->spidev->dev,
317 sja1105_static_config_error_msg[valid]);
318 return -EINVAL;
319 }
320
321
322 sja1105_static_config_pack(config_buf, config);
323
324
325
326 crc_len = buf_len - 4;
327
328 final_header_ptr = config_buf + buf_len - SJA1105_SIZE_TABLE_HEADER;
329 sja1105_table_header_packing(final_header_ptr, &final_header, UNPACK);
330
331 final_header.crc = sja1105_crc32(config_buf, crc_len);
332
333 sja1105_table_header_packing(final_header_ptr, &final_header, PACK);
334
335 return 0;
336}
337
338#define RETRIES 10
339
340int sja1105_static_config_upload(struct sja1105_private *priv)
341{
342 unsigned long port_bitmap = GENMASK_ULL(SJA1105_NUM_PORTS - 1, 0);
343 struct sja1105_static_config *config = &priv->static_config;
344 const struct sja1105_regs *regs = priv->info->regs;
345 struct device *dev = &priv->spidev->dev;
346 struct sja1105_status status;
347 int rc, retries = RETRIES;
348 u8 *config_buf;
349 int buf_len;
350
351 buf_len = sja1105_static_config_get_length(config);
352 config_buf = kcalloc(buf_len, sizeof(char), GFP_KERNEL);
353 if (!config_buf)
354 return -ENOMEM;
355
356 rc = static_config_buf_prepare_for_upload(priv, config_buf, buf_len);
357 if (rc < 0) {
358 dev_err(dev, "Invalid config, cannot upload\n");
359 rc = -EINVAL;
360 goto out;
361 }
362
363
364
365
366 rc = sja1105_inhibit_tx(priv, port_bitmap, true);
367 if (rc < 0) {
368 dev_err(dev, "Failed to inhibit Tx on ports\n");
369 rc = -ENXIO;
370 goto out;
371 }
372
373
374
375
376 usleep_range(500, 1000);
377 do {
378
379 rc = priv->info->reset_cmd(priv->ds);
380 if (rc < 0) {
381 dev_err(dev, "Failed to reset switch, retrying...\n");
382 continue;
383 }
384
385 usleep_range(1000, 5000);
386
387 rc = sja1105_xfer_buf(priv, SPI_WRITE, regs->config,
388 config_buf, buf_len);
389 if (rc < 0) {
390 dev_err(dev, "Failed to upload config, retrying...\n");
391 continue;
392 }
393
394 rc = sja1105_status_get(priv, &status);
395 if (rc < 0)
396 continue;
397
398 if (status.ids == 1) {
399 dev_err(dev, "Mismatch between hardware and static config "
400 "device id. Wrote 0x%llx, wants 0x%llx\n",
401 config->device_id, priv->info->device_id);
402 continue;
403 }
404 if (status.crcchkl == 1) {
405 dev_err(dev, "Switch reported invalid local CRC on "
406 "the uploaded config, retrying...\n");
407 continue;
408 }
409 if (status.crcchkg == 1) {
410 dev_err(dev, "Switch reported invalid global CRC on "
411 "the uploaded config, retrying...\n");
412 continue;
413 }
414 if (status.configs == 0) {
415 dev_err(dev, "Switch reported that configuration is "
416 "invalid, retrying...\n");
417 continue;
418 }
419
420 break;
421 } while (--retries);
422
423 if (!retries) {
424 rc = -EIO;
425 dev_err(dev, "Failed to upload config to device, giving up\n");
426 goto out;
427 } else if (retries != RETRIES) {
428 dev_info(dev, "Succeeded after %d tried\n", RETRIES - retries);
429 }
430
431out:
432 kfree(config_buf);
433 return rc;
434}
435
436static struct sja1105_regs sja1105et_regs = {
437 .device_id = 0x0,
438 .prod_id = 0x100BC3,
439 .status = 0x1,
440 .port_control = 0x11,
441 .vl_status = 0x10000,
442 .config = 0x020000,
443 .rgu = 0x100440,
444
445 .pad_mii_tx = {0x100800, 0x100802, 0x100804, 0x100806, 0x100808},
446 .pad_mii_rx = {0x100801, 0x100803, 0x100805, 0x100807, 0x100809},
447 .rmii_pll1 = 0x10000A,
448 .cgu_idiv = {0x10000B, 0x10000C, 0x10000D, 0x10000E, 0x10000F},
449 .mac = {0x200, 0x202, 0x204, 0x206, 0x208},
450 .mac_hl1 = {0x400, 0x410, 0x420, 0x430, 0x440},
451 .mac_hl2 = {0x600, 0x610, 0x620, 0x630, 0x640},
452
453 .mii_tx_clk = {0x100013, 0x10001A, 0x100021, 0x100028, 0x10002F},
454 .mii_rx_clk = {0x100014, 0x10001B, 0x100022, 0x100029, 0x100030},
455 .mii_ext_tx_clk = {0x100018, 0x10001F, 0x100026, 0x10002D, 0x100034},
456 .mii_ext_rx_clk = {0x100019, 0x100020, 0x100027, 0x10002E, 0x100035},
457 .rgmii_tx_clk = {0x100016, 0x10001D, 0x100024, 0x10002B, 0x100032},
458 .rmii_ref_clk = {0x100015, 0x10001C, 0x100023, 0x10002A, 0x100031},
459 .rmii_ext_tx_clk = {0x100018, 0x10001F, 0x100026, 0x10002D, 0x100034},
460 .ptpegr_ts = {0xC0, 0xC2, 0xC4, 0xC6, 0xC8},
461 .ptpschtm = 0x12,
462 .ptppinst = 0x14,
463 .ptppindur = 0x16,
464 .ptp_control = 0x17,
465 .ptpclkval = 0x18,
466 .ptpclkrate = 0x1A,
467 .ptpclkcorp = 0x1D,
468};
469
470static struct sja1105_regs sja1105pqrs_regs = {
471 .device_id = 0x0,
472 .prod_id = 0x100BC3,
473 .status = 0x1,
474 .port_control = 0x12,
475 .vl_status = 0x10000,
476 .config = 0x020000,
477 .rgu = 0x100440,
478
479 .pad_mii_tx = {0x100800, 0x100802, 0x100804, 0x100806, 0x100808},
480 .pad_mii_rx = {0x100801, 0x100803, 0x100805, 0x100807, 0x100809},
481 .pad_mii_id = {0x100810, 0x100811, 0x100812, 0x100813, 0x100814},
482 .sgmii = 0x1F0000,
483 .rmii_pll1 = 0x10000A,
484 .cgu_idiv = {0x10000B, 0x10000C, 0x10000D, 0x10000E, 0x10000F},
485 .mac = {0x200, 0x202, 0x204, 0x206, 0x208},
486 .mac_hl1 = {0x400, 0x410, 0x420, 0x430, 0x440},
487 .mac_hl2 = {0x600, 0x610, 0x620, 0x630, 0x640},
488 .ether_stats = {0x1400, 0x1418, 0x1430, 0x1448, 0x1460},
489
490 .mii_tx_clk = {0x100013, 0x100019, 0x10001F, 0x100025, 0x10002B},
491 .mii_rx_clk = {0x100014, 0x10001A, 0x100020, 0x100026, 0x10002C},
492 .mii_ext_tx_clk = {0x100017, 0x10001D, 0x100023, 0x100029, 0x10002F},
493 .mii_ext_rx_clk = {0x100018, 0x10001E, 0x100024, 0x10002A, 0x100030},
494 .rgmii_tx_clk = {0x100016, 0x10001C, 0x100022, 0x100028, 0x10002E},
495 .rmii_ref_clk = {0x100015, 0x10001B, 0x100021, 0x100027, 0x10002D},
496 .rmii_ext_tx_clk = {0x100017, 0x10001D, 0x100023, 0x100029, 0x10002F},
497 .qlevel = {0x604, 0x614, 0x624, 0x634, 0x644},
498 .ptpegr_ts = {0xC0, 0xC4, 0xC8, 0xCC, 0xD0},
499 .ptpschtm = 0x13,
500 .ptppinst = 0x15,
501 .ptppindur = 0x17,
502 .ptp_control = 0x18,
503 .ptpclkval = 0x19,
504 .ptpclkrate = 0x1B,
505 .ptpclkcorp = 0x1E,
506 .ptpsyncts = 0x1F,
507};
508
509const struct sja1105_info sja1105e_info = {
510 .device_id = SJA1105E_DEVICE_ID,
511 .part_no = SJA1105ET_PART_NO,
512 .static_ops = sja1105e_table_ops,
513 .dyn_ops = sja1105et_dyn_ops,
514 .qinq_tpid = ETH_P_8021Q,
515 .can_limit_mcast_flood = false,
516 .ptp_ts_bits = 24,
517 .ptpegr_ts_bytes = 4,
518 .num_cbs_shapers = SJA1105ET_MAX_CBS_COUNT,
519 .reset_cmd = sja1105et_reset_cmd,
520 .fdb_add_cmd = sja1105et_fdb_add,
521 .fdb_del_cmd = sja1105et_fdb_del,
522 .ptp_cmd_packing = sja1105et_ptp_cmd_packing,
523 .regs = &sja1105et_regs,
524 .name = "SJA1105E",
525};
526
527const struct sja1105_info sja1105t_info = {
528 .device_id = SJA1105T_DEVICE_ID,
529 .part_no = SJA1105ET_PART_NO,
530 .static_ops = sja1105t_table_ops,
531 .dyn_ops = sja1105et_dyn_ops,
532 .qinq_tpid = ETH_P_8021Q,
533 .can_limit_mcast_flood = false,
534 .ptp_ts_bits = 24,
535 .ptpegr_ts_bytes = 4,
536 .num_cbs_shapers = SJA1105ET_MAX_CBS_COUNT,
537 .reset_cmd = sja1105et_reset_cmd,
538 .fdb_add_cmd = sja1105et_fdb_add,
539 .fdb_del_cmd = sja1105et_fdb_del,
540 .ptp_cmd_packing = sja1105et_ptp_cmd_packing,
541 .regs = &sja1105et_regs,
542 .name = "SJA1105T",
543};
544
545const struct sja1105_info sja1105p_info = {
546 .device_id = SJA1105PR_DEVICE_ID,
547 .part_no = SJA1105P_PART_NO,
548 .static_ops = sja1105p_table_ops,
549 .dyn_ops = sja1105pqrs_dyn_ops,
550 .qinq_tpid = ETH_P_8021AD,
551 .can_limit_mcast_flood = true,
552 .ptp_ts_bits = 32,
553 .ptpegr_ts_bytes = 8,
554 .num_cbs_shapers = SJA1105PQRS_MAX_CBS_COUNT,
555 .setup_rgmii_delay = sja1105pqrs_setup_rgmii_delay,
556 .reset_cmd = sja1105pqrs_reset_cmd,
557 .fdb_add_cmd = sja1105pqrs_fdb_add,
558 .fdb_del_cmd = sja1105pqrs_fdb_del,
559 .ptp_cmd_packing = sja1105pqrs_ptp_cmd_packing,
560 .regs = &sja1105pqrs_regs,
561 .name = "SJA1105P",
562};
563
564const struct sja1105_info sja1105q_info = {
565 .device_id = SJA1105QS_DEVICE_ID,
566 .part_no = SJA1105Q_PART_NO,
567 .static_ops = sja1105q_table_ops,
568 .dyn_ops = sja1105pqrs_dyn_ops,
569 .qinq_tpid = ETH_P_8021AD,
570 .can_limit_mcast_flood = true,
571 .ptp_ts_bits = 32,
572 .ptpegr_ts_bytes = 8,
573 .num_cbs_shapers = SJA1105PQRS_MAX_CBS_COUNT,
574 .setup_rgmii_delay = sja1105pqrs_setup_rgmii_delay,
575 .reset_cmd = sja1105pqrs_reset_cmd,
576 .fdb_add_cmd = sja1105pqrs_fdb_add,
577 .fdb_del_cmd = sja1105pqrs_fdb_del,
578 .ptp_cmd_packing = sja1105pqrs_ptp_cmd_packing,
579 .regs = &sja1105pqrs_regs,
580 .name = "SJA1105Q",
581};
582
583const struct sja1105_info sja1105r_info = {
584 .device_id = SJA1105PR_DEVICE_ID,
585 .part_no = SJA1105R_PART_NO,
586 .static_ops = sja1105r_table_ops,
587 .dyn_ops = sja1105pqrs_dyn_ops,
588 .qinq_tpid = ETH_P_8021AD,
589 .can_limit_mcast_flood = true,
590 .ptp_ts_bits = 32,
591 .ptpegr_ts_bytes = 8,
592 .num_cbs_shapers = SJA1105PQRS_MAX_CBS_COUNT,
593 .setup_rgmii_delay = sja1105pqrs_setup_rgmii_delay,
594 .reset_cmd = sja1105pqrs_reset_cmd,
595 .fdb_add_cmd = sja1105pqrs_fdb_add,
596 .fdb_del_cmd = sja1105pqrs_fdb_del,
597 .ptp_cmd_packing = sja1105pqrs_ptp_cmd_packing,
598 .regs = &sja1105pqrs_regs,
599 .name = "SJA1105R",
600};
601
602const struct sja1105_info sja1105s_info = {
603 .device_id = SJA1105QS_DEVICE_ID,
604 .part_no = SJA1105S_PART_NO,
605 .static_ops = sja1105s_table_ops,
606 .dyn_ops = sja1105pqrs_dyn_ops,
607 .regs = &sja1105pqrs_regs,
608 .qinq_tpid = ETH_P_8021AD,
609 .can_limit_mcast_flood = true,
610 .ptp_ts_bits = 32,
611 .ptpegr_ts_bytes = 8,
612 .num_cbs_shapers = SJA1105PQRS_MAX_CBS_COUNT,
613 .setup_rgmii_delay = sja1105pqrs_setup_rgmii_delay,
614 .reset_cmd = sja1105pqrs_reset_cmd,
615 .fdb_add_cmd = sja1105pqrs_fdb_add,
616 .fdb_del_cmd = sja1105pqrs_fdb_del,
617 .ptp_cmd_packing = sja1105pqrs_ptp_cmd_packing,
618 .name = "SJA1105S",
619};
620