[linux-block.git] / drivers / hwmon / i5k_amb.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * A hwmon driver for the Intel 5000 series chipset FB-DIMM AMB
 * temperature sensors
 * Copyright (C) 2007 IBM
 *
 * Author: Darrick J. Wong <darrick.wong@oracle.com>
 */

#include <linux/module.h>
#include <linux/hwmon.h>
#include <linux/hwmon-sysfs.h>
#include <linux/err.h>
#include <linux/mutex.h>
#include <linux/log2.h>
#include <linux/pci.h>
#include <linux/platform_device.h>
#include <linux/slab.h>

#define DRVNAME "i5k_amb"

#define I5K_REG_AMB_BASE_ADDR		0x48
#define I5K_REG_AMB_LEN_ADDR		0x50
#define I5K_REG_CHAN0_PRESENCE_ADDR	0x64
#define I5K_REG_CHAN1_PRESENCE_ADDR	0x66

#define AMB_REG_TEMP_MIN_ADDR		0x80
#define AMB_REG_TEMP_MID_ADDR		0x81
#define AMB_REG_TEMP_MAX_ADDR		0x82
#define AMB_REG_TEMP_STATUS_ADDR	0x84
#define AMB_REG_TEMP_ADDR		0x85

#define AMB_CONFIG_SIZE			2048
#define AMB_FUNC_3_OFFSET		768

static unsigned long amb_reg_temp_status(unsigned int amb)
{
	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_STATUS_ADDR +
	       AMB_CONFIG_SIZE * amb;
}

static unsigned long amb_reg_temp_min(unsigned int amb)
{
	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_MIN_ADDR +
	       AMB_CONFIG_SIZE * amb;
}

static unsigned long amb_reg_temp_mid(unsigned int amb)
{
	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_MID_ADDR +
	       AMB_CONFIG_SIZE * amb;
}

static unsigned long amb_reg_temp_max(unsigned int amb)
{
	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_MAX_ADDR +
	       AMB_CONFIG_SIZE * amb;
}

static unsigned long amb_reg_temp(unsigned int amb)
{
	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_ADDR +
	       AMB_CONFIG_SIZE * amb;
}

#define MAX_MEM_CHANNELS		4
#define MAX_AMBS_PER_CHANNEL		16
#define MAX_AMBS			(MAX_MEM_CHANNELS * \
					 MAX_AMBS_PER_CHANNEL)
#define CHANNEL_SHIFT			4
#define DIMM_MASK			0xF
/*
 * Ugly hack: For some reason the highest bit is set if there
 * are _any_ DIMMs in the channel.  Attempting to read from
 * this "high-order" AMB results in a memory bus error, so
 * for now we'll just ignore that top bit, even though that
 * might prevent us from seeing the 16th DIMM in the channel.
 */
#define REAL_MAX_AMBS_PER_CHANNEL	15
#define KNOBS_PER_AMB			6

static unsigned long amb_num_from_reg(unsigned int byte_num, unsigned int bit)
{
	return byte_num * MAX_AMBS_PER_CHANNEL + bit;
}

#define AMB_SYSFS_NAME_LEN		16
struct i5k_device_attribute {
	struct sensor_device_attribute s_attr;
	char name[AMB_SYSFS_NAME_LEN];
};

struct i5k_amb_data {
	struct device *hwmon_dev;

	unsigned long amb_base;
	unsigned long amb_len;
	u16 amb_present[MAX_MEM_CHANNELS];
	void __iomem *amb_mmio;
	struct i5k_device_attribute *attrs;
	unsigned int num_attrs;
};

static ssize_t name_show(struct device *dev, struct device_attribute *devattr,
			 char *buf)
{
	return sprintf(buf, "%s\n", DRVNAME);
}


static DEVICE_ATTR_RO(name);

static struct platform_device *amb_pdev;

static u8 amb_read_byte(struct i5k_amb_data *data, unsigned long offset)
{
	return ioread8(data->amb_mmio + offset);
}

static void amb_write_byte(struct i5k_amb_data *data, unsigned long offset,
			   u8 val)
{
	iowrite8(val, data->amb_mmio + offset);
}

static ssize_t show_amb_alarm(struct device *dev,
			     struct device_attribute *devattr,
			     char *buf)
{
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	struct i5k_amb_data *data = dev_get_drvdata(dev);

	if (!(amb_read_byte(data, amb_reg_temp_status(attr->index)) & 0x20) &&
	     (amb_read_byte(data, amb_reg_temp_status(attr->index)) & 0x8))
		return sprintf(buf, "1\n");
	else
		return sprintf(buf, "0\n");
}

static ssize_t store_amb_min(struct device *dev,
			     struct device_attribute *devattr,
			     const char *buf,
			     size_t count)
{
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	struct i5k_amb_data *data = dev_get_drvdata(dev);
	unsigned long temp;
	int ret = kstrtoul(buf, 10, &temp);
	if (ret < 0)
		return ret;

	temp = temp / 500;
	if (temp > 255)
		temp = 255;

	amb_write_byte(data, amb_reg_temp_min(attr->index), temp);
	return count;
}

static ssize_t store_amb_mid(struct device *dev,
			     struct device_attribute *devattr,
			     const char *buf,
			     size_t count)
{
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	struct i5k_amb_data *data = dev_get_drvdata(dev);
	unsigned long temp;
	int ret = kstrtoul(buf, 10, &temp);
	if (ret < 0)
		return ret;

	temp = temp / 500;
	if (temp > 255)
		temp = 255;

	amb_write_byte(data, amb_reg_temp_mid(attr->index), temp);
	return count;
}

