2 * Copyright (c) 2014-2015 Hisilicon Limited.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
10 #include "hns_dsaf_mac.h"
11 #include "hns_dsaf_misc.h"
12 #include "hns_dsaf_ppe.h"
13 #include "hns_dsaf_reg.h"
16 HNS_OP_RESET_FUNC
= 0x1,
17 HNS_OP_SERDES_LP_FUNC
= 0x2,
18 HNS_OP_LED_SET_FUNC
= 0x3,
19 HNS_OP_GET_PORT_TYPE_FUNC
= 0x4,
20 HNS_OP_GET_SFP_STAT_FUNC
= 0x5,
24 HNS_DSAF_RESET_FUNC
= 0x1,
25 HNS_PPE_RESET_FUNC
= 0x2,
26 HNS_XGE_RESET_FUNC
= 0x4,
27 HNS_GE_RESET_FUNC
= 0x5,
28 HNS_DSAF_CHN_RESET_FUNC
= 0x6,
29 HNS_ROCE_RESET_FUNC
= 0x7,
32 const u8 hns_dsaf_acpi_dsm_uuid
[] = {
33 0x1A, 0xAA, 0x85, 0x1A, 0x93, 0xE2, 0x5E, 0x41,
34 0x8E, 0x28, 0x8D, 0x69, 0x0A, 0x0F, 0x82, 0x0A
37 static void dsaf_write_sub(struct dsaf_device
*dsaf_dev
, u32 reg
, u32 val
)
39 if (dsaf_dev
->sub_ctrl
)
40 dsaf_write_syscon(dsaf_dev
->sub_ctrl
, reg
, val
);
42 dsaf_write_reg(dsaf_dev
->sc_base
, reg
, val
);
45 static u32
dsaf_read_sub(struct dsaf_device
*dsaf_dev
, u32 reg
)
49 if (dsaf_dev
->sub_ctrl
)
50 ret
= dsaf_read_syscon(dsaf_dev
->sub_ctrl
, reg
);
52 ret
= dsaf_read_reg(dsaf_dev
->sc_base
, reg
);
57 static void hns_cpld_set_led(struct hns_mac_cb
*mac_cb
, int link_status
,
64 pr_err("sfp_led_opt mac_dev is null!\n");
67 if (!mac_cb
->cpld_ctrl
) {
68 dev_err(mac_cb
->dev
, "mac_id=%d, cpld syscon is null !\n",
73 if (speed
== MAC_SPEED_10000
)
76 value
= mac_cb
->cpld_led_value
;
79 dsaf_set_bit(value
, DSAF_LED_LINK_B
, link_status
);
80 dsaf_set_field(value
, DSAF_LED_SPEED_M
,
81 DSAF_LED_SPEED_S
, speed_reg
);
82 dsaf_set_bit(value
, DSAF_LED_DATA_B
, data
);
84 if (value
!= mac_cb
->cpld_led_value
) {
85 dsaf_write_syscon(mac_cb
->cpld_ctrl
,
86 mac_cb
->cpld_ctrl_reg
, value
);
87 mac_cb
->cpld_led_value
= value
;
90 value
= (mac_cb
->cpld_led_value
) & (0x1 << DSAF_LED_ANCHOR_B
);
91 dsaf_write_syscon(mac_cb
->cpld_ctrl
,
92 mac_cb
->cpld_ctrl_reg
, value
);
93 mac_cb
->cpld_led_value
= value
;
97 static void cpld_led_reset(struct hns_mac_cb
*mac_cb
)
99 if (!mac_cb
|| !mac_cb
->cpld_ctrl
)
102 dsaf_write_syscon(mac_cb
->cpld_ctrl
, mac_cb
->cpld_ctrl_reg
,
103 CPLD_LED_DEFAULT_VALUE
);
104 mac_cb
->cpld_led_value
= CPLD_LED_DEFAULT_VALUE
;
107 static int cpld_set_led_id(struct hns_mac_cb
*mac_cb
,
108 enum hnae_led_state status
)
111 case HNAE_LED_ACTIVE
:
112 mac_cb
->cpld_led_value
=
113 dsaf_read_syscon(mac_cb
->cpld_ctrl
,
114 mac_cb
->cpld_ctrl_reg
);
115 dsaf_set_bit(mac_cb
->cpld_led_value
, DSAF_LED_ANCHOR_B
,
117 dsaf_write_syscon(mac_cb
->cpld_ctrl
, mac_cb
->cpld_ctrl_reg
,
118 mac_cb
->cpld_led_value
);
120 case HNAE_LED_INACTIVE
:
121 dsaf_set_bit(mac_cb
->cpld_led_value
, DSAF_LED_ANCHOR_B
,
122 CPLD_LED_DEFAULT_VALUE
);
123 dsaf_write_syscon(mac_cb
->cpld_ctrl
, mac_cb
->cpld_ctrl_reg
,
124 mac_cb
->cpld_led_value
);
127 dev_err(mac_cb
->dev
, "invalid led state: %d!", status
);
134 #define RESET_REQ_OR_DREQ 1
136 static void hns_dsaf_acpi_srst_by_port(struct dsaf_device
*dsaf_dev
, u8 op_type
,
137 u32 port_type
, u32 port
, u32 val
)
139 union acpi_object
*obj
;
140 union acpi_object obj_args
[3], argv4
;
142 obj_args
[0].integer
.type
= ACPI_TYPE_INTEGER
;
143 obj_args
[0].integer
.value
= port_type
;
144 obj_args
[1].integer
.type
= ACPI_TYPE_INTEGER
;
145 obj_args
[1].integer
.value
= port
;
146 obj_args
[2].integer
.type
= ACPI_TYPE_INTEGER
;
147 obj_args
[2].integer
.value
= val
;
149 argv4
.type
= ACPI_TYPE_PACKAGE
;
150 argv4
.package
.count
= 3;
151 argv4
.package
.elements
= obj_args
;
153 obj
= acpi_evaluate_dsm(ACPI_HANDLE(dsaf_dev
->dev
),
154 hns_dsaf_acpi_dsm_uuid
, 0, op_type
, &argv4
);
156 dev_warn(dsaf_dev
->dev
, "reset port_type%d port%d fail!",
164 static void hns_dsaf_rst(struct dsaf_device
*dsaf_dev
, bool dereset
)
170 xbar_reg_addr
= DSAF_SUB_SC_XBAR_RESET_REQ_REG
;
171 nt_reg_addr
= DSAF_SUB_SC_NT_RESET_REQ_REG
;
173 xbar_reg_addr
= DSAF_SUB_SC_XBAR_RESET_DREQ_REG
;
174 nt_reg_addr
= DSAF_SUB_SC_NT_RESET_DREQ_REG
;
177 dsaf_write_sub(dsaf_dev
, xbar_reg_addr
, RESET_REQ_OR_DREQ
);
178 dsaf_write_sub(dsaf_dev
, nt_reg_addr
, RESET_REQ_OR_DREQ
);
181 static void hns_dsaf_rst_acpi(struct dsaf_device
*dsaf_dev
, bool dereset
)
183 hns_dsaf_acpi_srst_by_port(dsaf_dev
, HNS_OP_RESET_FUNC
,
188 static void hns_dsaf_xge_srst_by_port(struct dsaf_device
*dsaf_dev
, u32 port
,
194 if (port
>= DSAF_XGE_NUM
)
197 reg_val
|= RESET_REQ_OR_DREQ
;
198 reg_val
|= 0x2082082 << dsaf_dev
->mac_cb
[port
]->port_rst_off
;
201 reg_addr
= DSAF_SUB_SC_XGE_RESET_REQ_REG
;
203 reg_addr
= DSAF_SUB_SC_XGE_RESET_DREQ_REG
;
205 dsaf_write_sub(dsaf_dev
, reg_addr
, reg_val
);
208 static void hns_dsaf_xge_srst_by_port_acpi(struct dsaf_device
*dsaf_dev
,
209 u32 port
, bool dereset
)
211 hns_dsaf_acpi_srst_by_port(dsaf_dev
, HNS_OP_RESET_FUNC
,
212 HNS_XGE_RESET_FUNC
, port
, dereset
);
216 * hns_dsaf_srst_chns - reset dsaf channels
217 * @dsaf_dev: dsaf device struct pointer
218 * @msk: xbar channels mask value:
221 * bit12-17 for roce0-5
222 * bit18-19 for com/dfx
223 * @enable: false - request reset , true - drop reset
225 void hns_dsaf_srst_chns(struct dsaf_device
*dsaf_dev
, u32 msk
, bool dereset
)
230 reg_addr
= DSAF_SUB_SC_DSAF_RESET_REQ_REG
;
232 reg_addr
= DSAF_SUB_SC_DSAF_RESET_DREQ_REG
;
234 dsaf_write_sub(dsaf_dev
, reg_addr
, msk
);
238 * hns_dsaf_srst_chns - reset dsaf channels
239 * @dsaf_dev: dsaf device struct pointer
240 * @msk: xbar channels mask value:
243 * bit12-17 for roce0-5
244 * bit18-19 for com/dfx
245 * @enable: false - request reset , true - drop reset
248 hns_dsaf_srst_chns_acpi(struct dsaf_device
*dsaf_dev
, u32 msk
, bool dereset
)
250 hns_dsaf_acpi_srst_by_port(dsaf_dev
, HNS_OP_RESET_FUNC
,
251 HNS_DSAF_CHN_RESET_FUNC
,
255 void hns_dsaf_roce_srst(struct dsaf_device
*dsaf_dev
, bool dereset
)
258 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_ROCEE_RESET_REQ_REG
, 1);
260 dsaf_write_sub(dsaf_dev
,
261 DSAF_SUB_SC_ROCEE_CLK_DIS_REG
, 1);
262 dsaf_write_sub(dsaf_dev
,
263 DSAF_SUB_SC_ROCEE_RESET_DREQ_REG
, 1);
265 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_ROCEE_CLK_EN_REG
, 1);
269 void hns_dsaf_roce_srst_acpi(struct dsaf_device
*dsaf_dev
, bool dereset
)
271 hns_dsaf_acpi_srst_by_port(dsaf_dev
, HNS_OP_RESET_FUNC
,
272 HNS_ROCE_RESET_FUNC
, 0, dereset
);
275 static void hns_dsaf_ge_srst_by_port(struct dsaf_device
*dsaf_dev
, u32 port
,
282 if (port
>= DSAF_GE_NUM
)
285 if (!HNS_DSAF_IS_DEBUG(dsaf_dev
)) {
286 reg_val_1
= 0x1 << port
;
287 port_rst_off
= dsaf_dev
->mac_cb
[port
]->port_rst_off
;
288 /* there is difference between V1 and V2 in register.*/
289 reg_val_2
= AE_IS_VER1(dsaf_dev
->dsaf_ver
) ?
290 0x1041041 : 0x2082082;
291 reg_val_2
<<= port_rst_off
;
294 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_GE_RESET_REQ1_REG
,
297 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_GE_RESET_REQ0_REG
,
300 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_GE_RESET_DREQ0_REG
,
303 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_GE_RESET_DREQ1_REG
,
308 reg_val_2
= AE_IS_VER1(dsaf_dev
->dsaf_ver
) ? 0x100 : 0x40;
310 reg_val_1
<<= dsaf_dev
->reset_offset
;
311 reg_val_2
<<= dsaf_dev
->reset_offset
;
314 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_GE_RESET_REQ1_REG
,
317 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_PPE_RESET_REQ_REG
,
320 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_GE_RESET_DREQ1_REG
,
323 dsaf_write_sub(dsaf_dev
, DSAF_SUB_SC_PPE_RESET_DREQ_REG
,
329 static void hns_dsaf_ge_srst_by_port_acpi(struct dsaf_device
*dsaf_dev
,
330 u32 port
, bool dereset
)
332 hns_dsaf_acpi_srst_by_port(dsaf_dev
, HNS_OP_RESET_FUNC
,
333 HNS_GE_RESET_FUNC
, port
, dereset
);
336 static void hns_ppe_srst_by_port(struct dsaf_device
*dsaf_dev
, u32 port
,
342 reg_val
|= RESET_REQ_OR_DREQ
<< dsaf_dev
->mac_cb
[port
]->port_rst_off
;
345 reg_addr
= DSAF_SUB_SC_PPE_RESET_REQ_REG
;
347 reg_addr
= DSAF_SUB_SC_PPE_RESET_DREQ_REG
;
349 dsaf_write_sub(dsaf_dev
, reg_addr
, reg_val
);
353 hns_ppe_srst_by_port_acpi(struct dsaf_device
*dsaf_dev
, u32 port
, bool dereset
)
355 hns_dsaf_acpi_srst_by_port(dsaf_dev
, HNS_OP_RESET_FUNC
,
356 HNS_PPE_RESET_FUNC
, port
, dereset
);
359 static void hns_ppe_com_srst(struct dsaf_device
*dsaf_dev
, bool dereset
)
364 if (!(dev_of_node(dsaf_dev
->dev
)))
367 if (!HNS_DSAF_IS_DEBUG(dsaf_dev
)) {
368 reg_val
= RESET_REQ_OR_DREQ
;
370 reg_addr
= DSAF_SUB_SC_RCB_PPE_COM_RESET_REQ_REG
;
372 reg_addr
= DSAF_SUB_SC_RCB_PPE_COM_RESET_DREQ_REG
;
375 reg_val
= 0x100 << dsaf_dev
->reset_offset
;
378 reg_addr
= DSAF_SUB_SC_PPE_RESET_REQ_REG
;
380 reg_addr
= DSAF_SUB_SC_PPE_RESET_DREQ_REG
;
383 dsaf_write_sub(dsaf_dev
, reg_addr
, reg_val
);
387 * hns_mac_get_sds_mode - get phy ifterface form serdes mode
388 * @mac_cb: mac control block
389 * retuen phy interface
391 static phy_interface_t
hns_mac_get_phy_if(struct hns_mac_cb
*mac_cb
)
395 bool is_ver1
= AE_IS_VER1(mac_cb
->dsaf_dev
->dsaf_ver
);
396 int mac_id
= mac_cb
->mac_id
;
397 phy_interface_t phy_if
;
400 if (HNS_DSAF_IS_DEBUG(mac_cb
->dsaf_dev
))
401 return PHY_INTERFACE_MODE_SGMII
;
403 if (mac_id
>= 0 && mac_id
<= 3)
404 reg
= HNS_MAC_HILINK4_REG
;
406 reg
= HNS_MAC_HILINK3_REG
;
408 if (!HNS_DSAF_IS_DEBUG(mac_cb
->dsaf_dev
) && mac_id
<= 3)
409 reg
= HNS_MAC_HILINK4V2_REG
;
411 reg
= HNS_MAC_HILINK3V2_REG
;
414 mode
= dsaf_read_sub(mac_cb
->dsaf_dev
, reg
);
415 if (dsaf_get_bit(mode
, mac_cb
->port_mode_off
))
416 phy_if
= PHY_INTERFACE_MODE_XGMII
;
418 phy_if
= PHY_INTERFACE_MODE_SGMII
;
423 static phy_interface_t
hns_mac_get_phy_if_acpi(struct hns_mac_cb
*mac_cb
)
425 phy_interface_t phy_if
= PHY_INTERFACE_MODE_NA
;
426 union acpi_object
*obj
;
427 union acpi_object obj_args
, argv4
;
429 obj_args
.integer
.type
= ACPI_TYPE_INTEGER
;
430 obj_args
.integer
.value
= mac_cb
->mac_id
;
432 argv4
.type
= ACPI_TYPE_PACKAGE
,
433 argv4
.package
.count
= 1,
434 argv4
.package
.elements
= &obj_args
,
436 obj
= acpi_evaluate_dsm(ACPI_HANDLE(mac_cb
->dev
),
437 hns_dsaf_acpi_dsm_uuid
, 0,
438 HNS_OP_GET_PORT_TYPE_FUNC
, &argv4
);
440 if (!obj
|| obj
->type
!= ACPI_TYPE_INTEGER
)
443 phy_if
= obj
->integer
.value
?
444 PHY_INTERFACE_MODE_XGMII
: PHY_INTERFACE_MODE_SGMII
;
446 dev_dbg(mac_cb
->dev
, "mac_id=%d, phy_if=%d\n", mac_cb
->mac_id
, phy_if
);
453 int hns_mac_get_sfp_prsnt(struct hns_mac_cb
*mac_cb
, int *sfp_prsnt
)
455 if (!mac_cb
->cpld_ctrl
)
458 *sfp_prsnt
= !dsaf_read_syscon(mac_cb
->cpld_ctrl
, mac_cb
->cpld_ctrl_reg
459 + MAC_SFP_PORT_OFFSET
);
465 * hns_mac_config_sds_loopback - set loop back for serdes
466 * @mac_cb: mac control block
467 * retuen 0 == success
469 static int hns_mac_config_sds_loopback(struct hns_mac_cb
*mac_cb
, bool en
)
471 const u8 lane_id
[] = {
472 0, /* mac 0 -> lane 0 */
473 1, /* mac 1 -> lane 1 */
474 2, /* mac 2 -> lane 2 */
475 3, /* mac 3 -> lane 3 */
476 2, /* mac 4 -> lane 2 */
477 3, /* mac 5 -> lane 3 */
478 0, /* mac 6 -> lane 0 */
479 1 /* mac 7 -> lane 1 */
481 #define RX_CSR(lane, reg) ((0x4080 + (reg) * 0x0002 + (lane) * 0x0200) * 2)
482 u64 reg_offset
= RX_CSR(lane_id
[mac_cb
->mac_id
], 0);
485 int ret
= hns_mac_get_sfp_prsnt(mac_cb
, &sfp_prsnt
);
487 if (!mac_cb
->phy_dev
) {
489 pr_info("please confirm sfp is present or not\n");
492 pr_info("no sfp in this eth\n");
495 if (mac_cb
->serdes_ctrl
) {
498 if (!AE_IS_VER1(mac_cb
->dsaf_dev
->dsaf_ver
)) {
499 #define HILINK_ACCESS_SEL_CFG 0x40008
500 /* hilink4 & hilink3 use the same xge training and
501 * xge u adaptor. There is a hilink access sel cfg
502 * register to select which one to be configed
504 if ((!HNS_DSAF_IS_DEBUG(mac_cb
->dsaf_dev
)) &&
505 (mac_cb
->mac_id
<= 3))
506 dsaf_write_syscon(mac_cb
->serdes_ctrl
,
507 HILINK_ACCESS_SEL_CFG
, 0);
509 dsaf_write_syscon(mac_cb
->serdes_ctrl
,
510 HILINK_ACCESS_SEL_CFG
, 3);
513 origin
= dsaf_read_syscon(mac_cb
->serdes_ctrl
, reg_offset
);
515 dsaf_set_field(origin
, 1ull << 10, 10, en
);
516 dsaf_write_syscon(mac_cb
->serdes_ctrl
, reg_offset
, origin
);
518 u8
*base_addr
= (u8
*)mac_cb
->serdes_vaddr
+
519 (mac_cb
->mac_id
<= 3 ? 0x00280000 : 0x00200000);
520 dsaf_set_reg_field(base_addr
, reg_offset
, 1ull << 10, 10, en
);
527 hns_mac_config_sds_loopback_acpi(struct hns_mac_cb
*mac_cb
, bool en
)
529 union acpi_object
*obj
;
530 union acpi_object obj_args
[3], argv4
;
532 obj_args
[0].integer
.type
= ACPI_TYPE_INTEGER
;
533 obj_args
[0].integer
.value
= mac_cb
->mac_id
;
534 obj_args
[1].integer
.type
= ACPI_TYPE_INTEGER
;
535 obj_args
[1].integer
.value
= !!en
;
537 argv4
.type
= ACPI_TYPE_PACKAGE
;
538 argv4
.package
.count
= 2;
539 argv4
.package
.elements
= obj_args
;
541 obj
= acpi_evaluate_dsm(ACPI_HANDLE(mac_cb
->dsaf_dev
->dev
),
542 hns_dsaf_acpi_dsm_uuid
, 0,
543 HNS_OP_SERDES_LP_FUNC
, &argv4
);
545 dev_warn(mac_cb
->dsaf_dev
->dev
, "set port%d serdes lp fail!",
556 struct dsaf_misc_op
*hns_misc_op_get(struct dsaf_device
*dsaf_dev
)
558 struct dsaf_misc_op
*misc_op
;
560 misc_op
= devm_kzalloc(dsaf_dev
->dev
, sizeof(*misc_op
), GFP_KERNEL
);
564 if (dev_of_node(dsaf_dev
->dev
)) {
565 misc_op
->cpld_set_led
= hns_cpld_set_led
;
566 misc_op
->cpld_reset_led
= cpld_led_reset
;
567 misc_op
->cpld_set_led_id
= cpld_set_led_id
;
569 misc_op
->dsaf_reset
= hns_dsaf_rst
;
570 misc_op
->xge_srst
= hns_dsaf_xge_srst_by_port
;
571 misc_op
->ge_srst
= hns_dsaf_ge_srst_by_port
;
572 misc_op
->ppe_srst
= hns_ppe_srst_by_port
;
573 misc_op
->ppe_comm_srst
= hns_ppe_com_srst
;
574 misc_op
->hns_dsaf_srst_chns
= hns_dsaf_srst_chns
;
575 misc_op
->hns_dsaf_roce_srst
= hns_dsaf_roce_srst
;
577 misc_op
->get_phy_if
= hns_mac_get_phy_if
;
578 misc_op
->get_sfp_prsnt
= hns_mac_get_sfp_prsnt
;
580 misc_op
->cfg_serdes_loopback
= hns_mac_config_sds_loopback
;
581 } else if (is_acpi_node(dsaf_dev
->dev
->fwnode
)) {
582 misc_op
->cpld_set_led
= hns_cpld_set_led
;
583 misc_op
->cpld_reset_led
= cpld_led_reset
;
584 misc_op
->cpld_set_led_id
= cpld_set_led_id
;
586 misc_op
->dsaf_reset
= hns_dsaf_rst_acpi
;
587 misc_op
->xge_srst
= hns_dsaf_xge_srst_by_port_acpi
;
588 misc_op
->ge_srst
= hns_dsaf_ge_srst_by_port_acpi
;
589 misc_op
->ppe_srst
= hns_ppe_srst_by_port_acpi
;
590 misc_op
->ppe_comm_srst
= hns_ppe_com_srst
;
591 misc_op
->hns_dsaf_srst_chns
= hns_dsaf_srst_chns_acpi
;
592 misc_op
->hns_dsaf_roce_srst
= hns_dsaf_roce_srst_acpi
;
594 misc_op
->get_phy_if
= hns_mac_get_phy_if_acpi
;
595 misc_op
->get_sfp_prsnt
= hns_mac_get_sfp_prsnt
;
597 misc_op
->cfg_serdes_loopback
= hns_mac_config_sds_loopback_acpi
;
599 devm_kfree(dsaf_dev
->dev
, (void *)misc_op
);
603 return (void *)misc_op
;
606 static int hns_dsaf_dev_match(struct device
*dev
, void *fwnode
)
608 return dev
->fwnode
== fwnode
;
612 platform_device
*hns_dsaf_find_platform_device(struct fwnode_handle
*fwnode
)
616 dev
= bus_find_device(&platform_bus_type
, NULL
,
617 fwnode
, hns_dsaf_dev_match
);
618 return dev
? to_platform_device(dev
) : NULL
;