| Message ID | 20220622141716.3517645-1-michael@walle.cc (mailing list archive) |
|---|---|
| State | Handled Elsewhere |
| Headers | show |
| Series | [net-next] net: phy: mxl-gpy: add temperature sensor | expand |
On Wed, Jun 22, 2022 at 04:17:16PM +0200, Michael Walle wrote: > The GPY115 and GPY2xx PHYs contain an integrated temperature sensor. It > accuracy is +/- 5°C. Add support for it. > > Signed-off-by: Michael Walle <michael@walle.cc> Acked-by: Guenter Roeck <linux@roeck-us.net> > --- > drivers/net/phy/Kconfig | 2 + > drivers/net/phy/mxl-gpy.c | 106 ++++++++++++++++++++++++++++++++++++++ > 2 files changed, 108 insertions(+) > > diff --git a/drivers/net/phy/Kconfig b/drivers/net/phy/Kconfig > index 9fee639ee5c8..09fa17796d4d 100644 > --- a/drivers/net/phy/Kconfig > +++ b/drivers/net/phy/Kconfig > @@ -216,6 +216,8 @@ config MARVELL_88X2222_PHY > > config MAXLINEAR_GPHY > tristate "Maxlinear Ethernet PHYs" > + select POLYNOMIAL if HWMON > + depends on HWMON || HWMON=n > help > Support for the Maxlinear GPY115, GPY211, GPY212, GPY215, > GPY241, GPY245 PHYs. > diff --git a/drivers/net/phy/mxl-gpy.c b/drivers/net/phy/mxl-gpy.c > index 6c4da2f9e90a..5b99acf44337 100644 > --- a/drivers/net/phy/mxl-gpy.c > +++ b/drivers/net/phy/mxl-gpy.c > @@ -8,7 +8,9 @@ > > #include <linux/module.h> > #include <linux/bitfield.h> > +#include <linux/hwmon.h> > #include <linux/phy.h> > +#include <linux/polynomial.h> > #include <linux/netdevice.h> > > /* PHY ID */ > @@ -64,6 +66,10 @@ > #define VSPEC1_SGMII_ANEN_ANRS (VSPEC1_SGMII_CTRL_ANEN | \ > VSPEC1_SGMII_CTRL_ANRS) > > +/* Temperature sensor */ > +#define VPSPEC1_TEMP_STA 0x0E > +#define VPSPEC1_TEMP_STA_DATA GENMASK(9, 0) > + > /* WoL */ > #define VPSPEC2_WOL_CTL 0x0E06 > #define VPSPEC2_WOL_AD01 0x0E08 > @@ -80,6 +86,102 @@ static const struct { > {9, 0x73}, > }; > > +#if IS_ENABLED(CONFIG_HWMON) > +/* The original translation formulae of the temperature (in degrees of Celsius) > + * are as follows: > + * > + * T = -2.5761e-11*(N^4) + 9.7332e-8*(N^3) + -1.9165e-4*(N^2) + > + * 3.0762e-1*(N^1) + -5.2156e1 > + * > + * where [-52.156, 137.961]C and N = [0, 1023]. > + * > + * They must be accordingly altered to be suitable for the integer arithmetics. > + * The technique is called 'factor redistribution', which just makes sure the > + * multiplications and divisions are made so to have a result of the operations > + * within the integer numbers limit. In addition we need to translate the > + * formulae to accept millidegrees of Celsius. Here what it looks like after > + * the alterations: > + * > + * T = -25761e-12*(N^4) + 97332e-9*(N^3) + -191650e-6*(N^2) + > + * 307620e-3*(N^1) + -52156 > + * > + * where T = [-52156, 137961]mC and N = [0, 1023]. > + */ > +static const struct polynomial poly_N_to_temp = { > + .terms = { > + {4, -25761, 1000, 1}, > + {3, 97332, 1000, 1}, > + {2, -191650, 1000, 1}, > + {1, 307620, 1000, 1}, > + {0, -52156, 1, 1} > + } > +}; > + > +static int gpy_hwmon_read(struct device *dev, > + enum hwmon_sensor_types type, > + u32 attr, int channel, long *value) > +{ > + struct phy_device *phydev = dev_get_drvdata(dev); > + int ret; > + > + ret = phy_read_mmd(phydev, MDIO_MMD_VEND1, VPSPEC1_TEMP_STA); > + if (ret < 0) > + return ret; > + if (!ret) > + return -ENODATA; > + > + *value = polynomial_calc(&poly_N_to_temp, > + FIELD_GET(VPSPEC1_TEMP_STA_DATA, ret)); > + > + return 0; > +} > + > +static umode_t gpy_hwmon_is_visible(const void *data, > + enum hwmon_sensor_types type, > + u32 attr, int channel) > +{ > + return 0444; > +} > + > +static const struct hwmon_channel_info *gpy_hwmon_info[] = { > + HWMON_CHANNEL_INFO(temp, HWMON_T_INPUT), > + NULL > +}; > + > +static const struct hwmon_ops gpy_hwmon_hwmon_ops = { > + .is_visible = gpy_hwmon_is_visible, > + .read = gpy_hwmon_read, > +}; > + > +static const struct hwmon_chip_info gpy_hwmon_chip_info = { > + .ops = &gpy_hwmon_hwmon_ops, > + .info = gpy_hwmon_info, > +}; > + > +static int gpy_hwmon_register(struct phy_device *phydev) > +{ > + struct device *dev = &phydev->mdio.dev; > + struct device *hwmon_dev; > + char *hwmon_name; > + > + hwmon_name = devm_hwmon_sanitize_name(dev, dev_name(dev)); > + if (IS_ERR(hwmon_name)) > + return PTR_ERR(hwmon_name); > + > + hwmon_dev = devm_hwmon_device_register_with_info(dev, hwmon_name, > + phydev, > + &gpy_hwmon_chip_info, > + NULL); > + > + return PTR_ERR_OR_ZERO(hwmon_dev); > +} > +#else > +static int gpy_hwmon_register(struct phy_device *phydev) > +{ > + return 0; > +} > +#endif > + > static int gpy_config_init(struct phy_device *phydev) > { > int ret; > @@ -109,6 +211,10 @@ static int gpy_probe(struct phy_device *phydev) > if (ret < 0) > return ret; > > + ret = gpy_hwmon_register(phydev); > + if (ret) > + return ret; > + > phydev_info(phydev, "Firmware Version: 0x%04X (%s)\n", ret, > (ret & PHY_FWV_REL_MASK) ? "release" : "test"); > > -- > 2.30.2 >
On Wed, Jun 22, 2022 at 04:17:16PM +0200, Michael Walle wrote: > The GPY115 and GPY2xx PHYs contain an integrated temperature sensor. It > accuracy is +/- 5°C. Add support for it. > > Signed-off-by: Michael Walle <michael@walle.cc> Reviewed-by: Andrew Lunn <andrew@lunn.ch> Andrew
Hello: This patch was applied to netdev/net-next.git (master) by Jakub Kicinski <kuba@kernel.org>: On Wed, 22 Jun 2022 16:17:16 +0200 you wrote: > The GPY115 and GPY2xx PHYs contain an integrated temperature sensor. It > accuracy is +/- 5°C. Add support for it. > > Signed-off-by: Michael Walle <michael@walle.cc> > --- > drivers/net/phy/Kconfig | 2 + > drivers/net/phy/mxl-gpy.c | 106 ++++++++++++++++++++++++++++++++++++++ > 2 files changed, 108 insertions(+) Here is the summary with links: - [net-next] net: phy: mxl-gpy: add temperature sensor https://git.kernel.org/netdev/net-next/c/09ce6b20103b You are awesome, thank you!
diff --git a/drivers/net/phy/Kconfig b/drivers/net/phy/Kconfig index 9fee639ee5c8..09fa17796d4d 100644 --- a/drivers/net/phy/Kconfig +++ b/drivers/net/phy/Kconfig @@ -216,6 +216,8 @@ config MARVELL_88X2222_PHY config MAXLINEAR_GPHY tristate "Maxlinear Ethernet PHYs" + select POLYNOMIAL if HWMON + depends on HWMON || HWMON=n help Support for the Maxlinear GPY115, GPY211, GPY212, GPY215, GPY241, GPY245 PHYs. diff --git a/drivers/net/phy/mxl-gpy.c b/drivers/net/phy/mxl-gpy.c index 6c4da2f9e90a..5b99acf44337 100644 --- a/drivers/net/phy/mxl-gpy.c +++ b/drivers/net/phy/mxl-gpy.c @@ -8,7 +8,9 @@ #include <linux/module.h> #include <linux/bitfield.h> +#include <linux/hwmon.h> #include <linux/phy.h> +#include <linux/polynomial.h> #include <linux/netdevice.h> /* PHY ID */ @@ -64,6 +66,10 @@ #define VSPEC1_SGMII_ANEN_ANRS (VSPEC1_SGMII_CTRL_ANEN | \ VSPEC1_SGMII_CTRL_ANRS) +/* Temperature sensor */ +#define VPSPEC1_TEMP_STA 0x0E +#define VPSPEC1_TEMP_STA_DATA GENMASK(9, 0) + /* WoL */ #define VPSPEC2_WOL_CTL 0x0E06 #define VPSPEC2_WOL_AD01 0x0E08 @@ -80,6 +86,102 @@ static const struct { {9, 0x73}, }; +#if IS_ENABLED(CONFIG_HWMON) +/* The original translation formulae of the temperature (in degrees of Celsius) + * are as follows: + * + * T = -2.5761e-11*(N^4) + 9.7332e-8*(N^3) + -1.9165e-4*(N^2) + + * 3.0762e-1*(N^1) + -5.2156e1 + * + * where [-52.156, 137.961]C and N = [0, 1023]. + * + * They must be accordingly altered to be suitable for the integer arithmetics. + * The technique is called 'factor redistribution', which just makes sure the + * multiplications and divisions are made so to have a result of the operations + * within the integer numbers limit. In addition we need to translate the + * formulae to accept millidegrees of Celsius. Here what it looks like after + * the alterations: + * + * T = -25761e-12*(N^4) + 97332e-9*(N^3) + -191650e-6*(N^2) + + * 307620e-3*(N^1) + -52156 + * + * where T = [-52156, 137961]mC and N = [0, 1023]. + */ +static const struct polynomial poly_N_to_temp = { + .terms = { + {4, -25761, 1000, 1}, + {3, 97332, 1000, 1}, + {2, -191650, 1000, 1}, + {1, 307620, 1000, 1}, + {0, -52156, 1, 1} + } +}; + +static int gpy_hwmon_read(struct device *dev, + enum hwmon_sensor_types type, + u32 attr, int channel, long *value) +{ + struct phy_device *phydev = dev_get_drvdata(dev); + int ret; + + ret = phy_read_mmd(phydev, MDIO_MMD_VEND1, VPSPEC1_TEMP_STA); + if (ret < 0) + return ret; + if (!ret) + return -ENODATA; + + *value = polynomial_calc(&poly_N_to_temp, + FIELD_GET(VPSPEC1_TEMP_STA_DATA, ret)); + + return 0; +} + +static umode_t gpy_hwmon_is_visible(const void *data, + enum hwmon_sensor_types type, + u32 attr, int channel) +{ + return 0444; +} + +static const struct hwmon_channel_info *gpy_hwmon_info[] = { + HWMON_CHANNEL_INFO(temp, HWMON_T_INPUT), + NULL +}; + +static const struct hwmon_ops gpy_hwmon_hwmon_ops = { + .is_visible = gpy_hwmon_is_visible, + .read = gpy_hwmon_read, +}; + +static const struct hwmon_chip_info gpy_hwmon_chip_info = { + .ops = &gpy_hwmon_hwmon_ops, + .info = gpy_hwmon_info, +}; + +static int gpy_hwmon_register(struct phy_device *phydev) +{ + struct device *dev = &phydev->mdio.dev; + struct device *hwmon_dev; + char *hwmon_name; + + hwmon_name = devm_hwmon_sanitize_name(dev, dev_name(dev)); + if (IS_ERR(hwmon_name)) + return PTR_ERR(hwmon_name); + + hwmon_dev = devm_hwmon_device_register_with_info(dev, hwmon_name, + phydev, + &gpy_hwmon_chip_info, + NULL); + + return PTR_ERR_OR_ZERO(hwmon_dev); +} +#else +static int gpy_hwmon_register(struct phy_device *phydev) +{ + return 0; +} +#endif + static int gpy_config_init(struct phy_device *phydev) { int ret; @@ -109,6 +211,10 @@ static int gpy_probe(struct phy_device *phydev) if (ret < 0) return ret; + ret = gpy_hwmon_register(phydev); + if (ret) + return ret; + phydev_info(phydev, "Firmware Version: 0x%04X (%s)\n", ret, (ret & PHY_FWV_REL_MASK) ? "release" : "test");
The GPY115 and GPY2xx PHYs contain an integrated temperature sensor. It accuracy is +/- 5°C. Add support for it. Signed-off-by: Michael Walle <michael@walle.cc> --- drivers/net/phy/Kconfig | 2 + drivers/net/phy/mxl-gpy.c | 106 ++++++++++++++++++++++++++++++++++++++ 2 files changed, 108 insertions(+)