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 /** 330 * hns_dsaf_srst_chns - reset dsaf channels 331 * @dsaf_dev: dsaf device struct pointer 332 * @msk: xbar channels mask value: 333 * @dereset: false - request reset , true - drop reset 334 * 335 * bit0-5 for xge0-5 336 * bit6-11 for ppe0-5 337 * bit12-17 for roce0-5 338 * bit18-19 for com/dfx 339 */ 340 static void 341 hns_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 else 348 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 - reset dsaf channels 355 * @dsaf_dev: dsaf device struct pointer 356 * @msk: xbar channels mask value: 357 * @dereset: false - request reset , true - drop reset 358 * 359 * bit0-5 for xge0-5 360 * bit6-11 for ppe0-5 361 * bit12-17 for roce0-5 362 * bit18-19 for com/dfx 363 */ 364 static void 365 hns_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 372 static 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 386 static 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 392 static 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 reg_val_1 = 0x1 << port; 404 port_rst_off = dsaf_dev->mac_cb[port]->port_rst_off; 405 /* there is difference between V1 and V2 in register.*/ 406 reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ? 407 0x1041041 : 0x2082082; 408 reg_val_2 <<= port_rst_off; 409 410 if (!dereset) { 411 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG, 412 reg_val_1); 413 414 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ0_REG, 415 reg_val_2); 416 } else { 417 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ0_REG, 418 reg_val_2); 419 420 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG, 421 reg_val_1); 422 } 423 } else { 424 reg_val_1 = 0x15540; 425 reg_val_2 = AE_IS_VER1(dsaf_dev->dsaf_ver) ? 0x100 : 0x40; 426 427 reg_val_1 <<= dsaf_dev->reset_offset; 428 reg_val_2 <<= dsaf_dev->reset_offset; 429 430 if (!dereset) { 431 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_REQ1_REG, 432 reg_val_1); 433 434 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_REQ_REG, 435 reg_val_2); 436 } else { 437 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_GE_RESET_DREQ1_REG, 438 reg_val_1); 439 440 dsaf_write_sub(dsaf_dev, DSAF_SUB_SC_PPE_RESET_DREQ_REG, 441 reg_val_2); 442 } 443 } 444 } 445 446 static void hns_dsaf_ge_srst_by_port_acpi(struct dsaf_device *dsaf_dev, 447 u32 port, bool dereset) 448 { 449 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC, 450 HNS_GE_RESET_FUNC, port, dereset); 451 } 452 453 static void hns_ppe_srst_by_port(struct dsaf_device *dsaf_dev, u32 port, 454 bool dereset) 455 { 456 u32 reg_val = 0; 457 u32 reg_addr; 458 459 reg_val |= RESET_REQ_OR_DREQ << dsaf_dev->mac_cb[port]->port_rst_off; 460 461 if (!dereset) 462 reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG; 463 else 464 reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG; 465 466 dsaf_write_sub(dsaf_dev, reg_addr, reg_val); 467 } 468 469 static void 470 hns_ppe_srst_by_port_acpi(struct dsaf_device *dsaf_dev, u32 port, bool dereset) 471 { 472 hns_dsaf_acpi_srst_by_port(dsaf_dev, HNS_OP_RESET_FUNC, 473 HNS_PPE_RESET_FUNC, port, dereset); 474 } 475 476 static void hns_ppe_com_srst(struct dsaf_device *dsaf_dev, bool dereset) 477 { 478 u32 reg_val; 479 u32 reg_addr; 480 481 if (!(dev_of_node(dsaf_dev->dev))) 482 return; 483 484 if (!HNS_DSAF_IS_DEBUG(dsaf_dev)) { 485 reg_val = RESET_REQ_OR_DREQ; 486 if (!dereset) 487 reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_REQ_REG; 488 else 489 reg_addr = DSAF_SUB_SC_RCB_PPE_COM_RESET_DREQ_REG; 490 491 } else { 492 reg_val = 0x100 << dsaf_dev->reset_offset; 493 494 if (!dereset) 495 reg_addr = DSAF_SUB_SC_PPE_RESET_REQ_REG; 496 else 497 reg_addr = DSAF_SUB_SC_PPE_RESET_DREQ_REG; 498 } 499 500 dsaf_write_sub(dsaf_dev, reg_addr, reg_val); 501 } 502 503 /** 504 * hns_mac_get_sds_mode - get phy ifterface form serdes mode 505 * @mac_cb: mac control block 506 * retuen phy interface 507 */ 508 static phy_interface_t hns_mac_get_phy_if(struct hns_mac_cb *mac_cb) 509 { 510 u32 mode; 511 u32 reg; 512 bool is_ver1 = AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver); 513 int mac_id = mac_cb->mac_id; 514 phy_interface_t phy_if; 515 516 if (is_ver1) { 517 if (HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev)) 518 return PHY_INTERFACE_MODE_SGMII; 519 520 if (mac_id >= 0 && mac_id <= 3) 521 reg = HNS_MAC_HILINK4_REG; 522 else 523 reg = HNS_MAC_HILINK3_REG; 524 } else{ 525 if (!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev) && mac_id <= 3) 526 reg = HNS_MAC_HILINK4V2_REG; 527 else 528 reg = HNS_MAC_HILINK3V2_REG; 529 } 530 531 mode = dsaf_read_sub(mac_cb->dsaf_dev, reg); 532 if (dsaf_get_bit(mode, mac_cb->port_mode_off)) 533 phy_if = PHY_INTERFACE_MODE_XGMII; 534 else 535 phy_if = PHY_INTERFACE_MODE_SGMII; 536 537 return phy_if; 538 } 539 540 static phy_interface_t hns_mac_get_phy_if_acpi(struct hns_mac_cb *mac_cb) 541 { 542 phy_interface_t phy_if = PHY_INTERFACE_MODE_NA; 543 union acpi_object *obj; 544 union acpi_object obj_args, argv4; 545 546 obj_args.integer.type = ACPI_TYPE_INTEGER; 547 obj_args.integer.value = mac_cb->mac_id; 548 549 argv4.type = ACPI_TYPE_PACKAGE; 550 argv4.package.count = 1; 551 argv4.package.elements = &obj_args; 552 553 obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dev), 554 &hns_dsaf_acpi_dsm_guid, 0, 555 HNS_OP_GET_PORT_TYPE_FUNC, &argv4); 556 557 if (!obj || obj->type != ACPI_TYPE_INTEGER) 558 return phy_if; 559 560 phy_if = obj->integer.value ? 561 PHY_INTERFACE_MODE_XGMII : PHY_INTERFACE_MODE_SGMII; 562 563 dev_dbg(mac_cb->dev, "mac_id=%d, phy_if=%d\n", mac_cb->mac_id, phy_if); 564 565 ACPI_FREE(obj); 566 567 return phy_if; 568 } 569 570 static int hns_mac_get_sfp_prsnt(struct hns_mac_cb *mac_cb, int *sfp_prsnt) 571 { 572 u32 val = 0; 573 int ret; 574 575 if (!mac_cb->cpld_ctrl) 576 return -ENODEV; 577 578 ret = dsaf_read_syscon(mac_cb->cpld_ctrl, 579 mac_cb->cpld_ctrl_reg + MAC_SFP_PORT_OFFSET, 580 &val); 581 if (ret) 582 return ret; 583 584 *sfp_prsnt = !val; 585 return 0; 586 } 587 588 static int hns_mac_get_sfp_prsnt_acpi(struct hns_mac_cb *mac_cb, int *sfp_prsnt) 589 { 590 union acpi_object *obj; 591 union acpi_object obj_args, argv4; 592 593 obj_args.integer.type = ACPI_TYPE_INTEGER; 594 obj_args.integer.value = mac_cb->mac_id; 595 596 argv4.type = ACPI_TYPE_PACKAGE; 597 argv4.package.count = 1; 598 argv4.package.elements = &obj_args; 599 600 obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dev), 601 &hns_dsaf_acpi_dsm_guid, 0, 602 HNS_OP_GET_SFP_STAT_FUNC, &argv4); 603 604 if (!obj || obj->type != ACPI_TYPE_INTEGER) 605 return -ENODEV; 606 607 *sfp_prsnt = obj->integer.value; 608 609 ACPI_FREE(obj); 610 611 return 0; 612 } 613 614 /** 615 * hns_mac_config_sds_loopback - set loop back for serdes 616 * @mac_cb: mac control block 617 * @en: enable or disable 618 * return 0 == success 619 */ 620 static int hns_mac_config_sds_loopback(struct hns_mac_cb *mac_cb, bool en) 621 { 622 const u8 lane_id[] = { 623 0, /* mac 0 -> lane 0 */ 624 1, /* mac 1 -> lane 1 */ 625 2, /* mac 2 -> lane 2 */ 626 3, /* mac 3 -> lane 3 */ 627 2, /* mac 4 -> lane 2 */ 628 3, /* mac 5 -> lane 3 */ 629 0, /* mac 6 -> lane 0 */ 630 1 /* mac 7 -> lane 1 */ 631 }; 632 #define RX_CSR(lane, reg) ((0x4080 + (reg) * 0x0002 + (lane) * 0x0200) * 2) 633 u64 reg_offset = RX_CSR(lane_id[mac_cb->mac_id], 0); 634 635 int sfp_prsnt = 0; 636 int ret = hns_mac_get_sfp_prsnt(mac_cb, &sfp_prsnt); 637 638 if (!mac_cb->phy_dev) { 639 if (ret) 640 pr_info("please confirm sfp is present or not\n"); 641 else 642 if (!sfp_prsnt) 643 pr_info("no sfp in this eth\n"); 644 } 645 646 if (mac_cb->serdes_ctrl) { 647 u32 origin = 0; 648 649 if (!AE_IS_VER1(mac_cb->dsaf_dev->dsaf_ver)) { 650 #define HILINK_ACCESS_SEL_CFG 0x40008 651 /* hilink4 & hilink3 use the same xge training and 652 * xge u adaptor. There is a hilink access sel cfg 653 * register to select which one to be configed 654 */ 655 if ((!HNS_DSAF_IS_DEBUG(mac_cb->dsaf_dev)) && 656 (mac_cb->mac_id <= 3)) 657 dsaf_write_syscon(mac_cb->serdes_ctrl, 658 HILINK_ACCESS_SEL_CFG, 0); 659 else 660 dsaf_write_syscon(mac_cb->serdes_ctrl, 661 HILINK_ACCESS_SEL_CFG, 3); 662 } 663 664 ret = dsaf_read_syscon(mac_cb->serdes_ctrl, reg_offset, 665 &origin); 666 if (ret) 667 return ret; 668 669 dsaf_set_field(origin, 1ull << 10, 10, en); 670 dsaf_write_syscon(mac_cb->serdes_ctrl, reg_offset, origin); 671 } else { 672 u8 __iomem *base_addr = mac_cb->serdes_vaddr + 673 (mac_cb->mac_id <= 3 ? 0x00280000 : 0x00200000); 674 dsaf_set_reg_field(base_addr, reg_offset, 1ull << 10, 10, en); 675 } 676 677 return 0; 678 } 679 680 static int 681 hns_mac_config_sds_loopback_acpi(struct hns_mac_cb *mac_cb, bool en) 682 { 683 union acpi_object *obj; 684 union acpi_object obj_args[3], argv4; 685 686 obj_args[0].integer.type = ACPI_TYPE_INTEGER; 687 obj_args[0].integer.value = mac_cb->mac_id; 688 obj_args[1].integer.type = ACPI_TYPE_INTEGER; 689 obj_args[1].integer.value = !!en; 690 691 argv4.type = ACPI_TYPE_PACKAGE; 692 argv4.package.count = 2; 693 argv4.package.elements = obj_args; 694 695 obj = acpi_evaluate_dsm(ACPI_HANDLE(mac_cb->dsaf_dev->dev), 696 &hns_dsaf_acpi_dsm_guid, 0, 697 HNS_OP_SERDES_LP_FUNC, &argv4); 698 if (!obj) { 699 dev_warn(mac_cb->dsaf_dev->dev, "set port%d serdes lp fail!", 700 mac_cb->mac_id); 701 702 return -ENOTSUPP; 703 } 704 705 ACPI_FREE(obj); 706 707 return 0; 708 } 709 710 struct dsaf_misc_op *hns_misc_op_get(struct dsaf_device *dsaf_dev) 711 { 712 struct dsaf_misc_op *misc_op; 713 714 misc_op = devm_kzalloc(dsaf_dev->dev, sizeof(*misc_op), GFP_KERNEL); 715 if (!misc_op) 716 return NULL; 717 718 if (dev_of_node(dsaf_dev->dev)) { 719 misc_op->cpld_set_led = hns_cpld_set_led; 720 misc_op->cpld_reset_led = cpld_led_reset; 721 misc_op->cpld_set_led_id = cpld_set_led_id; 722 723 misc_op->dsaf_reset = hns_dsaf_rst; 724 misc_op->xge_srst = hns_dsaf_xge_srst_by_port; 725 misc_op->ge_srst = hns_dsaf_ge_srst_by_port; 726 misc_op->ppe_srst = hns_ppe_srst_by_port; 727 misc_op->ppe_comm_srst = hns_ppe_com_srst; 728 misc_op->hns_dsaf_srst_chns = hns_dsaf_srst_chns; 729 misc_op->hns_dsaf_roce_srst = hns_dsaf_roce_srst; 730 731 misc_op->get_phy_if = hns_mac_get_phy_if; 732 misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt; 733 734 misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback; 735 } else if (is_acpi_node(dsaf_dev->dev->fwnode)) { 736 misc_op->cpld_set_led = hns_cpld_set_led_acpi; 737 misc_op->cpld_reset_led = cpld_led_reset_acpi; 738 misc_op->cpld_set_led_id = cpld_set_led_id_acpi; 739 740 misc_op->dsaf_reset = hns_dsaf_rst_acpi; 741 misc_op->xge_srst = hns_dsaf_xge_srst_by_port_acpi; 742 misc_op->ge_srst = hns_dsaf_ge_srst_by_port_acpi; 743 misc_op->ppe_srst = hns_ppe_srst_by_port_acpi; 744 misc_op->ppe_comm_srst = hns_ppe_com_srst; 745 misc_op->hns_dsaf_srst_chns = hns_dsaf_srst_chns_acpi; 746 misc_op->hns_dsaf_roce_srst = hns_dsaf_roce_srst_acpi; 747 748 misc_op->get_phy_if = hns_mac_get_phy_if_acpi; 749 misc_op->get_sfp_prsnt = hns_mac_get_sfp_prsnt_acpi; 750 751 misc_op->cfg_serdes_loopback = hns_mac_config_sds_loopback_acpi; 752 } else { 753 devm_kfree(dsaf_dev->dev, (void *)misc_op); 754 misc_op = NULL; 755 } 756 757 return (void *)misc_op; 758 } 759 760 struct 761 platform_device *hns_dsaf_find_platform_device(struct fwnode_handle *fwnode) 762 { 763 struct device *dev; 764 765 dev = bus_find_device_by_fwnode(&platform_bus_type, fwnode); 766 return dev ? to_platform_device(dev) : NULL; 767 } 768