phy.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895
  1. /*
  2. * Generic PHY Management code
  3. *
  4. * SPDX-License-Identifier: GPL-2.0+
  5. *
  6. * Copyright 2011 Freescale Semiconductor, Inc.
  7. * author Andy Fleming
  8. *
  9. * Based loosely off of Linux's PHY Lib
  10. */
  11. #include <config.h>
  12. #include <common.h>
  13. #include <console.h>
  14. #include <dm.h>
  15. #include <malloc.h>
  16. #include <net.h>
  17. #include <command.h>
  18. #include <miiphy.h>
  19. #include <phy.h>
  20. #include <errno.h>
  21. #include <linux/err.h>
  22. #include <linux/compiler.h>
  23. DECLARE_GLOBAL_DATA_PTR;
  24. /* Generic PHY support and helper functions */
  25. /**
  26. * genphy_config_advert - sanitize and advertise auto-negotation parameters
  27. * @phydev: target phy_device struct
  28. *
  29. * Description: Writes MII_ADVERTISE with the appropriate values,
  30. * after sanitizing the values to make sure we only advertise
  31. * what is supported. Returns < 0 on error, 0 if the PHY's advertisement
  32. * hasn't changed, and > 0 if it has changed.
  33. */
  34. static int genphy_config_advert(struct phy_device *phydev)
  35. {
  36. u32 advertise;
  37. int oldadv, adv, bmsr;
  38. int err, changed = 0;
  39. /* Only allow advertising what this PHY supports */
  40. phydev->advertising &= phydev->supported;
  41. advertise = phydev->advertising;
  42. /* Setup standard advertisement */
  43. adv = phy_read(phydev, MDIO_DEVAD_NONE, MII_ADVERTISE);
  44. oldadv = adv;
  45. if (adv < 0)
  46. return adv;
  47. adv &= ~(ADVERTISE_ALL | ADVERTISE_100BASE4 | ADVERTISE_PAUSE_CAP |
  48. ADVERTISE_PAUSE_ASYM);
  49. if (advertise & ADVERTISED_10baseT_Half)
  50. adv |= ADVERTISE_10HALF;
  51. if (advertise & ADVERTISED_10baseT_Full)
  52. adv |= ADVERTISE_10FULL;
  53. if (advertise & ADVERTISED_100baseT_Half)
  54. adv |= ADVERTISE_100HALF;
  55. if (advertise & ADVERTISED_100baseT_Full)
  56. adv |= ADVERTISE_100FULL;
  57. if (advertise & ADVERTISED_Pause)
  58. adv |= ADVERTISE_PAUSE_CAP;
  59. if (advertise & ADVERTISED_Asym_Pause)
  60. adv |= ADVERTISE_PAUSE_ASYM;
  61. if (advertise & ADVERTISED_1000baseX_Half)
  62. adv |= ADVERTISE_1000XHALF;
  63. if (advertise & ADVERTISED_1000baseX_Full)
  64. adv |= ADVERTISE_1000XFULL;
  65. if (adv != oldadv) {
  66. err = phy_write(phydev, MDIO_DEVAD_NONE, MII_ADVERTISE, adv);
  67. if (err < 0)
  68. return err;
  69. changed = 1;
  70. }
  71. bmsr = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
  72. if (bmsr < 0)
  73. return bmsr;
  74. /* Per 802.3-2008, Section 22.2.4.2.16 Extended status all
  75. * 1000Mbits/sec capable PHYs shall have the BMSR_ESTATEN bit set to a
  76. * logical 1.
  77. */
  78. if (!(bmsr & BMSR_ESTATEN))
  79. return changed;
  80. /* Configure gigabit if it's supported */
  81. adv = phy_read(phydev, MDIO_DEVAD_NONE, MII_CTRL1000);
  82. oldadv = adv;
  83. if (adv < 0)
  84. return adv;
  85. adv &= ~(ADVERTISE_1000FULL | ADVERTISE_1000HALF);
  86. if (phydev->supported & (SUPPORTED_1000baseT_Half |
  87. SUPPORTED_1000baseT_Full)) {
  88. if (advertise & SUPPORTED_1000baseT_Half)
  89. adv |= ADVERTISE_1000HALF;
  90. if (advertise & SUPPORTED_1000baseT_Full)
  91. adv |= ADVERTISE_1000FULL;
  92. }
  93. if (adv != oldadv)
  94. changed = 1;
  95. err = phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, adv);
  96. if (err < 0)
  97. return err;
  98. return changed;
  99. }
  100. /**
  101. * genphy_setup_forced - configures/forces speed/duplex from @phydev
  102. * @phydev: target phy_device struct
  103. *
  104. * Description: Configures MII_BMCR to force speed/duplex
  105. * to the values in phydev. Assumes that the values are valid.
  106. */
  107. static int genphy_setup_forced(struct phy_device *phydev)
  108. {
  109. int err;
  110. int ctl = BMCR_ANRESTART;
  111. phydev->pause = phydev->asym_pause = 0;
  112. if (SPEED_1000 == phydev->speed)
  113. ctl |= BMCR_SPEED1000;
  114. else if (SPEED_100 == phydev->speed)
  115. ctl |= BMCR_SPEED100;
  116. if (DUPLEX_FULL == phydev->duplex)
  117. ctl |= BMCR_FULLDPLX;
  118. err = phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, ctl);
  119. return err;
  120. }
  121. /**
  122. * genphy_restart_aneg - Enable and Restart Autonegotiation
  123. * @phydev: target phy_device struct
  124. */
  125. int genphy_restart_aneg(struct phy_device *phydev)
  126. {
  127. int ctl;
  128. ctl = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
  129. if (ctl < 0)
  130. return ctl;
  131. ctl |= (BMCR_ANENABLE | BMCR_ANRESTART);
  132. /* Don't isolate the PHY if we're negotiating */
  133. ctl &= ~(BMCR_ISOLATE);
  134. ctl = phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, ctl);
  135. return ctl;
  136. }
  137. /**
  138. * genphy_config_aneg - restart auto-negotiation or write BMCR
  139. * @phydev: target phy_device struct
  140. *
  141. * Description: If auto-negotiation is enabled, we configure the
  142. * advertising, and then restart auto-negotiation. If it is not
  143. * enabled, then we write the BMCR.
  144. */
  145. int genphy_config_aneg(struct phy_device *phydev)
  146. {
  147. int result;
  148. if (AUTONEG_ENABLE != phydev->autoneg)
  149. return genphy_setup_forced(phydev);
  150. result = genphy_config_advert(phydev);
  151. if (result < 0) /* error */
  152. return result;
  153. if (result == 0) {
  154. /* Advertisment hasn't changed, but maybe aneg was never on to
  155. * begin with? Or maybe phy was isolated? */
  156. int ctl = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
  157. if (ctl < 0)
  158. return ctl;
  159. if (!(ctl & BMCR_ANENABLE) || (ctl & BMCR_ISOLATE))
  160. result = 1; /* do restart aneg */
  161. }
  162. /* Only restart aneg if we are advertising something different
  163. * than we were before. */
  164. if (result > 0)
  165. result = genphy_restart_aneg(phydev);
  166. return result;
  167. }
  168. /**
  169. * genphy_update_link - update link status in @phydev
  170. * @phydev: target phy_device struct
  171. *
  172. * Description: Update the value in phydev->link to reflect the
  173. * current link value. In order to do this, we need to read
  174. * the status register twice, keeping the second value.
  175. */
  176. int genphy_update_link(struct phy_device *phydev)
  177. {
  178. unsigned int mii_reg;
  179. /*
  180. * Wait if the link is up, and autonegotiation is in progress
  181. * (ie - we're capable and it's not done)
  182. */
  183. mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
  184. /*
  185. * If we already saw the link up, and it hasn't gone down, then
  186. * we don't need to wait for autoneg again
  187. */
  188. if (phydev->link && mii_reg & BMSR_LSTATUS)
  189. return 0;
  190. if ((mii_reg & BMSR_ANEGCAPABLE) && !(mii_reg & BMSR_ANEGCOMPLETE)) {
  191. int i = 0;
  192. printf("%s Waiting for PHY auto negotiation to complete",
  193. phydev->dev->name);
  194. while (!(mii_reg & BMSR_ANEGCOMPLETE)) {
  195. /*
  196. * Timeout reached ?
  197. */
  198. if (i > PHY_ANEG_TIMEOUT) {
  199. printf(" TIMEOUT !\n");
  200. phydev->link = 0;
  201. return 0;
  202. }
  203. if (ctrlc()) {
  204. puts("user interrupt!\n");
  205. phydev->link = 0;
  206. return -EINTR;
  207. }
  208. if ((i++ % 500) == 0)
  209. printf(".");
  210. udelay(1000); /* 1 ms */
  211. mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
  212. }
  213. printf(" done\n");
  214. phydev->link = 1;
  215. } else {
  216. /* Read the link a second time to clear the latched state */
  217. mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
  218. if (mii_reg & BMSR_LSTATUS)
  219. phydev->link = 1;
  220. else
  221. phydev->link = 0;
  222. }
  223. return 0;
  224. }
  225. /*
  226. * Generic function which updates the speed and duplex. If
  227. * autonegotiation is enabled, it uses the AND of the link
  228. * partner's advertised capabilities and our advertised
  229. * capabilities. If autonegotiation is disabled, we use the
  230. * appropriate bits in the control register.
  231. *
  232. * Stolen from Linux's mii.c and phy_device.c
  233. */
  234. int genphy_parse_link(struct phy_device *phydev)
  235. {
  236. int mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
  237. /* We're using autonegotiation */
  238. if (phydev->supported & SUPPORTED_Autoneg) {
  239. u32 lpa = 0;
  240. int gblpa = 0;
  241. u32 estatus = 0;
  242. /* Check for gigabit capability */
  243. if (phydev->supported & (SUPPORTED_1000baseT_Full |
  244. SUPPORTED_1000baseT_Half)) {
  245. /* We want a list of states supported by
  246. * both PHYs in the link
  247. */
  248. gblpa = phy_read(phydev, MDIO_DEVAD_NONE, MII_STAT1000);
  249. if (gblpa < 0) {
  250. debug("Could not read MII_STAT1000. Ignoring gigabit capability\n");
  251. gblpa = 0;
  252. }
  253. gblpa &= phy_read(phydev,
  254. MDIO_DEVAD_NONE, MII_CTRL1000) << 2;
  255. }
  256. /* Set the baseline so we only have to set them
  257. * if they're different
  258. */
  259. phydev->speed = SPEED_10;
  260. phydev->duplex = DUPLEX_HALF;
  261. /* Check the gigabit fields */
  262. if (gblpa & (PHY_1000BTSR_1000FD | PHY_1000BTSR_1000HD)) {
  263. phydev->speed = SPEED_1000;
  264. if (gblpa & PHY_1000BTSR_1000FD)
  265. phydev->duplex = DUPLEX_FULL;
  266. /* We're done! */
  267. return 0;
  268. }
  269. lpa = phy_read(phydev, MDIO_DEVAD_NONE, MII_ADVERTISE);
  270. lpa &= phy_read(phydev, MDIO_DEVAD_NONE, MII_LPA);
  271. if (lpa & (LPA_100FULL | LPA_100HALF)) {
  272. phydev->speed = SPEED_100;
  273. if (lpa & LPA_100FULL)
  274. phydev->duplex = DUPLEX_FULL;
  275. } else if (lpa & LPA_10FULL)
  276. phydev->duplex = DUPLEX_FULL;
  277. /*
  278. * Extended status may indicate that the PHY supports
  279. * 1000BASE-T/X even though the 1000BASE-T registers
  280. * are missing. In this case we can't tell whether the
  281. * peer also supports it, so we only check extended
  282. * status if the 1000BASE-T registers are actually
  283. * missing.
  284. */
  285. if ((mii_reg & BMSR_ESTATEN) && !(mii_reg & BMSR_ERCAP))
  286. estatus = phy_read(phydev, MDIO_DEVAD_NONE,
  287. MII_ESTATUS);
  288. if (estatus & (ESTATUS_1000_XFULL | ESTATUS_1000_XHALF |
  289. ESTATUS_1000_TFULL | ESTATUS_1000_THALF)) {
  290. phydev->speed = SPEED_1000;
  291. if (estatus & (ESTATUS_1000_XFULL | ESTATUS_1000_TFULL))
  292. phydev->duplex = DUPLEX_FULL;
  293. }
  294. } else {
  295. u32 bmcr = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
  296. phydev->speed = SPEED_10;
  297. phydev->duplex = DUPLEX_HALF;
  298. if (bmcr & BMCR_FULLDPLX)
  299. phydev->duplex = DUPLEX_FULL;
  300. if (bmcr & BMCR_SPEED1000)
  301. phydev->speed = SPEED_1000;
  302. else if (bmcr & BMCR_SPEED100)
  303. phydev->speed = SPEED_100;
  304. }
  305. return 0;
  306. }
  307. int genphy_config(struct phy_device *phydev)
  308. {
  309. int val;
  310. u32 features;
  311. features = (SUPPORTED_TP | SUPPORTED_MII
  312. | SUPPORTED_AUI | SUPPORTED_FIBRE |
  313. SUPPORTED_BNC);
  314. /* Do we support autonegotiation? */
  315. val = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMSR);
  316. if (val < 0)
  317. return val;
  318. if (val & BMSR_ANEGCAPABLE)
  319. features |= SUPPORTED_Autoneg;
  320. if (val & BMSR_100FULL)
  321. features |= SUPPORTED_100baseT_Full;
  322. if (val & BMSR_100HALF)
  323. features |= SUPPORTED_100baseT_Half;
  324. if (val & BMSR_10FULL)
  325. features |= SUPPORTED_10baseT_Full;
  326. if (val & BMSR_10HALF)
  327. features |= SUPPORTED_10baseT_Half;
  328. if (val & BMSR_ESTATEN) {
  329. val = phy_read(phydev, MDIO_DEVAD_NONE, MII_ESTATUS);
  330. if (val < 0)
  331. return val;
  332. if (val & ESTATUS_1000_TFULL)
  333. features |= SUPPORTED_1000baseT_Full;
  334. if (val & ESTATUS_1000_THALF)
  335. features |= SUPPORTED_1000baseT_Half;
  336. if (val & ESTATUS_1000_XFULL)
  337. features |= SUPPORTED_1000baseX_Full;
  338. if (val & ESTATUS_1000_XHALF)
  339. features |= SUPPORTED_1000baseX_Half;
  340. }
  341. phydev->supported &= features;
  342. phydev->advertising &= features;
  343. genphy_config_aneg(phydev);
  344. return 0;
  345. }
  346. int genphy_startup(struct phy_device *phydev)
  347. {
  348. genphy_update_link(phydev);
  349. genphy_parse_link(phydev);
  350. return 0;
  351. }
  352. int genphy_shutdown(struct phy_device *phydev)
  353. {
  354. return 0;
  355. }
  356. static struct phy_driver genphy_driver = {
  357. .uid = 0xffffffff,
  358. .mask = 0xffffffff,
  359. .name = "Generic PHY",
  360. .features = PHY_GBIT_FEATURES | SUPPORTED_MII |
  361. SUPPORTED_AUI | SUPPORTED_FIBRE |
  362. SUPPORTED_BNC,
  363. .config = genphy_config,
  364. .startup = genphy_startup,
  365. .shutdown = genphy_shutdown,
  366. };
  367. static LIST_HEAD(phy_drivers);
  368. int phy_init(void)
  369. {
  370. #ifdef CONFIG_PHY_AQUANTIA
  371. phy_aquantia_init();
  372. #endif
  373. #ifdef CONFIG_PHY_ATHEROS
  374. phy_atheros_init();
  375. #endif
  376. #ifdef CONFIG_PHY_BROADCOM
  377. phy_broadcom_init();
  378. #endif
  379. #ifdef CONFIG_PHY_CORTINA
  380. phy_cortina_init();
  381. #endif
  382. #ifdef CONFIG_PHY_DAVICOM
  383. phy_davicom_init();
  384. #endif
  385. #ifdef CONFIG_PHY_ET1011C
  386. phy_et1011c_init();
  387. #endif
  388. #ifdef CONFIG_PHY_LXT
  389. phy_lxt_init();
  390. #endif
  391. #ifdef CONFIG_PHY_MARVELL
  392. phy_marvell_init();
  393. #endif
  394. #ifdef CONFIG_PHY_MICREL
  395. phy_micrel_init();
  396. #endif
  397. #ifdef CONFIG_PHY_NATSEMI
  398. phy_natsemi_init();
  399. #endif
  400. #ifdef CONFIG_PHY_REALTEK
  401. phy_realtek_init();
  402. #endif
  403. #ifdef CONFIG_PHY_SMSC
  404. phy_smsc_init();
  405. #endif
  406. #ifdef CONFIG_PHY_TERANETICS
  407. phy_teranetics_init();
  408. #endif
  409. #ifdef CONFIG_PHY_TI
  410. phy_ti_init();
  411. #endif
  412. #ifdef CONFIG_PHY_VITESSE
  413. phy_vitesse_init();
  414. #endif
  415. return 0;
  416. }
  417. int phy_register(struct phy_driver *drv)
  418. {
  419. INIT_LIST_HEAD(&drv->list);
  420. list_add_tail(&drv->list, &phy_drivers);
  421. #ifdef CONFIG_NEEDS_MANUAL_RELOC
  422. if (drv->probe)
  423. drv->probe += gd->reloc_off;
  424. if (drv->config)
  425. drv->config += gd->reloc_off;
  426. if (drv->startup)
  427. drv->startup += gd->reloc_off;
  428. if (drv->shutdown)
  429. drv->shutdown += gd->reloc_off;
  430. if (drv->readext)
  431. drv->readext += gd->reloc_off;
  432. if (drv->writeext)
  433. drv->writeext += gd->reloc_off;
  434. #endif
  435. return 0;
  436. }
  437. int phy_set_supported(struct phy_device *phydev, u32 max_speed)
  438. {
  439. /* The default values for phydev->supported are provided by the PHY
  440. * driver "features" member, we want to reset to sane defaults first
  441. * before supporting higher speeds.
  442. */
  443. phydev->supported &= PHY_DEFAULT_FEATURES;
  444. switch (max_speed) {
  445. default:
  446. return -ENOTSUPP;
  447. case SPEED_1000:
  448. phydev->supported |= PHY_1000BT_FEATURES;
  449. /* fall through */
  450. case SPEED_100:
  451. phydev->supported |= PHY_100BT_FEATURES;
  452. /* fall through */
  453. case SPEED_10:
  454. phydev->supported |= PHY_10BT_FEATURES;
  455. }
  456. return 0;
  457. }
  458. static int phy_probe(struct phy_device *phydev)
  459. {
  460. int err = 0;
  461. phydev->advertising = phydev->supported = phydev->drv->features;
  462. phydev->mmds = phydev->drv->mmds;
  463. if (phydev->drv->probe)
  464. err = phydev->drv->probe(phydev);
  465. return err;
  466. }
  467. static struct phy_driver *generic_for_interface(phy_interface_t interface)
  468. {
  469. #ifdef CONFIG_PHYLIB_10G
  470. if (is_10g_interface(interface))
  471. return &gen10g_driver;
  472. #endif
  473. return &genphy_driver;
  474. }
  475. static struct phy_driver *get_phy_driver(struct phy_device *phydev,
  476. phy_interface_t interface)
  477. {
  478. struct list_head *entry;
  479. int phy_id = phydev->phy_id;
  480. struct phy_driver *drv = NULL;
  481. list_for_each(entry, &phy_drivers) {
  482. drv = list_entry(entry, struct phy_driver, list);
  483. if ((drv->uid & drv->mask) == (phy_id & drv->mask))
  484. return drv;
  485. }
  486. /* If we made it here, there's no driver for this PHY */
  487. return generic_for_interface(interface);
  488. }
  489. static struct phy_device *phy_device_create(struct mii_dev *bus, int addr,
  490. u32 phy_id,
  491. phy_interface_t interface)
  492. {
  493. struct phy_device *dev;
  494. /* We allocate the device, and initialize the
  495. * default values */
  496. dev = malloc(sizeof(*dev));
  497. if (!dev) {
  498. printf("Failed to allocate PHY device for %s:%d\n",
  499. bus->name, addr);
  500. return NULL;
  501. }
  502. memset(dev, 0, sizeof(*dev));
  503. dev->duplex = -1;
  504. dev->link = 0;
  505. dev->interface = interface;
  506. dev->autoneg = AUTONEG_ENABLE;
  507. dev->addr = addr;
  508. dev->phy_id = phy_id;
  509. dev->bus = bus;
  510. dev->drv = get_phy_driver(dev, interface);
  511. phy_probe(dev);
  512. bus->phymap[addr] = dev;
  513. return dev;
  514. }
  515. /**
  516. * get_phy_id - reads the specified addr for its ID.
  517. * @bus: the target MII bus
  518. * @addr: PHY address on the MII bus
  519. * @phy_id: where to store the ID retrieved.
  520. *
  521. * Description: Reads the ID registers of the PHY at @addr on the
  522. * @bus, stores it in @phy_id and returns zero on success.
  523. */
  524. int __weak get_phy_id(struct mii_dev *bus, int addr, int devad, u32 *phy_id)
  525. {
  526. int phy_reg;
  527. /* Grab the bits from PHYIR1, and put them
  528. * in the upper half */
  529. phy_reg = bus->read(bus, addr, devad, MII_PHYSID1);
  530. if (phy_reg < 0)
  531. return -EIO;
  532. *phy_id = (phy_reg & 0xffff) << 16;
  533. /* Grab the bits from PHYIR2, and put them in the lower half */
  534. phy_reg = bus->read(bus, addr, devad, MII_PHYSID2);
  535. if (phy_reg < 0)
  536. return -EIO;
  537. *phy_id |= (phy_reg & 0xffff);
  538. return 0;
  539. }
  540. static struct phy_device *create_phy_by_mask(struct mii_dev *bus,
  541. unsigned phy_mask, int devad, phy_interface_t interface)
  542. {
  543. u32 phy_id = 0xffffffff;
  544. while (phy_mask) {
  545. int addr = ffs(phy_mask) - 1;
  546. int r = get_phy_id(bus, addr, devad, &phy_id);
  547. /* If the PHY ID is mostly f's, we didn't find anything */
  548. if (r == 0 && (phy_id & 0x1fffffff) != 0x1fffffff)
  549. return phy_device_create(bus, addr, phy_id, interface);
  550. phy_mask &= ~(1 << addr);
  551. }
  552. return NULL;
  553. }
  554. static struct phy_device *search_for_existing_phy(struct mii_dev *bus,
  555. unsigned phy_mask, phy_interface_t interface)
  556. {
  557. /* If we have one, return the existing device, with new interface */
  558. while (phy_mask) {
  559. int addr = ffs(phy_mask) - 1;
  560. if (bus->phymap[addr]) {
  561. bus->phymap[addr]->interface = interface;
  562. return bus->phymap[addr];
  563. }
  564. phy_mask &= ~(1 << addr);
  565. }
  566. return NULL;
  567. }
  568. static struct phy_device *get_phy_device_by_mask(struct mii_dev *bus,
  569. unsigned phy_mask, phy_interface_t interface)
  570. {
  571. int i;
  572. struct phy_device *phydev;
  573. phydev = search_for_existing_phy(bus, phy_mask, interface);
  574. if (phydev)
  575. return phydev;
  576. /* Try Standard (ie Clause 22) access */
  577. /* Otherwise we have to try Clause 45 */
  578. for (i = 0; i < 5; i++) {
  579. phydev = create_phy_by_mask(bus, phy_mask,
  580. i ? i : MDIO_DEVAD_NONE, interface);
  581. if (IS_ERR(phydev))
  582. return NULL;
  583. if (phydev)
  584. return phydev;
  585. }
  586. debug("\n%s PHY: ", bus->name);
  587. while (phy_mask) {
  588. int addr = ffs(phy_mask) - 1;
  589. debug("%d ", addr);
  590. phy_mask &= ~(1 << addr);
  591. }
  592. debug("not found\n");
  593. return NULL;
  594. }
  595. /**
  596. * get_phy_device - reads the specified PHY device and returns its @phy_device struct
  597. * @bus: the target MII bus
  598. * @addr: PHY address on the MII bus
  599. *
  600. * Description: Reads the ID registers of the PHY at @addr on the
  601. * @bus, then allocates and returns the phy_device to represent it.
  602. */
  603. static struct phy_device *get_phy_device(struct mii_dev *bus, int addr,
  604. phy_interface_t interface)
  605. {
  606. return get_phy_device_by_mask(bus, 1 << addr, interface);
  607. }
  608. int phy_reset(struct phy_device *phydev)
  609. {
  610. int reg;
  611. int timeout = 500;
  612. int devad = MDIO_DEVAD_NONE;
  613. #ifdef CONFIG_PHYLIB_10G
  614. /* If it's 10G, we need to issue reset through one of the MMDs */
  615. if (is_10g_interface(phydev->interface)) {
  616. if (!phydev->mmds)
  617. gen10g_discover_mmds(phydev);
  618. devad = ffs(phydev->mmds) - 1;
  619. }
  620. #endif
  621. if (phy_write(phydev, devad, MII_BMCR, BMCR_RESET) < 0) {
  622. debug("PHY reset failed\n");
  623. return -1;
  624. }
  625. #ifdef CONFIG_PHY_RESET_DELAY
  626. udelay(CONFIG_PHY_RESET_DELAY); /* Intel LXT971A needs this */
  627. #endif
  628. /*
  629. * Poll the control register for the reset bit to go to 0 (it is
  630. * auto-clearing). This should happen within 0.5 seconds per the
  631. * IEEE spec.
  632. */
  633. reg = phy_read(phydev, devad, MII_BMCR);
  634. while ((reg & BMCR_RESET) && timeout--) {
  635. reg = phy_read(phydev, devad, MII_BMCR);
  636. if (reg < 0) {
  637. debug("PHY status read failed\n");
  638. return -1;
  639. }
  640. udelay(1000);
  641. }
  642. if (reg & BMCR_RESET) {
  643. puts("PHY reset timed out\n");
  644. return -1;
  645. }
  646. return 0;
  647. }
  648. int miiphy_reset(const char *devname, unsigned char addr)
  649. {
  650. struct mii_dev *bus = miiphy_get_dev_by_name(devname);
  651. struct phy_device *phydev;
  652. /*
  653. * miiphy_reset was only used on standard PHYs, so we'll fake it here.
  654. * If later code tries to connect with the right interface, this will
  655. * be corrected by get_phy_device in phy_connect()
  656. */
  657. phydev = get_phy_device(bus, addr, PHY_INTERFACE_MODE_MII);
  658. return phy_reset(phydev);
  659. }
  660. struct phy_device *phy_find_by_mask(struct mii_dev *bus, unsigned phy_mask,
  661. phy_interface_t interface)
  662. {
  663. /* Reset the bus */
  664. if (bus->reset) {
  665. bus->reset(bus);
  666. /* Wait 15ms to make sure the PHY has come out of hard reset */
  667. udelay(15000);
  668. }
  669. return get_phy_device_by_mask(bus, phy_mask, interface);
  670. }
  671. #ifdef CONFIG_DM_ETH
  672. void phy_connect_dev(struct phy_device *phydev, struct udevice *dev)
  673. #else
  674. void phy_connect_dev(struct phy_device *phydev, struct eth_device *dev)
  675. #endif
  676. {
  677. /* Soft Reset the PHY */
  678. phy_reset(phydev);
  679. if (phydev->dev && phydev->dev != dev) {
  680. printf("%s:%d is connected to %s. Reconnecting to %s\n",
  681. phydev->bus->name, phydev->addr,
  682. phydev->dev->name, dev->name);
  683. }
  684. phydev->dev = dev;
  685. debug("%s connected to %s\n", dev->name, phydev->drv->name);
  686. }
  687. #ifdef CONFIG_DM_ETH
  688. struct phy_device *phy_connect(struct mii_dev *bus, int addr,
  689. struct udevice *dev, phy_interface_t interface)
  690. #else
  691. struct phy_device *phy_connect(struct mii_dev *bus, int addr,
  692. struct eth_device *dev, phy_interface_t interface)
  693. #endif
  694. {
  695. struct phy_device *phydev;
  696. phydev = phy_find_by_mask(bus, 1 << addr, interface);
  697. if (phydev)
  698. phy_connect_dev(phydev, dev);
  699. else
  700. printf("Could not get PHY for %s: addr %d\n", bus->name, addr);
  701. return phydev;
  702. }
  703. /*
  704. * Start the PHY. Returns 0 on success, or a negative error code.
  705. */
  706. int phy_startup(struct phy_device *phydev)
  707. {
  708. if (phydev->drv->startup)
  709. return phydev->drv->startup(phydev);
  710. return 0;
  711. }
  712. __weak int board_phy_config(struct phy_device *phydev)
  713. {
  714. if (phydev->drv->config)
  715. return phydev->drv->config(phydev);
  716. return 0;
  717. }
  718. int phy_config(struct phy_device *phydev)
  719. {
  720. /* Invoke an optional board-specific helper */
  721. board_phy_config(phydev);
  722. return 0;
  723. }
  724. int phy_shutdown(struct phy_device *phydev)
  725. {
  726. if (phydev->drv->shutdown)
  727. phydev->drv->shutdown(phydev);
  728. return 0;
  729. }
  730. int phy_get_interface_by_name(const char *str)
  731. {
  732. int i;
  733. for (i = 0; i < PHY_INTERFACE_MODE_COUNT; i++) {
  734. if (!strcmp(str, phy_interface_strings[i]))
  735. return i;
  736. }
  737. return -1;
  738. }