static ssize_t store_amb_max(struct device *dev,
			     struct device_attribute *devattr,
			     const char *buf,
			     size_t count)
{
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	struct i5k_amb_data *data = dev_get_drvdata(dev);
	unsigned long temp;
	int ret = kstrtoul(buf, 10, &temp);
	if (ret < 0)
		return ret;

	temp = temp / 500;
	if (temp > 255)
		temp = 255;

	amb_write_byte(data, amb_reg_temp_max(attr->index), temp);
	return count;
}

static ssize_t show_amb_min(struct device *dev,
			     struct device_attribute *devattr,
			     char *buf)
{
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	struct i5k_amb_data *data = dev_get_drvdata(dev);
	return sprintf(buf, "%d\n",
		500 * amb_read_byte(data, amb_reg_temp_min(attr->index)));
}

static ssize_t show_amb_mid(struct device *dev,
			     struct device_attribute *devattr,
			     char *buf)
{
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	struct i5k_amb_data *data = dev_get_drvdata(dev);
	return sprintf(buf, "%d\n",
		500 * amb_read_byte(data, amb_reg_temp_mid(attr->index)));
}

static ssize_t show_amb_max(struct device *dev,
			     struct device_attribute *devattr,
			     char *buf)
{
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	struct i5k_amb_data *data = dev_get_drvdata(dev);
	return sprintf(buf, "%d\n",
		500 * amb_read_byte(data, amb_reg_temp_max(attr->index)));
}

static ssize_t show_amb_temp(struct device *dev,
			     struct device_attribute *devattr,
			     char *buf)
{
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	struct i5k_amb_data *data = dev_get_drvdata(dev);
	return sprintf(buf, "%d\n",
		500 * amb_read_byte(data, amb_reg_temp(attr->index)));
}

static ssize_t show_label(struct device *dev,
			  struct device_attribute *devattr,
			  char *buf)
{
	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);

	return sprintf(buf, "Ch. %d DIMM %d\n", attr->index >> CHANNEL_SHIFT,
		       attr->index & DIMM_MASK);
}

static int i5k_amb_hwmon_init(struct platform_device *pdev)
{
	int i, j, k, d = 0;
	u16 c;
	int res = 0;
	int num_ambs = 0;
	struct i5k_amb_data *data = platform_get_drvdata(pdev);

	/* Count the number of AMBs found */
	/* ignore the high-order bit, see "Ugly hack" comment above */
	for (i = 0; i < MAX_MEM_CHANNELS; i++)
		num_ambs += hweight16(data->amb_present[i] & 0x7fff);

	/* Set up sysfs stuff */
	data->attrs = kzalloc(array3_size(num_ambs, KNOBS_PER_AMB,
					  sizeof(*data->attrs)),
			      GFP_KERNEL);
	if (!data->attrs)
		return -ENOMEM;
	data->num_attrs = 0;

	for (i = 0; i < MAX_MEM_CHANNELS; i++) {
		c = data->amb_present[i];
		for (j = 0; j < REAL_MAX_AMBS_PER_CHANNEL; j++, c >>= 1) {
			struct i5k_device_attribute *iattr;

			k = amb_num_from_reg(i, j);
			if (!(c & 0x1))
				continue;
			d++;

			/* sysfs label */
			iattr = data->attrs + data->num_attrs;
			snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
				 "temp%d_label", d);
			iattr->s_attr.dev_attr.attr.name = iattr->name;
			iattr->s_attr.dev_attr.attr.mode = 0444;
			iattr->s_attr.dev_attr.show = show_label;
			iattr->s_attr.index = k;
			sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
			res = device_create_file(&pdev->dev,
						 &iattr->s_attr.dev_attr);
			if (res)
				goto exit_remove;
			data->num_attrs++;

			/* Temperature sysfs knob */
			iattr = data->attrs + data->num_attrs;
			snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
				 "temp%d_input", d);
			iattr->s_attr.dev_attr.attr.name = iattr->name;
			iattr->s_attr.dev_attr.attr.mode = 0444;
			iattr->s_attr.dev_attr.show = show_amb_temp;
			iattr->s_attr.index = k;
			sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
			res = device_create_file(&pdev->dev,
						 &iattr->s_attr.dev_attr);
			if (res)
				goto exit_remove;
			data->num_attrs++;

			/* Temperature min sysfs knob */
			iattr = data->attrs + data->num_attrs;
			snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
				 "temp%d_min", d);
			iattr->s_attr.dev_attr.attr.name = iattr->name;
			iattr->s_attr.dev_attr.attr.mode = 0644;
			iattr->s_attr.dev_attr.show = show_amb_min;
			iattr->s_attr.dev_attr.store = store_amb_min;
			iattr->s_attr.index = k;
			sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
			res = device_create_file(&pdev->dev,
						 &iattr->s_attr.dev_attr);
			if (res)
				goto exit_remove;
			data->num_attrs++;

			/* Temperature mid sysfs knob */
			iattr = data->attrs + data->num_attrs;
			snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
				 "temp%d_mid", d);
			iattr->s_attr.dev_attr.attr.name = iattr->name;
			iattr->s_attr.dev_attr.attr.mode = 0644;
			iattr->s_attr.dev_attr.show = show_amb_mid;
			iattr->s_attr.dev_attr.store = store_amb_mid;
			iattr->s_attr.index = k;
			sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
			res = device_create_file(&pdev->dev,
						 &iattr->s_attr.dev_attr);
			if (res)
				goto exit_remove;
			data->num_attrs++;

			/* Temperature max sysfs knob */
			iattr = data->attrs + data->num_attrs;
			snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
				 "temp%d_max", d);
			iattr->s_attr.dev_attr.attr.name = iattr->name;
			iattr->s_attr.dev_attr.attr.mode = 0644;
			iattr->s_attr.dev_attr.show = show_amb_max;
			iattr->s_attr.dev_attr.store = store_amb_max;
			iattr->s_attr.index = k;
			sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
			res = device_create_file(&pdev->dev,
						 &iattr->s_attr.dev_attr);
			if (res)
				goto exit_remove;
			data->num_attrs++;

			/* Temperature alarm sysfs knob */
			iattr = data->attrs + data->num_attrs;
			snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
				 "temp%d_alarm", d);
			iattr->s_attr.dev_attr.attr.name = iattr->name;
			iattr->s_attr.dev_attr.attr.mode = 0444;
			iattr->s_attr.dev_attr.show = show_amb_alarm;
			iattr->s_attr.index = k;
			sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
			res = device_create_file(&pdev->dev,
						 &iattr->s_attr.dev_attr);
			if (res)
				goto exit_remove;
			data->num_attrs++;
		}
	}

	res = device_create_file(&pdev->dev, &dev_attr_name);
	if (res)
		goto exit_remove;

	data->hwmon_dev = hwmon_device_register(&pdev->dev);
	if (IS_ERR(data->hwmon_dev)) {
		res = PTR_ERR(data->hwmon_dev);
		goto exit_remove;
	}

	return res;

