Re: [PATCH] Support for DS620

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



On Sat, Dec 25, 2010 at 04:10:44PM -0500, Roland Stigge wrote:
> Hi!
> 
> Thanks for your advice!
> 
> On 25/12/10 19:34, Guenter Roeck wrote:
> >> Signed-off-by: Roland Stigge <stigge@xxxxxxxxx>
> > 
> > Did you apply your patch ? All the above will show up in the patch log,
> > which isn't really a good idea.
> 
> Please only consider the attached patch file (including the one line
> description plus the "Signed-off-by:" line.
> 
> I included all your suggestions and attached the new patch.
> 
> Thanks for considering!
> 
> bye,
>   Roland

> Added support for Dallas Semiconductor DS620
> 
> Signed-off-by: Roland Stigge <stigge@xxxxxxxxx>
> 
Almost there. See below.

Guenter

> diff --git a/Documentation/hwmon/ds620 b/Documentation/hwmon/ds620
> new file mode 100644
> index 0000000..824d01d
> --- /dev/null
> +++ b/Documentation/hwmon/ds620
> @@ -0,0 +1,23 @@
> +Kernel driver ds620
> +===================
> +
> +Supported chips:
> +  * Dallas Semiconductor DS620
> +    Prefix: 'ds620'
> +    Addresses scanned: I2C 0x48 - 0x4f
> +    Datasheet: Publicly available at the Dallas Semiconductor website
> +               http://www.dalsemi.com/
> +
> +Authors:
> +        Roland Stigge <stigge@xxxxxxxxx>
> +        based on ds1621.c by
> +        Christian W. Zuckschwerdt <zany@xxxxxxxx>
> +
> +Description
> +-----------
> +
> +The DS620 is a (one instance) digital thermometer and thermostat. It has both
> +high and low temperature limits which can be user defined (i.e.  programmed
> +into non-volatile on-chip registers). Temperature range is -55 degree Celsius
> +to +125. Between 0 and 70 degree Celsius, accuracy is 0.5 Kelvin. The value
> +returned via sysfs displays post decimal positions.
> diff --git a/drivers/hwmon/Kconfig b/drivers/hwmon/Kconfig
> index a56f6ad..700389a 100644
> --- a/drivers/hwmon/Kconfig
> +++ b/drivers/hwmon/Kconfig
> @@ -274,6 +274,16 @@ config SENSORS_ATXP1
>  	  This driver can also be built as a module.  If so, the module
>  	  will be called atxp1.
>  
> +config SENSORS_DS620
> +	tristate "Dallas Semiconductor DS620"
> +	depends on I2C
> +	help
> +	  If you say yes here you get support for Dallas Semiconductor
> +	  DS620 sensor chip.
> +
> +	  This driver can also be built as a module.  If so, the module
> +	  will be called ds620.
> +
>  config SENSORS_DS1621
>  	tristate "Dallas Semiconductor DS1621 and DS1625"
>  	depends on I2C
> diff --git a/drivers/hwmon/Makefile b/drivers/hwmon/Makefile
> index 2479b3d..42542d7 100644
> --- a/drivers/hwmon/Makefile
> +++ b/drivers/hwmon/Makefile
> @@ -41,6 +41,7 @@ obj-$(CONFIG_SENSORS_ATXP1)	+= atxp1.o
>  obj-$(CONFIG_SENSORS_CORETEMP)	+= coretemp.o
>  obj-$(CONFIG_SENSORS_PKGTEMP)	+= pkgtemp.o
>  obj-$(CONFIG_SENSORS_DME1737)	+= dme1737.o
> +obj-$(CONFIG_SENSORS_DS620)	+= ds620.o
>  obj-$(CONFIG_SENSORS_DS1621)	+= ds1621.o
>  obj-$(CONFIG_SENSORS_EMC1403)	+= emc1403.o
>  obj-$(CONFIG_SENSORS_EMC2103)	+= emc2103.o
> diff --git a/drivers/hwmon/ds620.c b/drivers/hwmon/ds620.c
> new file mode 100644
> index 0000000..1025f74
> --- /dev/null
> +++ b/drivers/hwmon/ds620.c
> @@ -0,0 +1,362 @@
> +/*
> +    ds620.c - Support for temperature sensor and thermostat DS620
> +
> +    Copyright (C) 2010 Roland Stigge <stigge@xxxxxxxxx>
> +
> +    based on ds1621.c by Christian W. Zuckschwerdt  <zany@xxxxxxxx>
> +
> +    This program is free software; you can redistribute it and/or modify
> +    it under the terms of the GNU General Public License as published by
> +    the Free Software Foundation; either version 2 of the License, or
> +    (at your option) any later version.
> +
> +    This program is distributed in the hope that it will be useful,
> +    but WITHOUT ANY WARRANTY; without even the implied warranty of
> +    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
> +    GNU General Public License for more details.
> +
> +    You should have received a copy of the GNU General Public License
> +    along with this program; if not, write to the Free Software
> +    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
> +*/
> +
> +#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/mutex.h>
> +#include <linux/sysfs.h>
> +
> +/* Addresses to scan */
> +static const unsigned short normal_i2c[] = { 0x48, 0x49, 0x4a, 0x4b, 0x4c,
> +					0x4d, 0x4e, 0x4f, I2C_CLIENT_END
> +};
> +
> +/* Many DS620 constants specified below */
> +/* Config register used for detection          */
> +/*  15   14   13   12   11   10   09    08     */
> +/* |Done|NVB |THF |TLF |R1  |R0  |AUTOC|1SHOT| */
> +
> +/*  07   06   05   04   03   02   01    00     */
> +/* |PO2 |PO1 |A2  |A1  |A0  |    |     |     | */
> +#define DS620_REG_CONFIG_DONE		0x8000
> +#define DS620_REG_CONFIG_NVB		0x4000
> +#define DS620_REG_CONFIG_THF		0x2000
> +#define DS620_REG_CONFIG_TLF		0x1000
> +#define DS620_REG_CONFIG_R1		0x0800
> +#define DS620_REG_CONFIG_R0		0x0400
> +#define DS620_REG_CONFIG_AUTOC          0x0200

Some blanks got in here. Odd - I thought checkpatch would complain about that.

> +#define DS620_REG_CONFIG_1SHOT		0x0100
> +#define DS620_REG_CONFIG_PO2		0x0080
> +#define DS620_REG_CONFIG_PO1		0x0040
> +#define DS620_REG_CONFIG_A2		0x0020
> +#define DS620_REG_CONFIG_A1		0x0010
> +#define DS620_REG_CONFIG_A0		0x0008
> +
> +/* The DS620 registers */
> +static const u8 DS620_REG_TEMP[3] = {
> +	0xAA,			/* input, word, RO */
> +	0xA2,			/* min, word, RW */
> +	0xA0,			/* max, word, RW */
> +};
> +
> +#define DS620_REG_CONF		0xAC	/* word, RW */
> +#define DS620_COM_START		0x51	/* no data */
> +#define DS620_COM_STOP		0x22	/* no data */
> +
> +/* Conversions */
> +#define ALARMS_FROM_REG(val) ((val) & \
> +				(DS620_REG_CONFIG_THF | DS620_REG_CONFIG_TLF))
> +
> +/* Each client has this additional data */
> +struct ds620_data {
> +	struct device *hwmon_dev;
> +	struct mutex update_lock;
> +	char valid;		/* !=0 if following fields are valid */
> +	unsigned long last_updated;	/* In jiffies */
> +
> +	u16 temp[3];		/* Register values, word */
> +	u16 conf;		/* Register encoding, combined */
> +};
> +
> +/* Temperature registers are word-sized.
> +   DS620 uses a high-byte first convention, which is exactly opposite to
> +   the SMBus standard. */
> +static int ds620_read_temp(struct i2c_client *client, u8 reg)
> +{
> +	int ret;
> +
> +	ret = i2c_smbus_read_word_data(client, reg);
> +	if (ret < 0)
> +		return ret;
> +	return swab16(ret);
> +}
> +
> +static int ds620_write_temp(struct i2c_client *client, u8 reg, u16 value)
> +{
> +	return i2c_smbus_write_word_data(client, reg, swab16(value));
> +}
> +
> +static void ds620_init_client(struct i2c_client *client)
> +{
> +	u16 conf, new_conf;
> +
> +	new_conf = conf =
> +	    swab16(i2c_smbus_read_word_data(client, DS620_REG_CONF));
> +
> +	/* switch to continuous conversion mode */
> +	new_conf &= ~DS620_REG_CONFIG_1SHOT;
> +	/* with highest precision */
> +	new_conf |= DS620_REG_CONFIG_R1 | DS620_REG_CONFIG_R0;
> +
> +	if (conf != new_conf) {
> +		i2c_smbus_write_word_data(client, DS620_REG_CONF,
> +					  swab16(new_conf));
> +	}
> +
> +	/* start conversion */
> +	i2c_smbus_write_byte(client, DS620_COM_START);
> +}
> +
> +static struct ds620_data *ds620_update_client(struct device *dev)
> +{
> +	struct i2c_client *client = to_i2c_client(dev);
> +	struct ds620_data *data = i2c_get_clientdata(client);
> +
> +	mutex_lock(&data->update_lock);
> +
> +	if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
> +	    || !data->valid) {
> +		int i;
> +		int res;
> +
> +		dev_dbg(&client->dev, "Starting ds620 update\n");
> +
> +		for (i = 0; i < ARRAY_SIZE(data->temp); i++) {
> +			res = ds620_read_temp(client,
> +					      DS620_REG_TEMP[i]);
> +			if (res < 0)
> +				return ERR_PTR(res);
> +
Mutex is still locked here. Look at how I implemented this in ltc4261.c.

> +			data->temp[i] = res;
> +		}
> +
> +		data->last_updated = jiffies;
> +		data->valid = 1;
> +	}
> +
> +	mutex_unlock(&data->update_lock);
> +
> +	return data;
> +}
> +
> +static ssize_t show_temp(struct device *dev, struct device_attribute *da,
> +			 char *buf)
> +{
> +	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
> +	struct ds620_data *data = ds620_update_client(dev);
> +
> +	if (IS_ERR(data))
> +		return PTR_ERR(data);
> +
> +	return sprintf(buf, "%d\n", ((data->temp[attr->index] / 8) * 625) / 10);
> +}
> +
> +static ssize_t set_temp(struct device *dev, struct device_attribute *da,
> +			const char *buf, size_t count)
> +{
> +	int res;
> +	long val;
> +
> +	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
> +	struct i2c_client *client = to_i2c_client(dev);
> +	struct ds620_data *data = i2c_get_clientdata(client);
> +
> +	res = strict_strtol(buf, 10, &val);
> +
> +	if (res)
> +		return res;
> +
> +	val = (val * 10 / 625) * 8;
> +
> +	mutex_lock(&data->update_lock);
> +	data->temp[attr->index] = val;
> +	ds620_write_temp(client, DS620_REG_TEMP[attr->index],
> +			 data->temp[attr->index]);
> +	mutex_unlock(&data->update_lock);
> +	return count;
> +}
> +
> +static ssize_t show_alarm(struct device *dev, struct device_attribute *da,
> +			  char *buf)
> +{
> +	struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
> +	struct ds620_data *data = ds620_update_client(dev);
> +	struct i2c_client *client = to_i2c_client(dev);
> +	u16 new_conf;
> +
> +	if (IS_ERR(data))
> +		return PTR_ERR(data);
> +
> +	/* reset alarms if necessary */
> +	data->conf = swab16(i2c_smbus_read_word_data(client,
> +						     DS620_REG_CONF));

You might want to check the error code from i2c_smbus_read_word_data() as well.

> +	new_conf = data->conf;
> +	if (data->temp[0] > data->temp[1])	/* input > min */
> +		new_conf &= ~DS620_REG_CONFIG_TLF;
> +	if (data->temp[0] < data->temp[2])	/* input < max */
> +		new_conf &= ~DS620_REG_CONFIG_THF;
> +	if (data->conf != new_conf)
> +		i2c_smbus_write_word_data(client, DS620_REG_CONF,
> +					  swab16(new_conf));
> +
> +	return sprintf(buf, "%d\n", !!(data->conf & attr->index));
> +}
> +
> +static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0);
> +static SENSOR_DEVICE_ATTR(temp1_min, S_IWUSR | S_IRUGO, show_temp, set_temp, 1);
> +static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp, set_temp, 2);
> +static SENSOR_DEVICE_ATTR(temp1_min_alarm, S_IRUGO, show_alarm, NULL,
> +			  DS620_REG_CONFIG_TLF);
> +static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL,
> +			  DS620_REG_CONFIG_THF);
> +
> +static struct attribute *ds620_attributes[] = {
> +	&sensor_dev_attr_temp1_input.dev_attr.attr,
> +	&sensor_dev_attr_temp1_min.dev_attr.attr,
> +	&sensor_dev_attr_temp1_max.dev_attr.attr,
> +	&sensor_dev_attr_temp1_min_alarm.dev_attr.attr,
> +	&sensor_dev_attr_temp1_max_alarm.dev_attr.attr,
> +	NULL
> +};
> +
> +static const struct attribute_group ds620_group = {
> +	.attrs = ds620_attributes,
> +};
> +
> +/* Return 0 if detection is successful, -ENODEV otherwise */
> +static int ds620_detect(struct i2c_client *client, struct i2c_board_info *info)
> +{
> +	struct i2c_adapter *adapter = client->adapter;
> +	int result, conf, temp;
> +	int i;
> +
> +	if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA
> +				     | I2C_FUNC_SMBUS_WORD_DATA
> +				     | I2C_FUNC_SMBUS_WRITE_BYTE))
> +		return -ENODEV;
> +
> +	/* Now, we do the remaining detection. */
> +	result = i2c_smbus_read_word_data(client, DS620_REG_CONF);
> +	conf = swab16(result);
> +	if (result < 0 || conf & DS620_REG_CONFIG_NVB ||
> +	    ((conf & DS620_REG_CONFIG_DONE) &&
> +	     (conf & DS620_REG_CONFIG_AUTOC)) ||
> +	    !((conf & DS620_REG_CONFIG_DONE) &&
> +	      !(conf & DS620_REG_CONFIG_AUTOC)))
> +		return -ENODEV;
> +	/* The 3 lowest bits of a temperature should always be 0. */
> +	for (i = 0; i < ARRAY_SIZE(DS620_REG_TEMP); i++) {
> +		temp = i2c_smbus_read_word_data(client, DS620_REG_TEMP[i]);
> +		if (temp < 0 || (temp & 0x0700))
> +			return -ENODEV;
> +	}
> +
> +	strlcpy(info->type, "ds620", I2C_NAME_SIZE);
> +
> +	return 0;
> +}
> +
> +static int ds620_probe(struct i2c_client *client,
> +		       const struct i2c_device_id *id)
> +{
> +	struct ds620_data *data;
> +	int err;
> +
> +	data = kzalloc(sizeof(struct ds620_data), GFP_KERNEL);
> +	if (!data) {
> +		err = -ENOMEM;
> +		goto exit;
> +	}
> +
> +	i2c_set_clientdata(client, data);
> +	mutex_init(&data->update_lock);
> +
> +	/* Initialize the DS620 chip */
> +	ds620_init_client(client);
> +
> +	/* Register sysfs hooks */
> +	err = sysfs_create_group(&client->dev.kobj, &ds620_group);
> +	if (err)
> +		goto exit_free;
> +
> +	data->hwmon_dev = hwmon_device_register(&client->dev);
> +	if (IS_ERR(data->hwmon_dev)) {
> +		err = PTR_ERR(data->hwmon_dev);
> +		goto exit_remove_files;
> +	}
> +
> +	dev_info(&client->dev, "temperature sensor found\n");
> +
> +	return 0;
> +
> +exit_remove_files:
> +	sysfs_remove_group(&client->dev.kobj, &ds620_group);
> +exit_free:
> +	kfree(data);
> +exit:
> +	return err;
> +}
> +
> +static int ds620_remove(struct i2c_client *client)
> +{
> +	struct ds620_data *data = i2c_get_clientdata(client);
> +
> +	hwmon_device_unregister(data->hwmon_dev);
> +	sysfs_remove_group(&client->dev.kobj, &ds620_group);
> +
> +	kfree(data);
> +
> +	return 0;
> +}
> +
> +static const struct i2c_device_id ds620_id[] = {
> +	{"ds620", 0},
> +	{}
> +};
> +
> +MODULE_DEVICE_TABLE(i2c, ds620_id);
> +
> +/* This is the driver that will be inserted */
> +static struct i2c_driver ds620_driver = {
> +	.class = I2C_CLASS_HWMON,
> +	.driver = {
> +		   .name = "ds620",
> +	},
> +	.probe = ds620_probe,
> +	.remove = ds620_remove,
> +	.id_table = ds620_id,
> +	.detect = ds620_detect,
> +	.address_list = normal_i2c,
> +};
> +
> +static int __init ds620_init(void)
> +{
> +	return i2c_add_driver(&ds620_driver);
> +}
> +
> +static void __exit ds620_exit(void)
> +{
> +	i2c_del_driver(&ds620_driver);
> +}
> +
> +MODULE_AUTHOR("Roland Stigge <stigge@xxxxxxxxx>");
> +MODULE_DESCRIPTION("DS620 driver");
> +MODULE_LICENSE("GPL");
> +
> +module_init(ds620_init);
> +module_exit(ds620_exit);


_______________________________________________
lm-sensors mailing list
lm-sensors@xxxxxxxxxxxxxx
http://lists.lm-sensors.org/mailman/listinfo/lm-sensors


[Index of Archives]     [Linux Kernel]     [Linux Hardware Monitoring]     [Linux USB Devel]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [Yosemite Backpacking]

  Powered by Linux