Blame view
drivers/macintosh/windfarm_lm75_sensor.c
5.89 KB
75722d399 [PATCH] ppc64: Th... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 |
/* * 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> |
75722d399 [PATCH] ppc64: Th... |
18 19 20 21 22 |
#include <asm/prom.h> #include <asm/machdep.h> #include <asm/io.h> #include <asm/system.h> #include <asm/sections.h> |
a28d3af2a [PATCH] 2/5 power... |
23 |
#include <asm/pmac_low_i2c.h> |
75722d399 [PATCH] ppc64: Th... |
24 25 |
#include "windfarm.h" |
b55fafc5a [PATCH] powerpc: ... |
26 |
#define VERSION "0.2" |
75722d399 [PATCH] ppc64: Th... |
27 28 29 30 31 32 33 34 35 36 37 38 |
#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; |
351ca3e31 windfarm: Convert... |
39 |
struct i2c_client *i2c; |
75722d399 [PATCH] ppc64: Th... |
40 41 42 |
struct wf_sensor sens; }; #define wf_to_lm75(c) container_of(c, struct wf_lm75_sensor, sens) |
75722d399 [PATCH] ppc64: Th... |
43 44 45 46 47 |
static int wf_lm75_get(struct wf_sensor *sr, s32 *value) { struct wf_lm75_sensor *lm = wf_to_lm75(sr); s32 data; |
351ca3e31 windfarm: Convert... |
48 |
if (lm->i2c == NULL) |
75722d399 [PATCH] ppc64: Th... |
49 50 51 52 |
return -ENODEV; /* Init chip if necessary */ if (!lm->inited) { |
351ca3e31 windfarm: Convert... |
53 |
u8 cfg_new, cfg = (u8)i2c_smbus_read_byte_data(lm->i2c, 1); |
75722d399 [PATCH] ppc64: Th... |
54 55 56 57 58 59 60 61 62 |
DBG("wf_lm75: Initializing %s, cfg was: %02x ", sr->name, cfg); /* clear shutdown bit, keep other settings as left by * the firmware for now */ cfg_new = cfg & ~0x01; |
351ca3e31 windfarm: Convert... |
63 |
i2c_smbus_write_byte_data(lm->i2c, 1, cfg_new); |
75722d399 [PATCH] ppc64: Th... |
64 65 66 67 68 69 70 |
lm->inited = 1; /* If we just powered it up, let's wait 200 ms */ msleep(200); } /* Read temperature register */ |
351ca3e31 windfarm: Convert... |
71 |
data = (s32)le16_to_cpu(i2c_smbus_read_word_data(lm->i2c, 0)); |
75722d399 [PATCH] ppc64: Th... |
72 73 74 75 76 77 78 79 80 |
data <<= 8; *value = data; return 0; } static void wf_lm75_release(struct wf_sensor *sr) { struct wf_lm75_sensor *lm = wf_to_lm75(sr); |
75722d399 [PATCH] ppc64: Th... |
81 82 83 84 85 86 87 88 |
kfree(lm); } static struct wf_sensor_ops wf_lm75_ops = { .get_value = wf_lm75_get, .release = wf_lm75_release, .owner = THIS_MODULE, }; |
351ca3e31 windfarm: Convert... |
89 90 |
static int wf_lm75_probe(struct i2c_client *client, const struct i2c_device_id *id) |
75722d399 [PATCH] ppc64: Th... |
91 92 |
{ struct wf_lm75_sensor *lm; |
b55fafc5a [PATCH] powerpc: ... |
93 |
int rc; |
75722d399 [PATCH] ppc64: Th... |
94 |
|
dd00cc486 some kmalloc/mems... |
95 |
lm = kzalloc(sizeof(struct wf_lm75_sensor), GFP_KERNEL); |
75722d399 [PATCH] ppc64: Th... |
96 |
if (lm == NULL) |
351ca3e31 windfarm: Convert... |
97 98 99 100 101 102 103 104 105 106 |
return -ENODEV; lm->inited = 0; lm->ds1775 = id->driver_data; lm->i2c = client; lm->sens.name = client->dev.platform_data; lm->sens.ops = &wf_lm75_ops; i2c_set_clientdata(client, lm); rc = wf_register_sensor(&lm->sens); |
fbae3fb15 i2c: Remove all i... |
107 |
if (rc) |
351ca3e31 windfarm: Convert... |
108 |
kfree(lm); |
351ca3e31 windfarm: Convert... |
109 110 111 |
return rc; } |
6f6b35e13 macintosh: Don't ... |
112 |
static struct i2c_driver wf_lm75_driver; |
351ca3e31 windfarm: Convert... |
113 114 115 116 117 118 119 120 121 122 123 |
static struct i2c_client *wf_lm75_create(struct i2c_adapter *adapter, u8 addr, int ds1775, const char *loc) { struct i2c_board_info info; struct i2c_client *client; char *name; DBG("wf_lm75: creating %s device at address 0x%02x ", ds1775 ? "ds1775" : "lm75", addr); |
75722d399 [PATCH] ppc64: Th... |
124 125 126 127 128 129 |
/* 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")) |
351ca3e31 windfarm: Convert... |
130 |
name = "hd-temp"; |
80ff974db [POWERPC] windfar... |
131 |
else if (!strcmp(loc, "Incoming Air Temp")) |
351ca3e31 windfarm: Convert... |
132 |
name = "incoming-air-temp"; |
80ff974db [POWERPC] windfar... |
133 |
else if (!strcmp(loc, "ODD Temp")) |
351ca3e31 windfarm: Convert... |
134 |
name = "optical-drive-temp"; |
80ff974db [POWERPC] windfar... |
135 |
else if (!strcmp(loc, "HD Temp")) |
351ca3e31 windfarm: Convert... |
136 |
name = "hard-drive-temp"; |
75722d399 [PATCH] ppc64: Th... |
137 138 |
else goto fail; |
351ca3e31 windfarm: Convert... |
139 140 141 142 |
memset(&info, 0, sizeof(struct i2c_board_info)); info.addr = (addr >> 1) & 0x7f; info.platform_data = name; strlcpy(info.type, ds1775 ? "wf_ds1775" : "wf_lm75", I2C_NAME_SIZE); |
75722d399 [PATCH] ppc64: Th... |
143 |
|
351ca3e31 windfarm: Convert... |
144 145 146 147 148 |
client = i2c_new_device(adapter, &info); if (client == NULL) { printk(KERN_ERR "windfarm: failed to attach %s %s to i2c ", ds1775 ? "ds1775" : "lm75", name); |
75722d399 [PATCH] ppc64: Th... |
149 150 |
goto fail; } |
351ca3e31 windfarm: Convert... |
151 152 153 154 |
/* * Let i2c-core delete that device on driver removal. * This is safe because i2c-core holds the core_lock mutex for us. */ |
6f6b35e13 macintosh: Don't ... |
155 |
list_add_tail(&client->detected, &wf_lm75_driver.clients); |
351ca3e31 windfarm: Convert... |
156 |
return client; |
75722d399 [PATCH] ppc64: Th... |
157 |
fail: |
75722d399 [PATCH] ppc64: Th... |
158 159 160 161 162 |
return NULL; } static int wf_lm75_attach(struct i2c_adapter *adapter) { |
a28d3af2a [PATCH] 2/5 power... |
163 164 |
struct device_node *busnode, *dev; struct pmac_i2c_bus *bus; |
75722d399 [PATCH] ppc64: Th... |
165 166 167 |
DBG("wf_lm75: adapter %s detected ", adapter->name); |
a28d3af2a [PATCH] 2/5 power... |
168 169 170 171 |
bus = pmac_i2c_adapter_to_bus(adapter); if (bus == NULL) return -ENODEV; busnode = pmac_i2c_get_bus_node(bus); |
75722d399 [PATCH] ppc64: Th... |
172 173 174 175 176 177 |
DBG("wf_lm75: bus found, looking for device... "); /* Now look for lm75(s) in there */ for (dev = NULL; |
a28d3af2a [PATCH] 2/5 power... |
178 |
(dev = of_get_next_child(busnode, dev)) != NULL;) { |
75722d399 [PATCH] ppc64: Th... |
179 |
const char *loc = |
01b2726dd [POWERPC] Rename ... |
180 |
of_get_property(dev, "hwsensor-location", NULL); |
b55fafc5a [PATCH] powerpc: ... |
181 182 183 184 185 186 187 188 189 |
u8 addr; /* We must re-match the adapter in order to properly check * the channel on multibus setups */ if (!pmac_i2c_match_adapter(dev, adapter)) continue; addr = pmac_i2c_get_dev_addr(dev); if (loc == NULL || addr == 0) |
75722d399 [PATCH] ppc64: Th... |
190 191 |
continue; /* real lm75 */ |
55b61fec2 [POWERPC] Rename ... |
192 |
if (of_device_is_compatible(dev, "lm75")) |
b55fafc5a [PATCH] powerpc: ... |
193 |
wf_lm75_create(adapter, addr, 0, loc); |
75722d399 [PATCH] ppc64: Th... |
194 |
/* ds1775 (compatible, better resolution */ |
55b61fec2 [POWERPC] Rename ... |
195 |
else if (of_device_is_compatible(dev, "ds1775")) |
b55fafc5a [PATCH] powerpc: ... |
196 |
wf_lm75_create(adapter, addr, 1, loc); |
75722d399 [PATCH] ppc64: Th... |
197 |
} |
75722d399 [PATCH] ppc64: Th... |
198 199 |
return 0; } |
351ca3e31 windfarm: Convert... |
200 |
static int wf_lm75_remove(struct i2c_client *client) |
75722d399 [PATCH] ppc64: Th... |
201 |
{ |
351ca3e31 windfarm: Convert... |
202 |
struct wf_lm75_sensor *lm = i2c_get_clientdata(client); |
75722d399 [PATCH] ppc64: Th... |
203 204 205 206 207 |
DBG("wf_lm75: i2c detatch called for %s ", lm->sens.name); /* Mark client detached */ |
351ca3e31 windfarm: Convert... |
208 |
lm->i2c = NULL; |
75722d399 [PATCH] ppc64: Th... |
209 210 211 212 213 214 |
/* release sensor */ wf_unregister_sensor(&lm->sens); return 0; } |
351ca3e31 windfarm: Convert... |
215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 |
static const struct i2c_device_id wf_lm75_id[] = { { "wf_lm75", 0 }, { "wf_ds1775", 1 }, { } }; static struct i2c_driver wf_lm75_driver = { .driver = { .name = "wf_lm75", }, .attach_adapter = wf_lm75_attach, .probe = wf_lm75_probe, .remove = wf_lm75_remove, .id_table = wf_lm75_id, }; |
75722d399 [PATCH] ppc64: Th... |
230 231 |
static int __init wf_lm75_sensor_init(void) { |
b55fafc5a [PATCH] powerpc: ... |
232 |
/* Don't register on old machines that use therm_pm72 for now */ |
71a157e8e of: add 'of_' pre... |
233 234 235 |
if (of_machine_is_compatible("PowerMac7,2") || of_machine_is_compatible("PowerMac7,3") || of_machine_is_compatible("RackMac3,1")) |
b55fafc5a [PATCH] powerpc: ... |
236 |
return -ENODEV; |
c9662b4b3 [PATCH] macintosh... |
237 |
return i2c_add_driver(&wf_lm75_driver); |
75722d399 [PATCH] ppc64: Th... |
238 239 240 241 242 243 244 245 246 247 248 249 250 251 |
} static void __exit wf_lm75_sensor_exit(void) { i2c_del_driver(&wf_lm75_driver); } module_init(wf_lm75_sensor_init); module_exit(wf_lm75_sensor_exit); MODULE_AUTHOR("Benjamin Herrenschmidt <benh@kernel.crashing.org>"); MODULE_DESCRIPTION("LM75 sensor objects for PowerMacs thermal control"); MODULE_LICENSE("GPL"); |