exit_remove:
	device_remove_file(&pdev->dev, &dev_attr_name);
	for (i = 0; i < data->num_attrs; i++)
		device_remove_file(&pdev->dev, &data->attrs[i].s_attr.dev_attr);
	kfree(data->attrs);

	return res;
}

static int i5k_amb_add(void)
{
	int res;

	/* only ever going to be one of these */
	amb_pdev = platform_device_alloc(DRVNAME, 0);
	if (!amb_pdev)
		return -ENOMEM;

	res = platform_device_add(amb_pdev);
	if (res)
		goto err;
	return 0;

err:
	platform_device_put(amb_pdev);
	return res;
}

static int i5k_find_amb_registers(struct i5k_amb_data *data,
					    unsigned long devid)
{
	struct pci_dev *pcidev;
	u32 val32;
	int res = -ENODEV;

	/* Find AMB register memory space */
	pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
				devid,
				NULL);
	if (!pcidev)
		return -ENODEV;

	pci_read_config_dword(pcidev, I5K_REG_AMB_BASE_ADDR, &val32);
	if (val32 == (u32)~0)
		goto out;
	data->amb_base = val32;

	pci_read_config_dword(pcidev, I5K_REG_AMB_LEN_ADDR, &val32);
	if (val32 == (u32)~0)
		goto out;
	data->amb_len = val32;

	/* Is it big enough? */
	if (data->amb_len < AMB_CONFIG_SIZE * MAX_AMBS) {
		dev_err(&pcidev->dev, "AMB region too small!\n");
		goto out;
	}

	res = 0;
out:
	pci_dev_put(pcidev);
	return res;
}

static int i5k_channel_probe(u16 *amb_present, unsigned long dev_id)
{
	struct pci_dev *pcidev;
	u16 val16;
	int res = -ENODEV;

	/* Copy the DIMM presence map for these two channels */
	pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, dev_id, NULL);
	if (!pcidev)
		return -ENODEV;

	pci_read_config_word(pcidev, I5K_REG_CHAN0_PRESENCE_ADDR, &val16);
	if (val16 == (u16)~0)
		goto out;
	amb_present[0] = val16;

	pci_read_config_word(pcidev, I5K_REG_CHAN1_PRESENCE_ADDR, &val16);
	if (val16 == (u16)~0)
		goto out;
	amb_present[1] = val16;

	res = 0;

out:
	pci_dev_put(pcidev);
	return res;
}

static struct {
	unsigned long err;
	unsigned long fbd0;
} chipset_ids[]  = {
	{ PCI_DEVICE_ID_INTEL_5000_ERR, PCI_DEVICE_ID_INTEL_5000_FBD0 },
	{ PCI_DEVICE_ID_INTEL_5400_ERR, PCI_DEVICE_ID_INTEL_5400_FBD0 },
	{ 0, 0 }
};

#ifdef MODULE
static const struct pci_device_id i5k_amb_ids[] = {
	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_5000_ERR) },
	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_5400_ERR) },
	{ 0, }
};
MODULE_DEVICE_TABLE(pci, i5k_amb_ids);
#endif

