1 // SPDX-License-Identifier: BSD-3-Clause
2 /* Copyright (c) 2016-2018, NXP Semiconductors
3 * Copyright (c) 2018, Sensor-Technik Wiedemann GmbH
4 * Copyright (c) 2018-2019, Vladimir Oltean <olteanv@gmail.com>
6 #include <linux/spi/spi.h>
7 #include <linux/packing.h>
10 #define SJA1105_SIZE_RESET_CMD 4
11 #define SJA1105_SIZE_SPI_MSG_HEADER 4
12 #define SJA1105_SIZE_SPI_MSG_MAXLEN (64 * 4)
14 struct sja1105_chunk
{
21 sja1105_spi_message_pack(void *buf
, const struct sja1105_spi_message
*msg
)
23 const int size
= SJA1105_SIZE_SPI_MSG_HEADER
;
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
);
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)
40 * - SPI_WRITE: creates and sends an SPI write message at absolute
41 * address reg_addr, taking @len bytes from *buf
42 * - SPI_READ: creates and sends an SPI read message from absolute
43 * address reg_addr, writing @len bytes into *buf
45 static 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
)
49 struct sja1105_chunk chunk
= {
50 .len
= min_t(size_t, len
, SJA1105_SIZE_SPI_MSG_MAXLEN
),
54 struct spi_device
*spi
= priv
->spidev
;
55 struct spi_transfer
*xfers
;
60 num_chunks
= DIV_ROUND_UP(len
, SJA1105_SIZE_SPI_MSG_MAXLEN
);
62 /* One transfer for each message header, one for each message
65 xfers
= kcalloc(2 * num_chunks
, sizeof(struct spi_transfer
),
70 /* Packed buffers for the num_chunks SPI message headers,
71 * stored as a contiguous array
73 hdr_bufs
= kcalloc(num_chunks
, SJA1105_SIZE_SPI_MSG_HEADER
,
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
;
87 /* Populate the transfer's header buffer */
88 msg
.address
= chunk
.reg_addr
;
91 msg
.read_count
= chunk
.len
/ 4;
95 sja1105_spi_message_pack(hdr_buf
, &msg
);
96 hdr_xfer
->tx_buf
= hdr_buf
;
97 hdr_xfer
->len
= SJA1105_SIZE_SPI_MSG_HEADER
;
99 /* Populate the transfer's data buffer */
101 chunk_xfer
->rx_buf
= chunk
.buf
;
103 chunk_xfer
->tx_buf
= chunk
.buf
;
104 chunk_xfer
->len
= chunk
.len
;
106 /* Request timestamping for the transfer. Instead of letting
107 * callers specify which byte they want to timestamp, we can
108 * make certain assumptions:
109 * - A read operation will request a software timestamp when
110 * what's being read is the PTP time. That is snapshotted by
111 * the switch hardware at the end of the command portion
113 * - A write operation will request a software timestamp on
114 * actions that modify the PTP time. Taking clock stepping as
115 * an example, the switch writes the PTP time at the end of
116 * the data portion (chunk_xfer).
119 ptp_sts_xfer
= hdr_xfer
;
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
;
126 /* Calculate next chunk */
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
);
132 /* De-assert the chip select after each chunk. */
134 chunk_xfer
->cs_change
= 1;
137 rc
= spi_sync_transfer(spi
, xfers
, 2 * num_chunks
);
139 dev_err(&spi
->dev
, "SPI transfer failed: %d\n", rc
);
147 int sja1105_xfer_buf(const struct sja1105_private
*priv
,
148 sja1105_spi_rw_mode_t rw
, u64 reg_addr
,
151 return sja1105_xfer(priv
, rw
, reg_addr
, buf
, len
, NULL
);
155 * - SPI_WRITE: creates and sends an SPI write message at absolute
157 * - SPI_READ: creates and sends an SPI read message from absolute
160 * The u64 *value is unpacked, meaning that it's stored in the native
161 * CPU endianness and directly usable by software running on the core.
163 int 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
)
171 sja1105_pack(packed_buf
, value
, 63, 0, 8);
173 rc
= sja1105_xfer(priv
, rw
, reg_addr
, packed_buf
, 8, ptp_sts
);
176 sja1105_unpack(packed_buf
, value
, 63, 0, 8);
181 /* Same as above, but transfers only a 4 byte word */
182 int 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
)
190 if (rw
== SPI_WRITE
) {
191 /* The packing API only supports u64 as CPU word size,
192 * so we need to convert.
195 sja1105_pack(packed_buf
, &tmp
, 31, 0, 4);
198 rc
= sja1105_xfer(priv
, rw
, reg_addr
, packed_buf
, 4, ptp_sts
);
200 if (rw
== SPI_READ
) {
201 sja1105_unpack(packed_buf
, &tmp
, 31, 0, 4);
208 static int sja1105et_reset_cmd(struct dsa_switch
*ds
)
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
;
216 sja1105_pack(packed_buf
, &cold_rst
, 3, 3, size
);
218 return sja1105_xfer_buf(priv
, SPI_WRITE
, regs
->rgu
, packed_buf
,
219 SJA1105_SIZE_RESET_CMD
);
222 static int sja1105pqrs_reset_cmd(struct dsa_switch
*ds
)
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
;
230 sja1105_pack(packed_buf
, &cold_rst
, 2, 2, size
);
232 return sja1105_xfer_buf(priv
, SPI_WRITE
, regs
->rgu
, packed_buf
,
233 SJA1105_SIZE_RESET_CMD
);
236 int sja1105_inhibit_tx(const struct sja1105_private
*priv
,
237 unsigned long port_bitmap
, bool tx_inhibited
)
239 const struct sja1105_regs
*regs
= priv
->info
->regs
;
243 rc
= sja1105_xfer_u32(priv
, SPI_READ
, regs
->port_control
,
249 inhibit_cmd
|= port_bitmap
;
251 inhibit_cmd
&= ~port_bitmap
;
253 return sja1105_xfer_u32(priv
, SPI_WRITE
, regs
->port_control
,
257 struct sja1105_status
{
264 /* This is not reading the entire General Status area, which is also
265 * divergent between E/T and P/Q/R/S, but only the relevant bits for
266 * ensuring that the static config upload procedure was successful.
268 static void sja1105_status_unpack(void *buf
, struct sja1105_status
*status
)
270 /* So that addition translates to 4 bytes */
273 /* device_id is missing from the buffer, but we don't
274 * want to diverge from the manual definition of the
275 * register addresses, so we'll back off one step with
276 * the register pointer, and never access p[0].
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);
285 static int sja1105_status_get(struct sja1105_private
*priv
,
286 struct sja1105_status
*status
)
288 const struct sja1105_regs
*regs
= priv
->info
->regs
;
292 rc
= sja1105_xfer_buf(priv
, SPI_READ
, regs
->status
, packed_buf
, 4);
296 sja1105_status_unpack(packed_buf
, status
);
301 /* Not const because unpacking priv->static_config into buffers and preparing
302 * for upload requires the recalculation of table CRCs and updating the
303 * structures with these.
305 int static_config_buf_prepare_for_upload(struct sja1105_private
*priv
,
306 void *config_buf
, int buf_len
)
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
;
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
]);
321 /* Write Device ID and config tables to config_buf */
322 sja1105_static_config_pack(config_buf
, config
);
323 /* Recalculate CRC of the last header (right now 0xDEADBEEF).
324 * Don't include the CRC field itself.
326 crc_len
= buf_len
- 4;
327 /* Read the whole table header */
328 final_header_ptr
= config_buf
+ buf_len
- SJA1105_SIZE_TABLE_HEADER
;
329 sja1105_table_header_packing(final_header_ptr
, &final_header
, UNPACK
);
331 final_header
.crc
= sja1105_crc32(config_buf
, crc_len
);
333 sja1105_table_header_packing(final_header_ptr
, &final_header
, PACK
);
340 int sja1105_static_config_upload(struct sja1105_private
*priv
)
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
;
351 buf_len
= sja1105_static_config_get_length(config
);
352 config_buf
= kcalloc(buf_len
, sizeof(char), GFP_KERNEL
);
356 rc
= static_config_buf_prepare_for_upload(priv
, config_buf
, buf_len
);
358 dev_err(dev
, "Invalid config, cannot upload\n");
362 /* Prevent PHY jabbering during switch reset by inhibiting
363 * Tx on all ports and waiting for current packet to drain.
364 * Otherwise, the PHY will see an unterminated Ethernet packet.
366 rc
= sja1105_inhibit_tx(priv
, port_bitmap
, true);
368 dev_err(dev
, "Failed to inhibit Tx on ports\n");
372 /* Wait for an eventual egress packet to finish transmission
373 * (reach IFG). It is guaranteed that a second one will not
374 * follow, and that switch cold reset is thus safe
376 usleep_range(500, 1000);
378 /* Put the SJA1105 in programming mode */
379 rc
= priv
->info
->reset_cmd(priv
->ds
);
381 dev_err(dev
, "Failed to reset switch, retrying...\n");
384 /* Wait for the switch to come out of reset */
385 usleep_range(1000, 5000);
386 /* Upload the static config to the device */
387 rc
= sja1105_xfer_buf(priv
, SPI_WRITE
, regs
->config
,
388 config_buf
, buf_len
);
390 dev_err(dev
, "Failed to upload config, retrying...\n");
393 /* Check that SJA1105 responded well to the config upload */
394 rc
= sja1105_status_get(priv
, &status
);
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
);
404 if (status
.crcchkl
== 1) {
405 dev_err(dev
, "Switch reported invalid local CRC on "
406 "the uploaded config, retrying...\n");
409 if (status
.crcchkg
== 1) {
410 dev_err(dev
, "Switch reported invalid global CRC on "
411 "the uploaded config, retrying...\n");
414 if (status
.configs
== 0) {
415 dev_err(dev
, "Switch reported that configuration is "
416 "invalid, retrying...\n");
425 dev_err(dev
, "Failed to upload config to device, giving up\n");
427 } else if (retries
!= RETRIES
) {
428 dev_info(dev
, "Succeeded after %d tried\n", RETRIES
- retries
);
436 static struct sja1105_regs sja1105et_regs
= {
440 .port_control
= 0x11,
441 .vl_status
= 0x10000,
444 /* UM10944.pdf, Table 86, ACU Register overview */
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 /* UM10944.pdf, Table 78, CGU Register overview */
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, /* Spans 0x12 to 0x13 */
465 .ptpclkval
= 0x18, /* Spans 0x18 to 0x19 */
470 static struct sja1105_regs sja1105pqrs_regs
= {
474 .port_control
= 0x12,
475 .vl_status
= 0x10000,
478 /* UM10944.pdf, Table 86, ACU Register overview */
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},
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 /* UM11040.pdf, Table 114 */
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, /* Spans 0x13 to 0x14 */
509 const 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
,
516 .ptpegr_ts_bytes
= 4,
517 .num_cbs_shapers
= SJA1105ET_MAX_CBS_COUNT
,
518 .reset_cmd
= sja1105et_reset_cmd
,
519 .fdb_add_cmd
= sja1105et_fdb_add
,
520 .fdb_del_cmd
= sja1105et_fdb_del
,
521 .ptp_cmd_packing
= sja1105et_ptp_cmd_packing
,
522 .regs
= &sja1105et_regs
,
526 const struct sja1105_info sja1105t_info
= {
527 .device_id
= SJA1105T_DEVICE_ID
,
528 .part_no
= SJA1105ET_PART_NO
,
529 .static_ops
= sja1105t_table_ops
,
530 .dyn_ops
= sja1105et_dyn_ops
,
531 .qinq_tpid
= ETH_P_8021Q
,
533 .ptpegr_ts_bytes
= 4,
534 .num_cbs_shapers
= SJA1105ET_MAX_CBS_COUNT
,
535 .reset_cmd
= sja1105et_reset_cmd
,
536 .fdb_add_cmd
= sja1105et_fdb_add
,
537 .fdb_del_cmd
= sja1105et_fdb_del
,
538 .ptp_cmd_packing
= sja1105et_ptp_cmd_packing
,
539 .regs
= &sja1105et_regs
,
543 const struct sja1105_info sja1105p_info
= {
544 .device_id
= SJA1105PR_DEVICE_ID
,
545 .part_no
= SJA1105P_PART_NO
,
546 .static_ops
= sja1105p_table_ops
,
547 .dyn_ops
= sja1105pqrs_dyn_ops
,
548 .qinq_tpid
= ETH_P_8021AD
,
550 .ptpegr_ts_bytes
= 8,
551 .num_cbs_shapers
= SJA1105PQRS_MAX_CBS_COUNT
,
552 .setup_rgmii_delay
= sja1105pqrs_setup_rgmii_delay
,
553 .reset_cmd
= sja1105pqrs_reset_cmd
,
554 .fdb_add_cmd
= sja1105pqrs_fdb_add
,
555 .fdb_del_cmd
= sja1105pqrs_fdb_del
,
556 .ptp_cmd_packing
= sja1105pqrs_ptp_cmd_packing
,
557 .regs
= &sja1105pqrs_regs
,
561 const struct sja1105_info sja1105q_info
= {
562 .device_id
= SJA1105QS_DEVICE_ID
,
563 .part_no
= SJA1105Q_PART_NO
,
564 .static_ops
= sja1105q_table_ops
,
565 .dyn_ops
= sja1105pqrs_dyn_ops
,
566 .qinq_tpid
= ETH_P_8021AD
,
568 .ptpegr_ts_bytes
= 8,
569 .num_cbs_shapers
= SJA1105PQRS_MAX_CBS_COUNT
,
570 .setup_rgmii_delay
= sja1105pqrs_setup_rgmii_delay
,
571 .reset_cmd
= sja1105pqrs_reset_cmd
,
572 .fdb_add_cmd
= sja1105pqrs_fdb_add
,
573 .fdb_del_cmd
= sja1105pqrs_fdb_del
,
574 .ptp_cmd_packing
= sja1105pqrs_ptp_cmd_packing
,
575 .regs
= &sja1105pqrs_regs
,
579 const struct sja1105_info sja1105r_info
= {
580 .device_id
= SJA1105PR_DEVICE_ID
,
581 .part_no
= SJA1105R_PART_NO
,
582 .static_ops
= sja1105r_table_ops
,
583 .dyn_ops
= sja1105pqrs_dyn_ops
,
584 .qinq_tpid
= ETH_P_8021AD
,
586 .ptpegr_ts_bytes
= 8,
587 .num_cbs_shapers
= SJA1105PQRS_MAX_CBS_COUNT
,
588 .setup_rgmii_delay
= sja1105pqrs_setup_rgmii_delay
,
589 .reset_cmd
= sja1105pqrs_reset_cmd
,
590 .fdb_add_cmd
= sja1105pqrs_fdb_add
,
591 .fdb_del_cmd
= sja1105pqrs_fdb_del
,
592 .ptp_cmd_packing
= sja1105pqrs_ptp_cmd_packing
,
593 .regs
= &sja1105pqrs_regs
,
597 const struct sja1105_info sja1105s_info
= {
598 .device_id
= SJA1105QS_DEVICE_ID
,
599 .part_no
= SJA1105S_PART_NO
,
600 .static_ops
= sja1105s_table_ops
,
601 .dyn_ops
= sja1105pqrs_dyn_ops
,
602 .regs
= &sja1105pqrs_regs
,
603 .qinq_tpid
= ETH_P_8021AD
,
605 .ptpegr_ts_bytes
= 8,
606 .num_cbs_shapers
= SJA1105PQRS_MAX_CBS_COUNT
,
607 .setup_rgmii_delay
= sja1105pqrs_setup_rgmii_delay
,
608 .reset_cmd
= sja1105pqrs_reset_cmd
,
609 .fdb_add_cmd
= sja1105pqrs_fdb_add
,
610 .fdb_del_cmd
= sja1105pqrs_fdb_del
,
611 .ptp_cmd_packing
= sja1105pqrs_ptp_cmd_packing
,