700-net-phy-add-reset-controller-support.patch 2.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107
  1. From 71dd6c0dff51b5f1fef2e9dfa6f6a948aac975f3 Mon Sep 17 00:00:00 2001
  2. From: David Bauer <[email protected]>
  3. Date: Wed, 17 Apr 2019 23:59:21 +0200
  4. Subject: [PATCH] net: phy: add support for reset-controller
  5. This commit adds support for PHY reset pins handled by a reset controller.
  6. Signed-off-by: David Bauer <[email protected]>
  7. Reviewed-by: Andrew Lunn <[email protected]>
  8. Signed-off-by: David S. Miller <[email protected]>
  9. ---
  10. drivers/net/phy/mdio_bus.c | 27 +++++++++++++++++++++++++--
  11. drivers/net/phy/mdio_device.c | 13 +++++++++++--
  12. include/linux/mdio.h | 1 +
  13. 3 files changed, 37 insertions(+), 4 deletions(-)
  14. --- a/drivers/net/phy/mdio_bus.c
  15. +++ b/drivers/net/phy/mdio_bus.c
  16. @@ -29,6 +29,7 @@
  17. #include <linux/of_gpio.h>
  18. #include <linux/netdevice.h>
  19. #include <linux/etherdevice.h>
  20. +#include <linux/reset.h>
  21. #include <linux/skbuff.h>
  22. #include <linux/spinlock.h>
  23. #include <linux/mm.h>
  24. @@ -65,8 +66,23 @@ static int mdiobus_register_gpiod(struct
  25. mdiodev->reset = gpiod;
  26. - /* Assert the reset signal again */
  27. - mdio_device_reset(mdiodev, 1);
  28. + return 0;
  29. +}
  30. +
  31. +static int mdiobus_register_reset(struct mdio_device *mdiodev)
  32. +{
  33. + struct reset_control *reset = NULL;
  34. +
  35. + if (mdiodev->dev.of_node)
  36. + reset = devm_reset_control_get_exclusive(&mdiodev->dev,
  37. + "phy");
  38. + if (PTR_ERR(reset) == -ENOENT ||
  39. + PTR_ERR(reset) == -ENOTSUPP)
  40. + reset = NULL;
  41. + else if (IS_ERR(reset))
  42. + return PTR_ERR(reset);
  43. +
  44. + mdiodev->reset_ctrl = reset;
  45. return 0;
  46. }
  47. @@ -82,6 +98,13 @@ int mdiobus_register_device(struct mdio_
  48. err = mdiobus_register_gpiod(mdiodev);
  49. if (err)
  50. return err;
  51. +
  52. + err = mdiobus_register_reset(mdiodev);
  53. + if (err)
  54. + return err;
  55. +
  56. + /* Assert the reset signal */
  57. + mdio_device_reset(mdiodev, 1);
  58. }
  59. mdiodev->bus->mdio_map[mdiodev->addr] = mdiodev;
  60. --- a/drivers/net/phy/mdio_device.c
  61. +++ b/drivers/net/phy/mdio_device.c
  62. @@ -21,6 +21,7 @@
  63. #include <linux/mii.h>
  64. #include <linux/module.h>
  65. #include <linux/phy.h>
  66. +#include <linux/reset.h>
  67. #include <linux/slab.h>
  68. #include <linux/string.h>
  69. #include <linux/unistd.h>
  70. @@ -121,10 +122,18 @@ void mdio_device_reset(struct mdio_devic
  71. {
  72. unsigned int d;
  73. - if (!mdiodev->reset)
  74. + if (!mdiodev->reset && !mdiodev->reset_ctrl)
  75. return;
  76. - gpiod_set_value(mdiodev->reset, value);
  77. + if (mdiodev->reset)
  78. + gpiod_set_value(mdiodev->reset, value);
  79. +
  80. + if (mdiodev->reset_ctrl) {
  81. + if (value)
  82. + reset_control_assert(mdiodev->reset_ctrl);
  83. + else
  84. + reset_control_deassert(mdiodev->reset_ctrl);
  85. + }
  86. d = value ? mdiodev->reset_assert_delay : mdiodev->reset_deassert_delay;
  87. if (d)
  88. --- a/include/linux/mdio.h
  89. +++ b/include/linux/mdio.h
  90. @@ -40,6 +40,7 @@ struct mdio_device {
  91. int addr;
  92. int flags;
  93. struct gpio_desc *reset;
  94. + struct reset_control *reset_ctrl;
  95. unsigned int reset_assert_delay;
  96. unsigned int reset_deassert_delay;
  97. };