static int i5k_amb_probe(struct platform_device *pdev)
{
	struct i5k_amb_data *data;
	struct resource *reso;
	int i, res;

	data = kzalloc(sizeof(*data), GFP_KERNEL);
	if (!data)
		return -ENOMEM;

	/* Figure out where the AMB registers live */
	i = 0;
	do {
		res = i5k_find_amb_registers(data, chipset_ids[i].err);
		if (res == 0)
			break;
		i++;
	} while (chipset_ids[i].err);

	if (res)
		goto err;

	/* Copy the DIMM presence map for the first two channels */
	res = i5k_channel_probe(&data->amb_present[0], chipset_ids[i].fbd0);
	if (res)
		goto err;

	/* Copy the DIMM presence map for the optional second two channels */
	i5k_channel_probe(&data->amb_present[2], chipset_ids[i].fbd0 + 1);

	/* Set up resource regions */
	reso = request_mem_region(data->amb_base, data->amb_len, DRVNAME);
	if (!reso) {
		res = -EBUSY;
		goto err;
	}

	data->amb_mmio = ioremap(data->amb_base, data->amb_len);
	if (!data->amb_mmio) {
		res = -EBUSY;
		goto err_map_failed;
	}

	platform_set_drvdata(pdev, data);

	res = i5k_amb_hwmon_init(pdev);
	if (res)
		goto err_init_failed;

	return res;

err_init_failed:
	iounmap(data->amb_mmio);
err_map_failed:
	release_mem_region(data->amb_base, data->amb_len);
err:
	kfree(data);
	return res;
}

static int i5k_amb_remove(struct platform_device *pdev)
{
	int i;
	struct i5k_amb_data *data = platform_get_drvdata(pdev);

	hwmon_device_unregister(data->hwmon_dev);
	device_remove_file(&pdev->dev, &dev_attr_name);
	for (i = 0; i < data->num_attrs; i++)
		device_remove_file(&pdev->dev, &data->attrs[i].s_attr.dev_attr);
	kfree(data->attrs);
	iounmap(data->amb_mmio);
	release_mem_region(data->amb_base, data->amb_len);
	kfree(data);
	return 0;
}

static struct platform_driver i5k_amb_driver = {
	.driver = {
		.name = DRVNAME,
	},
	.probe = i5k_amb_probe,
	.remove = i5k_amb_remove,
};

static int __init i5k_amb_init(void)
{
	int res;

	res = platform_driver_register(&i5k_amb_driver);
	if (res)
		return res;

	res = i5k_amb_add();
	if (res)
		platform_driver_unregister(&i5k_amb_driver);

	return res;
}

static void __exit i5k_amb_exit(void)
{
	platform_device_unregister(amb_pdev);
	platform_driver_unregister(&i5k_amb_driver);
}

MODULE_AUTHOR("Darrick J. Wong <darrick.wong@oracle.com>");
MODULE_DESCRIPTION("Intel 5000 chipset FB-DIMM AMB temperature sensor");
MODULE_LICENSE("GPL");

module_init(i5k_amb_init);
module_exit(i5k_amb_exit);
Commit	Line	Data
1a59d1b8	1	// SPDX-License-Identifier: GPL-2.0-or-later
298c7524 DW	2	/*
	3	* A hwmon driver for the Intel 5000 series chipset FB-DIMM AMB
	4	* temperature sensors
	5	* Copyright (C) 2007 IBM
	6	*
5407e051	7	* Author: Darrick J. Wong <darrick.wong@oracle.com>
298c7524 DW	8	*/
	9
	10	#include <linux/module.h>
298c7524 DW	11	#include <linux/hwmon.h>
	12	#include <linux/hwmon-sysfs.h>
	13	#include <linux/err.h>
	14	#include <linux/mutex.h>
298c7524 DW	15	#include <linux/log2.h>
	16	#include <linux/pci.h>
	17	#include <linux/platform_device.h>
5a0e3ad6	18	#include <linux/slab.h>
298c7524 DW	19
	20	#define DRVNAME "i5k_amb"
	21
	22	#define I5K_REG_AMB_BASE_ADDR 0x48
	23	#define I5K_REG_AMB_LEN_ADDR 0x50
	24	#define I5K_REG_CHAN0_PRESENCE_ADDR 0x64
	25	#define I5K_REG_CHAN1_PRESENCE_ADDR 0x66
	26
	27	#define AMB_REG_TEMP_MIN_ADDR 0x80
	28	#define AMB_REG_TEMP_MID_ADDR 0x81
	29	#define AMB_REG_TEMP_MAX_ADDR 0x82
	30	#define AMB_REG_TEMP_STATUS_ADDR 0x84
	31	#define AMB_REG_TEMP_ADDR 0x85
	32
	33	#define AMB_CONFIG_SIZE 2048
	34	#define AMB_FUNC_3_OFFSET 768
	35
59a030a9 DW	36	static unsigned long amb_reg_temp_status(unsigned int amb)
	37	{
	38	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_STATUS_ADDR +
	39	AMB_CONFIG_SIZE * amb;
	40	}
	41
	42	static unsigned long amb_reg_temp_min(unsigned int amb)
	43	{
	44	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_MIN_ADDR +
	45	AMB_CONFIG_SIZE * amb;
	46	}
	47
	48	static unsigned long amb_reg_temp_mid(unsigned int amb)
	49	{
	50	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_MID_ADDR +
	51	AMB_CONFIG_SIZE * amb;
	52	}
	53
	54	static unsigned long amb_reg_temp_max(unsigned int amb)
	55	{
	56	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_MAX_ADDR +
	57	AMB_CONFIG_SIZE * amb;
	58	}
	59
	60	static unsigned long amb_reg_temp(unsigned int amb)
	61	{
	62	return AMB_FUNC_3_OFFSET + AMB_REG_TEMP_ADDR +
	63	AMB_CONFIG_SIZE * amb;
	64	}
298c7524 DW	65
	66	#define MAX_MEM_CHANNELS 4
	67	#define MAX_AMBS_PER_CHANNEL 16
	68	#define MAX_AMBS (MAX_MEM_CHANNELS * \
	69	MAX_AMBS_PER_CHANNEL)
