drivers/net/ethernet/realtek/r8169_phy_config.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * r8169_phy_config.c: RealTek 8169/8168/8101 ethernet driver.
   4  *
   5  * Copyright (c) 2002 ShuChen <shuchen@realtek.com.tw>
   6  * Copyright (c) 2003 - 2007 Francois Romieu <romieu@fr.zoreil.com>
   7  * Copyright (c) a lot of people too. Please respect their work.
   8  *
   9  * See MAINTAINERS file for support contact information.
  10  */
  11
  12 #include <linux/delay.h>
  13 #include <linux/phy.h>
  14
  15 #include "r8169.h"
  16
  17 typedef void (*rtl_phy_cfg_fct)(struct rtl8169_private *tp,
  18                                 struct phy_device *phydev);
  19
  20 static void r8168d_modify_extpage(struct phy_device *phydev, int extpage,
  21                                   int reg, u16 mask, u16 val)
  22 {
  23         int oldpage = phy_select_page(phydev, 0x0007);
  24
  25         __phy_write(phydev, 0x1e, extpage);
  26         __phy_modify(phydev, reg, mask, val);
  27
  28         phy_restore_page(phydev, oldpage, 0);
  29 }
  30
  31 static void r8168d_phy_param(struct phy_device *phydev, u16 parm,
  32                              u16 mask, u16 val)
  33 {
  34         int oldpage = phy_select_page(phydev, 0x0005);
  35
  36         __phy_write(phydev, 0x05, parm);
  37         __phy_modify(phydev, 0x06, mask, val);
  38
  39         phy_restore_page(phydev, oldpage, 0);
  40 }
  41
  42 static void r8168g_phy_param(struct phy_device *phydev, u16 parm,
  43                              u16 mask, u16 val)
  44 {
  45         int oldpage = phy_select_page(phydev, 0x0a43);
  46
  47         __phy_write(phydev, 0x13, parm);
  48         __phy_modify(phydev, 0x14, mask, val);
  49
  50         phy_restore_page(phydev, oldpage, 0);
  51 }
  52
  53 struct phy_reg {
  54         u16 reg;
  55         u16 val;
  56 };
  57
  58 static void __rtl_writephy_batch(struct phy_device *phydev,
  59                                  const struct phy_reg *regs, int len)
  60 {
  61         phy_lock_mdio_bus(phydev);
  62
  63         while (len-- > 0) {
  64                 __phy_write(phydev, regs->reg, regs->val);
  65                 regs++;
  66         }
  67
  68         phy_unlock_mdio_bus(phydev);
  69 }
  70
  71 #define rtl_writephy_batch(p, a) __rtl_writephy_batch(p, a, ARRAY_SIZE(a))
  72
  73 static void rtl8168f_config_eee_phy(struct phy_device *phydev)
  74 {
  75         r8168d_modify_extpage(phydev, 0x0020, 0x15, 0, BIT(8));
  76         r8168d_phy_param(phydev, 0x8b85, 0, BIT(13));
  77 }
  78
  79 static void rtl8168g_config_eee_phy(struct phy_device *phydev)
  80 {
  81         phy_modify_paged(phydev, 0x0a43, 0x11, 0, BIT(4));
  82 }
  83
  84 static void rtl8168h_config_eee_phy(struct phy_device *phydev)
  85 {
  86         rtl8168g_config_eee_phy(phydev);
  87
  88         phy_modify_paged(phydev, 0xa4a, 0x11, 0x0000, 0x0200);
  89         phy_modify_paged(phydev, 0xa42, 0x14, 0x0000, 0x0080);
  90 }
  91
  92 static void rtl8125a_config_eee_phy(struct phy_device *phydev)
  93 {
  94         rtl8168h_config_eee_phy(phydev);
  95
  96         phy_modify_paged(phydev, 0xa6d, 0x12, 0x0001, 0x0000);
  97         phy_modify_paged(phydev, 0xa6d, 0x14, 0x0010, 0x0000);
  98 }
  99
 100 static void rtl8125b_config_eee_phy(struct phy_device *phydev)
 101 {
 102         phy_modify_paged(phydev, 0xa6d, 0x12, 0x0001, 0x0000);
 103         phy_modify_paged(phydev, 0xa6d, 0x14, 0x0010, 0x0000);
 104         phy_modify_paged(phydev, 0xa42, 0x14, 0x0080, 0x0000);
 105         phy_modify_paged(phydev, 0xa4a, 0x11, 0x0200, 0x0000);
 106 }
 107
 108 static void rtl8169s_hw_phy_config(struct rtl8169_private *tp,
 109                                    struct phy_device *phydev)
 110 {
 111         static const struct phy_reg phy_reg_init[] = {
 112                 { 0x1f, 0x0001 },
 113                 { 0x06, 0x006e },
 114                 { 0x08, 0x0708 },
 115                 { 0x15, 0x4000 },
 116                 { 0x18, 0x65c7 },
 117
 118                 { 0x1f, 0x0001 },
 119                 { 0x03, 0x00a1 },
 120                 { 0x02, 0x0008 },
 121                 { 0x01, 0x0120 },
 122                 { 0x00, 0x1000 },
 123                 { 0x04, 0x0800 },
 124                 { 0x04, 0x0000 },
 125
 126                 { 0x03, 0xff41 },
 127                 { 0x02, 0xdf60 },
 128                 { 0x01, 0x0140 },
 129                 { 0x00, 0x0077 },
 130                 { 0x04, 0x7800 },
 131                 { 0x04, 0x7000 },
 132
 133                 { 0x03, 0x802f },
 134                 { 0x02, 0x4f02 },
 135                 { 0x01, 0x0409 },
 136                 { 0x00, 0xf0f9 },
 137                 { 0x04, 0x9800 },
 138                 { 0x04, 0x9000 },
 139
 140                 { 0x03, 0xdf01 },
 141                 { 0x02, 0xdf20 },
 142                 { 0x01, 0xff95 },
 143                 { 0x00, 0xba00 },
 144                 { 0x04, 0xa800 },
 145                 { 0x04, 0xa000 },
 146
 147                 { 0x03, 0xff41 },
 148                 { 0x02, 0xdf20 },
 149                 { 0x01, 0x0140 },
 150                 { 0x00, 0x00bb },
 151                 { 0x04, 0xb800 },
 152                 { 0x04, 0xb000 },
 153
 154                 { 0x03, 0xdf41 },
 155                 { 0x02, 0xdc60 },
 156                 { 0x01, 0x6340 },
 157                 { 0x00, 0x007d },
 158                 { 0x04, 0xd800 },
 159                 { 0x04, 0xd000 },
 160
 161                 { 0x03, 0xdf01 },
 162                 { 0x02, 0xdf20 },
 163                 { 0x01, 0x100a },
 164                 { 0x00, 0xa0ff },
 165                 { 0x04, 0xf800 },
 166                 { 0x04, 0xf000 },
 167
 168                 { 0x1f, 0x0000 },
 169                 { 0x0b, 0x0000 },
 170                 { 0x00, 0x9200 }
 171         };
 172
 173         rtl_writephy_batch(phydev, phy_reg_init);
 174 }
 175
 176 static void rtl8169sb_hw_phy_config(struct rtl8169_private *tp,
 177                                     struct phy_device *phydev)
 178 {
 179         phy_write_paged(phydev, 0x0002, 0x01, 0x90d0);
 180 }
 181
 182 static void rtl8169scd_hw_phy_config(struct rtl8169_private *tp,
 183                                      struct phy_device *phydev)
 184 {
 185         static const struct phy_reg phy_reg_init[] = {
 186                 { 0x1f, 0x0001 },
 187                 { 0x04, 0x0000 },
 188                 { 0x03, 0x00a1 },
 189                 { 0x02, 0x0008 },
 190                 { 0x01, 0x0120 },
 191                 { 0x00, 0x1000 },
 192                 { 0x04, 0x0800 },
 193                 { 0x04, 0x9000 },
 194                 { 0x03, 0x802f },
 195                 { 0x02, 0x4f02 },
 196                 { 0x01, 0x0409 },
 197                 { 0x00, 0xf099 },
 198                 { 0x04, 0x9800 },
 199                 { 0x04, 0xa000 },
 200                 { 0x03, 0xdf01 },
 201                 { 0x02, 0xdf20 },
 202                 { 0x01, 0xff95 },
 203                 { 0x00, 0xba00 },
 204                 { 0x04, 0xa800 },
 205                 { 0x04, 0xf000 },
 206                 { 0x03, 0xdf01 },
 207                 { 0x02, 0xdf20 },
 208                 { 0x01, 0x101a },
 209                 { 0x00, 0xa0ff },
 210                 { 0x04, 0xf800 },
 211                 { 0x04, 0x0000 },
 212                 { 0x1f, 0x0000 },
 213
 214                 { 0x1f, 0x0001 },
 215                 { 0x10, 0xf41b },
 216                 { 0x14, 0xfb54 },
 217                 { 0x18, 0xf5c7 },
 218                 { 0x1f, 0x0000 },
 219
 220                 { 0x1f, 0x0001 },
 221                 { 0x17, 0x0cc0 },
 222                 { 0x1f, 0x0000 }
 223         };
 224
 225         rtl_writephy_batch(phydev, phy_reg_init);
 226 }
 227
 228 static void rtl8169sce_hw_phy_config(struct rtl8169_private *tp,
 229                                      struct phy_device *phydev)
 230 {
 231         static const struct phy_reg phy_reg_init[] = {
 232                 { 0x1f, 0x0001 },
 233                 { 0x04, 0x0000 },
 234                 { 0x03, 0x00a1 },
 235                 { 0x02, 0x0008 },
 236                 { 0x01, 0x0120 },
 237                 { 0x00, 0x1000 },
 238                 { 0x04, 0x0800 },
 239                 { 0x04, 0x9000 },
 240                 { 0x03, 0x802f },
 241                 { 0x02, 0x4f02 },
 242                 { 0x01, 0x0409 },
 243                 { 0x00, 0xf099 },
 244                 { 0x04, 0x9800 },
 245                 { 0x04, 0xa000 },
 246                 { 0x03, 0xdf01 },
 247                 { 0x02, 0xdf20 },
 248                 { 0x01, 0xff95 },
 249                 { 0x00, 0xba00 },
 250                 { 0x04, 0xa800 },
 251                 { 0x04, 0xf000 },
 252                 { 0x03, 0xdf01 },
 253                 { 0x02, 0xdf20 },
 254                 { 0x01, 0x101a },
 255                 { 0x00, 0xa0ff },
 256                 { 0x04, 0xf800 },
 257                 { 0x04, 0x0000 },
 258                 { 0x1f, 0x0000 },
 259
 260                 { 0x1f, 0x0001 },
 261                 { 0x0b, 0x8480 },
 262                 { 0x1f, 0x0000 },
 263
 264                 { 0x1f, 0x0001 },
 265                 { 0x18, 0x67c7 },
 266                 { 0x04, 0x2000 },
 267                 { 0x03, 0x002f },
 268                 { 0x02, 0x4360 },
 269                 { 0x01, 0x0109 },
 270                 { 0x00, 0x3022 },
 271                 { 0x04, 0x2800 },
 272                 { 0x1f, 0x0000 },
 273
 274                 { 0x1f, 0x0001 },
 275                 { 0x17, 0x0cc0 },
 276                 { 0x1f, 0x0000 }
 277         };
 278
 279         rtl_writephy_batch(phydev, phy_reg_init);
 280 }
 281
 282 static void rtl8168bb_hw_phy_config(struct rtl8169_private *tp,
 283                                     struct phy_device *phydev)
 284 {
 285         phy_write(phydev, 0x1f, 0x0001);
 286         phy_set_bits(phydev, 0x16, BIT(0));
 287         phy_write(phydev, 0x10, 0xf41b);
 288         phy_write(phydev, 0x1f, 0x0000);
 289 }
 290
 291 static void rtl8168bef_hw_phy_config(struct rtl8169_private *tp,
 292                                      struct phy_device *phydev)
 293 {
 294         phy_write_paged(phydev, 0x0001, 0x10, 0xf41b);
 295 }
 296
 297 static void rtl8168cp_1_hw_phy_config(struct rtl8169_private *tp,
 298                                       struct phy_device *phydev)
 299 {
 300         phy_write(phydev, 0x1d, 0x0f00);
 301         phy_write_paged(phydev, 0x0002, 0x0c, 0x1ec8);
 302 }
 303
 304 static void rtl8168cp_2_hw_phy_config(struct rtl8169_private *tp,
 305                                       struct phy_device *phydev)
 306 {
 307         phy_set_bits(phydev, 0x14, BIT(5));
 308         phy_set_bits(phydev, 0x0d, BIT(5));
 309         phy_write_paged(phydev, 0x0001, 0x1d, 0x3d98);
 310 }
 311
 312 static void rtl8168c_1_hw_phy_config(struct rtl8169_private *tp,
 313                                      struct phy_device *phydev)
 314 {
 315         static const struct phy_reg phy_reg_init[] = {
 316                 { 0x1f, 0x0001 },
 317                 { 0x12, 0x2300 },
 318                 { 0x1f, 0x0002 },
 319                 { 0x00, 0x88d4 },
 320                 { 0x01, 0x82b1 },
 321                 { 0x03, 0x7002 },
 322                 { 0x08, 0x9e30 },
 323                 { 0x09, 0x01f0 },
 324                 { 0x0a, 0x5500 },
 325                 { 0x0c, 0x00c8 },
 326                 { 0x1f, 0x0003 },
 327                 { 0x12, 0xc096 },
 328                 { 0x16, 0x000a },
 329                 { 0x1f, 0x0000 },
 330                 { 0x1f, 0x0000 },
 331                 { 0x09, 0x2000 },
 332                 { 0x09, 0x0000 }
 333         };
 334
 335         rtl_writephy_batch(phydev, phy_reg_init);
 336
 337         phy_set_bits(phydev, 0x14, BIT(5));
 338         phy_set_bits(phydev, 0x0d, BIT(5));
 339 }
 340
 341 static void rtl8168c_2_hw_phy_config(struct rtl8169_private *tp,
 342                                      struct phy_device *phydev)
 343 {
 344         static const struct phy_reg phy_reg_init[] = {
 345                 { 0x1f, 0x0001 },
 346                 { 0x12, 0x2300 },
 347                 { 0x03, 0x802f },
 348                 { 0x02, 0x4f02 },
 349                 { 0x01, 0x0409 },
 350                 { 0x00, 0xf099 },
 351                 { 0x04, 0x9800 },
 352                 { 0x04, 0x9000 },
 353                 { 0x1d, 0x3d98 },
 354                 { 0x1f, 0x0002 },
 355                 { 0x0c, 0x7eb8 },
 356                 { 0x06, 0x0761 },
 357                 { 0x1f, 0x0003 },
 358                 { 0x16, 0x0f0a },
 359                 { 0x1f, 0x0000 }
 360         };
 361
 362         rtl_writephy_batch(phydev, phy_reg_init);
 363
 364         phy_set_bits(phydev, 0x16, BIT(0));
 365         phy_set_bits(phydev, 0x14, BIT(5));
 366         phy_set_bits(phydev, 0x0d, BIT(5));
 367 }
 368
 369 static void rtl8168c_3_hw_phy_config(struct rtl8169_private *tp,
 370                                      struct phy_device *phydev)
 371 {
 372         static const struct phy_reg phy_reg_init[] = {
 373                 { 0x1f, 0x0001 },
 374                 { 0x12, 0x2300 },
 375                 { 0x1d, 0x3d98 },
 376                 { 0x1f, 0x0002 },
 377                 { 0x0c, 0x7eb8 },
 378                 { 0x06, 0x5461 },
 379                 { 0x1f, 0x0003 },
 380                 { 0x16, 0x0f0a },
 381                 { 0x1f, 0x0000 }
 382         };
 383
 384         rtl_writephy_batch(phydev, phy_reg_init);
 385
 386         phy_set_bits(phydev, 0x16, BIT(0));
 387         phy_set_bits(phydev, 0x14, BIT(5));
 388         phy_set_bits(phydev, 0x0d, BIT(5));
 389 }
 390
 391 static const struct phy_reg rtl8168d_1_phy_reg_init_0[] = {
 392         /* Channel Estimation */
 393         { 0x1f, 0x0001 },
 394         { 0x06, 0x4064 },
 395         { 0x07, 0x2863 },
 396         { 0x08, 0x059c },
 397         { 0x09, 0x26b4 },
 398         { 0x0a, 0x6a19 },
 399         { 0x0b, 0xdcc8 },
 400         { 0x10, 0xf06d },
 401         { 0x14, 0x7f68 },
 402         { 0x18, 0x7fd9 },
 403         { 0x1c, 0xf0ff },
 404         { 0x1d, 0x3d9c },
 405         { 0x1f, 0x0003 },
 406         { 0x12, 0xf49f },
 407         { 0x13, 0x070b },
 408         { 0x1a, 0x05ad },
 409         { 0x14, 0x94c0 },
 410
 411         /*
 412          * Tx Error Issue
 413          * Enhance line driver power
 414          */
 415         { 0x1f, 0x0002 },
 416         { 0x06, 0x5561 },
 417         { 0x1f, 0x0005 },
 418         { 0x05, 0x8332 },
 419         { 0x06, 0x5561 },
 420
 421         /*
 422          * Can not link to 1Gbps with bad cable
 423          * Decrease SNR threshold form 21.07dB to 19.04dB
 424          */
 425         { 0x1f, 0x0001 },
 426         { 0x17, 0x0cc0 },
 427
 428         { 0x1f, 0x0000 },
 429         { 0x0d, 0xf880 }
 430 };
 431
 432 static const struct phy_reg rtl8168d_1_phy_reg_init_1[] = {
 433         { 0x1f, 0x0002 },
 434         { 0x05, 0x669a },
 435         { 0x1f, 0x0005 },
 436         { 0x05, 0x8330 },
 437         { 0x06, 0x669a },
 438         { 0x1f, 0x0002 }
 439 };
 440
 441 static void rtl8168d_apply_firmware_cond(struct rtl8169_private *tp,
 442                                          struct phy_device *phydev,
 443                                          u16 val)
 444 {
 445         u16 reg_val;
 446
 447         phy_write(phydev, 0x1f, 0x0005);
 448         phy_write(phydev, 0x05, 0x001b);
 449         reg_val = phy_read(phydev, 0x06);
 450         phy_write(phydev, 0x1f, 0x0000);
 451
 452         if (reg_val != val)
 453                 phydev_warn(phydev, "chipset not ready for firmware\n");
 454         else
 455                 r8169_apply_firmware(tp);
 456 }
 457
 458 static void rtl8168d_1_hw_phy_config(struct rtl8169_private *tp,
 459                                      struct phy_device *phydev)
 460 {
 461         rtl_writephy_batch(phydev, rtl8168d_1_phy_reg_init_0);
 462
 463         /*
 464          * Rx Error Issue
 465          * Fine Tune Switching regulator parameter
 466          */
 467         phy_write(phydev, 0x1f, 0x0002);
 468         phy_modify(phydev, 0x0b, 0x00ef, 0x0010);
 469         phy_modify(phydev, 0x0c, 0x5d00, 0xa200);
 470
 471         if (rtl8168d_efuse_read(tp, 0x01) == 0xb1) {
 472                 int val;
 473
 474                 rtl_writephy_batch(phydev, rtl8168d_1_phy_reg_init_1);
 475
 476                 val = phy_read(phydev, 0x0d);
 477
 478                 if ((val & 0x00ff) != 0x006c) {
 479                         static const u32 set[] = {
 480                                 0x0065, 0x0066, 0x0067, 0x0068,
 481                                 0x0069, 0x006a, 0x006b, 0x006c
 482                         };
 483                         int i;
 484
 485                         phy_write(phydev, 0x1f, 0x0002);
 486
 487                         val &= 0xff00;
 488                         for (i = 0; i < ARRAY_SIZE(set); i++)
 489                                 phy_write(phydev, 0x0d, val | set[i]);
 490                 }
 491         } else {
 492                 phy_write_paged(phydev, 0x0002, 0x05, 0x6662);
 493                 r8168d_phy_param(phydev, 0x8330, 0xffff, 0x6662);
 494         }
 495
 496         /* RSET couple improve */
 497         phy_write(phydev, 0x1f, 0x0002);
 498         phy_set_bits(phydev, 0x0d, 0x0300);
 499         phy_set_bits(phydev, 0x0f, 0x0010);
 500
 501         /* Fine tune PLL performance */
 502         phy_write(phydev, 0x1f, 0x0002);
 503         phy_modify(phydev, 0x02, 0x0600, 0x0100);
 504         phy_clear_bits(phydev, 0x03, 0xe000);
 505         phy_write(phydev, 0x1f, 0x0000);
 506
 507         rtl8168d_apply_firmware_cond(tp, phydev, 0xbf00);
 508 }
 509
 510 static void rtl8168d_2_hw_phy_config(struct rtl8169_private *tp,
 511                                      struct phy_device *phydev)
 512 {
 513         rtl_writephy_batch(phydev, rtl8168d_1_phy_reg_init_0);
 514
 515         if (rtl8168d_efuse_read(tp, 0x01) == 0xb1) {
 516                 int val;
 517
 518                 rtl_writephy_batch(phydev, rtl8168d_1_phy_reg_init_1);
 519
 520                 val = phy_read(phydev, 0x0d);
 521                 if ((val & 0x00ff) != 0x006c) {
 522                         static const u32 set[] = {
 523                                 0x0065, 0x0066, 0x0067, 0x0068,
 524                                 0x0069, 0x006a, 0x006b, 0x006c
 525                         };
 526                         int i;
 527
 528                         phy_write(phydev, 0x1f, 0x0002);
 529
 530                         val &= 0xff00;
 531                         for (i = 0; i < ARRAY_SIZE(set); i++)
 532                                 phy_write(phydev, 0x0d, val | set[i]);
 533                 }
 534         } else {
 535                 phy_write_paged(phydev, 0x0002, 0x05, 0x2642);
 536                 r8168d_phy_param(phydev, 0x8330, 0xffff, 0x2642);
 537         }
 538
 539         /* Fine tune PLL performance */
 540         phy_write(phydev, 0x1f, 0x0002);
 541         phy_modify(phydev, 0x02, 0x0600, 0x0100);
 542         phy_clear_bits(phydev, 0x03, 0xe000);
 543         phy_write(phydev, 0x1f, 0x0000);
 544
 545         /* Switching regulator Slew rate */
 546         phy_modify_paged(phydev, 0x0002, 0x0f, 0x0000, 0x0017);
 547
 548         rtl8168d_apply_firmware_cond(tp, phydev, 0xb300);
 549 }
 550
 551 static void rtl8168d_3_hw_phy_config(struct rtl8169_private *tp,
 552                                      struct phy_device *phydev)
 553 {
 554         static const struct phy_reg phy_reg_init[] = {
 555                 { 0x1f, 0x0002 },
 556                 { 0x10, 0x0008 },
 557                 { 0x0d, 0x006c },
 558
 559                 { 0x1f, 0x0000 },
 560                 { 0x0d, 0xf880 },
 561
 562                 { 0x1f, 0x0001 },
 563                 { 0x17, 0x0cc0 },
 564
 565                 { 0x1f, 0x0001 },
 566                 { 0x0b, 0xa4d8 },
 567                 { 0x09, 0x281c },
 568                 { 0x07, 0x2883 },
 569                 { 0x0a, 0x6b35 },
 570                 { 0x1d, 0x3da4 },
 571                 { 0x1c, 0xeffd },
 572                 { 0x14, 0x7f52 },
 573                 { 0x18, 0x7fc6 },
 574                 { 0x08, 0x0601 },
 575                 { 0x06, 0x4063 },
 576                 { 0x10, 0xf074 },
 577                 { 0x1f, 0x0003 },
 578                 { 0x13, 0x0789 },
 579                 { 0x12, 0xf4bd },
 580                 { 0x1a, 0x04fd },
 581                 { 0x14, 0x84b0 },
 582                 { 0x1f, 0x0000 },
 583                 { 0x00, 0x9200 },
 584
 585                 { 0x1f, 0x0005 },
 586                 { 0x01, 0x0340 },
 587                 { 0x1f, 0x0001 },
 588                 { 0x04, 0x4000 },
 589                 { 0x03, 0x1d21 },
 590                 { 0x02, 0x0c32 },
 591                 { 0x01, 0x0200 },
 592                 { 0x00, 0x5554 },
 593                 { 0x04, 0x4800 },
 594                 { 0x04, 0x4000 },
 595                 { 0x04, 0xf000 },
 596                 { 0x03, 0xdf01 },
 597                 { 0x02, 0xdf20 },
 598                 { 0x01, 0x101a },
 599                 { 0x00, 0xa0ff },
 600                 { 0x04, 0xf800 },
 601                 { 0x04, 0xf000 },
 602                 { 0x1f, 0x0000 },
 603         };
 604
 605         rtl_writephy_batch(phydev, phy_reg_init);
 606         r8168d_modify_extpage(phydev, 0x0023, 0x16, 0xffff, 0x0000);
 607 }
 608
 609 static void rtl8168d_4_hw_phy_config(struct rtl8169_private *tp,
 610                                      struct phy_device *phydev)
 611 {
 612         phy_write_paged(phydev, 0x0001, 0x17, 0x0cc0);
 613         r8168d_modify_extpage(phydev, 0x002d, 0x18, 0xffff, 0x0040);
 614         phy_set_bits(phydev, 0x0d, BIT(5));
 615 }
 616
 617 static void rtl8168e_1_hw_phy_config(struct rtl8169_private *tp,
 618                                      struct phy_device *phydev)
 619 {
 620         static const struct phy_reg phy_reg_init[] = {
 621                 /* Channel estimation fine tune */
 622                 { 0x1f, 0x0001 },
 623                 { 0x0b, 0x6c20 },
 624                 { 0x07, 0x2872 },
 625                 { 0x1c, 0xefff },
 626                 { 0x1f, 0x0003 },
 627                 { 0x14, 0x6420 },
 628                 { 0x1f, 0x0000 },
 629         };
 630
 631         r8169_apply_firmware(tp);
 632
 633         /* Enable Delay cap */
 634         r8168d_phy_param(phydev, 0x8b80, 0xffff, 0xc896);
 635
 636         rtl_writephy_batch(phydev, phy_reg_init);
 637
 638         /* Update PFM & 10M TX idle timer */
 639         r8168d_modify_extpage(phydev, 0x002f, 0x15, 0xffff, 0x1919);
 640
 641         r8168d_modify_extpage(phydev, 0x00ac, 0x18, 0xffff, 0x0006);
 642
 643         /* DCO enable for 10M IDLE Power */
 644         r8168d_modify_extpage(phydev, 0x0023, 0x17, 0x0000, 0x0006);
 645
 646         /* For impedance matching */
 647         phy_modify_paged(phydev, 0x0002, 0x08, 0x7f00, 0x8000);
 648
 649         /* PHY auto speed down */
 650         r8168d_modify_extpage(phydev, 0x002d, 0x18, 0x0000, 0x0050);
 651         phy_set_bits(phydev, 0x14, BIT(15));
 652
 653         r8168d_phy_param(phydev, 0x8b86, 0x0000, 0x0001);
 654         r8168d_phy_param(phydev, 0x8b85, 0x2000, 0x0000);
 655
 656         r8168d_modify_extpage(phydev, 0x0020, 0x15, 0x1100, 0x0000);
 657         phy_write_paged(phydev, 0x0006, 0x00, 0x5a00);
 658
 659         phy_write_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV, 0x0000);
 660 }
 661
 662 static void rtl8168e_2_hw_phy_config(struct rtl8169_private *tp,
 663                                      struct phy_device *phydev)
 664 {
 665         r8169_apply_firmware(tp);
 666
 667         /* Enable Delay cap */
 668         r8168d_modify_extpage(phydev, 0x00ac, 0x18, 0xffff, 0x0006);
 669
 670         /* Channel estimation fine tune */
 671         phy_write_paged(phydev, 0x0003, 0x09, 0xa20f);
 672
 673         /* Green Setting */
 674         r8168d_phy_param(phydev, 0x8b5b, 0xffff, 0x9222);
 675         r8168d_phy_param(phydev, 0x8b6d, 0xffff, 0x8000);
 676         r8168d_phy_param(phydev, 0x8b76, 0xffff, 0x8000);
 677
 678         /* For 4-corner performance improve */
 679         phy_write(phydev, 0x1f, 0x0005);
 680         phy_write(phydev, 0x05, 0x8b80);
 681         phy_set_bits(phydev, 0x17, 0x0006);
 682         phy_write(phydev, 0x1f, 0x0000);
 683
 684         /* PHY auto speed down */
 685         r8168d_modify_extpage(phydev, 0x002d, 0x18, 0x0000, 0x0010);
 686         phy_set_bits(phydev, 0x14, BIT(15));
 687
 688         /* improve 10M EEE waveform */
 689         r8168d_phy_param(phydev, 0x8b86, 0x0000, 0x0001);
 690
 691         /* Improve 2-pair detection performance */
 692         r8168d_phy_param(phydev, 0x8b85, 0x0000, 0x4000);
 693
 694         rtl8168f_config_eee_phy(phydev);
 695
 696         /* Green feature */
 697         phy_write(phydev, 0x1f, 0x0003);
 698         phy_set_bits(phydev, 0x19, BIT(0));
 699         phy_set_bits(phydev, 0x10, BIT(10));
 700         phy_write(phydev, 0x1f, 0x0000);
 701         phy_modify_paged(phydev, 0x0005, 0x01, 0, BIT(8));
 702 }
 703
 704 static void rtl8168f_hw_phy_config(struct rtl8169_private *tp,
 705                                    struct phy_device *phydev)
 706 {
 707         /* For 4-corner performance improve */
 708         r8168d_phy_param(phydev, 0x8b80, 0x0000, 0x0006);
 709
 710         /* PHY auto speed down */
 711         r8168d_modify_extpage(phydev, 0x002d, 0x18, 0x0000, 0x0010);
 712         phy_set_bits(phydev, 0x14, BIT(15));
 713
 714         /* Improve 10M EEE waveform */
 715         r8168d_phy_param(phydev, 0x8b86, 0x0000, 0x0001);
 716
 717         rtl8168f_config_eee_phy(phydev);
 718 }
 719
 720 static void rtl8168f_1_hw_phy_config(struct rtl8169_private *tp,
 721                                      struct phy_device *phydev)
 722 {
 723         r8169_apply_firmware(tp);
 724
 725         /* Channel estimation fine tune */
 726         phy_write_paged(phydev, 0x0003, 0x09, 0xa20f);
 727
 728         /* Modify green table for giga & fnet */
 729         r8168d_phy_param(phydev, 0x8b55, 0xffff, 0x0000);
 730         r8168d_phy_param(phydev, 0x8b5e, 0xffff, 0x0000);
 731         r8168d_phy_param(phydev, 0x8b67, 0xffff, 0x0000);
 732         r8168d_phy_param(phydev, 0x8b70, 0xffff, 0x0000);
 733         r8168d_modify_extpage(phydev, 0x0078, 0x17, 0xffff, 0x0000);
 734         r8168d_modify_extpage(phydev, 0x0078, 0x19, 0xffff, 0x00fb);
 735
 736         /* Modify green table for 10M */
 737         r8168d_phy_param(phydev, 0x8b79, 0xffff, 0xaa00);
 738
 739         /* Disable hiimpedance detection (RTCT) */
 740         phy_write_paged(phydev, 0x0003, 0x01, 0x328a);
 741
 742         rtl8168f_hw_phy_config(tp, phydev);
 743
 744         /* Improve 2-pair detection performance */
 745         r8168d_phy_param(phydev, 0x8b85, 0x0000, 0x4000);
 746 }
 747
 748 static void rtl8168f_2_hw_phy_config(struct rtl8169_private *tp,
 749                                      struct phy_device *phydev)
 750 {
 751         r8169_apply_firmware(tp);
 752
 753         rtl8168f_hw_phy_config(tp, phydev);
 754 }
 755
 756 static void rtl8411_hw_phy_config(struct rtl8169_private *tp,
 757                                   struct phy_device *phydev)
 758 {
 759         r8169_apply_firmware(tp);
 760
 761         rtl8168f_hw_phy_config(tp, phydev);
 762
 763         /* Improve 2-pair detection performance */
 764         r8168d_phy_param(phydev, 0x8b85, 0x0000, 0x4000);
 765
 766         /* Channel estimation fine tune */
 767         phy_write_paged(phydev, 0x0003, 0x09, 0xa20f);
 768
 769         /* Modify green table for giga & fnet */
 770         r8168d_phy_param(phydev, 0x8b55, 0xffff, 0x0000);
 771         r8168d_phy_param(phydev, 0x8b5e, 0xffff, 0x0000);
 772         r8168d_phy_param(phydev, 0x8b67, 0xffff, 0x0000);
 773         r8168d_phy_param(phydev, 0x8b70, 0xffff, 0x0000);
 774         r8168d_modify_extpage(phydev, 0x0078, 0x17, 0xffff, 0x0000);
 775         r8168d_modify_extpage(phydev, 0x0078, 0x19, 0xffff, 0x00aa);
 776
 777         /* Modify green table for 10M */
 778         r8168d_phy_param(phydev, 0x8b79, 0xffff, 0xaa00);
 779
 780         /* Disable hiimpedance detection (RTCT) */
 781         phy_write_paged(phydev, 0x0003, 0x01, 0x328a);
 782
 783         /* Modify green table for giga */
 784         r8168d_phy_param(phydev, 0x8b54, 0x0800, 0x0000);
 785         r8168d_phy_param(phydev, 0x8b5d, 0x0800, 0x0000);
 786         r8168d_phy_param(phydev, 0x8a7c, 0x0100, 0x0000);
 787         r8168d_phy_param(phydev, 0x8a7f, 0x0000, 0x0100);
 788         r8168d_phy_param(phydev, 0x8a82, 0x0100, 0x0000);
 789         r8168d_phy_param(phydev, 0x8a85, 0x0100, 0x0000);
 790         r8168d_phy_param(phydev, 0x8a88, 0x0100, 0x0000);
 791
 792         /* uc same-seed solution */
 793         r8168d_phy_param(phydev, 0x8b85, 0x0000, 0x8000);
 794
 795         /* Green feature */
 796         phy_write(phydev, 0x1f, 0x0003);
 797         phy_clear_bits(phydev, 0x19, BIT(0));
 798         phy_clear_bits(phydev, 0x10, BIT(10));
 799         phy_write(phydev, 0x1f, 0x0000);
 800 }
 801
 802 static void rtl8168g_disable_aldps(struct phy_device *phydev)
 803 {
 804         phy_modify_paged(phydev, 0x0a43, 0x10, BIT(2), 0);
 805 }
 806
 807 static void rtl8168g_enable_gphy_10m(struct phy_device *phydev)
 808 {
 809         phy_modify_paged(phydev, 0x0a44, 0x11, 0, BIT(11));
 810 }
 811
 812 static void rtl8168g_phy_adjust_10m_aldps(struct phy_device *phydev)
 813 {
 814         phy_modify_paged(phydev, 0x0bcc, 0x14, BIT(8), 0);
 815         phy_modify_paged(phydev, 0x0a44, 0x11, 0, BIT(7) | BIT(6));
 816         r8168g_phy_param(phydev, 0x8084, 0x6000, 0x0000);
 817         phy_modify_paged(phydev, 0x0a43, 0x10, 0x0000, 0x1003);
 818 }
 819
 820 static void rtl8168g_1_hw_phy_config(struct rtl8169_private *tp,
 821                                      struct phy_device *phydev)
 822 {
 823         int ret;
 824
 825         r8169_apply_firmware(tp);
 826
 827         ret = phy_read_paged(phydev, 0x0a46, 0x10);
 828         if (ret & BIT(8))
 829                 phy_modify_paged(phydev, 0x0bcc, 0x12, BIT(15), 0);
 830         else
 831                 phy_modify_paged(phydev, 0x0bcc, 0x12, 0, BIT(15));
 832
 833         ret = phy_read_paged(phydev, 0x0a46, 0x13);
 834         if (ret & BIT(8))
 835                 phy_modify_paged(phydev, 0x0c41, 0x15, 0, BIT(1));
 836         else
 837                 phy_modify_paged(phydev, 0x0c41, 0x15, BIT(1), 0);
 838
 839         /* Enable PHY auto speed down */
 840         phy_modify_paged(phydev, 0x0a44, 0x11, 0, BIT(3) | BIT(2));
 841
 842         rtl8168g_phy_adjust_10m_aldps(phydev);
 843
 844         /* EEE auto-fallback function */
 845         phy_modify_paged(phydev, 0x0a4b, 0x11, 0, BIT(2));
 846
 847         /* Enable UC LPF tune function */
 848         r8168g_phy_param(phydev, 0x8012, 0x0000, 0x8000);
 849
 850         phy_modify_paged(phydev, 0x0c42, 0x11, BIT(13), BIT(14));
 851
 852         /* Improve SWR Efficiency */
 853         phy_write(phydev, 0x1f, 0x0bcd);
 854         phy_write(phydev, 0x14, 0x5065);
 855         phy_write(phydev, 0x14, 0xd065);
 856         phy_write(phydev, 0x1f, 0x0bc8);
 857         phy_write(phydev, 0x11, 0x5655);
 858         phy_write(phydev, 0x1f, 0x0bcd);
 859         phy_write(phydev, 0x14, 0x1065);
 860         phy_write(phydev, 0x14, 0x9065);
 861         phy_write(phydev, 0x14, 0x1065);
 862         phy_write(phydev, 0x1f, 0x0000);
 863
 864         rtl8168g_disable_aldps(phydev);
 865         rtl8168g_config_eee_phy(phydev);
 866 }
 867
 868 static void rtl8168g_2_hw_phy_config(struct rtl8169_private *tp,
 869                                      struct phy_device *phydev)
 870 {
 871         r8169_apply_firmware(tp);
 872         rtl8168g_config_eee_phy(phydev);
 873 }
 874
 875 static void rtl8168h_1_hw_phy_config(struct rtl8169_private *tp,
 876                                      struct phy_device *phydev)
 877 {
 878         u16 dout_tapbin;
 879         u32 data;
 880
 881         r8169_apply_firmware(tp);
 882
 883         /* CHN EST parameters adjust - giga master */
 884         r8168g_phy_param(phydev, 0x809b, 0xf800, 0x8000);
 885         r8168g_phy_param(phydev, 0x80a2, 0xff00, 0x8000);
 886         r8168g_phy_param(phydev, 0x80a4, 0xff00, 0x8500);
 887         r8168g_phy_param(phydev, 0x809c, 0xff00, 0xbd00);
 888
 889         /* CHN EST parameters adjust - giga slave */
 890         r8168g_phy_param(phydev, 0x80ad, 0xf800, 0x7000);
 891         r8168g_phy_param(phydev, 0x80b4, 0xff00, 0x5000);
 892         r8168g_phy_param(phydev, 0x80ac, 0xff00, 0x4000);
 893
 894         /* CHN EST parameters adjust - fnet */
 895         r8168g_phy_param(phydev, 0x808e, 0xff00, 0x1200);
 896         r8168g_phy_param(phydev, 0x8090, 0xff00, 0xe500);
 897         r8168g_phy_param(phydev, 0x8092, 0xff00, 0x9f00);
 898
 899         /* enable R-tune & PGA-retune function */
 900         dout_tapbin = 0;
 901         data = phy_read_paged(phydev, 0x0a46, 0x13);
 902         data &= 3;
 903         data <<= 2;
 904         dout_tapbin |= data;
 905         data = phy_read_paged(phydev, 0x0a46, 0x12);
 906         data &= 0xc000;
 907         data >>= 14;
 908         dout_tapbin |= data;
 909         dout_tapbin = ~(dout_tapbin ^ 0x08);
 910         dout_tapbin <<= 12;
 911         dout_tapbin &= 0xf000;
 912
 913         r8168g_phy_param(phydev, 0x827a, 0xf000, dout_tapbin);
 914         r8168g_phy_param(phydev, 0x827b, 0xf000, dout_tapbin);
 915         r8168g_phy_param(phydev, 0x827c, 0xf000, dout_tapbin);
 916         r8168g_phy_param(phydev, 0x827d, 0xf000, dout_tapbin);
 917         r8168g_phy_param(phydev, 0x0811, 0x0000, 0x0800);
 918         phy_modify_paged(phydev, 0x0a42, 0x16, 0x0000, 0x0002);
 919
 920         rtl8168g_enable_gphy_10m(phydev);
 921
 922         /* SAR ADC performance */
 923         phy_modify_paged(phydev, 0x0bca, 0x17, BIT(12) | BIT(13), BIT(14));
 924
 925         r8168g_phy_param(phydev, 0x803f, 0x3000, 0x0000);
 926         r8168g_phy_param(phydev, 0x8047, 0x3000, 0x0000);
 927         r8168g_phy_param(phydev, 0x804f, 0x3000, 0x0000);
 928         r8168g_phy_param(phydev, 0x8057, 0x3000, 0x0000);
 929         r8168g_phy_param(phydev, 0x805f, 0x3000, 0x0000);
 930         r8168g_phy_param(phydev, 0x8067, 0x3000, 0x0000);
 931         r8168g_phy_param(phydev, 0x806f, 0x3000, 0x0000);
 932
 933         /* disable phy pfm mode */
 934         phy_modify_paged(phydev, 0x0a44, 0x11, BIT(7), 0);
 935
 936         rtl8168g_disable_aldps(phydev);
 937         rtl8168h_config_eee_phy(phydev);
 938 }
 939
 940 static void rtl8168h_2_hw_phy_config(struct rtl8169_private *tp,
 941                                      struct phy_device *phydev)
 942 {
 943         u16 ioffset, rlen;
 944         u32 data;
 945
 946         r8169_apply_firmware(tp);
 947
 948         /* CHIN EST parameter update */
 949         r8168g_phy_param(phydev, 0x808a, 0x003f, 0x000a);
 950
 951         /* enable R-tune & PGA-retune function */
 952         r8168g_phy_param(phydev, 0x0811, 0x0000, 0x0800);
 953         phy_modify_paged(phydev, 0x0a42, 0x16, 0x0000, 0x0002);
 954
 955         rtl8168g_enable_gphy_10m(phydev);
 956
 957         ioffset = rtl8168h_2_get_adc_bias_ioffset(tp);
 958         if (ioffset != 0xffff)
 959                 phy_write_paged(phydev, 0x0bcf, 0x16, ioffset);
 960
 961         /* Modify rlen (TX LPF corner frequency) level */
 962         data = phy_read_paged(phydev, 0x0bcd, 0x16);
 963         data &= 0x000f;
 964         rlen = 0;
 965         if (data > 3)
 966                 rlen = data - 3;
 967         data = rlen | (rlen << 4) | (rlen << 8) | (rlen << 12);
 968         phy_write_paged(phydev, 0x0bcd, 0x17, data);
 969
 970         /* disable phy pfm mode */
 971         phy_modify_paged(phydev, 0x0a44, 0x11, BIT(7), 0);
 972
 973         rtl8168g_disable_aldps(phydev);
 974         rtl8168g_config_eee_phy(phydev);
 975 }
 976
 977 static void rtl8168ep_1_hw_phy_config(struct rtl8169_private *tp,
 978                                       struct phy_device *phydev)
 979 {
 980         /* Enable PHY auto speed down */
 981         phy_modify_paged(phydev, 0x0a44, 0x11, 0, BIT(3) | BIT(2));
 982
 983         rtl8168g_phy_adjust_10m_aldps(phydev);
 984
 985         /* Enable EEE auto-fallback function */
 986         phy_modify_paged(phydev, 0x0a4b, 0x11, 0, BIT(2));
 987
 988         /* Enable UC LPF tune function */
 989         r8168g_phy_param(phydev, 0x8012, 0x0000, 0x8000);
 990
 991         /* set rg_sel_sdm_rate */
 992         phy_modify_paged(phydev, 0x0c42, 0x11, BIT(13), BIT(14));
 993
 994         rtl8168g_disable_aldps(phydev);
 995         rtl8168g_config_eee_phy(phydev);
 996 }
 997
 998 static void rtl8168ep_2_hw_phy_config(struct rtl8169_private *tp,
 999                                       struct phy_device *phydev)
