1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 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 11 enum _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 20 enum _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 29 static const guid_t hns_dsaf_acpi_dsm_guid = 30 GUID_INIT(0x1A85AA1A, 0xE293, 0x415E, 31 0x8E, 0x28, 0x8D, 0x69, 0x0A, 0x0F, 0x82, 0x0A); 32 33 static 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 else 38 dsaf_write_reg(dsaf_dev->sc_base, reg, val); 39 } 40 41 static 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 58 static 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 86 static 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 113 static 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 153 static 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 165 static 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 175 static 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 189 static 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 224 static 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 1 249 250 static 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 278 static 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 295 static 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 302 static 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 else 317 reg_addr = DSAF_SUB_SC_XGE_RESET_DREQ_REG; 318 319 dsaf_write_sub(dsaf_dev, reg_addr, reg_val); 320 } 321 322 static 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 static void hns_dsaf_ge_srst_by_port(struct dsaf_device *dsaf_dev, u32 port, 330 bool dereset) 331 { 332 u32 reg_val_1; 333 u32 reg_val_2; 334 u32 port_rst_off; 335 336 if (port >= DSAF_GE_NUM) 337 return; 338 339 if (!HNS_DSAF_IS_DEBUG(dsaf_dev)) { 340 /* DSAF_MAX_PORT_NUM is 6, but DSAF_GE_NUM is 8. 341 We need check to prevent array overflow */ 342 if (port >= DSAF_MAX_PORT_NUM) 343 return; 344 reg_val_1 = 0x1 << port; 345 port_rst_off = dsaf_dev->mac_cb[port]->port_rst_off; 346 /* there is difference between V1 and V2 in register.*/ 347 reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ? 348 0x1041041 : 0x2082082; 349 reg_val_2 <<= port_rst_off; 350 351 if (!dereset) { 352 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG, 353 reg_val_1); 354 355 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ0_REG, 356 reg_val_2); 357 } else { 358 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ0_REG, 359 reg_val_2); 360 361 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG, 362 reg_val_1); 363 } 364 } else { 365 reg_val_1 = 0x15540; 366 reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ? 0x100 : 0x40; 367 368 reg_val_1 <<= dsaf_dev->reset_offset; 369 reg_val_2 <<= dsaf_dev->reset_offset; 370 371 if (!dereset) { 372 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG, 373 reg_val_1); 374 375 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_REQ_REG, 376 reg_val_2); 377 } else { 378 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG, 379 reg_val_1); 380 381 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_DREQ_REG, 382 reg_val_2); 383 } 384 } 385 } 386 387 static void hns_dsaf_ge_srst_by_port_acpi(struct dsaf_device *dsaf_dev, 388 u32 port, bool dereset) 389 { 390 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC, 391 HNS_GE_RESET_FUNC, port, dereset); 392 } 393 394 static void hns_ppe_srst_by_port(struct dsaf_device *dsaf_dev, u32 port, 395 bool dereset) 396 { 397 u32 reg_val = 0; 398 u32 reg_addr; 399 400 reg_val |= RESET_REQ_OR_DREQ << dsaf_dev->mac_cb[port]->port_rst_off; 401 402 if (!dereset) 403 reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG; 404 else 405 reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG; 406 407 dsaf_write_sub(dsaf_dev, reg_addr, reg_val); 408 } 409 410 static void 411 hns_ppe_srst_by_port_acpi(struct dsaf_device *dsaf_dev, u32 port, bool dereset) 412 { 413 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC, 414 HNS_PPE_RESET_FUNC, port, dereset); 415 } 416 417 static void hns_ppe_com_srst(struct dsaf_device *dsaf_dev, bool dereset) 418 { 419 u32 reg_val; 420 u32 reg_addr; 421 422 if (!(dev_of_node(dsaf_dev->dev))) 423 return; 424 425 if (!HNS_DSAF_IS_DEBUG(dsaf_dev)) { 426 reg_val = RESET_REQ_OR_DREQ; 427 if (!dereset) 428 reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_REQ_REG; 429 else 430 reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_DREQ_REG; 431 432 } else { 433 reg_val = 0x100 << dsaf_dev->reset_offset; 434 435 if (!dereset) 436 reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG; 437 else 438 reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG; 439 } 440 441 dsaf_write_sub(dsaf_dev, reg_addr, reg_val); 442 } 443 444 /** 445 * hns_mac_get_phy_if - get phy ifterface form serdes mode 446 * @mac_cb: mac control block 447 * retuen phy interface 448 */ 449 static phy_interface_t hns_mac_get_phy_if(struct hns_mac_cb *mac_cb) 450 { 451 u32 mode; 452 u32 reg; 453 bool is_ver1 = AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver); 454 int mac_id = mac_cb->mac_id; 455 phy_interface_t phy_if; 456 457 if (is_ver1) { 458 if (HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev)) 459 return PHY_INTERFACE_MODE_SGMII; 460 461 if (mac_id >= 0 && mac_id <= 3) 462 reg = HNS_MAC_HILINK4_REG; 463 else 464 reg = HNS_MAC_HILINK3_REG; 465 } else { 466 if (!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev) && mac_id <= 3) 467 reg = HNS_MAC_HILINK4V2_REG; 468 else 469 reg = HNS_MAC_HILINK3V2_REG; 470 } 471 472 mode = dsaf_read_sub(mac_cb->dsaf_dev, reg); 473 if (dsaf_get_bit(mode, mac_cb->port_mode_off)) 474 phy_if = PHY_INTERFACE_MODE_XGMII; 475 else 476 phy_if = PHY_INTERFACE_MODE_SGMII; 477 478 return phy_if; 479 } 480 481 static phy_interface_t hns_mac_get_phy_if_acpi(struct hns_mac_cb *mac_cb) 482 { 483 phy_interface_t phy_if = PHY_INTERFACE_MODE_NA; 484 union acpi_object *obj; 485 union acpi_object obj_args, argv4; 486 487 obj_args.integer.type = ACPI_TYPE_INTEGER; 488 obj_args.integer.value = mac_cb->mac_id; 489 490 argv4.type = ACPI_TYPE_PACKAGE; 491 argv4.package.count = 1; 492 argv4.package.elements = &obj_args; 493 494 obj = acpi_evaluate_dsm_typed(ACPI_HANDLE(mac_cb->dev), 495 &hns_dsaf_acpi_dsm_guid, 0, 496 HNS_OP_GET_PORT_TYPE_FUNC, &argv4, 497 ACPI_TYPE_INTEGER); 498 if (!obj) 499 return phy_if; 500 501 phy_if = obj->integer.value ? 502 PHY_INTERFACE_MODE_XGMII : PHY_INTERFACE_MODE_SGMII; 503 504 dev_dbg(mac_cb->dev, "mac_id=%d, phy_if=%d\n", mac_cb->mac_id, phy_if); 505 506 ACPI_FREE(obj); 507 508 return phy_if; 509 } 510 511 static int hns_mac_get_sfp_prsnt(struct hns_mac_cb *mac_cb, int *sfp_prsnt) 512 { 513 u32 val = 0; 514 int ret; 515 516 if (!mac_cb->cpld_ctrl) 517 return -ENODEV; 518 519 ret = dsaf_read_syscon(mac_cb->cpld_ctrl, 520 mac_cb->cpld_ctrl_reg + MAC_SFP_PORT_OFFSET, 521 &val); 522 if (ret) 523 return ret; 524 525 *sfp_prsnt = !val; 526 return 0; 527 } 528 529 static int hns_mac_get_sfp_prsnt_acpi(struct hns_mac_cb *mac_cb, int *sfp_prsnt) 530 { 531 union acpi_object *obj; 532 union acpi_object obj_args, argv4; 533 534 obj_args.integer.type = ACPI_TYPE_INTEGER; 535 obj_args.integer.value = mac_cb->mac_id; 536 537 argv4.type = ACPI_TYPE_PACKAGE; 538 argv4.package.count = 1; 539 argv4.package.elements = &obj_args; 540 541 obj = acpi_evaluate_dsm_typed(ACPI_HANDLE(mac_cb->dev), 542 &hns_dsaf_acpi_dsm_guid, 0, 543 HNS_OP_GET_SFP_STAT_FUNC, &argv4, 544 ACPI_TYPE_INTEGER); 545 if (!obj) 546 return -ENODEV; 547 548 *sfp_prsnt = obj->integer.value; 549 550 ACPI_FREE(obj); 551 552 return 0; 553 } 554 555 /** 556 * hns_mac_config_sds_loopback - set loop back for serdes 557 * @mac_cb: mac control block 558 * @en: enable or disable 559 * return 0 == success 560 */ 561 static int hns_mac_config_sds_loopback(struct hns_mac_cb *mac_cb, bool en) 562 { 563 const u8 lane_id[] = { 564 0, /* mac 0 -> lane 0 */ 565 1, /* mac 1 -> lane 1 */ 566 2, /* mac 2 -> lane 2 */ 567 3, /* mac 3 -> lane 3 */ 568 2, /* mac 4 -> lane 2 */ 569 3, /* mac 5 -> lane 3 */ 570 0, /* mac 6 -> lane 0 */ 571 1 /* mac 7 -> lane 1 */ 572 }; 573 #define RX_CSR(lane, reg) ((0x4080 + (reg) * 0x0002 + (lane) * 0x0200) * 2) 574 u64 reg_offset = RX_CSR(lane_id[mac_cb->mac_id], 0); 575 576 int sfp_prsnt = 0; 577 int ret = hns_mac_get_sfp_prsnt(mac_cb, &sfp_prsnt); 578 579 if (!mac_cb->phy_dev) { 580 if (ret) 581 pr_info("please confirm sfp is present or not\n"); 582 else 583 if (!sfp_prsnt) 584 pr_info("no sfp in this eth\n"); 585 } 586 587 if (mac_cb->serdes_ctrl) { 588 u32 origin = 0; 589 590 if (!AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver)) { 591 #define HILINK_ACCESS_SEL_CFG 0x40008 592 /* hilink4 & hilink3 use the same xge training and 593 * xge u adaptor. There is a hilink access sel cfg 594 * register to select which one to be configed 595 */ 596 if ((!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev)) && 597 (mac_cb->mac_id <= 3)) 598 dsaf_write_syscon(mac_cb->serdes_ctrl, 599 HILINK_ACCESS_SEL_CFG, 0); 600 else 601 dsaf_write_syscon(mac_cb->serdes_ctrl, 602 HILINK_ACCESS_SEL_CFG, 3); 603 } 604 605 ret = dsaf_read_syscon(mac_cb->serdes_ctrl, reg_offset, 606 &origin); 607 if (ret) 608 return ret; 609 610 dsaf_set_field(origin, 1ull << 10, 10, en); 611 dsaf_write_syscon(mac_cb->serdes_ctrl, reg_offset, origin); 612 } else { 613 u8 __iomem *base_addr = mac_cb->serdes_vaddr + 614 (mac_cb->mac_id <= 3 ? 0x00280000 : 0x00200000); 615 dsaf_set_reg_field(base_addr, reg_offset, 1ull << 10, 10, en); 616 } 617 618 return 0; 619 } 620 621 static int 622 hns_mac_config_sds_loopback_acpi(struct hns_mac_cb *mac_cb, bool en) 623 { 624 union acpi_object *obj; 625 union acpi_object obj_args[3], argv4; 626 627 obj_args[0].integer.type = ACPI_TYPE_INTEGER; 628 obj_args[0].integer.value = mac_cb->mac_id; 629 obj_args[1].integer.type = ACPI_TYPE_INTEGER; 630 obj_args[1].integer.value = en; 631 632 argv4.type = ACPI_TYPE_PACKAGE; 633 argv4.package.count = 2; 634 argv4.package.elements = obj_args; 635 636 obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dsaf_dev->dev), 637 &hns_dsaf_acpi_dsm_guid, 0, 638 HNS_OP_SERDES_LP_FUNC, &argv4); 639 if (!obj) { 640 dev_warn(mac_cb->dsaf_dev->dev, "set port%d serdes lp fail!", 641 mac_cb->mac_id); 642 643 return -ENOTSUPP; 644 } 645 646 ACPI_FREE(obj); 647 648 return 0; 649 } 650 651 struct dsaf_misc_op *hns_misc_op_get(struct dsaf_device *dsaf_dev) 652 { 653 struct dsaf_misc_op *misc_op; 654 655 misc_op = devm_kzalloc(dsaf_dev->dev, sizeof(*misc_op), GFP_KERNEL); 656 if (!misc_op) 657 return NULL; 658 659 if (dev_of_node(dsaf_dev->dev)) { 660 misc_op->cpld_set_led = hns_cpld_set_led; 661 misc_op->cpld_reset_led = cpld_led_reset; 662 misc_op->cpld_set_led_id = cpld_set_led_id; 663 664 misc_op->dsaf_reset = hns_dsaf_rst; 665 misc_op->xge_srst = hns_dsaf_xge_srst_by_port; 666 misc_op->ge_srst = hns_dsaf_ge_srst_by_port; 667 misc_op->ppe_srst = hns_ppe_srst_by_port; 668 misc_op->ppe_comm_srst = hns_ppe_com_srst; 669 670 misc_op->get_phy_if = hns_mac_get_phy_if; 671 misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt; 672 673 misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback; 674 } else if (is_acpi_node(dsaf_dev->dev->fwnode)) { 675 misc_op->cpld_set_led = hns_cpld_set_led_acpi; 676 misc_op->cpld_reset_led = cpld_led_reset_acpi; 677 misc_op->cpld_set_led_id = cpld_set_led_id_acpi; 678 679 misc_op->dsaf_reset = hns_dsaf_rst_acpi; 680 misc_op->xge_srst = hns_dsaf_xge_srst_by_port_acpi; 681 misc_op->ge_srst = hns_dsaf_ge_srst_by_port_acpi; 682 misc_op->ppe_srst = hns_ppe_srst_by_port_acpi; 683 misc_op->ppe_comm_srst = hns_ppe_com_srst; 684 685 misc_op->get_phy_if = hns_mac_get_phy_if_acpi; 686 misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt_acpi; 687 688 misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback_acpi; 689 } else { 690 devm_kfree(dsaf_dev->dev, (void *)misc_op); 691 misc_op = NULL; 692 } 693 694 return (void *)misc_op; 695 } 696 697 struct 698 platform_device *hns_dsaf_find_platform_device(struct fwnode_handle *fwnode) 699 { 700 struct device *dev; 701 702 dev = bus_find_device_by_fwnode(&platform_bus_type, fwnode); 703 return dev ? to_platform_device(dev) : NULL; 704 } 705