963d96b5 DW	70	#define CHANNEL_SHIFT 4
963d96b5 DW	71	#define DIMM_MASK 0xF
298c7524 DW	72	/*
	73	* Ugly hack: For some reason the highest bit is set if there
	74	* are _any_ DIMMs in the channel. Attempting to read from
	75	* this "high-order" AMB results in a memory bus error, so
	76	* for now we'll just ignore that top bit, even though that
	77	* might prevent us from seeing the 16th DIMM in the channel.
	78	*/
	79	#define REAL_MAX_AMBS_PER_CHANNEL 15
963d96b5	80	#define KNOBS_PER_AMB 6
298c7524	81
59a030a9 DW	82	static unsigned long amb_num_from_reg(unsigned int byte_num, unsigned int bit)
	83	{
	84	return byte_num * MAX_AMBS_PER_CHANNEL + bit;
	85	}
298c7524 DW	86
	87	#define AMB_SYSFS_NAME_LEN 16
	88	struct i5k_device_attribute {
	89	struct sensor_device_attribute s_attr;
	90	char name[AMB_SYSFS_NAME_LEN];
	91	};
	92
	93	struct i5k_amb_data {
	94	struct device *hwmon_dev;
	95
	96	unsigned long amb_base;
	97	unsigned long amb_len;
	98	u16 amb_present[MAX_MEM_CHANNELS];
	99	void __iomem *amb_mmio;
	100	struct i5k_device_attribute *attrs;
	101	unsigned int num_attrs;
	102	};
	103
3edf03b3	104	static ssize_t name_show(struct device dev, struct device_attribute devattr,
298c7524 DW	105	char *buf)
	106	{
	107	return sprintf(buf, "%s\n", DRVNAME);
	108	}
	109
	110
3edf03b3	111	static DEVICE_ATTR_RO(name);
298c7524 DW	112
	113	static struct platform_device *amb_pdev;
	114
	115	static u8 amb_read_byte(struct i5k_amb_data *data, unsigned long offset)
	116	{
	117	return ioread8(data->amb_mmio + offset);
	118	}
	119
	120	static void amb_write_byte(struct i5k_amb_data *data, unsigned long offset,
	121	u8 val)
	122	{
	123	iowrite8(val, data->amb_mmio + offset);
	124	}
	125
	126	static ssize_t show_amb_alarm(struct device *dev,
	127	struct device_attribute *devattr,
	128	char *buf)
	129	{
	130	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	131	struct i5k_amb_data *data = dev_get_drvdata(dev);
	132
59a030a9 DW	133	if (!(amb_read_byte(data, amb_reg_temp_status(attr->index)) & 0x20) &&
59a030a9 DW	134	(amb_read_byte(data, amb_reg_temp_status(attr->index)) & 0x8))
298c7524 DW	135	return sprintf(buf, "1\n");
	136	else
	137	return sprintf(buf, "0\n");
	138	}
	139
	140	static ssize_t store_amb_min(struct device *dev,
	141	struct device_attribute *devattr,
	142	const char *buf,
	143	size_t count)
	144	{
	145	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	146	struct i5k_amb_data *data = dev_get_drvdata(dev);
7b102ed6 FM	147	unsigned long temp;
	148	int ret = kstrtoul(buf, 10, &temp);
	149	if (ret < 0)
	150	return ret;
298c7524	151
7b102ed6	152	temp = temp / 500;
298c7524 DW	153	if (temp > 255)
	154	temp = 255;
	155
59a030a9	156	amb_write_byte(data, amb_reg_temp_min(attr->index), temp);
298c7524 DW	157	return count;
	158	}
	159
	160	static ssize_t store_amb_mid(struct device *dev,
	161	struct device_attribute *devattr,
	162	const char *buf,
	163	size_t count)
	164	{
	165	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	166	struct i5k_amb_data *data = dev_get_drvdata(dev);
7b102ed6 FM	167	unsigned long temp;
	168	int ret = kstrtoul(buf, 10, &temp);
	169	if (ret < 0)
	170	return ret;
298c7524	171
7b102ed6	172	temp = temp / 500;
298c7524 DW	173	if (temp > 255)
	174	temp = 255;
	175
59a030a9	176	amb_write_byte(data, amb_reg_temp_mid(attr->index), temp);
298c7524 DW	177	return count;
	178	}
	179
	180	static ssize_t store_amb_max(struct device *dev,
	181	struct device_attribute *devattr,
	182	const char *buf,
	183	size_t count)
	184	{
	185	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	186	struct i5k_amb_data *data = dev_get_drvdata(dev);
7b102ed6 FM	187	unsigned long temp;
	188	int ret = kstrtoul(buf, 10, &temp);
	189	if (ret < 0)
	190	return ret;
298c7524	191
7b102ed6	192	temp = temp / 500;
298c7524 DW	193	if (temp > 255)
	194	temp = 255;
	195
59a030a9	196	amb_write_byte(data, amb_reg_temp_max(attr->index), temp);
298c7524 DW	197	return count;
	198	}
	199
	200	static ssize_t show_amb_min(struct device *dev,
	201	struct device_attribute *devattr,
	202	char *buf)
	203	{
	204	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	205	struct i5k_amb_data *data = dev_get_drvdata(dev);
	206	return sprintf(buf, "%d\n",
59a030a9	207	500 * amb_read_byte(data, amb_reg_temp_min(attr->index)));
298c7524 DW	208	}
	209
	210	static ssize_t show_amb_mid(struct device *dev,
	211	struct device_attribute *devattr,
	212	char *buf)
	213	{
	214	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	215	struct i5k_amb_data *data = dev_get_drvdata(dev);
	216	return sprintf(buf, "%d\n",
59a030a9	217	500 * amb_read_byte(data, amb_reg_temp_mid(attr->index)));
298c7524 DW	218	}
	219
	220	static ssize_t show_amb_max(struct device *dev,
	221	struct device_attribute *devattr,
	222	char *buf)
	223	{
	224	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	225	struct i5k_amb_data *data = dev_get_drvdata(dev);
	226	return sprintf(buf, "%d\n",
59a030a9	227	500 * amb_read_byte(data, amb_reg_temp_max(attr->index)));
298c7524 DW	228	}
	229
	230	static ssize_t show_amb_temp(struct device *dev,
	231	struct device_attribute *devattr,
	232	char *buf)
	233	{
	234	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	235	struct i5k_amb_data *data = dev_get_drvdata(dev);
	236	return sprintf(buf, "%d\n",
59a030a9	237	500 * amb_read_byte(data, amb_reg_temp(attr->index)));
298c7524 DW	238	}
298c7524 DW	239
963d96b5 DW	240	static ssize_t show_label(struct device *dev,
	241	struct device_attribute *devattr,
	242	char *buf)
	243	{
	244	struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
	245
	246	return sprintf(buf, "Ch. %d DIMM %d\n", attr->index >> CHANNEL_SHIFT,
	247	attr->index & DIMM_MASK);
	248	}
	249
