mirror of
https://git.openwrt.org/openwrt/openwrt.git
synced 2025-04-12 20:03:03 +00:00
864d6743ee
Add simple driver reading the internal temperature sensor. Signed-off-by: Bjørn Mork <bjorn@mork.no> Link: https://github.com/openwrt/openwrt/pull/17967 Signed-off-by: Sander Vanheule <sander@svanheule.net>
147 lines
4.2 KiB
C
147 lines
4.2 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Realtek thermal sensor driver
|
|
*
|
|
* Copyright (C) 2025 Bjørn Mork <bjorn@mork.no>>
|
|
*/
|
|
|
|
#include <linux/bitfield.h>
|
|
#include <linux/mfd/syscon.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regmap.h>
|
|
#include "thermal_hwmon.h"
|
|
|
|
#define RTL8380_THERMAL_METER_CTRL0 0x98
|
|
#define RTL8380_THERMAL_METER_CTRL1 0x9c
|
|
#define RTL8380_THERMAL_METER_CTRL2 0xa0
|
|
#define RTL8380_THERMAL_METER_RESULT 0xa4
|
|
#define RTL8380_TM_ENABLE BIT(0)
|
|
#define RTL8380_TEMP_VALID BIT(8)
|
|
#define RTL8380_TEMP_OUT_MASK GENMASK(6, 0)
|
|
|
|
#define RTL9300_THERMAL_METER_CTRL0 0x60
|
|
#define RTL9300_THERMAL_METER_CTRL1 0x64
|
|
#define RTL9300_THERMAL_METER_CTRL2 0x68
|
|
#define RTL9300_THERMAL_METER_RESULT0 0x6c
|
|
#define RTL9300_THERMAL_METER_RESULT1 0x70
|
|
#define RTL9300_TM_ENABLE BIT(16)
|
|
#define RTL9300_TEMP_VALID BIT(24)
|
|
#define RTL9300_TEMP_OUT_MASK GENMASK(23, 16)
|
|
#define RTL9300_SAMPLE_DLY_SHIFT (16)
|
|
#define RTL9300_SAMPLE_DLY_MASK GENMASK(RTL9300_SAMPLE_DLY_SHIFT + 15, RTL9300_SAMPLE_DLY_SHIFT)
|
|
#define RTL9300_COMPARE_DLY_SHIFT (0)
|
|
#define RTL9300_COMPARE_DLY_MASK GENMASK(RTL9300_COMPARE_DLY_SHIFT + 15, RTL9300_COMPARE_DLY_SHIFT)
|
|
|
|
struct realtek_thermal_priv {
|
|
struct regmap *regmap;
|
|
bool enabled;
|
|
};
|
|
|
|
static void rtl8380_thermal_init(struct realtek_thermal_priv *priv)
|
|
{
|
|
priv->enabled = !regmap_update_bits(priv->regmap, RTL8380_THERMAL_METER_CTRL0, RTL8380_TM_ENABLE, RTL8380_TM_ENABLE);
|
|
}
|
|
|
|
static int rtl8380_get_temp(struct thermal_zone_device *tz, int *res)
|
|
{
|
|
struct realtek_thermal_priv *priv = thermal_zone_device_priv(tz);
|
|
int offset = thermal_zone_get_offset(tz);
|
|
int slope = thermal_zone_get_slope(tz);
|
|
u32 val;
|
|
int ret;
|
|
|
|
if (!priv->enabled)
|
|
rtl8380_thermal_init(priv);
|
|
|
|
ret = regmap_read(priv->regmap, RTL8380_THERMAL_METER_RESULT, &val);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (!(val & RTL8380_TEMP_VALID))
|
|
return -EAGAIN;
|
|
|
|
*res = FIELD_GET(RTL8380_TEMP_OUT_MASK, val) * slope + offset;
|
|
return 0;
|
|
}
|
|
|
|
static const struct thermal_zone_device_ops rtl8380_ops = {
|
|
.get_temp = rtl8380_get_temp,
|
|
};
|
|
|
|
static void rtl9300_thermal_init(struct realtek_thermal_priv *priv)
|
|
{
|
|
/* increasing sample delay makes get_temp() succeed more often */
|
|
regmap_update_bits(priv->regmap, RTL9300_THERMAL_METER_CTRL1, RTL9300_SAMPLE_DLY_MASK, 0x0800 << RTL9300_SAMPLE_DLY_SHIFT);
|
|
priv->enabled = !regmap_update_bits(priv->regmap, RTL9300_THERMAL_METER_CTRL2, RTL9300_TM_ENABLE, RTL9300_TM_ENABLE);
|
|
}
|
|
|
|
static int rtl9300_get_temp(struct thermal_zone_device *tz, int *res)
|
|
{
|
|
struct realtek_thermal_priv *priv = thermal_zone_device_priv(tz);
|
|
int offset = thermal_zone_get_offset(tz);
|
|
int slope = thermal_zone_get_slope(tz);
|
|
u32 val;
|
|
int ret;
|
|
|
|
if (!priv->enabled)
|
|
rtl9300_thermal_init(priv);
|
|
|
|
ret = regmap_read(priv->regmap, RTL9300_THERMAL_METER_RESULT0, &val);
|
|
if (ret)
|
|
return ret;
|
|
if (!(val & RTL9300_TEMP_VALID))
|
|
return -EAGAIN;
|
|
|
|
*res = FIELD_GET(RTL9300_TEMP_OUT_MASK, val) * slope + offset;
|
|
return 0;
|
|
}
|
|
|
|
static const struct thermal_zone_device_ops rtl9300_ops = {
|
|
.get_temp = rtl9300_get_temp,
|
|
};
|
|
|
|
static int realtek_thermal_probe(struct platform_device *pdev)
|
|
{
|
|
struct realtek_thermal_priv *priv;
|
|
struct thermal_zone_device *tzdev;
|
|
struct device *dev = &pdev->dev;
|
|
struct regmap *regmap;
|
|
|
|
priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
|
|
if (!priv)
|
|
return -ENOMEM;
|
|
|
|
regmap = syscon_node_to_regmap(dev->of_node->parent);
|
|
if (IS_ERR(regmap))
|
|
return PTR_ERR(regmap);
|
|
|
|
priv->regmap = regmap;
|
|
tzdev = devm_thermal_of_zone_register(dev, 0, priv, device_get_match_data(dev));
|
|
if (IS_ERR(tzdev))
|
|
return PTR_ERR(tzdev);
|
|
|
|
return devm_thermal_add_hwmon_sysfs(dev, tzdev);
|
|
}
|
|
|
|
static const struct of_device_id realtek_sensor_ids[] = {
|
|
{ .compatible = "realtek,rtl8380-thermal", .data = &rtl8380_ops, },
|
|
{ .compatible = "realtek,rtl9300-thermal", .data = &rtl9300_ops, },
|
|
{ /* sentinel */ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, realtek_sensor_ids);
|
|
|
|
static struct platform_driver realtek_thermal_driver = {
|
|
.probe = realtek_thermal_probe,
|
|
.driver = {
|
|
.name = "realtek-thermal",
|
|
.of_match_table = realtek_sensor_ids,
|
|
},
|
|
};
|
|
|
|
module_platform_driver(realtek_thermal_driver);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Bjørn Mork <bjorn@mork.no>");
|
|
MODULE_DESCRIPTION("Realtek temperature sensor");
|