1000 {
1001         rtl8168g_phy_adjust_10m_aldps(phydev);
1002
1003         /* Enable UC LPF tune function */
1004         r8168g_phy_param(phydev, 0x8012, 0x0000, 0x8000);
1005
1006         /* Set rg_sel_sdm_rate */
1007         phy_modify_paged(phydev, 0x0c42, 0x11, BIT(13), BIT(14));
1008
1009         /* Channel estimation parameters */
1010         r8168g_phy_param(phydev, 0x80f3, 0xff00, 0x8b00);
1011         r8168g_phy_param(phydev, 0x80f0, 0xff00, 0x3a00);
1012         r8168g_phy_param(phydev, 0x80ef, 0xff00, 0x0500);
1013         r8168g_phy_param(phydev, 0x80f6, 0xff00, 0x6e00);
1014         r8168g_phy_param(phydev, 0x80ec, 0xff00, 0x6800);
1015         r8168g_phy_param(phydev, 0x80ed, 0xff00, 0x7c00);
1016         r8168g_phy_param(phydev, 0x80f2, 0xff00, 0xf400);
1017         r8168g_phy_param(phydev, 0x80f4, 0xff00, 0x8500);
1018         r8168g_phy_param(phydev, 0x8110, 0xff00, 0xa800);
1019         r8168g_phy_param(phydev, 0x810f, 0xff00, 0x1d00);
1020         r8168g_phy_param(phydev, 0x8111, 0xff00, 0xf500);
1021         r8168g_phy_param(phydev, 0x8113, 0xff00, 0x6100);
1022         r8168g_phy_param(phydev, 0x8115, 0xff00, 0x9200);
1023         r8168g_phy_param(phydev, 0x810e, 0xff00, 0x0400);
1024         r8168g_phy_param(phydev, 0x810c, 0xff00, 0x7c00);
1025         r8168g_phy_param(phydev, 0x810b, 0xff00, 0x5a00);
1026         r8168g_phy_param(phydev, 0x80d1, 0xff00, 0xff00);
1027         r8168g_phy_param(phydev, 0x80cd, 0xff00, 0x9e00);
1028         r8168g_phy_param(phydev, 0x80d3, 0xff00, 0x0e00);
1029         r8168g_phy_param(phydev, 0x80d5, 0xff00, 0xca00);
1030         r8168g_phy_param(phydev, 0x80d7, 0xff00, 0x8400);
1031
1032         /* Force PWM-mode */
1033         phy_write(phydev, 0x1f, 0x0bcd);
1034         phy_write(phydev, 0x14, 0x5065);
1035         phy_write(phydev, 0x14, 0xd065);
1036         phy_write(phydev, 0x1f, 0x0bc8);
1037         phy_write(phydev, 0x12, 0x00ed);
1038         phy_write(phydev, 0x1f, 0x0bcd);
1039         phy_write(phydev, 0x14, 0x1065);
1040         phy_write(phydev, 0x14, 0x9065);
1041         phy_write(phydev, 0x14, 0x1065);
1042         phy_write(phydev, 0x1f, 0x0000);
1043
1044         rtl8168g_disable_aldps(phydev);
1045         rtl8168g_config_eee_phy(phydev);
1046 }
1047
1048 static void rtl8117_hw_phy_config(struct rtl8169_private *tp,
1049                                   struct phy_device *phydev)
1050 {
1051         /* CHN EST parameters adjust - fnet */
1052         r8168g_phy_param(phydev, 0x808e, 0xff00, 0x4800);
1053         r8168g_phy_param(phydev, 0x8090, 0xff00, 0xcc00);
1054         r8168g_phy_param(phydev, 0x8092, 0xff00, 0xb000);
1055
1056         r8168g_phy_param(phydev, 0x8088, 0xff00, 0x6000);
1057         r8168g_phy_param(phydev, 0x808b, 0x3f00, 0x0b00);
1058         r8168g_phy_param(phydev, 0x808d, 0x1f00, 0x0600);
1059         r8168g_phy_param(phydev, 0x808c, 0xff00, 0xb000);
1060         r8168g_phy_param(phydev, 0x80a0, 0xff00, 0x2800);
1061         r8168g_phy_param(phydev, 0x80a2, 0xff00, 0x5000);
1062         r8168g_phy_param(phydev, 0x809b, 0xf800, 0xb000);
1063         r8168g_phy_param(phydev, 0x809a, 0xff00, 0x4b00);
1064         r8168g_phy_param(phydev, 0x809d, 0x3f00, 0x0800);
1065         r8168g_phy_param(phydev, 0x80a1, 0xff00, 0x7000);
1066         r8168g_phy_param(phydev, 0x809f, 0x1f00, 0x0300);
1067         r8168g_phy_param(phydev, 0x809e, 0xff00, 0x8800);
1068         r8168g_phy_param(phydev, 0x80b2, 0xff00, 0x2200);
1069         r8168g_phy_param(phydev, 0x80ad, 0xf800, 0x9800);
1070         r8168g_phy_param(phydev, 0x80af, 0x3f00, 0x0800);
1071         r8168g_phy_param(phydev, 0x80b3, 0xff00, 0x6f00);
1072         r8168g_phy_param(phydev, 0x80b1, 0x1f00, 0x0300);
1073         r8168g_phy_param(phydev, 0x80b0, 0xff00, 0x9300);
1074
1075         r8168g_phy_param(phydev, 0x8011, 0x0000, 0x0800);
1076
1077         rtl8168g_enable_gphy_10m(phydev);
1078
1079         r8168g_phy_param(phydev, 0x8016, 0x0000, 0x0400);
1080
1081         rtl8168g_disable_aldps(phydev);
1082         rtl8168h_config_eee_phy(phydev);
1083 }
1084
1085 static void rtl8102e_hw_phy_config(struct rtl8169_private *tp,
1086                                    struct phy_device *phydev)
1087 {
1088         static const struct phy_reg phy_reg_init[] = {
1089                 { 0x1f, 0x0003 },
1090                 { 0x08, 0x441d },
1091                 { 0x01, 0x9100 },
1092                 { 0x1f, 0x0000 }
1093         };
1094
1095         phy_set_bits(phydev, 0x11, BIT(12));
1096         phy_set_bits(phydev, 0x19, BIT(13));
1097         phy_set_bits(phydev, 0x10, BIT(15));
1098
1099         rtl_writephy_batch(phydev, phy_reg_init);
1100 }
1101
1102 static void rtl8401_hw_phy_config(struct rtl8169_private *tp,
1103                                   struct phy_device *phydev)
1104 {
1105         phy_set_bits(phydev, 0x11, BIT(12));
1106         phy_modify_paged(phydev, 0x0002, 0x0f, 0x0000, 0x0003);
1107 }
1108
1109 static void rtl8105e_hw_phy_config(struct rtl8169_private *tp,
1110                                    struct phy_device *phydev)
1111 {
1112         /* Disable ALDPS before ram code */
1113         phy_write(phydev, 0x18, 0x0310);
1114         msleep(100);
1115
1116         r8169_apply_firmware(tp);
1117
1118         phy_write_paged(phydev, 0x0005, 0x1a, 0x0000);
1119         phy_write_paged(phydev, 0x0004, 0x1c, 0x0000);
1120         phy_write_paged(phydev, 0x0001, 0x15, 0x7701);
1121 }
1122
1123 static void rtl8402_hw_phy_config(struct rtl8169_private *tp,
1124                                   struct phy_device *phydev)
1125 {
1126         /* Disable ALDPS before setting firmware */
1127         phy_write(phydev, 0x18, 0x0310);
1128         msleep(20);
1129
1130         r8169_apply_firmware(tp);
1131
1132         /* EEE setting */
1133         phy_write(phydev, 0x1f, 0x0004);
1134         phy_write(phydev, 0x10, 0x401f);
1135         phy_write(phydev, 0x19, 0x7030);
1136         phy_write(phydev, 0x1f, 0x0000);
1137 }
1138
1139 static void rtl8106e_hw_phy_config(struct rtl8169_private *tp,
1140                                    struct phy_device *phydev)
1141 {
1142         static const struct phy_reg phy_reg_init[] = {
1143                 { 0x1f, 0x0004 },
1144                 { 0x10, 0xc07f },
1145                 { 0x19, 0x7030 },
1146                 { 0x1f, 0x0000 }
1147         };
1148
1149         /* Disable ALDPS before ram code */
1150         phy_write(phydev, 0x18, 0x0310);
1151         msleep(100);
1152
1153         r8169_apply_firmware(tp);
1154
1155         rtl_writephy_batch(phydev, phy_reg_init);
1156 }
1157
1158 static void rtl8125_legacy_force_mode(struct phy_device *phydev)
1159 {
1160         phy_modify_paged(phydev, 0xa5b, 0x12, BIT(15), 0);
1161 }
1162
1163 static void rtl8125a_1_hw_phy_config(struct rtl8169_private *tp,
1164                                      struct phy_device *phydev)
1165 {
1166         phy_modify_paged(phydev, 0xad4, 0x10, 0x03ff, 0x0084);
1167         phy_modify_paged(phydev, 0xad4, 0x17, 0x0000, 0x0010);
1168         phy_modify_paged(phydev, 0xad1, 0x13, 0x03ff, 0x0006);
1169         phy_modify_paged(phydev, 0xad3, 0x11, 0x003f, 0x0006);
1170         phy_modify_paged(phydev, 0xac0, 0x14, 0x0000, 0x1100);
1171         phy_modify_paged(phydev, 0xac8, 0x15, 0xf000, 0x7000);
1172         phy_modify_paged(phydev, 0xad1, 0x14, 0x0000, 0x0400);
1173         phy_modify_paged(phydev, 0xad1, 0x15, 0x0000, 0x03ff);
1174         phy_modify_paged(phydev, 0xad1, 0x16, 0x0000, 0x03ff);
1175
1176         r8168g_phy_param(phydev, 0x80ea, 0xff00, 0xc400);
1177         r8168g_phy_param(phydev, 0x80eb, 0x0700, 0x0300);
1178         r8168g_phy_param(phydev, 0x80f8, 0xff00, 0x1c00);
1179         r8168g_phy_param(phydev, 0x80f1, 0xff00, 0x3000);
1180         r8168g_phy_param(phydev, 0x80fe, 0xff00, 0xa500);
1181         r8168g_phy_param(phydev, 0x8102, 0xff00, 0x5000);
1182         r8168g_phy_param(phydev, 0x8105, 0xff00, 0x3300);
1183         r8168g_phy_param(phydev, 0x8100, 0xff00, 0x7000);
1184         r8168g_phy_param(phydev, 0x8104, 0xff00, 0xf000);
1185         r8168g_phy_param(phydev, 0x8106, 0xff00, 0x6500);
1186         r8168g_phy_param(phydev, 0x80dc, 0xff00, 0xed00);
1187         r8168g_phy_param(phydev, 0x80df, 0x0000, 0x0100);
1188         r8168g_phy_param(phydev, 0x80e1, 0x0100, 0x0000);
1189
1190         phy_modify_paged(phydev, 0xbf0, 0x13, 0x003f, 0x0038);
1191         r8168g_phy_param(phydev, 0x819f, 0xffff, 0xd0b6);
1192
1193         phy_write_paged(phydev, 0xbc3, 0x12, 0x5555);
1194         phy_modify_paged(phydev, 0xbf0, 0x15, 0x0e00, 0x0a00);
1195         phy_modify_paged(phydev, 0xa5c, 0x10, 0x0400, 0x0000);
1196         rtl8168g_enable_gphy_10m(phydev);
1197
1198         rtl8125a_config_eee_phy(phydev);
1199 }
1200
1201 static void rtl8125a_2_hw_phy_config(struct rtl8169_private *tp,
1202                                      struct phy_device *phydev)
1203 {
1204         int i;
1205
1206         phy_modify_paged(phydev, 0xad4, 0x17, 0x0000, 0x0010);
1207         phy_modify_paged(phydev, 0xad1, 0x13, 0x03ff, 0x03ff);
1208         phy_modify_paged(phydev, 0xad3, 0x11, 0x003f, 0x0006);
1209         phy_modify_paged(phydev, 0xac0, 0x14, 0x1100, 0x0000);
1210         phy_modify_paged(phydev, 0xacc, 0x10, 0x0003, 0x0002);
1211         phy_modify_paged(phydev, 0xad4, 0x10, 0x00e7, 0x0044);
1212         phy_modify_paged(phydev, 0xac1, 0x12, 0x0080, 0x0000);
1213         phy_modify_paged(phydev, 0xac8, 0x10, 0x0300, 0x0000);
1214         phy_modify_paged(phydev, 0xac5, 0x17, 0x0007, 0x0002);
1215         phy_write_paged(phydev, 0xad4, 0x16, 0x00a8);
1216         phy_write_paged(phydev, 0xac5, 0x16, 0x01ff);
1217         phy_modify_paged(phydev, 0xac8, 0x15, 0x00f0, 0x0030);
1218
1219         phy_write(phydev, 0x1f, 0x0b87);
1220         phy_write(phydev, 0x16, 0x80a2);
1221         phy_write(phydev, 0x17, 0x0153);
1222         phy_write(phydev, 0x16, 0x809c);
1223         phy_write(phydev, 0x17, 0x0153);
1224         phy_write(phydev, 0x1f, 0x0000);
1225
1226         phy_write(phydev, 0x1f, 0x0a43);
1227         phy_write(phydev, 0x13, 0x81B3);
1228         phy_write(phydev, 0x14, 0x0043);
1229         phy_write(phydev, 0x14, 0x00A7);
1230         phy_write(phydev, 0x14, 0x00D6);
1231         phy_write(phydev, 0x14, 0x00EC);
1232         phy_write(phydev, 0x14, 0x00F6);
1233         phy_write(phydev, 0x14, 0x00FB);
1234         phy_write(phydev, 0x14, 0x00FD);
1235         phy_write(phydev, 0x14, 0x00FF);
1236         phy_write(phydev, 0x14, 0x00BB);
1237         phy_write(phydev, 0x14, 0x0058);
1238         phy_write(phydev, 0x14, 0x0029);
1239         phy_write(phydev, 0x14, 0x0013);
1240         phy_write(phydev, 0x14, 0x0009);
1241         phy_write(phydev, 0x14, 0x0004);
1242         phy_write(phydev, 0x14, 0x0002);
1243         for (i = 0; i < 25; i++)
1244                 phy_write(phydev, 0x14, 0x0000);
1245         phy_write(phydev, 0x1f, 0x0000);
1246
1247         r8168g_phy_param(phydev, 0x8257, 0xffff, 0x020F);
1248         r8168g_phy_param(phydev, 0x80ea, 0xffff, 0x7843);
1249
1250         r8169_apply_firmware(tp);
1251
1252         phy_modify_paged(phydev, 0xd06, 0x14, 0x0000, 0x2000);
1253
1254         r8168g_phy_param(phydev, 0x81a2, 0x0000, 0x0100);
1255
1256         phy_modify_paged(phydev, 0xb54, 0x16, 0xff00, 0xdb00);
1257         phy_modify_paged(phydev, 0xa45, 0x12, 0x0001, 0x0000);
1258         phy_modify_paged(phydev, 0xa5d, 0x12, 0x0000, 0x0020);
1259         phy_modify_paged(phydev, 0xad4, 0x17, 0x0010, 0x0000);
1260         phy_modify_paged(phydev, 0xa86, 0x15, 0x0001, 0x0000);
1261         rtl8168g_enable_gphy_10m(phydev);
1262
1263         rtl8125a_config_eee_phy(phydev);
1264 }
1265
1266 static void rtl8125b_hw_phy_config(struct rtl8169_private *tp,
1267                                    struct phy_device *phydev)
1268 {
1269         r8169_apply_firmware(tp);
1270
1271         phy_modify_paged(phydev, 0xa44, 0x11, 0x0000, 0x0800);
1272         phy_modify_paged(phydev, 0xac4, 0x13, 0x00f0, 0x0090);
1273         phy_modify_paged(phydev, 0xad3, 0x10, 0x0003, 0x0001);
1274
1275         phy_write(phydev, 0x1f, 0x0b87);
1276         phy_write(phydev, 0x16, 0x80f5);
1277         phy_write(phydev, 0x17, 0x760e);
1278         phy_write(phydev, 0x16, 0x8107);
1279         phy_write(phydev, 0x17, 0x360e);
1280         phy_write(phydev, 0x16, 0x8551);
1281         phy_modify(phydev, 0x17, 0xff00, 0x0800);
1282         phy_write(phydev, 0x1f, 0x0000);
1283
1284         phy_modify_paged(phydev, 0xbf0, 0x10, 0xe000, 0xa000);
1285         phy_modify_paged(phydev, 0xbf4, 0x13, 0x0f00, 0x0300);
1286
1287         r8168g_phy_param(phydev, 0x8044, 0xffff, 0x2417);
1288         r8168g_phy_param(phydev, 0x804a, 0xffff, 0x2417);
1289         r8168g_phy_param(phydev, 0x8050, 0xffff, 0x2417);
1290         r8168g_phy_param(phydev, 0x8056, 0xffff, 0x2417);
1291         r8168g_phy_param(phydev, 0x805c, 0xffff, 0x2417);
1292         r8168g_phy_param(phydev, 0x8062, 0xffff, 0x2417);
1293         r8168g_phy_param(phydev, 0x8068, 0xffff, 0x2417);
1294         r8168g_phy_param(phydev, 0x806e, 0xffff, 0x2417);
1295         r8168g_phy_param(phydev, 0x8074, 0xffff, 0x2417);
1296         r8168g_phy_param(phydev, 0x807a, 0xffff, 0x2417);
1297
1298         phy_modify_paged(phydev, 0xa4c, 0x15, 0x0000, 0x0040);
1299         phy_modify_paged(phydev, 0xbf8, 0x12, 0xe000, 0xa000);
1300
1301         rtl8125_legacy_force_mode(phydev);
1302         rtl8125b_config_eee_phy(phydev);
1303 }
1304
1305 void r8169_hw_phy_config(struct rtl8169_private *tp, struct phy_device *phydev,
1306                          enum mac_version ver)
1307 {
1308         static const rtl_phy_cfg_fct phy_configs[] = {
1309                 /* PCI devices. */
1310                 [RTL_GIGA_MAC_VER_02] = rtl8169s_hw_phy_config,
1311                 [RTL_GIGA_MAC_VER_03] = rtl8169s_hw_phy_config,
1312                 [RTL_GIGA_MAC_VER_04] = rtl8169sb_hw_phy_config,
1313                 [RTL_GIGA_MAC_VER_05] = rtl8169scd_hw_phy_config,
1314                 [RTL_GIGA_MAC_VER_06] = rtl8169sce_hw_phy_config,
1315                 /* PCI-E devices. */
1316                 [RTL_GIGA_MAC_VER_07] = rtl8102e_hw_phy_config,
1317                 [RTL_GIGA_MAC_VER_08] = rtl8102e_hw_phy_config,
1318                 [RTL_GIGA_MAC_VER_09] = rtl8102e_hw_phy_config,
1319                 [RTL_GIGA_MAC_VER_10] = NULL,
1320                 [RTL_GIGA_MAC_VER_11] = rtl8168bb_hw_phy_config,
1321                 [RTL_GIGA_MAC_VER_12] = rtl8168bef_hw_phy_config,
1322                 [RTL_GIGA_MAC_VER_13] = NULL,
1323                 [RTL_GIGA_MAC_VER_14] = rtl8401_hw_phy_config,
1324                 [RTL_GIGA_MAC_VER_16] = NULL,
1325                 [RTL_GIGA_MAC_VER_17] = rtl8168bef_hw_phy_config,
1326                 [RTL_GIGA_MAC_VER_18] = rtl8168cp_1_hw_phy_config,
1327                 [RTL_GIGA_MAC_VER_19] = rtl8168c_1_hw_phy_config,
1328                 [RTL_GIGA_MAC_VER_20] = rtl8168c_2_hw_phy_config,
1329                 [RTL_GIGA_MAC_VER_21] = rtl8168c_3_hw_phy_config,
1330                 [RTL_GIGA_MAC_VER_22] = rtl8168c_3_hw_phy_config,
1331                 [RTL_GIGA_MAC_VER_23] = rtl8168cp_2_hw_phy_config,
1332                 [RTL_GIGA_MAC_VER_24] = rtl8168cp_2_hw_phy_config,
1333                 [RTL_GIGA_MAC_VER_25] = rtl8168d_1_hw_phy_config,
1334                 [RTL_GIGA_MAC_VER_26] = rtl8168d_2_hw_phy_config,
1335                 [RTL_GIGA_MAC_VER_27] = rtl8168d_3_hw_phy_config,
1336                 [RTL_GIGA_MAC_VER_28] = rtl8168d_4_hw_phy_config,
1337                 [RTL_GIGA_MAC_VER_29] = rtl8105e_hw_phy_config,
1338                 [RTL_GIGA_MAC_VER_30] = rtl8105e_hw_phy_config,
1339                 [RTL_GIGA_MAC_VER_31] = NULL,
1340                 [RTL_GIGA_MAC_VER_32] = rtl8168e_1_hw_phy_config,
1341                 [RTL_GIGA_MAC_VER_33] = rtl8168e_1_hw_phy_config,
1342                 [RTL_GIGA_MAC_VER_34] = rtl8168e_2_hw_phy_config,
1343                 [RTL_GIGA_MAC_VER_35] = rtl8168f_1_hw_phy_config,
1344                 [RTL_GIGA_MAC_VER_36] = rtl8168f_2_hw_phy_config,
1345                 [RTL_GIGA_MAC_VER_37] = rtl8402_hw_phy_config,
1346                 [RTL_GIGA_MAC_VER_38] = rtl8411_hw_phy_config,
1347                 [RTL_GIGA_MAC_VER_39] = rtl8106e_hw_phy_config,
1348                 [RTL_GIGA_MAC_VER_40] = rtl8168g_1_hw_phy_config,
1349                 [RTL_GIGA_MAC_VER_41] = NULL,
1350                 [RTL_GIGA_MAC_VER_42] = rtl8168g_2_hw_phy_config,
1351                 [RTL_GIGA_MAC_VER_43] = rtl8168g_2_hw_phy_config,
1352                 [RTL_GIGA_MAC_VER_44] = rtl8168g_2_hw_phy_config,
1353                 [RTL_GIGA_MAC_VER_45] = rtl8168h_1_hw_phy_config,
1354                 [RTL_GIGA_MAC_VER_46] = rtl8168h_2_hw_phy_config,
1355                 [RTL_GIGA_MAC_VER_47] = rtl8168h_1_hw_phy_config,
1356                 [RTL_GIGA_MAC_VER_48] = rtl8168h_2_hw_phy_config,
1357                 [RTL_GIGA_MAC_VER_49] = rtl8168ep_1_hw_phy_config,
1358                 [RTL_GIGA_MAC_VER_50] = rtl8168ep_2_hw_phy_config,
1359                 [RTL_GIGA_MAC_VER_51] = rtl8168ep_2_hw_phy_config,
1360                 [RTL_GIGA_MAC_VER_52] = rtl8117_hw_phy_config,
1361                 [RTL_GIGA_MAC_VER_60] = rtl8125a_1_hw_phy_config,
1362                 [RTL_GIGA_MAC_VER_61] = rtl8125a_2_hw_phy_config,
1363                 [RTL_GIGA_MAC_VER_63] = rtl8125b_hw_phy_config,
1364         };
1365
1366         if (phy_configs[ver])
1367                 phy_configs[ver](tp, phydev);
1368 }