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