772 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Copyright (c) 2014-2015 Hisilicon Limited.4 */5 6#include "hns_dsaf_mac.h"7#include "hns_dsaf_misc.h"8#include "hns_dsaf_ppe.h"9#include "hns_dsaf_reg.h"10 11enum _dsm_op_index {12 HNS_OP_RESET_FUNC = 0x1,13 HNS_OP_SERDES_LP_FUNC = 0x2,14 HNS_OP_LED_SET_FUNC = 0x3,15 HNS_OP_GET_PORT_TYPE_FUNC = 0x4,16 HNS_OP_GET_SFP_STAT_FUNC = 0x5,17 HNS_OP_LOCATE_LED_SET_FUNC = 0x6,18};19 20enum _dsm_rst_type {21 HNS_DSAF_RESET_FUNC = 0x1,22 HNS_PPE_RESET_FUNC = 0x2,23 HNS_XGE_RESET_FUNC = 0x4,24 HNS_GE_RESET_FUNC = 0x5,25 HNS_DSAF_CHN_RESET_FUNC = 0x6,26 HNS_ROCE_RESET_FUNC = 0x7,27};28 29static const guid_t hns_dsaf_acpi_dsm_guid =30 GUID_INIT(0x1A85AA1A, 0xE293, 0x415E,31 0x8E, 0x28, 0x8D, 0x69, 0x0A, 0x0F, 0x82, 0x0A);32 33static void dsaf_write_sub(struct dsaf_device *dsaf_dev, u32 reg, u32 val)34{35 if (dsaf_dev->sub_ctrl)36 dsaf_write_syscon(dsaf_dev->sub_ctrl, reg, val);37 else38 dsaf_write_reg(dsaf_dev->sc_base, reg, val);39}40 41static u32 dsaf_read_sub(struct dsaf_device *dsaf_dev, u32 reg)42{43 u32 ret = 0;44 int err;45 46 if (dsaf_dev->sub_ctrl) {47 err = dsaf_read_syscon(dsaf_dev->sub_ctrl, reg, &ret);48 if (err)49 dev_err(dsaf_dev->dev, "dsaf_read_syscon error %d!\n",50 err);51 } else {52 ret = dsaf_read_reg(dsaf_dev->sc_base, reg);53 }54 55 return ret;56}57 58static void hns_dsaf_acpi_ledctrl_by_port(struct hns_mac_cb *mac_cb, u8 op_type,59 u32 link, u32 port, u32 act)60{61 union acpi_object *obj;62 union acpi_object obj_args[3], argv4;63 64 obj_args[0].integer.type = ACPI_TYPE_INTEGER;65 obj_args[0].integer.value = link;66 obj_args[1].integer.type = ACPI_TYPE_INTEGER;67 obj_args[1].integer.value = port;68 obj_args[2].integer.type = ACPI_TYPE_INTEGER;69 obj_args[2].integer.value = act;70 71 argv4.type = ACPI_TYPE_PACKAGE;72 argv4.package.count = 3;73 argv4.package.elements = obj_args;74 75 obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dev),76 &hns_dsaf_acpi_dsm_guid, 0, op_type, &argv4);77 if (!obj) {78 dev_warn(mac_cb->dev, "ledctrl fail, link:%d port:%d act:%d!\n",79 link, port, act);80 return;81 }82 83 ACPI_FREE(obj);84}85 86static void hns_dsaf_acpi_locate_ledctrl_by_port(struct hns_mac_cb *mac_cb,87 u8 op_type, u32 locate,88 u32 port)89{90 union acpi_object obj_args[2], argv4;91 union acpi_object *obj;92 93 obj_args[0].integer.type = ACPI_TYPE_INTEGER;94 obj_args[0].integer.value = locate;95 obj_args[1].integer.type = ACPI_TYPE_INTEGER;96 obj_args[1].integer.value = port;97 98 argv4.type = ACPI_TYPE_PACKAGE;99 argv4.package.count = 2;100 argv4.package.elements = obj_args;101 102 obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dev),103 &hns_dsaf_acpi_dsm_guid, 0, op_type, &argv4);104 if (!obj) {105 dev_err(mac_cb->dev, "ledctrl fail, locate:%d port:%d!\n",106 locate, port);107 return;108 }109 110 ACPI_FREE(obj);111}112 113static void hns_cpld_set_led(struct hns_mac_cb *mac_cb, int link_status,114 u16 speed, int data)115{116 int speed_reg = 0;117 u8 value;118 119 if (!mac_cb) {120 pr_err("sfp_led_opt mac_dev is null!\n");121 return;122 }123 if (!mac_cb->cpld_ctrl) {124 dev_err(mac_cb->dev, "mac_id=%d, cpld syscon is null !\n",125 mac_cb->mac_id);126 return;127 }128 129 if (speed == MAC_SPEED_10000)130 speed_reg = 1;131 132 value = mac_cb->cpld_led_value;133 134 if (link_status) {135 dsaf_set_bit(value, DSAF_LED_LINK_B, link_status);136 dsaf_set_field(value, DSAF_LED_SPEED_M,137 DSAF_LED_SPEED_S, speed_reg);138 dsaf_set_bit(value, DSAF_LED_DATA_B, data);139 140 if (value != mac_cb->cpld_led_value) {141 dsaf_write_syscon(mac_cb->cpld_ctrl,142 mac_cb->cpld_ctrl_reg, value);143 mac_cb->cpld_led_value = value;144 }145 } else {146 value = (mac_cb->cpld_led_value) & (0x1 << DSAF_LED_ANCHOR_B);147 dsaf_write_syscon(mac_cb->cpld_ctrl,148 mac_cb->cpld_ctrl_reg, value);149 mac_cb->cpld_led_value = value;150 }151}152 153static void hns_cpld_set_led_acpi(struct hns_mac_cb *mac_cb, int link_status,154 u16 speed, int data)155{156 if (!mac_cb) {157 pr_err("cpld_led_set mac_cb is null!\n");158 return;159 }160 161 hns_dsaf_acpi_ledctrl_by_port(mac_cb, HNS_OP_LED_SET_FUNC,162 link_status, mac_cb->mac_id, data);163}164 165static void cpld_led_reset(struct hns_mac_cb *mac_cb)166{167 if (!mac_cb || !mac_cb->cpld_ctrl)168 return;169 170 dsaf_write_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,171 CPLD_LED_DEFAULT_VALUE);172 mac_cb->cpld_led_value = CPLD_LED_DEFAULT_VALUE;173}174 175static void cpld_led_reset_acpi(struct hns_mac_cb *mac_cb)176{177 if (!mac_cb) {178 pr_err("cpld_led_reset mac_cb is null!\n");179 return;180 }181 182 if (mac_cb->media_type != HNAE_MEDIA_TYPE_FIBER)183 return;184 185 hns_dsaf_acpi_ledctrl_by_port(mac_cb, HNS_OP_LED_SET_FUNC,186 0, mac_cb->mac_id, 0);187}188 189static int cpld_set_led_id(struct hns_mac_cb *mac_cb,190 enum hnae_led_state status)191{192 u32 val = 0;193 int ret;194 195 if (!mac_cb->cpld_ctrl)196 return 0;197 198 switch (status) {199 case HNAE_LED_ACTIVE:200 ret = dsaf_read_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,201 &val);202 if (ret)203 return ret;204 205 dsaf_set_bit(val, DSAF_LED_ANCHOR_B, CPLD_LED_ON_VALUE);206 dsaf_write_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,207 val);208 mac_cb->cpld_led_value = val;209 break;210 case HNAE_LED_INACTIVE:211 dsaf_set_bit(mac_cb->cpld_led_value, DSAF_LED_ANCHOR_B,212 CPLD_LED_DEFAULT_VALUE);213 dsaf_write_syscon(mac_cb->cpld_ctrl, mac_cb->cpld_ctrl_reg,214 mac_cb->cpld_led_value);215 break;216 default:217 dev_err(mac_cb->dev, "invalid led state: %d!", status);218 return -EINVAL;219 }220 221 return 0;222}223 224static int cpld_set_led_id_acpi(struct hns_mac_cb *mac_cb,225 enum hnae_led_state status)226{227 switch (status) {228 case HNAE_LED_ACTIVE:229 hns_dsaf_acpi_locate_ledctrl_by_port(mac_cb,230 HNS_OP_LOCATE_LED_SET_FUNC,231 CPLD_LED_ON_VALUE,232 mac_cb->mac_id);233 break;234 case HNAE_LED_INACTIVE:235 hns_dsaf_acpi_locate_ledctrl_by_port(mac_cb,236 HNS_OP_LOCATE_LED_SET_FUNC,237 CPLD_LED_DEFAULT_VALUE,238 mac_cb->mac_id);239 break;240 default:241 dev_err(mac_cb->dev, "invalid led state: %d!", status);242 return -EINVAL;243 }244 245 return 0;246}247 248#define RESET_REQ_OR_DREQ 1249 250static void hns_dsaf_acpi_srst_by_port(struct dsaf_device *dsaf_dev, u8 op_type,251 u32 port_type, u32 port, u32 val)252{253 union acpi_object *obj;254 union acpi_object obj_args[3], argv4;255 256 obj_args[0].integer.type = ACPI_TYPE_INTEGER;257 obj_args[0].integer.value = port_type;258 obj_args[1].integer.type = ACPI_TYPE_INTEGER;259 obj_args[1].integer.value = port;260 obj_args[2].integer.type = ACPI_TYPE_INTEGER;261 obj_args[2].integer.value = val;262 263 argv4.type = ACPI_TYPE_PACKAGE;264 argv4.package.count = 3;265 argv4.package.elements = obj_args;266 267 obj = acpi_evaluate_dsm(ACPI_HANDLE(dsaf_dev->dev),268 &hns_dsaf_acpi_dsm_guid, 0, op_type, &argv4);269 if (!obj) {270 dev_warn(dsaf_dev->dev, "reset port_type%d port%d fail!",271 port_type, port);272 return;273 }274 275 ACPI_FREE(obj);276}277 278static void hns_dsaf_rst(struct dsaf_device *dsaf_dev, bool dereset)279{280 u32 xbar_reg_addr;281 u32 nt_reg_addr;282 283 if (!dereset) {284 xbar_reg_addr = DSAF_SUB_SC_XBAR_RESET_REQ_REG;285 nt_reg_addr = DSAF_SUB_SC_NT_RESET_REQ_REG;286 } else {287 xbar_reg_addr = DSAF_SUB_SC_XBAR_RESET_DREQ_REG;288 nt_reg_addr = DSAF_SUB_SC_NT_RESET_DREQ_REG;289 }290 291 dsaf_write_sub(dsaf_dev, xbar_reg_addr, RESET_REQ_OR_DREQ);292 dsaf_write_sub(dsaf_dev, nt_reg_addr, RESET_REQ_OR_DREQ);293}294 295static void hns_dsaf_rst_acpi(struct dsaf_device *dsaf_dev, bool dereset)296{297 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,298 HNS_DSAF_RESET_FUNC,299 0, dereset);300}301 302static void hns_dsaf_xge_srst_by_port(struct dsaf_device *dsaf_dev, u32 port,303 bool dereset)304{305 u32 reg_val = 0;306 u32 reg_addr;307 308 if (port >= DSAF_XGE_NUM)309 return;310 311 reg_val |= RESET_REQ_OR_DREQ;312 reg_val |= 0x2082082 << dsaf_dev->mac_cb[port]->port_rst_off;313 314 if (!dereset)315 reg_addr = DSAF_SUB_SC_XGE_RESET_REQ_REG;316 else317 reg_addr = DSAF_SUB_SC_XGE_RESET_DREQ_REG;318 319 dsaf_write_sub(dsaf_dev, reg_addr, reg_val);320}321 322static void hns_dsaf_xge_srst_by_port_acpi(struct dsaf_device *dsaf_dev,323 u32 port, bool dereset)324{325 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,326 HNS_XGE_RESET_FUNC, port, dereset);327}328 329/**330 * hns_dsaf_srst_chns - reset dsaf channels331 * @dsaf_dev: dsaf device struct pointer332 * @msk: xbar channels mask value:333 * @dereset: false - request reset , true - drop reset334 *335 * bit0-5 for xge0-5336 * bit6-11 for ppe0-5337 * bit12-17 for roce0-5338 * bit18-19 for com/dfx339 */340static void341hns_dsaf_srst_chns(struct dsaf_device *dsaf_dev, u32 msk, bool dereset)342{343 u32 reg_addr;344 345 if (!dereset)346 reg_addr = DSAF_SUB_SC_DSAF_RESET_REQ_REG;347 else348 reg_addr = DSAF_SUB_SC_DSAF_RESET_DREQ_REG;349 350 dsaf_write_sub(dsaf_dev, reg_addr, msk);351}352 353/**354 * hns_dsaf_srst_chns_acpi - reset dsaf channels355 * @dsaf_dev: dsaf device struct pointer356 * @msk: xbar channels mask value:357 * @dereset: false - request reset , true - drop reset358 *359 * bit0-5 for xge0-5360 * bit6-11 for ppe0-5361 * bit12-17 for roce0-5362 * bit18-19 for com/dfx363 */364static void365hns_dsaf_srst_chns_acpi(struct dsaf_device *dsaf_dev, u32 msk, bool dereset)366{367 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,368 HNS_DSAF_CHN_RESET_FUNC,369 msk, dereset);370}371 372static void hns_dsaf_roce_srst(struct dsaf_device *dsaf_dev, bool dereset)373{374 if (!dereset) {375 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_ROCEE_RESET_REQ_REG, 1);376 } else {377 dsaf_write_sub(dsaf_dev,378 DSAF_SUB_SC_ROCEE_CLK_DIS_REG, 1);379 dsaf_write_sub(dsaf_dev,380 DSAF_SUB_SC_ROCEE_RESET_DREQ_REG, 1);381 msleep(20);382 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_ROCEE_CLK_EN_REG, 1);383 }384}385 386static void hns_dsaf_roce_srst_acpi(struct dsaf_device *dsaf_dev, bool dereset)387{388 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,389 HNS_ROCE_RESET_FUNC, 0, dereset);390}391 392static void hns_dsaf_ge_srst_by_port(struct dsaf_device *dsaf_dev, u32 port,393 bool dereset)394{395 u32 reg_val_1;396 u32 reg_val_2;397 u32 port_rst_off;398 399 if (port >= DSAF_GE_NUM)400 return;401 402 if (!HNS_DSAF_IS_DEBUG(dsaf_dev)) {403 /* DSAF_MAX_PORT_NUM is 6, but DSAF_GE_NUM is 8.404 We need check to prevent array overflow */405 if (port >= DSAF_MAX_PORT_NUM)406 return;407 reg_val_1 = 0x1 << port;408 port_rst_off = dsaf_dev->mac_cb[port]->port_rst_off;409 /* there is difference between V1 and V2 in register.*/410 reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ?411 0x1041041 : 0x2082082;412 reg_val_2 <<= port_rst_off;413 414 if (!dereset) {415 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG,416 reg_val_1);417 418 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ0_REG,419 reg_val_2);420 } else {421 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ0_REG,422 reg_val_2);423 424 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG,425 reg_val_1);426 }427 } else {428 reg_val_1 = 0x15540;429 reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ? 0x100 : 0x40;430 431 reg_val_1 <<= dsaf_dev->reset_offset;432 reg_val_2 <<= dsaf_dev->reset_offset;433 434 if (!dereset) {435 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG,436 reg_val_1);437 438 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_REQ_REG,439 reg_val_2);440 } else {441 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG,442 reg_val_1);443 444 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_DREQ_REG,445 reg_val_2);446 }447 }448}449 450static void hns_dsaf_ge_srst_by_port_acpi(struct dsaf_device *dsaf_dev,451 u32 port, bool dereset)452{453 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,454 HNS_GE_RESET_FUNC, port, dereset);455}456 457static void hns_ppe_srst_by_port(struct dsaf_device *dsaf_dev, u32 port,458 bool dereset)459{460 u32 reg_val = 0;461 u32 reg_addr;462 463 reg_val |= RESET_REQ_OR_DREQ << dsaf_dev->mac_cb[port]->port_rst_off;464 465 if (!dereset)466 reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG;467 else468 reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG;469 470 dsaf_write_sub(dsaf_dev, reg_addr, reg_val);471}472 473static void474hns_ppe_srst_by_port_acpi(struct dsaf_device *dsaf_dev, u32 port, bool dereset)475{476 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC,477 HNS_PPE_RESET_FUNC, port, dereset);478}479 480static void hns_ppe_com_srst(struct dsaf_device *dsaf_dev, bool dereset)481{482 u32 reg_val;483 u32 reg_addr;484 485 if (!(dev_of_node(dsaf_dev->dev)))486 return;487 488 if (!HNS_DSAF_IS_DEBUG(dsaf_dev)) {489 reg_val = RESET_REQ_OR_DREQ;490 if (!dereset)491 reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_REQ_REG;492 else493 reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_DREQ_REG;494 495 } else {496 reg_val = 0x100 << dsaf_dev->reset_offset;497 498 if (!dereset)499 reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG;500 else501 reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG;502 }503 504 dsaf_write_sub(dsaf_dev, reg_addr, reg_val);505}506 507/**508 * hns_mac_get_phy_if - get phy ifterface form serdes mode509 * @mac_cb: mac control block510 * retuen phy interface511 */512static phy_interface_t hns_mac_get_phy_if(struct hns_mac_cb *mac_cb)513{514 u32 mode;515 u32 reg;516 bool is_ver1 = AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver);517 int mac_id = mac_cb->mac_id;518 phy_interface_t phy_if;519 520 if (is_ver1) {521 if (HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev))522 return PHY_INTERFACE_MODE_SGMII;523 524 if (mac_id >= 0 && mac_id <= 3)525 reg = HNS_MAC_HILINK4_REG;526 else527 reg = HNS_MAC_HILINK3_REG;528 } else {529 if (!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev) && mac_id <= 3)530 reg = HNS_MAC_HILINK4V2_REG;531 else532 reg = HNS_MAC_HILINK3V2_REG;533 }534 535 mode = dsaf_read_sub(mac_cb->dsaf_dev, reg);536 if (dsaf_get_bit(mode, mac_cb->port_mode_off))537 phy_if = PHY_INTERFACE_MODE_XGMII;538 else539 phy_if = PHY_INTERFACE_MODE_SGMII;540 541 return phy_if;542}543 544static phy_interface_t hns_mac_get_phy_if_acpi(struct hns_mac_cb *mac_cb)545{546 phy_interface_t phy_if = PHY_INTERFACE_MODE_NA;547 union acpi_object *obj;548 union acpi_object obj_args, argv4;549 550 obj_args.integer.type = ACPI_TYPE_INTEGER;551 obj_args.integer.value = mac_cb->mac_id;552 553 argv4.type = ACPI_TYPE_PACKAGE;554 argv4.package.count = 1;555 argv4.package.elements = &obj_args;556 557 obj = acpi_evaluate_dsm_typed(ACPI_HANDLE(mac_cb->dev),558 &hns_dsaf_acpi_dsm_guid, 0,559 HNS_OP_GET_PORT_TYPE_FUNC, &argv4,560 ACPI_TYPE_INTEGER);561 if (!obj)562 return phy_if;563 564 phy_if = obj->integer.value ?565 PHY_INTERFACE_MODE_XGMII : PHY_INTERFACE_MODE_SGMII;566 567 dev_dbg(mac_cb->dev, "mac_id=%d, phy_if=%d\n", mac_cb->mac_id, phy_if);568 569 ACPI_FREE(obj);570 571 return phy_if;572}573 574static int hns_mac_get_sfp_prsnt(struct hns_mac_cb *mac_cb, int *sfp_prsnt)575{576 u32 val = 0;577 int ret;578 579 if (!mac_cb->cpld_ctrl)580 return -ENODEV;581 582 ret = dsaf_read_syscon(mac_cb->cpld_ctrl,583 mac_cb->cpld_ctrl_reg + MAC_SFP_PORT_OFFSET,584 &val);585 if (ret)586 return ret;587 588 *sfp_prsnt = !val;589 return 0;590}591 592static int hns_mac_get_sfp_prsnt_acpi(struct hns_mac_cb *mac_cb, int *sfp_prsnt)593{594 union acpi_object *obj;595 union acpi_object obj_args, argv4;596 597 obj_args.integer.type = ACPI_TYPE_INTEGER;598 obj_args.integer.value = mac_cb->mac_id;599 600 argv4.type = ACPI_TYPE_PACKAGE;601 argv4.package.count = 1;602 argv4.package.elements = &obj_args;603 604 obj = acpi_evaluate_dsm_typed(ACPI_HANDLE(mac_cb->dev),605 &hns_dsaf_acpi_dsm_guid, 0,606 HNS_OP_GET_SFP_STAT_FUNC, &argv4,607 ACPI_TYPE_INTEGER);608 if (!obj)609 return -ENODEV;610 611 *sfp_prsnt = obj->integer.value;612 613 ACPI_FREE(obj);614 615 return 0;616}617 618/**619 * hns_mac_config_sds_loopback - set loop back for serdes620 * @mac_cb: mac control block621 * @en: enable or disable622 * return 0 == success623 */624static int hns_mac_config_sds_loopback(struct hns_mac_cb *mac_cb, bool en)625{626 const u8 lane_id[] = {627 0, /* mac 0 -> lane 0 */628 1, /* mac 1 -> lane 1 */629 2, /* mac 2 -> lane 2 */630 3, /* mac 3 -> lane 3 */631 2, /* mac 4 -> lane 2 */632 3, /* mac 5 -> lane 3 */633 0, /* mac 6 -> lane 0 */634 1 /* mac 7 -> lane 1 */635 };636#define RX_CSR(lane, reg) ((0x4080 + (reg) * 0x0002 + (lane) * 0x0200) * 2)637 u64 reg_offset = RX_CSR(lane_id[mac_cb->mac_id], 0);638 639 int sfp_prsnt = 0;640 int ret = hns_mac_get_sfp_prsnt(mac_cb, &sfp_prsnt);641 642 if (!mac_cb->phy_dev) {643 if (ret)644 pr_info("please confirm sfp is present or not\n");645 else646 if (!sfp_prsnt)647 pr_info("no sfp in this eth\n");648 }649 650 if (mac_cb->serdes_ctrl) {651 u32 origin = 0;652 653 if (!AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver)) {654#define HILINK_ACCESS_SEL_CFG 0x40008655 /* hilink4 & hilink3 use the same xge training and656 * xge u adaptor. There is a hilink access sel cfg657 * register to select which one to be configed658 */659 if ((!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev)) &&660 (mac_cb->mac_id <= 3))661 dsaf_write_syscon(mac_cb->serdes_ctrl,662 HILINK_ACCESS_SEL_CFG, 0);663 else664 dsaf_write_syscon(mac_cb->serdes_ctrl,665 HILINK_ACCESS_SEL_CFG, 3);666 }667 668 ret = dsaf_read_syscon(mac_cb->serdes_ctrl, reg_offset,669 &origin);670 if (ret)671 return ret;672 673 dsaf_set_field(origin, 1ull << 10, 10, en);674 dsaf_write_syscon(mac_cb->serdes_ctrl, reg_offset, origin);675 } else {676 u8 __iomem *base_addr = mac_cb->serdes_vaddr +677 (mac_cb->mac_id <= 3 ? 0x00280000 : 0x00200000);678 dsaf_set_reg_field(base_addr, reg_offset, 1ull << 10, 10, en);679 }680 681 return 0;682}683 684static int685hns_mac_config_sds_loopback_acpi(struct hns_mac_cb *mac_cb, bool en)686{687 union acpi_object *obj;688 union acpi_object obj_args[3], argv4;689 690 obj_args[0].integer.type = ACPI_TYPE_INTEGER;691 obj_args[0].integer.value = mac_cb->mac_id;692 obj_args[1].integer.type = ACPI_TYPE_INTEGER;693 obj_args[1].integer.value = en;694 695 argv4.type = ACPI_TYPE_PACKAGE;696 argv4.package.count = 2;697 argv4.package.elements = obj_args;698 699 obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dsaf_dev->dev),700 &hns_dsaf_acpi_dsm_guid, 0,701 HNS_OP_SERDES_LP_FUNC, &argv4);702 if (!obj) {703 dev_warn(mac_cb->dsaf_dev->dev, "set port%d serdes lp fail!",704 mac_cb->mac_id);705 706 return -ENOTSUPP;707 }708 709 ACPI_FREE(obj);710 711 return 0;712}713 714struct dsaf_misc_op *hns_misc_op_get(struct dsaf_device *dsaf_dev)715{716 struct dsaf_misc_op *misc_op;717 718 misc_op = devm_kzalloc(dsaf_dev->dev, sizeof(*misc_op), GFP_KERNEL);719 if (!misc_op)720 return NULL;721 722 if (dev_of_node(dsaf_dev->dev)) {723 misc_op->cpld_set_led = hns_cpld_set_led;724 misc_op->cpld_reset_led = cpld_led_reset;725 misc_op->cpld_set_led_id = cpld_set_led_id;726 727 misc_op->dsaf_reset = hns_dsaf_rst;728 misc_op->xge_srst = hns_dsaf_xge_srst_by_port;729 misc_op->ge_srst = hns_dsaf_ge_srst_by_port;730 misc_op->ppe_srst = hns_ppe_srst_by_port;731 misc_op->ppe_comm_srst = hns_ppe_com_srst;732 misc_op->hns_dsaf_srst_chns = hns_dsaf_srst_chns;733 misc_op->hns_dsaf_roce_srst = hns_dsaf_roce_srst;734 735 misc_op->get_phy_if = hns_mac_get_phy_if;736 misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt;737 738 misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback;739 } else if (is_acpi_node(dsaf_dev->dev->fwnode)) {740 misc_op->cpld_set_led = hns_cpld_set_led_acpi;741 misc_op->cpld_reset_led = cpld_led_reset_acpi;742 misc_op->cpld_set_led_id = cpld_set_led_id_acpi;743 744 misc_op->dsaf_reset = hns_dsaf_rst_acpi;745 misc_op->xge_srst = hns_dsaf_xge_srst_by_port_acpi;746 misc_op->ge_srst = hns_dsaf_ge_srst_by_port_acpi;747 misc_op->ppe_srst = hns_ppe_srst_by_port_acpi;748 misc_op->ppe_comm_srst = hns_ppe_com_srst;749 misc_op->hns_dsaf_srst_chns = hns_dsaf_srst_chns_acpi;750 misc_op->hns_dsaf_roce_srst = hns_dsaf_roce_srst_acpi;751 752 misc_op->get_phy_if = hns_mac_get_phy_if_acpi;753 misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt_acpi;754 755 misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback_acpi;756 } else {757 devm_kfree(dsaf_dev->dev, (void *)misc_op);758 misc_op = NULL;759 }760 761 return (void *)misc_op;762}763 764struct765platform_device *hns_dsaf_find_platform_device(struct fwnode_handle *fwnode)766{767 struct device *dev;768 769 dev = bus_find_device_by_fwnode(&platform_bus_type, fwnode);770 return dev ? to_platform_device(dev) : NULL;771}772