6c931ae1	250	static int i5k_amb_hwmon_init(struct platform_device *pdev)
298c7524 DW	251	{
	252	int i, j, k, d = 0;
	253	u16 c;
	254	int res = 0;
	255	int num_ambs = 0;
	256	struct i5k_amb_data *data = platform_get_drvdata(pdev);
	257
	258	/* Count the number of AMBs found */
	259	/* ignore the high-order bit, see "Ugly hack" comment above */
	260	for (i = 0; i < MAX_MEM_CHANNELS; i++)
	261	num_ambs += hweight16(data->amb_present[i] & 0x7fff);
	262
	263	/* Set up sysfs stuff */
6396bb22 KC	264	data->attrs = kzalloc(array3_size(num_ambs, KNOBS_PER_AMB,
	265	sizeof(*data->attrs)),
	266	GFP_KERNEL);
298c7524 DW	267	if (!data->attrs)
	268	return -ENOMEM;
	269	data->num_attrs = 0;
	270
	271	for (i = 0; i < MAX_MEM_CHANNELS; i++) {
	272	c = data->amb_present[i];
	273	for (j = 0; j < REAL_MAX_AMBS_PER_CHANNEL; j++, c >>= 1) {
	274	struct i5k_device_attribute *iattr;
	275
59a030a9	276	k = amb_num_from_reg(i, j);
298c7524 DW	277	if (!(c & 0x1))
	278	continue;
	279	d++;
	280
963d96b5 DW	281	/* sysfs label */
	282	iattr = data->attrs + data->num_attrs;
	283	snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
	284	"temp%d_label", d);
	285	iattr->s_attr.dev_attr.attr.name = iattr->name;
2f8f7102	286	iattr->s_attr.dev_attr.attr.mode = 0444;
963d96b5 DW	287	iattr->s_attr.dev_attr.show = show_label;
963d96b5 DW	288	iattr->s_attr.index = k;
0e6c7870	289	sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
963d96b5 DW	290	res = device_create_file(&pdev->dev,
	291	&iattr->s_attr.dev_attr);
	292	if (res)
	293	goto exit_remove;
	294	data->num_attrs++;
	295
298c7524 DW	296	/* Temperature sysfs knob */
	297	iattr = data->attrs + data->num_attrs;
	298	snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
	299	"temp%d_input", d);
	300	iattr->s_attr.dev_attr.attr.name = iattr->name;
2f8f7102	301	iattr->s_attr.dev_attr.attr.mode = 0444;
298c7524 DW	302	iattr->s_attr.dev_attr.show = show_amb_temp;
298c7524 DW	303	iattr->s_attr.index = k;
0e6c7870	304	sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
298c7524 DW	305	res = device_create_file(&pdev->dev,
	306	&iattr->s_attr.dev_attr);
	307	if (res)
	308	goto exit_remove;
	309	data->num_attrs++;
	310
	311	/* Temperature min sysfs knob */
	312	iattr = data->attrs + data->num_attrs;
	313	snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
	314	"temp%d_min", d);
	315	iattr->s_attr.dev_attr.attr.name = iattr->name;
2f8f7102	316	iattr->s_attr.dev_attr.attr.mode = 0644;
298c7524 DW	317	iattr->s_attr.dev_attr.show = show_amb_min;
	318	iattr->s_attr.dev_attr.store = store_amb_min;
	319	iattr->s_attr.index = k;
0e6c7870	320	sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
298c7524 DW	321	res = device_create_file(&pdev->dev,
	322	&iattr->s_attr.dev_attr);
	323	if (res)
	324	goto exit_remove;
	325	data->num_attrs++;
	326
	327	/* Temperature mid sysfs knob */
	328	iattr = data->attrs + data->num_attrs;
	329	snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
	330	"temp%d_mid", d);
	331	iattr->s_attr.dev_attr.attr.name = iattr->name;
2f8f7102	332	iattr->s_attr.dev_attr.attr.mode = 0644;
298c7524 DW	333	iattr->s_attr.dev_attr.show = show_amb_mid;
	334	iattr->s_attr.dev_attr.store = store_amb_mid;
	335	iattr->s_attr.index = k;
