drivers/net/ethernet/hisilicon/hns/hns_dsaf_misc.c

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