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