0e6c7870	336	sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
298c7524 DW	337	res = device_create_file(&pdev->dev,
	338	&iattr->s_attr.dev_attr);
	339	if (res)
	340	goto exit_remove;
	341	data->num_attrs++;
	342
	343	/* Temperature max sysfs knob */
	344	iattr = data->attrs + data->num_attrs;
	345	snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
	346	"temp%d_max", d);
	347	iattr->s_attr.dev_attr.attr.name = iattr->name;
2f8f7102	348	iattr->s_attr.dev_attr.attr.mode = 0644;
298c7524 DW	349	iattr->s_attr.dev_attr.show = show_amb_max;
	350	iattr->s_attr.dev_attr.store = store_amb_max;
	351	iattr->s_attr.index = k;
0e6c7870	352	sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
298c7524 DW	353	res = device_create_file(&pdev->dev,
	354	&iattr->s_attr.dev_attr);
	355	if (res)
	356	goto exit_remove;
	357	data->num_attrs++;
	358
	359	/* Temperature alarm sysfs knob */
	360	iattr = data->attrs + data->num_attrs;
	361	snprintf(iattr->name, AMB_SYSFS_NAME_LEN,
	362	"temp%d_alarm", d);
	363	iattr->s_attr.dev_attr.attr.name = iattr->name;
2f8f7102	364	iattr->s_attr.dev_attr.attr.mode = 0444;
298c7524 DW	365	iattr->s_attr.dev_attr.show = show_amb_alarm;
298c7524 DW	366	iattr->s_attr.index = k;
0e6c7870	367	sysfs_attr_init(&iattr->s_attr.dev_attr.attr);
298c7524 DW	368	res = device_create_file(&pdev->dev,
	369	&iattr->s_attr.dev_attr);
	370	if (res)
	371	goto exit_remove;
	372	data->num_attrs++;
	373	}
	374	}
	375
	376	res = device_create_file(&pdev->dev, &dev_attr_name);
	377	if (res)
	378	goto exit_remove;
	379
	380	data->hwmon_dev = hwmon_device_register(&pdev->dev);
	381	if (IS_ERR(data->hwmon_dev)) {
	382	res = PTR_ERR(data->hwmon_dev);
	383	goto exit_remove;
	384	}
	385
	386	return res;
	387
	388	exit_remove:
	389	device_remove_file(&pdev->dev, &dev_attr_name);
	390	for (i = 0; i < data->num_attrs; i++)
	391	device_remove_file(&pdev->dev, &data->attrs[i].s_attr.dev_attr);
	392	kfree(data->attrs);
	393
	394	return res;
	395	}
	396
6c931ae1	397	static int i5k_amb_add(void)
298c7524	398	{
9e444234	399	int res;
298c7524 DW	400
	401	/* only ever going to be one of these */
	402	amb_pdev = platform_device_alloc(DRVNAME, 0);
	403	if (!amb_pdev)
	404	return -ENOMEM;
	405
	406	res = platform_device_add(amb_pdev);
	407	if (res)
	408	goto err;
	409	return 0;
	410
	411	err:
	412	platform_device_put(amb_pdev);
	413	return res;
	414	}
	415
6c931ae1	416	static int i5k_find_amb_registers(struct i5k_amb_data *data,
b8fdaf5a	417	unsigned long devid)
298c7524 DW	418	{
	419	struct pci_dev *pcidev;
	420	u32 val32;
	421	int res = -ENODEV;
	422
	423	/* Find AMB register memory space */
	424	pcidev = pci_get_device(PCI_VENDOR_ID_INTEL,
b8fdaf5a	425	devid,
298c7524 DW	426	NULL);
	427	if (!pcidev)
	428	return -ENODEV;
	429
2207515d SB	430	pci_read_config_dword(pcidev, I5K_REG_AMB_BASE_ADDR, &val32);
2207515d SB	431	if (val32 == (u32)~0)
298c7524 DW	432	goto out;
	433	data->amb_base = val32;
	434
2207515d SB	435	pci_read_config_dword(pcidev, I5K_REG_AMB_LEN_ADDR, &val32);
2207515d SB	436	if (val32 == (u32)~0)
298c7524 DW	437	goto out;
	438	data->amb_len = val32;
	439
	440	/* Is it big enough? */
	441	if (data->amb_len < AMB_CONFIG_SIZE * MAX_AMBS) {
	442	dev_err(&pcidev->dev, "AMB region too small!\n");
	443	goto out;
	444	}
	445
	446	res = 0;
	447	out:
	448	pci_dev_put(pcidev);
	449	return res;
	450	}
	451
6c931ae1	452	static int i5k_channel_probe(u16 *amb_present, unsigned long dev_id)
298c7524 DW	453	{
	454	struct pci_dev *pcidev;
	455	u16 val16;
	456	int res = -ENODEV;
	457
	458	/* Copy the DIMM presence map for these two channels */
	459	pcidev = pci_get_device(PCI_VENDOR_ID_INTEL, dev_id, NULL);
	460	if (!pcidev)
	461	return -ENODEV;
	462
2207515d SB	463	pci_read_config_word(pcidev, I5K_REG_CHAN0_PRESENCE_ADDR, &val16);
2207515d SB	464	if (val16 == (u16)~0)
298c7524 DW	465	goto out;
	466	amb_present[0] = val16;
	467
2207515d SB	468	pci_read_config_word(pcidev, I5K_REG_CHAN1_PRESENCE_ADDR, &val16);
2207515d SB	469	if (val16 == (u16)~0)
298c7524 DW	470	goto out;
	471	amb_present[1] = val16;
	472
	473	res = 0;
	474
	475	out:
	476	pci_dev_put(pcidev);
	477	return res;
	478	}
	479
