[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / macintosh / windfarm_lm75_sensor.c

/*
 * Windfarm PowerMac thermal control. LM75 sensor
 *
 * (c) Copyright 2005 Benjamin Herrenschmidt, IBM Corp.
 *                    <benh@kernel.crashing.org>
 *
 * Released under the term of the GNU GPL v2.
 */

#include <linux/types.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/delay.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/wait.h>
#include <linux/i2c.h>
#include <asm/prom.h>
#include <asm/machdep.h>
#include <asm/io.h>
#include <asm/sections.h>
#include <asm/pmac_low_i2c.h>

#include "windfarm.h"

#define VERSION "1.0"

#undef DEBUG

#ifdef DEBUG
#define DBG(args...)	printk(args)
#else
#define DBG(args...)	do { } while(0)
#endif

struct wf_lm75_sensor {
	int			ds1775 : 1;
	int			inited : 1;
	struct i2c_client	*i2c;
	struct wf_sensor	sens;
};
#define wf_to_lm75(c) container_of(c, struct wf_lm75_sensor, sens)

static int wf_lm75_get(struct wf_sensor *sr, s32 *value)
{
	struct wf_lm75_sensor *lm = wf_to_lm75(sr);
	s32 data;

	if (lm->i2c == NULL)
		return -ENODEV;

	/* Init chip if necessary */
	if (!lm->inited) {
		u8 cfg_new, cfg = (u8)i2c_smbus_read_byte_data(lm->i2c, 1);

		DBG("wf_lm75: Initializing %s, cfg was: %02x\n",
		    sr->name, cfg);

		/* clear shutdown bit, keep other settings as left by
		 * the firmware for now
		 */
		cfg_new = cfg & ~0x01;
		i2c_smbus_write_byte_data(lm->i2c, 1, cfg_new);
		lm->inited = 1;

		/* If we just powered it up, let's wait 200 ms */
		msleep(200);
	}

	/* Read temperature register */
	data = (s32)le16_to_cpu(i2c_smbus_read_word_data(lm->i2c, 0));
	data <<= 8;
	*value = data;

	return 0;
}

static void wf_lm75_release(struct wf_sensor *sr)
{
	struct wf_lm75_sensor *lm = wf_to_lm75(sr);

	kfree(lm);
}

static struct wf_sensor_ops wf_lm75_ops = {
	.get_value	= wf_lm75_get,
	.release	= wf_lm75_release,
	.owner		= THIS_MODULE,
};

static int wf_lm75_probe(struct i2c_client *client,
			 const struct i2c_device_id *id)
{	
	struct wf_lm75_sensor *lm;
	int rc, ds1775 = id->driver_data;
	const char *name, *loc;

	DBG("wf_lm75: creating  %s device at address 0x%02x\n",
	    ds1775 ? "ds1775" : "lm75", client->addr);

	loc = of_get_property(client->dev.of_node, "hwsensor-location", NULL);
	if (!loc) {
		dev_warn(&client->dev, "Missing hwsensor-location property!\n");
		return -ENXIO;
	}

	/* Usual rant about sensor names not beeing very consistent in
	 * the device-tree, oh well ...
	 * Add more entries below as you deal with more setups
	 */
	if (!strcmp(loc, "Hard drive") || !strcmp(loc, "DRIVE BAY"))
		name = "hd-temp";
	else if (!strcmp(loc, "Incoming Air Temp"))
		name = "incoming-air-temp";
	else if (!strcmp(loc, "ODD Temp"))
		name = "optical-drive-temp";
	else if (!strcmp(loc, "HD Temp"))
		name = "hard-drive-temp";
	else if (!strcmp(loc, "PCI SLOTS"))
		name = "slots-temp";
	else if (!strcmp(loc, "CPU A INLET"))
		name = "cpu-inlet-temp-0";
	else if (!strcmp(loc, "CPU B INLET"))
		name = "cpu-inlet-temp-1";
	else
		return -ENXIO;
 	

	lm = kzalloc(sizeof(struct wf_lm75_sensor), GFP_KERNEL);
	if (lm == NULL)
		return -ENODEV;

	lm->inited = 0;
	lm->ds1775 = ds1775;
	lm->i2c = client;
	lm->sens.name = (char *)name; /* XXX fix constness in structure */
	lm->sens.ops = &wf_lm75_ops;
	i2c_set_clientdata(client, lm);

	rc = wf_register_sensor(&lm->sens);
	if (rc)
		kfree(lm);
	return rc;
}

static int wf_lm75_remove(struct i2c_client *client)
{
	struct wf_lm75_sensor *lm = i2c_get_clientdata(client);

	DBG("wf_lm75: i2c detatch called for %s\n", lm->sens.name);

	/* Mark client detached */
	lm->i2c = NULL;

	/* release sensor */
	wf_unregister_sensor(&lm->sens);

	return 0;
}

static const struct i2c_device_id wf_lm75_id[] = {
	{ "MAC,lm75", 0 },
	{ "MAC,ds1775", 1 },
	{ }
};
MODULE_DEVICE_TABLE(i2c, wf_lm75_id);

static struct i2c_driver wf_lm75_driver = {
	.driver = {
		.name	= "wf_lm75",
	},
	.probe		= wf_lm75_probe,
	.remove		= wf_lm75_remove,
	.id_table	= wf_lm75_id,
};

module_i2c_driver(wf_lm75_driver);

MODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>");
MODULE_DESCRIPTION("LM75 sensor objects for PowerMacs thermal control");
MODULE_LICENSE("GPL");
Commit	Line	Data
75722d39 BH	1	/*
	2	* Windfarm PowerMac thermal control. LM75 sensor
	3	*
	4	* (c) Copyright 2005 Benjamin Herrenschmidt, IBM Corp.
	5	* <benh@kernel.crashing.org>
	6	*
	7	* Released under the term of the GNU GPL v2.
	8	*/
	9
	10	#include <linux/types.h>
	11	#include <linux/errno.h>
	12	#include <linux/kernel.h>
	13	#include <linux/delay.h>
	14	#include <linux/slab.h>
	15	#include <linux/init.h>
	16	#include <linux/wait.h>
	17	#include <linux/i2c.h>
75722d39 BH	18	#include <asm/prom.h>
	19	#include <asm/machdep.h>
	20	#include <asm/io.h>
75722d39	21	#include <asm/sections.h>
a28d3af2	22	#include <asm/pmac_low_i2c.h>
75722d39 BH	23
	24	#include "windfarm.h"
	25
5400480f	26	#define VERSION "1.0"
75722d39 BH	27
	28	#undef DEBUG
	29
	30	#ifdef DEBUG
	31	#define DBG(args...) printk(args)
	32	#else
	33	#define DBG(args...) do { } while(0)
	34	#endif
	35
	36	struct wf_lm75_sensor {
	37	int ds1775 : 1;
	38	int inited : 1;
5400480f BH	39	struct i2c_client *i2c;
5400480f BH	40	struct wf_sensor sens;
75722d39 BH	41	};
75722d39 BH	42	#define wf_to_lm75(c) container_of(c, struct wf_lm75_sensor, sens)
75722d39 BH	43
	44	static int wf_lm75_get(struct wf_sensor sr, s32 value)
	45	{
	46	struct wf_lm75_sensor *lm = wf_to_lm75(sr);
	47	s32 data;
	48
351ca3e3	49	if (lm->i2c == NULL)
75722d39 BH	50	return -ENODEV;
	51
	52	/* Init chip if necessary */
	53	if (!lm->inited) {
351ca3e3	54	u8 cfg_new, cfg = (u8)i2c_smbus_read_byte_data(lm->i2c, 1);
75722d39 BH	55
	56	DBG("wf_lm75: Initializing %s, cfg was: %02x\n",
	57	sr->name, cfg);
	58
	59	/* clear shutdown bit, keep other settings as left by
	60	* the firmware for now
	61	*/
	62	cfg_new = cfg & ~0x01;
351ca3e3	63	i2c_smbus_write_byte_data(lm->i2c, 1, cfg_new);
75722d39 BH	64	lm->inited = 1;
	65
	66	/* If we just powered it up, let's wait 200 ms */
	67	msleep(200);
	68	}
	69
	70	/* Read temperature register */
351ca3e3	71	data = (s32)le16_to_cpu(i2c_smbus_read_word_data(lm->i2c, 0));
75722d39 BH	72	data <<= 8;
	73	*value = data;
	74
	75	return 0;
	76	}
	77
	78	static void wf_lm75_release(struct wf_sensor *sr)
	79	{
	80	struct wf_lm75_sensor *lm = wf_to_lm75(sr);
	81
75722d39 BH	82	kfree(lm);
	83	}
	84
	85	static struct wf_sensor_ops wf_lm75_ops = {
	86	.get_value = wf_lm75_get,
	87	.release = wf_lm75_release,
	88	.owner = THIS_MODULE,
	89	};
	90
351ca3e3 JD	91	static int wf_lm75_probe(struct i2c_client *client,
351ca3e3 JD	92	const struct i2c_device_id *id)
5400480f	93	{
75722d39	94	struct wf_lm75_sensor *lm;
5400480f BH	95	int rc, ds1775 = id->driver_data;
5400480f BH	96	const char name, loc;
351ca3e3 JD	97
351ca3e3 JD	98	DBG("wf_lm75: creating %s device at address 0x%02x\n",
5400480f BH	99	ds1775 ? "ds1775" : "lm75", client->addr);
	100
	101	loc = of_get_property(client->dev.of_node, "hwsensor-location", NULL);
	102	if (!loc) {
	103	dev_warn(&client->dev, "Missing hwsensor-location property!\n");
	104	return -ENXIO;
	105	}
75722d39 BH	106
	107	/* Usual rant about sensor names not beeing very consistent in
	108	* the device-tree, oh well ...
	109	* Add more entries below as you deal with more setups
	110	*/
	111	if (!strcmp(loc, "Hard drive") \|\| !strcmp(loc, "DRIVE BAY"))
351ca3e3	112	name = "hd-temp";
80ff974d	113	else if (!strcmp(loc, "Incoming Air Temp"))
351ca3e3	114	name = "incoming-air-temp";
80ff974d	115	else if (!strcmp(loc, "ODD Temp"))
351ca3e3	116	name = "optical-drive-temp";
80ff974d	117	else if (!strcmp(loc, "HD Temp"))
351ca3e3	118	name = "hard-drive-temp";
d839ba2a BH	119	else if (!strcmp(loc, "PCI SLOTS"))
	120	name = "slots-temp";
	121	else if (!strcmp(loc, "CPU A INLET"))
	122	name = "cpu-inlet-temp-0";
	123	else if (!strcmp(loc, "CPU B INLET"))
	124	name = "cpu-inlet-temp-1";
75722d39	125	else
5400480f BH	126	return -ENXIO;
5400480f BH	127
75722d39	128
5400480f BH	129	lm = kzalloc(sizeof(struct wf_lm75_sensor), GFP_KERNEL);
5400480f BH	130	if (lm == NULL)
a28d3af2	131	return -ENODEV;
75722d39	132
5400480f BH	133	lm->inited = 0;
	134	lm->ds1775 = ds1775;
	135	lm->i2c = client;
	136	lm->sens.name = (char )name; / XXX fix constness in structure */
	137	lm->sens.ops = &wf_lm75_ops;
	138	i2c_set_clientdata(client, lm);
b55fafc5	139
5400480f BH	140	rc = wf_register_sensor(&lm->sens);
	141	if (rc)
	142	kfree(lm);
	143	return rc;
75722d39 BH	144	}
75722d39 BH	145
351ca3e3	146	static int wf_lm75_remove(struct i2c_client *client)
75722d39	147	{
351ca3e3	148	struct wf_lm75_sensor *lm = i2c_get_clientdata(client);
75722d39 BH	149
	150	DBG("wf_lm75: i2c detatch called for %s\n", lm->sens.name);
	151
	152	/* Mark client detached */
351ca3e3	153	lm->i2c = NULL;
75722d39 BH	154
	155	/* release sensor */
	156	wf_unregister_sensor(&lm->sens);
	157
	158	return 0;
	159	}
	160
351ca3e3	161	static const struct i2c_device_id wf_lm75_id[] = {
5400480f BH	162	{ "MAC,lm75", 0 },
5400480f BH	163	{ "MAC,ds1775", 1 },
351ca3e3 JD	164	{ }
351ca3e3 JD	165	};
5400480f	166	MODULE_DEVICE_TABLE(i2c, wf_lm75_id);
351ca3e3 JD	167
	168	static struct i2c_driver wf_lm75_driver = {
	169	.driver = {
	170	.name = "wf_lm75",
	171	},
351ca3e3 JD	172	.probe = wf_lm75_probe,
	173	.remove = wf_lm75_remove,
	174	.id_table = wf_lm75_id,
	175	};
	176
f7fb862b	177	module_i2c_driver(wf_lm75_driver);
75722d39 BH	178
	179	MODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>");
	180	MODULE_DESCRIPTION("LM75 sensor objects for PowerMacs thermal control");
	181	MODULE_LICENSE("GPL");
	182