mirror of
https://github.com/openwrt/openwrt.git
synced 2024-11-23 09:56:19 +08:00
kernel: hwmon-is28022: new package added
Added driver for ISL28022 power monitor used e.g. in Ubiquiti Edgerouter ER-6P Signed-off-by: Carsten Spieß <mail@carsten-spiess.de>
This commit is contained in:
Carsten Spieß
parent
c74b5e09e6
commit
c21bd25cc5
37
package/kernel/hwmon-isl28022/Makefile
Normal file
37
package/kernel/hwmon-isl28022/Makefile
Normal file
@ -0,0 +1,37 @@
|
||||
#
|
||||
# Copyright (C) 2023 OpenWrt.org
|
||||
#
|
||||
# This is free software, licensed under the GNU General Public License v2.
|
||||
# See /LICENSE for more information.
|
||||
#
|
||||
|
||||
include $(TOPDIR)/rules.mk
|
||||
include $(INCLUDE_DIR)/kernel.mk
|
||||
|
||||
PKG_NAME:=hwmon-isl28022
|
||||
PKG_RELEASE:=1
|
||||
PKG_MAINTAINER:=Carsten Spieß <mail@carsten-spiess.de
|
||||
PKG_LICENSE:=GPL-2.0
|
||||
|
||||
include $(INCLUDE_DIR)/package.mk
|
||||
|
||||
define KernelPackage/hwmon-isl28022
|
||||
SUBMENU:=Hardware Monitoring Support
|
||||
TITLE:= hwmon ISL28022 support
|
||||
DEPENDS:= +kmod-hwmon-core +kmod-i2c-core +kmod-regmap-i2c
|
||||
FILES:=$(PKG_BUILD_DIR)/isl28022.ko
|
||||
AUTOLOAD:=$(call AutoLoad,30,isl28022,1)
|
||||
endef
|
||||
|
||||
define KernelPackage/hwmon-isl28022/description
|
||||
Driver for ISL28022 power monitor.
|
||||
endef
|
||||
|
||||
define Build/Compile
|
||||
$(KERNEL_MAKE) \
|
||||
$(MAKE_OPTS) \
|
||||
M="$(PKG_BUILD_DIR)" \
|
||||
modules
|
||||
endef
|
||||
|
||||
$(eval $(call KernelPackage,hwmon-isl28022))
|
||||
1
package/kernel/hwmon-isl28022/src/Makefile
Normal file
1
package/kernel/hwmon-isl28022/src/Makefile
Normal file
@ -0,0 +1 @@
|
||||
obj-m += isl28022.o
|
||||
415
package/kernel/hwmon-isl28022/src/isl28022.c
Normal file
415
package/kernel/hwmon-isl28022/src/isl28022.c
Normal file
@ -0,0 +1,415 @@
|
||||
// SPDX-License-Identifier: GPL-2.0-or-later
|
||||
/*
|
||||
* isl28022.c - driver for Renesas ISL28022 power monitor chip
|
||||
* monitoring
|
||||
* Copyright (c) 1998, 1999 Frodo Looijaard <frodol@dds.nl>
|
||||
*/
|
||||
|
||||
/*#define DEBUG*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/jiffies.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/hwmon.h>
|
||||
#include <linux/hwmon-sysfs.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/of_device.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/util_macros.h>
|
||||
#include <linux/regulator/consumer.h>
|
||||
|
||||
enum isl28022_type {isl28022};
|
||||
|
||||
/* ISL28022 registers */
|
||||
#define ISL28022_REG_CONFIG 0x00
|
||||
#define ISL28022_REG_SHUNT 0x01
|
||||
#define ISL28022_REG_BUS 0x02
|
||||
#define ISL28022_REG_POWER 0x03
|
||||
#define ISL28022_REG_CURRENT 0x04
|
||||
#define ISL28022_REG_CALIB 0x05
|
||||
#define ISL28022_REG_SHUNT_THR 0x06
|
||||
#define ISL28022_REG_BUS_THR 0x07
|
||||
#define ISL28022_REG_INT 0x08
|
||||
#define ISL28022_REG_AUX 0x09
|
||||
#define ISL28022_REG_MAX ISL28022_REG_AUX
|
||||
|
||||
/* ISL28022 config flags */
|
||||
/* mode flags */
|
||||
#define ISL28022_MODE_SHIFT 0
|
||||
#define ISL28022_MODE_MASK 0x0007
|
||||
|
||||
#define ISL28022_MODE_PWR_DOWN 0x0
|
||||
#define ISL28022_MODE_TRG_S 0x1
|
||||
#define ISL28022_MODE_TRG_B 0x2
|
||||
#define ISL28022_MODE_TRG_SB 0x3
|
||||
#define ISL28022_MODE_ADC_OFF 0x4
|
||||
#define ISL28022_MODE_CONT_S 0x5
|
||||
#define ISL28022_MODE_CONT_B 0x6
|
||||
#define ISL28022_MODE_CONT_SB 0x7
|
||||
|
||||
/* shunt ADC settings */
|
||||
#define ISL28022_SADC_SHIFT 3
|
||||
#define ISL28022_SADC_MASK 0x0078
|
||||
|
||||
#define ISL28022_BADC_SHIFT 7
|
||||
#define ISL28022_BADC_MASK 0x0780
|
||||
|
||||
#define ISL28022_ADC_12 0x0 /* 12 bit ADC */
|
||||
#define ISL28022_ADC_13 0x1 /* 13 bit ADC */
|
||||
#define ISL28022_ADC_14 0x2 /* 14 bit ADC */
|
||||
#define ISL28022_ADC_15 0x3 /* 15 bit ADC */
|
||||
#define ISL28022_ADC_15_1 0x8 /* 15 bit ADC, 1 sample */
|
||||
#define ISL28022_ADC_15_2 0x9 /* 15 bit ADC, 2 samples */
|
||||
#define ISL28022_ADC_15_4 0xA /* 15 bit ADC, 4 samples */
|
||||
#define ISL28022_ADC_15_8 0xB /* 15 bit ADC, 8 samples */
|
||||
#define ISL28022_ADC_15_16 0xC /* 15 bit ADC, 16 samples */
|
||||
#define ISL28022_ADC_15_32 0xD /* 15 bit ADC, 32 samples */
|
||||
#define ISL28022_ADC_15_64 0xE /* 15 bit ADC, 64 samples */
|
||||
#define ISL28022_ADC_15_128 0xF /* 15 bit ADC, 128 samples */
|
||||
|
||||
/* shunt voltage range */
|
||||
#define ISL28022_PG_SHIFT 11
|
||||
#define ISL28022_PG_MASK 0x1800
|
||||
|
||||
#define ISL28022_PG_40 0x0 /* +/-40 mV */
|
||||
#define ISL28022_PG_80 0x1 /* +/-80 mV */
|
||||
#define ISL28022_PG_160 0x2 /* +/-160 mV */
|
||||
#define ISL28022_PG_320 0x3 /* +/-3200 mV */
|
||||
|
||||
/* bus voltage range */
|
||||
#define ISL28022_BRNG_SHIFT 13
|
||||
#define ISL28022_BRNG_MASK 0x6000
|
||||
|
||||
#define ISL28022_BRNG_16 0x0 /* 16 V */
|
||||
#define ISL28022_BRNG_32 0x1 /* 32 V */
|
||||
#define ISL28022_BRNG_60 0x3 /* 60 V */
|
||||
|
||||
/* reset */
|
||||
#define ISL28022_RESET 0x8000
|
||||
|
||||
struct isl28022_data {
|
||||
struct i2c_client *client;
|
||||
struct regmap *regmap;
|
||||
u32 shunt;
|
||||
u32 gain;
|
||||
u32 average;
|
||||
u16 config;
|
||||
u16 calib;
|
||||
};
|
||||
|
||||
static int isl28022_read(struct device *dev, enum hwmon_sensor_types type,
|
||||
u32 attr, int channel, long *val)
|
||||
{
|
||||
struct isl28022_data *data = dev_get_drvdata(dev);
|
||||
unsigned int regval;
|
||||
int err;
|
||||
|
||||
switch (type) {
|
||||
case hwmon_in:
|
||||
switch (attr) {
|
||||
case hwmon_in_input:
|
||||
err = regmap_read(data->regmap, ISL28022_REG_SHUNT + channel, ®val);
|
||||
if (err < 0)
|
||||
return err;
|
||||
dev_dbg(dev, "read reg %d: %x\n", ISL28022_REG_SHUNT + channel, regval);
|
||||
*val = (0 == channel) ?
|
||||
(long)((s16)((u16)regval)) * 10 :
|
||||
(long)(((u16)regval) & 0xFFFC);
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case hwmon_curr:
|
||||
switch (attr) {
|
||||
case hwmon_curr_input:
|
||||
err = regmap_read(data->regmap, ISL28022_REG_CURRENT, ®val);
|
||||
if (err < 0)
|
||||
return err;
|
||||
dev_dbg(dev, "read reg %d: %x\n", ISL28022_REG_CURRENT, regval);
|
||||
if(!data->shunt)
|
||||
return -EINVAL;
|
||||
*val = ((long)regval * 10000L * (long)data->gain) / (long)(8 * data->shunt);
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
case hwmon_power:
|
||||
switch (attr) {
|
||||
case hwmon_power_input:
|
||||
err = regmap_read(data->regmap, ISL28022_REG_POWER, ®val);
|
||||
if (err < 0)
|
||||
return err;
|
||||
dev_dbg(dev, "read reg %d: %x\n", ISL28022_REG_POWER, regval);
|
||||
if(!data->shunt)
|
||||
return -EINVAL;
|
||||
*val = ((long)regval * 409600000L * (long)data->gain) / (long)(8 * data->shunt);
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static umode_t isl28022_is_visible(const void *data, enum hwmon_sensor_types type,
|
||||
u32 attr, int channel)
|
||||
{
|
||||
switch (type) {
|
||||
case hwmon_in:
|
||||
switch (attr) {
|
||||
case hwmon_in_input:
|
||||
return 0444;
|
||||
}
|
||||
break;
|
||||
case hwmon_curr:
|
||||
switch (attr) {
|
||||
case hwmon_curr_input:
|
||||
return 0444;
|
||||
}
|
||||
break;
|
||||
case hwmon_power:
|
||||
switch (attr) {
|
||||
case hwmon_power_input:
|
||||
return 0444;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct hwmon_channel_info *isl28022_info[] = {
|
||||
HWMON_CHANNEL_INFO(in,
|
||||
HWMON_I_INPUT, /* channel 0: shunt voltage (µV) */
|
||||
HWMON_I_INPUT), /* channel 1: bus voltage (mV) */
|
||||
NULL
|
||||
};
|
||||
|
||||
static const struct hwmon_channel_info *isl28022_info_shunt[] = {
|
||||
HWMON_CHANNEL_INFO(in,
|
||||
HWMON_I_INPUT, /* channel 0: shunt voltage (µV) */
|
||||
HWMON_I_INPUT), /* channel 1: bus voltage (mV) */
|
||||
HWMON_CHANNEL_INFO(curr,
|
||||
HWMON_C_INPUT), /* channel 1: current (mA) */
|
||||
HWMON_CHANNEL_INFO(power,
|
||||
HWMON_P_INPUT), /* channel 1: power (µW) */
|
||||
NULL
|
||||
};
|
||||
|
||||
static const struct hwmon_ops isl28022_hwmon_ops = {
|
||||
.is_visible = isl28022_is_visible,
|
||||
.read = isl28022_read,
|
||||
};
|
||||
|
||||
static const struct hwmon_chip_info isl28022_chip_info = {
|
||||
.ops = &isl28022_hwmon_ops,
|
||||
.info = isl28022_info,
|
||||
};
|
||||
|
||||
static const struct hwmon_chip_info isl28022_chip_info_shunt = {
|
||||
.ops = &isl28022_hwmon_ops,
|
||||
.info = isl28022_info_shunt,
|
||||
};
|
||||
|
||||
static bool isl28022_is_writeable_reg(struct device *dev, unsigned int reg)
|
||||
{
|
||||
switch (reg) {
|
||||
case ISL28022_REG_CONFIG:
|
||||
case ISL28022_REG_CALIB:
|
||||
case ISL28022_REG_SHUNT_THR:
|
||||
case ISL28022_REG_BUS_THR:
|
||||
case ISL28022_REG_INT:
|
||||
case ISL28022_REG_AUX:
|
||||
return true;
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
static bool isl28022_is_volatile_reg(struct device *dev, unsigned int reg)
|
||||
{
|
||||
switch (reg) {
|
||||
case ISL28022_REG_CONFIG:
|
||||
case ISL28022_REG_SHUNT:
|
||||
case ISL28022_REG_BUS:
|
||||
case ISL28022_REG_POWER:
|
||||
case ISL28022_REG_CURRENT:
|
||||
case ISL28022_REG_INT:
|
||||
case ISL28022_REG_AUX:
|
||||
return true;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
|
||||
static const struct regmap_config isl28022_regmap_config = {
|
||||
.reg_bits = 8,
|
||||
.val_bits = 16,
|
||||
.max_register = ISL28022_REG_MAX,
|
||||
.writeable_reg = isl28022_is_writeable_reg,
|
||||
.volatile_reg = isl28022_is_volatile_reg,
|
||||
.val_format_endian = REGMAP_ENDIAN_BIG,
|
||||
.cache_type = REGCACHE_RBTREE,
|
||||
.use_single_read = true,
|
||||
.use_single_write = true,
|
||||
};
|
||||
|
||||
static const struct i2c_device_id isl28022_ids[] = {
|
||||
{ "isl28022", isl28022},
|
||||
{ /* LIST END */ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, isl28022_ids);
|
||||
|
||||
static int isl28022_config(struct device *dev)
|
||||
{
|
||||
struct isl28022_data *data = dev_get_drvdata(dev);
|
||||
|
||||
if (!dev || !data)
|
||||
return -EINVAL;
|
||||
;
|
||||
data->config = (ISL28022_MODE_CONT_SB << ISL28022_MODE_SHIFT) | \
|
||||
(ISL28022_BRNG_60 << ISL28022_BRNG_SHIFT);
|
||||
|
||||
switch (data->gain) {
|
||||
case 1:
|
||||
data->config |= (ISL28022_PG_40 << ISL28022_PG_SHIFT);
|
||||
break;
|
||||
case 2:
|
||||
data->config |= (ISL28022_PG_80 << ISL28022_PG_SHIFT);
|
||||
break;
|
||||
case 4:
|
||||
data->config |= (ISL28022_PG_160 << ISL28022_PG_SHIFT);
|
||||
break;
|
||||
default:
|
||||
data->config |= (ISL28022_PG_320 << ISL28022_PG_SHIFT);
|
||||
data->gain = 8;
|
||||
break;
|
||||
}
|
||||
|
||||
data->calib = data->shunt ? 0x8000 / data->gain : 0;
|
||||
|
||||
switch (data->average) {
|
||||
case 128:
|
||||
data->config |= (ISL28022_ADC_15_128 << ISL28022_SADC_SHIFT) |
|
||||
(ISL28022_ADC_15_128 << ISL28022_BADC_SHIFT);
|
||||
break;
|
||||
case 64:
|
||||
data->config |= (ISL28022_ADC_15_64 << ISL28022_SADC_SHIFT) |
|
||||
(ISL28022_ADC_15_64 << ISL28022_BADC_SHIFT);
|
||||
break;
|
||||
case 32:
|
||||
data->config |= (ISL28022_ADC_15_32 << ISL28022_SADC_SHIFT) |
|
||||
(ISL28022_ADC_15_32 << ISL28022_BADC_SHIFT);
|
||||
break;
|
||||
case 16:
|
||||
data->config |= (ISL28022_ADC_15_16 << ISL28022_SADC_SHIFT) |
|
||||
(ISL28022_ADC_15_16 << ISL28022_BADC_SHIFT);
|
||||
break;
|
||||
case 8:
|
||||
data->config |= (ISL28022_ADC_15_8 << ISL28022_SADC_SHIFT) |
|
||||
(ISL28022_ADC_15_8 << ISL28022_BADC_SHIFT);
|
||||
break;
|
||||
case 4:
|
||||
data->config |= (ISL28022_ADC_15_4 << ISL28022_SADC_SHIFT) |
|
||||
(ISL28022_ADC_15_4 << ISL28022_BADC_SHIFT);
|
||||
break;
|
||||
case 2:
|
||||
data->config |= (ISL28022_ADC_15_2 << ISL28022_SADC_SHIFT) |
|
||||
(ISL28022_ADC_15_2 << ISL28022_BADC_SHIFT);
|
||||
break;
|
||||
case 1:
|
||||
data->config |= (ISL28022_ADC_15_1 << ISL28022_SADC_SHIFT) |
|
||||
(ISL28022_ADC_15_1 << ISL28022_BADC_SHIFT);
|
||||
break;
|
||||
default:
|
||||
data->config |= (ISL28022_ADC_15 << ISL28022_SADC_SHIFT) |
|
||||
(ISL28022_ADC_15 << ISL28022_BADC_SHIFT);
|
||||
data->average = 0;
|
||||
break;
|
||||
}
|
||||
|
||||
regmap_write(data->regmap, ISL28022_REG_CONFIG, data->config);
|
||||
dev_dbg(dev, "write reg %d: %x\n", ISL28022_REG_CONFIG, data->config);
|
||||
regmap_write(data->regmap, ISL28022_REG_CALIB, data->calib);
|
||||
dev_dbg(dev, "write reg %d: %x\n", ISL28022_REG_CALIB, data->calib);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int isl28022_probe(struct i2c_client *client)
|
||||
{
|
||||
struct device *dev = &client->dev;
|
||||
struct device *hwmon_dev;
|
||||
struct isl28022_data *data;
|
||||
int status;
|
||||
|
||||
dev_dbg(dev, "probe\n");
|
||||
|
||||
if (!i2c_check_functionality(client->adapter,
|
||||
I2C_FUNC_SMBUS_BYTE_DATA | I2C_FUNC_SMBUS_WORD_DATA))
|
||||
return -EIO;
|
||||
|
||||
data = devm_kzalloc(dev, sizeof(struct isl28022_data), GFP_KERNEL);
|
||||
if (!data)
|
||||
return -ENOMEM;
|
||||
|
||||
data->client = client;
|
||||
|
||||
if (!of_property_read_u32(dev->of_node, "shunt-resistor-micro-ohms", &data->shunt))
|
||||
dev_dbg(dev, "shunt-resistor %d\n", data->shunt);
|
||||
if (!of_property_read_u32(dev->of_node, "shunt-gain", &data->gain))
|
||||
dev_dbg(dev, "shunt-gain %d\n", data->gain);
|
||||
if (!of_property_read_u32(dev->of_node, "average", &data->average))
|
||||
dev_dbg(dev, "average %d\n", data->average);
|
||||
|
||||
data->regmap = devm_regmap_init_i2c(client, &isl28022_regmap_config);
|
||||
if (IS_ERR(data->regmap))
|
||||
return PTR_ERR(data->regmap);
|
||||
|
||||
hwmon_dev = devm_hwmon_device_register_with_info(dev, "isl28022_hwmon"/*client->name*/, data,
|
||||
data->shunt ? &isl28022_chip_info_shunt : &isl28022_chip_info, NULL);
|
||||
if (IS_ERR(hwmon_dev))
|
||||
return PTR_ERR(hwmon_dev);
|
||||
|
||||
status = isl28022_config(hwmon_dev);
|
||||
if (status)
|
||||
return status;
|
||||
|
||||
dev_info(dev, "%s: sensor '%s'\n", dev_name(hwmon_dev), client->name);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id __maybe_unused isl28022_of_match[] = {
|
||||
{
|
||||
.compatible = "isl,isl28022",
|
||||
.data = (void *)isl28022
|
||||
},
|
||||
{ /* LIST END */ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, isl28022_of_match);
|
||||
|
||||
static struct i2c_driver isl28022_driver = {
|
||||
.class = I2C_CLASS_HWMON,
|
||||
.driver = {
|
||||
.name = "isl28022",
|
||||
.of_match_table = of_match_ptr(isl28022_of_match),
|
||||
},
|
||||
.probe_new = isl28022_probe,
|
||||
.id_table = isl28022_ids,
|
||||
};
|
||||
|
||||
module_i2c_driver(isl28022_driver);
|
||||
|
||||
MODULE_AUTHOR("Carsten Spiess <mail@carsten-spiess.de>");
|
||||
MODULE_DESCRIPTION("ISL28022 driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
24
target/linux/generic/hack-5.15/262-regmap-i2c-unhide.patch
Normal file
24
target/linux/generic/hack-5.15/262-regmap-i2c-unhide.patch
Normal file
@ -0,0 +1,24 @@
|
||||
This makes it possible to select CONFIG_REGMAP and CONFIG_REGMAP_I2C.
|
||||
This is needed to compile this into the kernel and make use of it
|
||||
from out of tree drivers like hwmon-isl28022.
|
||||
|
||||
--- a/drivers/base/regmap/Kconfig
|
||||
+++ b/drivers/base/regmap/Kconfig
|
||||
@@ -6,7 +6,7 @@
|
||||
config REGMAP
|
||||
select IRQ_DOMAIN if REGMAP_IRQ
|
||||
select MDIO_BUS if REGMAP_MDIO
|
||||
- tristate
|
||||
+ tristate "select REGMAP"
|
||||
|
||||
config REGCACHE_COMPRESSED
|
||||
select LZO_COMPRESS
|
||||
@@ -19,7 +19,7 @@ config REGMAP_AC97
|
||||
|
||||
config REGMAP_I2C
|
||||
select REGMAP
|
||||
- tristate
|
||||
+ tristate "select REGMAP_I2C"
|
||||
depends on I2C
|
||||
|
||||
config REGMAP_SLIMBUS
|
||||
Loading…
Reference in New Issue
Block a user