b4cb0d4d JD	480	static struct {
	481	unsigned long err;
	482	unsigned long fbd0;
a5977246	483	} chipset_ids[] = {
b4cb0d4d JD	484	{ PCI_DEVICE_ID_INTEL_5000_ERR, PCI_DEVICE_ID_INTEL_5000_FBD0 },
	485	{ PCI_DEVICE_ID_INTEL_5400_ERR, PCI_DEVICE_ID_INTEL_5400_FBD0 },
	486	{ 0, 0 }
b8fdaf5a DW	487	};
b8fdaf5a DW	488
c48a2916	489	#ifdef MODULE
4d3f2414	490	static const struct pci_device_id i5k_amb_ids[] = {
6e31eb2b DW	491	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_5000_ERR) },
	492	{ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_5400_ERR) },
	493	{ 0, }
	494	};
	495	MODULE_DEVICE_TABLE(pci, i5k_amb_ids);
c48a2916	496	#endif
6e31eb2b	497
6c931ae1	498	static int i5k_amb_probe(struct platform_device *pdev)
298c7524 DW	499	{
	500	struct i5k_amb_data *data;
	501	struct resource *reso;
b4cb0d4d	502	int i, res;
298c7524 DW	503
	504	data = kzalloc(sizeof(*data), GFP_KERNEL);
	505	if (!data)
	506	return -ENOMEM;
	507
	508	/* Figure out where the AMB registers live */
b8fdaf5a DW	509	i = 0;
b8fdaf5a DW	510	do {
b4cb0d4d JD	511	res = i5k_find_amb_registers(data, chipset_ids[i].err);
	512	if (res == 0)
	513	break;
b8fdaf5a	514	i++;
b4cb0d4d	515	} while (chipset_ids[i].err);
b8fdaf5a	516
298c7524 DW	517	if (res)
	518	goto err;
	519
	520	/* Copy the DIMM presence map for the first two channels */
b4cb0d4d	521	res = i5k_channel_probe(&data->amb_present[0], chipset_ids[i].fbd0);
298c7524 DW	522	if (res)
	523	goto err;
	524
	525	/* Copy the DIMM presence map for the optional second two channels */
b4cb0d4d	526	i5k_channel_probe(&data->amb_present[2], chipset_ids[i].fbd0 + 1);
298c7524 DW	527
	528	/* Set up resource regions */
	529	reso = request_mem_region(data->amb_base, data->amb_len, DRVNAME);
	530	if (!reso) {
	531	res = -EBUSY;
	532	goto err;
	533	}
	534
4bdc0d67	535	data->amb_mmio = ioremap(data->amb_base, data->amb_len);
298c7524 DW	536	if (!data->amb_mmio) {
	537	res = -EBUSY;
	538	goto err_map_failed;
	539	}
	540
	541	platform_set_drvdata(pdev, data);
	542
	543	res = i5k_amb_hwmon_init(pdev);
	544	if (res)
	545	goto err_init_failed;
	546
	547	return res;
	548
	549	err_init_failed:
	550	iounmap(data->amb_mmio);
298c7524 DW	551	err_map_failed:
	552	release_mem_region(data->amb_base, data->amb_len);
	553	err:
	554	kfree(data);
	555	return res;
	556	}
	557
281dfd0b	558	static int i5k_amb_remove(struct platform_device *pdev)
298c7524 DW	559	{
	560	int i;
	561	struct i5k_amb_data *data = platform_get_drvdata(pdev);
	562
	563	hwmon_device_unregister(data->hwmon_dev);
	564	device_remove_file(&pdev->dev, &dev_attr_name);
	565	for (i = 0; i < data->num_attrs; i++)
	566	device_remove_file(&pdev->dev, &data->attrs[i].s_attr.dev_attr);
	567	kfree(data->attrs);
	568	iounmap(data->amb_mmio);
	569	release_mem_region(data->amb_base, data->amb_len);
298c7524 DW	570	kfree(data);
	571	return 0;
	572	}
	573
	574	static struct platform_driver i5k_amb_driver = {
	575	.driver = {
298c7524 DW	576	.name = DRVNAME,
	577	},
	578	.probe = i5k_amb_probe,
9e5e9b7a	579	.remove = i5k_amb_remove,
298c7524 DW	580	};
	581
	582	static int __init i5k_amb_init(void)
	583	{
	584	int res;
	585
	586	res = platform_driver_register(&i5k_amb_driver);
	587	if (res)
	588	return res;
	589
	590	res = i5k_amb_add();
	591	if (res)
	592	platform_driver_unregister(&i5k_amb_driver);
	593
	594	return res;
	595	}
	596
	597	static void __exit i5k_amb_exit(void)
	598	{
	599	platform_device_unregister(amb_pdev);
	600	platform_driver_unregister(&i5k_amb_driver);
	601	}
	602
5407e051	603	MODULE_AUTHOR("Darrick J. Wong <darrick.wong@oracle.com>");
298c7524 DW	604	MODULE_DESCRIPTION("Intel 5000 chipset FB-DIMM AMB temperature sensor");
	605	MODULE_LICENSE("GPL");
	606
	607	module_init(i5k_amb_init);
	608	module_exit(i5k_amb_exit);