Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Creation Date: <2003/03/14 20:54:13 samuel> | |
3 | * Time-stamp: <2004/03/20 14:20:59 samuel> | |
4 | * | |
5 | * <therm_windtunnel.c> | |
6 | * | |
7 | * The G4 "windtunnel" has a single fan controlled by an | |
8 | * ADM1030 fan controller and a DS1775 thermostat. | |
9 | * | |
10 | * The fan controller is equipped with a temperature sensor | |
11 | * which measures the case temperature. The DS1775 sensor | |
12 | * measures the CPU temperature. This driver tunes the | |
13 | * behavior of the fan. It is based upon empirical observations | |
14 | * of the 'AppleFan' driver under Mac OS X. | |
15 | * | |
16 | * WARNING: This driver has only been testen on Apple's | |
17 | * 1.25 MHz Dual G4 (March 03). It is tuned for a CPU | |
af901ca1 | 18 | * temperature around 57 C. |
1da177e4 LT |
19 | * |
20 | * Copyright (C) 2003, 2004 Samuel Rydh (samuel@ibrium.se) | |
21 | * | |
22 | * Loosely based upon 'thermostat.c' written by Benjamin Herrenschmidt | |
23 | * | |
24 | * This program is free software; you can redistribute it and/or | |
25 | * modify it under the terms of the GNU General Public License | |
26 | * as published by the Free Software Foundation | |
27 | * | |
28 | */ | |
29 | ||
1da177e4 LT |
30 | #include <linux/types.h> |
31 | #include <linux/module.h> | |
32 | #include <linux/errno.h> | |
33 | #include <linux/kernel.h> | |
34 | #include <linux/delay.h> | |
35 | #include <linux/sched.h> | |
36 | #include <linux/i2c.h> | |
1da177e4 | 37 | #include <linux/init.h> |
98f6740e | 38 | #include <linux/kthread.h> |
ad9e05ae | 39 | #include <linux/of_platform.h> |
7eebde70 | 40 | |
1da177e4 LT |
41 | #include <asm/prom.h> |
42 | #include <asm/machdep.h> | |
43 | #include <asm/io.h> | |
44 | #include <asm/system.h> | |
45 | #include <asm/sections.h> | |
5e655772 | 46 | #include <asm/macio.h> |
1da177e4 LT |
47 | |
48 | #define LOG_TEMP 0 /* continously log temperature */ | |
49 | ||
1da177e4 LT |
50 | static struct { |
51 | volatile int running; | |
98f6740e | 52 | struct task_struct *poll_task; |
1da177e4 | 53 | |
1baaeea0 | 54 | struct mutex lock; |
1da177e4 LT |
55 | struct of_device *of_dev; |
56 | ||
57 | struct i2c_client *thermostat; | |
58 | struct i2c_client *fan; | |
59 | ||
60 | int overheat_temp; /* 100% fan at this temp */ | |
61 | int overheat_hyst; | |
62 | int temp; | |
63 | int casetemp; | |
64 | int fan_level; /* active fan_table setting */ | |
65 | ||
66 | int downind; | |
67 | int upind; | |
68 | ||
69 | int r0, r1, r20, r23, r25; /* saved register */ | |
70 | } x; | |
71 | ||
72 | #define T(x,y) (((x)<<8) | (y)*0x100/10 ) | |
73 | ||
74 | static struct { | |
75 | int fan_down_setting; | |
76 | int temp; | |
77 | int fan_up_setting; | |
78 | } fan_table[] = { | |
79 | { 11, T(0,0), 11 }, /* min fan */ | |
80 | { 11, T(55,0), 11 }, | |
81 | { 6, T(55,3), 11 }, | |
82 | { 7, T(56,0), 11 }, | |
83 | { 8, T(57,0), 8 }, | |
84 | { 7, T(58,3), 7 }, | |
85 | { 6, T(58,8), 6 }, | |
86 | { 5, T(59,2), 5 }, | |
87 | { 4, T(59,6), 4 }, | |
88 | { 3, T(59,9), 3 }, | |
89 | { 2, T(60,1), 2 }, | |
90 | { 1, 0xfffff, 1 } /* on fire */ | |
91 | }; | |
92 | ||
93 | static void | |
94 | print_temp( const char *s, int temp ) | |
95 | { | |
96 | printk("%s%d.%d C", s ? s : "", temp>>8, (temp & 255)*10/256 ); | |
97 | } | |
98 | ||
99 | static ssize_t | |
e404e274 | 100 | show_cpu_temperature( struct device *dev, struct device_attribute *attr, char *buf ) |
1da177e4 LT |
101 | { |
102 | return sprintf(buf, "%d.%d\n", x.temp>>8, (x.temp & 255)*10/256 ); | |
103 | } | |
104 | ||
105 | static ssize_t | |
e404e274 | 106 | show_case_temperature( struct device *dev, struct device_attribute *attr, char *buf ) |
1da177e4 LT |
107 | { |
108 | return sprintf(buf, "%d.%d\n", x.casetemp>>8, (x.casetemp & 255)*10/256 ); | |
109 | } | |
110 | ||
111 | static DEVICE_ATTR(cpu_temperature, S_IRUGO, show_cpu_temperature, NULL ); | |
112 | static DEVICE_ATTR(case_temperature, S_IRUGO, show_case_temperature, NULL ); | |
113 | ||
114 | ||
115 | ||
116 | /************************************************************************/ | |
117 | /* controller thread */ | |
118 | /************************************************************************/ | |
119 | ||
120 | static int | |
121 | write_reg( struct i2c_client *cl, int reg, int data, int len ) | |
122 | { | |
123 | u8 tmp[3]; | |
124 | ||
125 | if( len < 1 || len > 2 || data < 0 ) | |
126 | return -EINVAL; | |
127 | ||
128 | tmp[0] = reg; | |
129 | tmp[1] = (len == 1) ? data : (data >> 8); | |
130 | tmp[2] = data; | |
131 | len++; | |
132 | ||
133 | if( i2c_master_send(cl, tmp, len) != len ) | |
134 | return -ENODEV; | |
135 | return 0; | |
136 | } | |
137 | ||
138 | static int | |
139 | read_reg( struct i2c_client *cl, int reg, int len ) | |
140 | { | |
141 | u8 buf[2]; | |
142 | ||
143 | if( len != 1 && len != 2 ) | |
144 | return -EINVAL; | |
145 | buf[0] = reg; | |
146 | if( i2c_master_send(cl, buf, 1) != 1 ) | |
147 | return -ENODEV; | |
148 | if( i2c_master_recv(cl, buf, len) != len ) | |
149 | return -ENODEV; | |
150 | return (len == 2)? ((unsigned int)buf[0] << 8) | buf[1] : buf[0]; | |
151 | } | |
152 | ||
153 | static void | |
154 | tune_fan( int fan_setting ) | |
155 | { | |
156 | int val = (fan_setting << 3) | 7; | |
157 | ||
158 | /* write_reg( x.fan, 0x24, val, 1 ); */ | |
159 | write_reg( x.fan, 0x25, val, 1 ); | |
160 | write_reg( x.fan, 0x20, 0, 1 ); | |
161 | print_temp("CPU-temp: ", x.temp ); | |
162 | if( x.casetemp ) | |
163 | print_temp(", Case: ", x.casetemp ); | |
164 | printk(", Fan: %d (tuned %+d)\n", 11-fan_setting, x.fan_level-fan_setting ); | |
165 | ||
166 | x.fan_level = fan_setting; | |
167 | } | |
168 | ||
169 | static void | |
170 | poll_temp( void ) | |
171 | { | |
172 | int temp, i, level, casetemp; | |
173 | ||
174 | temp = read_reg( x.thermostat, 0, 2 ); | |
175 | ||
176 | /* this actually occurs when the computer is loaded */ | |
177 | if( temp < 0 ) | |
178 | return; | |
179 | ||
180 | casetemp = read_reg(x.fan, 0x0b, 1) << 8; | |
181 | casetemp |= (read_reg(x.fan, 0x06, 1) & 0x7) << 5; | |
182 | ||
183 | if( LOG_TEMP && x.temp != temp ) { | |
184 | print_temp("CPU-temp: ", temp ); | |
185 | print_temp(", Case: ", casetemp ); | |
186 | printk(", Fan: %d\n", 11-x.fan_level ); | |
187 | } | |
188 | x.temp = temp; | |
189 | x.casetemp = casetemp; | |
190 | ||
191 | level = -1; | |
192 | for( i=0; (temp & 0xffff) > fan_table[i].temp ; i++ ) | |
193 | ; | |
194 | if( i < x.downind ) | |
195 | level = fan_table[i].fan_down_setting; | |
196 | x.downind = i; | |
197 | ||
198 | for( i=0; (temp & 0xffff) >= fan_table[i+1].temp ; i++ ) | |
199 | ; | |
200 | if( x.upind < i ) | |
201 | level = fan_table[i].fan_up_setting; | |
202 | x.upind = i; | |
203 | ||
204 | if( level >= 0 ) | |
205 | tune_fan( level ); | |
206 | } | |
207 | ||
208 | ||
209 | static void | |
210 | setup_hardware( void ) | |
211 | { | |
212 | int val; | |
98894dff | 213 | int err; |
1da177e4 LT |
214 | |
215 | /* save registers (if we unload the module) */ | |
216 | x.r0 = read_reg( x.fan, 0x00, 1 ); | |
217 | x.r1 = read_reg( x.fan, 0x01, 1 ); | |
218 | x.r20 = read_reg( x.fan, 0x20, 1 ); | |
219 | x.r23 = read_reg( x.fan, 0x23, 1 ); | |
220 | x.r25 = read_reg( x.fan, 0x25, 1 ); | |
221 | ||
222 | /* improve measurement resolution (convergence time 1.5s) */ | |
223 | if( (val=read_reg(x.thermostat, 1, 1)) >= 0 ) { | |
224 | val |= 0x60; | |
225 | if( write_reg( x.thermostat, 1, val, 1 ) ) | |
226 | printk("Failed writing config register\n"); | |
227 | } | |
228 | /* disable interrupts and TAC input */ | |
229 | write_reg( x.fan, 0x01, 0x01, 1 ); | |
230 | /* enable filter */ | |
231 | write_reg( x.fan, 0x23, 0x91, 1 ); | |
232 | /* remote temp. controls fan */ | |
233 | write_reg( x.fan, 0x00, 0x95, 1 ); | |
234 | ||
235 | /* The thermostat (which besides measureing temperature controls | |
236 | * has a THERM output which puts the fan on 100%) is usually | |
237 | * set to kick in at 80 C (chip default). We reduce this a bit | |
238 | * to be on the safe side (OSX doesn't)... | |
239 | */ | |
240 | if( x.overheat_temp == (80 << 8) ) { | |
b8e4a7da LV |
241 | x.overheat_temp = 75 << 8; |
242 | x.overheat_hyst = 70 << 8; | |
1da177e4 LT |
243 | write_reg( x.thermostat, 2, x.overheat_hyst, 2 ); |
244 | write_reg( x.thermostat, 3, x.overheat_temp, 2 ); | |
245 | ||
246 | print_temp("Reducing overheating limit to ", x.overheat_temp ); | |
247 | print_temp(" (Hyst: ", x.overheat_hyst ); | |
248 | printk(")\n"); | |
249 | } | |
250 | ||
251 | /* set an initial fan setting */ | |
252 | x.downind = 0xffff; | |
253 | x.upind = -1; | |
254 | /* tune_fan( fan_up_table[x.upind].fan_setting ); */ | |
255 | ||
98894dff SR |
256 | err = device_create_file( &x.of_dev->dev, &dev_attr_cpu_temperature ); |
257 | err |= device_create_file( &x.of_dev->dev, &dev_attr_case_temperature ); | |
258 | if (err) | |
259 | printk(KERN_WARNING | |
260 | "Failed to create temperature attribute file(s).\n"); | |
1da177e4 LT |
261 | } |
262 | ||
263 | static void | |
264 | restore_regs( void ) | |
265 | { | |
266 | device_remove_file( &x.of_dev->dev, &dev_attr_cpu_temperature ); | |
267 | device_remove_file( &x.of_dev->dev, &dev_attr_case_temperature ); | |
268 | ||
269 | write_reg( x.fan, 0x01, x.r1, 1 ); | |
270 | write_reg( x.fan, 0x20, x.r20, 1 ); | |
271 | write_reg( x.fan, 0x23, x.r23, 1 ); | |
272 | write_reg( x.fan, 0x25, x.r25, 1 ); | |
273 | write_reg( x.fan, 0x00, x.r0, 1 ); | |
274 | } | |
275 | ||
98f6740e | 276 | static int control_loop(void *dummy) |
1da177e4 | 277 | { |
1baaeea0 | 278 | mutex_lock(&x.lock); |
1da177e4 | 279 | setup_hardware(); |
1baaeea0 | 280 | mutex_unlock(&x.lock); |
1da177e4 | 281 | |
98f6740e | 282 | for (;;) { |
1da177e4 | 283 | msleep_interruptible(8000); |
98f6740e PM |
284 | if (kthread_should_stop()) |
285 | break; | |
286 | ||
1baaeea0 | 287 | mutex_lock(&x.lock); |
1da177e4 | 288 | poll_temp(); |
1baaeea0 | 289 | mutex_unlock(&x.lock); |
1da177e4 LT |
290 | } |
291 | ||
1baaeea0 | 292 | mutex_lock(&x.lock); |
1da177e4 | 293 | restore_regs(); |
1baaeea0 | 294 | mutex_unlock(&x.lock); |
1da177e4 | 295 | |
98f6740e | 296 | return 0; |
1da177e4 LT |
297 | } |
298 | ||
299 | ||
300 | /************************************************************************/ | |
301 | /* i2c probing and setup */ | |
302 | /************************************************************************/ | |
303 | ||
304 | static int | |
305 | do_attach( struct i2c_adapter *adapter ) | |
306 | { | |
036533e2 JD |
307 | /* scan 0x48-0x4f (DS1775) and 0x2c-2x2f (ADM1030) */ |
308 | static const unsigned short scan_ds1775[] = { | |
309 | 0x48, 0x49, 0x4a, 0x4b, 0x4c, 0x4d, 0x4e, 0x4f, | |
310 | I2C_CLIENT_END | |
311 | }; | |
312 | static const unsigned short scan_adm1030[] = { | |
313 | 0x2c, 0x2d, 0x2e, 0x2f, | |
314 | I2C_CLIENT_END | |
315 | }; | |
1da177e4 LT |
316 | |
317 | if( strncmp(adapter->name, "uni-n", 5) ) | |
318 | return 0; | |
319 | ||
320 | if( !x.running ) { | |
036533e2 JD |
321 | struct i2c_board_info info; |
322 | ||
323 | memset(&info, 0, sizeof(struct i2c_board_info)); | |
324 | strlcpy(info.type, "therm_ds1775", I2C_NAME_SIZE); | |
325 | i2c_new_probed_device(adapter, &info, scan_ds1775); | |
326 | ||
327 | strlcpy(info.type, "therm_adm1030", I2C_NAME_SIZE); | |
328 | i2c_new_probed_device(adapter, &info, scan_adm1030); | |
329 | ||
1da177e4 LT |
330 | if( x.thermostat && x.fan ) { |
331 | x.running = 1; | |
98f6740e | 332 | x.poll_task = kthread_run(control_loop, NULL, "g4fand"); |
1da177e4 LT |
333 | } |
334 | } | |
036533e2 | 335 | return 0; |
1da177e4 LT |
336 | } |
337 | ||
338 | static int | |
036533e2 | 339 | do_remove(struct i2c_client *client) |
1da177e4 | 340 | { |
036533e2 JD |
341 | if (x.running) { |
342 | x.running = 0; | |
343 | kthread_stop(x.poll_task); | |
344 | x.poll_task = NULL; | |
1da177e4 | 345 | } |
036533e2 JD |
346 | if (client == x.thermostat) |
347 | x.thermostat = NULL; | |
348 | else if (client == x.fan) | |
349 | x.fan = NULL; | |
350 | else | |
351 | printk(KERN_ERR "g4fan: bad client\n"); | |
1da177e4 | 352 | |
036533e2 JD |
353 | return 0; |
354 | } | |
1da177e4 LT |
355 | |
356 | static int | |
357 | attach_fan( struct i2c_client *cl ) | |
358 | { | |
359 | if( x.fan ) | |
360 | goto out; | |
361 | ||
362 | /* check that this is an ADM1030 */ | |
363 | if( read_reg(cl, 0x3d, 1) != 0x30 || read_reg(cl, 0x3e, 1) != 0x41 ) | |
364 | goto out; | |
365 | printk("ADM1030 fan controller [@%02x]\n", cl->addr ); | |
366 | ||
036533e2 | 367 | x.fan = cl; |
1da177e4 | 368 | out: |
1da177e4 LT |
369 | return 0; |
370 | } | |
371 | ||
372 | static int | |
373 | attach_thermostat( struct i2c_client *cl ) | |
374 | { | |
375 | int hyst_temp, os_temp, temp; | |
376 | ||
377 | if( x.thermostat ) | |
378 | goto out; | |
379 | ||
380 | if( (temp=read_reg(cl, 0, 2)) < 0 ) | |
381 | goto out; | |
382 | ||
383 | /* temperature sanity check */ | |
384 | if( temp < 0x1600 || temp > 0x3c00 ) | |
385 | goto out; | |
386 | hyst_temp = read_reg(cl, 2, 2); | |
387 | os_temp = read_reg(cl, 3, 2); | |
388 | if( hyst_temp < 0 || os_temp < 0 ) | |
389 | goto out; | |
390 | ||
391 | printk("DS1775 digital thermometer [@%02x]\n", cl->addr ); | |
392 | print_temp("Temp: ", temp ); | |
393 | print_temp(" Hyst: ", hyst_temp ); | |
394 | print_temp(" OS: ", os_temp ); | |
395 | printk("\n"); | |
396 | ||
397 | x.temp = temp; | |
398 | x.overheat_temp = os_temp; | |
399 | x.overheat_hyst = hyst_temp; | |
036533e2 | 400 | x.thermostat = cl; |
1da177e4 | 401 | out: |
1da177e4 LT |
402 | return 0; |
403 | } | |
404 | ||
036533e2 JD |
405 | enum chip { ds1775, adm1030 }; |
406 | ||
407 | static const struct i2c_device_id therm_windtunnel_id[] = { | |
408 | { "therm_ds1775", ds1775 }, | |
409 | { "therm_adm1030", adm1030 }, | |
410 | { } | |
411 | }; | |
412 | ||
1da177e4 | 413 | static int |
036533e2 | 414 | do_probe(struct i2c_client *cl, const struct i2c_device_id *id) |
1da177e4 | 415 | { |
036533e2 | 416 | struct i2c_adapter *adapter = cl->adapter; |
1da177e4 LT |
417 | |
418 | if( !i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA | |
419 | | I2C_FUNC_SMBUS_WRITE_BYTE) ) | |
420 | return 0; | |
421 | ||
036533e2 JD |
422 | switch (id->driver_data) { |
423 | case adm1030: | |
1da177e4 | 424 | return attach_fan( cl ); |
036533e2 JD |
425 | case ds1775: |
426 | return attach_thermostat(cl); | |
427 | } | |
428 | return 0; | |
1da177e4 LT |
429 | } |
430 | ||
036533e2 JD |
431 | static struct i2c_driver g4fan_driver = { |
432 | .driver = { | |
433 | .name = "therm_windtunnel", | |
434 | }, | |
435 | .attach_adapter = do_attach, | |
436 | .probe = do_probe, | |
437 | .remove = do_remove, | |
438 | .id_table = therm_windtunnel_id, | |
439 | }; | |
440 | ||
1da177e4 LT |
441 | |
442 | /************************************************************************/ | |
443 | /* initialization / cleanup */ | |
444 | /************************************************************************/ | |
445 | ||
446 | static int | |
5e655772 | 447 | therm_of_probe( struct of_device *dev, const struct of_device_id *match ) |
1da177e4 LT |
448 | { |
449 | return i2c_add_driver( &g4fan_driver ); | |
450 | } | |
451 | ||
452 | static int | |
453 | therm_of_remove( struct of_device *dev ) | |
454 | { | |
b3e82096 JD |
455 | i2c_del_driver( &g4fan_driver ); |
456 | return 0; | |
1da177e4 LT |
457 | } |
458 | ||
46759a7c | 459 | static const struct of_device_id therm_of_match[] = {{ |
1da177e4 | 460 | .name = "fan", |
1da177e4 LT |
461 | .compatible = "adm1030" |
462 | }, {} | |
463 | }; | |
464 | ||
465 | static struct of_platform_driver therm_of_driver = { | |
4018294b GL |
466 | .driver = { |
467 | .name = "temperature", | |
468 | .owner = THIS_MODULE, | |
469 | .of_match_table = therm_of_match, | |
470 | }, | |
1da177e4 LT |
471 | .probe = therm_of_probe, |
472 | .remove = therm_of_remove, | |
473 | }; | |
474 | ||
475 | struct apple_thermal_info { | |
476 | u8 id; /* implementation ID */ | |
477 | u8 fan_count; /* number of fans */ | |
478 | u8 thermostat_count; /* number of thermostats */ | |
479 | u8 unused; | |
480 | }; | |
481 | ||
482 | static int __init | |
483 | g4fan_init( void ) | |
484 | { | |
018a3d1d | 485 | const struct apple_thermal_info *info; |
1da177e4 LT |
486 | struct device_node *np; |
487 | ||
1baaeea0 | 488 | mutex_init(&x.lock); |
1da177e4 LT |
489 | |
490 | if( !(np=of_find_node_by_name(NULL, "power-mgt")) ) | |
491 | return -ENODEV; | |
01b2726d | 492 | info = of_get_property(np, "thermal-info", NULL); |
1da177e4 LT |
493 | of_node_put(np); |
494 | ||
71a157e8 | 495 | if( !info || !of_machine_is_compatible("PowerMac3,6") ) |
1da177e4 LT |
496 | return -ENODEV; |
497 | ||
498 | if( info->id != 3 ) { | |
499 | printk(KERN_ERR "therm_windtunnel: unsupported thermal design %d\n", info->id ); | |
500 | return -ENODEV; | |
501 | } | |
502 | if( !(np=of_find_node_by_name(NULL, "fan")) ) | |
503 | return -ENODEV; | |
0365ba7f | 504 | x.of_dev = of_platform_device_create(np, "temperature", NULL); |
1da177e4 LT |
505 | of_node_put( np ); |
506 | ||
507 | if( !x.of_dev ) { | |
508 | printk(KERN_ERR "Can't register fan controller!\n"); | |
509 | return -ENODEV; | |
510 | } | |
511 | ||
7eebde70 | 512 | of_register_platform_driver( &therm_of_driver ); |
1da177e4 LT |
513 | return 0; |
514 | } | |
515 | ||
516 | static void __exit | |
517 | g4fan_exit( void ) | |
518 | { | |
7eebde70 | 519 | of_unregister_platform_driver( &therm_of_driver ); |
1da177e4 LT |
520 | |
521 | if( x.of_dev ) | |
522 | of_device_unregister( x.of_dev ); | |
523 | } | |
524 | ||
525 | module_init(g4fan_init); | |
526 | module_exit(g4fan_exit); | |
527 | ||
528 | MODULE_AUTHOR("Samuel Rydh <samuel@ibrium.se>"); | |
529 | MODULE_DESCRIPTION("Apple G4 (windtunnel) fan controller"); | |
530 | MODULE_LICENSE("GPL"); |