2 * coretemp.c - Linux kernel module for hardware monitoring
4 * Copyright (C) 2007 Rudolf Marek <r.marek@assembler.cz>
6 * Inspired from many hwmon drivers
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; version 2 of the License.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
23 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
25 #include <linux/module.h>
26 #include <linux/init.h>
27 #include <linux/slab.h>
28 #include <linux/jiffies.h>
29 #include <linux/hwmon.h>
30 #include <linux/sysfs.h>
31 #include <linux/hwmon-sysfs.h>
32 #include <linux/err.h>
33 #include <linux/mutex.h>
34 #include <linux/list.h>
35 #include <linux/platform_device.h>
36 #include <linux/cpu.h>
37 #include <linux/pci.h>
38 #include <linux/smp.h>
39 #include <linux/moduleparam.h>
41 #include <asm/processor.h>
43 #define DRVNAME "coretemp"
46 * force_tjmax only matters when TjMax can't be read from the CPU itself.
47 * When set, it replaces the driver's suboptimal heuristic.
49 static int force_tjmax
;
50 module_param_named(tjmax
, force_tjmax
, int, 0444);
51 MODULE_PARM_DESC(tjmax
, "TjMax value in degrees Celsius");
53 #define BASE_SYSFS_ATTR_NO 2 /* Sysfs Base attr no for coretemp */
54 #define NUM_REAL_CORES 16 /* Number of Real cores per cpu */
55 #define CORETEMP_NAME_LENGTH 17 /* String Length of attrs */
56 #define MAX_CORE_ATTRS 4 /* Maximum no of basic attrs */
57 #define MAX_THRESH_ATTRS 3 /* Maximum no of Threshold attrs */
58 #define TOTAL_ATTRS (MAX_CORE_ATTRS + MAX_THRESH_ATTRS)
59 #define MAX_CORE_DATA (NUM_REAL_CORES + BASE_SYSFS_ATTR_NO)
62 #define TO_PHYS_ID(cpu) cpu_data(cpu).phys_proc_id
63 #define TO_CORE_ID(cpu) cpu_data(cpu).cpu_core_id
64 #define TO_ATTR_NO(cpu) (TO_CORE_ID(cpu) + BASE_SYSFS_ATTR_NO)
65 #define for_each_sibling(i, cpu) for_each_cpu(i, cpu_sibling_mask(cpu))
67 #define TO_PHYS_ID(cpu) (cpu)
68 #define TO_CORE_ID(cpu) (cpu)
69 #define TO_ATTR_NO(cpu) (cpu)
70 #define for_each_sibling(i, cpu) for (i = 0; false; )
74 * Per-Core Temperature Data
75 * @last_updated: The time when the current temperature value was updated
76 * earlier (in jiffies).
77 * @cpu_core_id: The CPU Core from which temperature values should be read
78 * This value is passed as "id" field to rdmsr/wrmsr functions.
79 * @status_reg: One of IA32_THERM_STATUS or IA32_PACKAGE_THERM_STATUS,
80 * from where the temperature values should be read.
81 * @intrpt_reg: One of IA32_THERM_INTERRUPT or IA32_PACKAGE_THERM_INTERRUPT,
82 * from where the thresholds are read.
83 * @attr_size: Total number of pre-core attrs displayed in the sysfs.
84 * @is_pkg_data: If this is 1, the temp_data holds pkgtemp data.
85 * Otherwise, temp_data holds coretemp data.
86 * @valid: If this is 1, the current temperature is valid.
93 unsigned long last_updated
;
101 struct sensor_device_attribute sd_attrs
[TOTAL_ATTRS
];
102 char attr_name
[TOTAL_ATTRS
][CORETEMP_NAME_LENGTH
];
103 struct mutex update_lock
;
106 /* Platform Data per Physical CPU */
107 struct platform_data
{
108 struct device
*hwmon_dev
;
110 struct temp_data
*core_data
[MAX_CORE_DATA
];
111 struct device_attribute name_attr
;
115 struct list_head list
;
116 struct platform_device
*pdev
;
120 static LIST_HEAD(pdev_list
);
121 static DEFINE_MUTEX(pdev_list_mutex
);
123 static ssize_t
show_name(struct device
*dev
,
124 struct device_attribute
*devattr
, char *buf
)
126 return sprintf(buf
, "%s\n", DRVNAME
);
129 static ssize_t
show_label(struct device
*dev
,
130 struct device_attribute
*devattr
, char *buf
)
132 struct sensor_device_attribute
*attr
= to_sensor_dev_attr(devattr
);
133 struct platform_data
*pdata
= dev_get_drvdata(dev
);
134 struct temp_data
*tdata
= pdata
->core_data
[attr
->index
];
136 if (tdata
->is_pkg_data
)
137 return sprintf(buf
, "Physical id %u\n", pdata
->phys_proc_id
);
139 return sprintf(buf
, "Core %u\n", tdata
->cpu_core_id
);
142 static ssize_t
show_crit_alarm(struct device
*dev
,
143 struct device_attribute
*devattr
, char *buf
)
146 struct sensor_device_attribute
*attr
= to_sensor_dev_attr(devattr
);
147 struct platform_data
*pdata
= dev_get_drvdata(dev
);
148 struct temp_data
*tdata
= pdata
->core_data
[attr
->index
];
150 rdmsr_on_cpu(tdata
->cpu
, tdata
->status_reg
, &eax
, &edx
);
152 return sprintf(buf
, "%d\n", (eax
>> 5) & 1);
155 static ssize_t
show_max_alarm(struct device
*dev
,
156 struct device_attribute
*devattr
, char *buf
)
159 struct sensor_device_attribute
*attr
= to_sensor_dev_attr(devattr
);
160 struct platform_data
*pdata
= dev_get_drvdata(dev
);
161 struct temp_data
*tdata
= pdata
->core_data
[attr
->index
];
163 rdmsr_on_cpu(tdata
->cpu
, tdata
->status_reg
, &eax
, &edx
);
165 return sprintf(buf
, "%d\n", !!(eax
& THERM_STATUS_THRESHOLD1
));
168 static ssize_t
show_tjmax(struct device
*dev
,
169 struct device_attribute
*devattr
, char *buf
)
171 struct sensor_device_attribute
*attr
= to_sensor_dev_attr(devattr
);
172 struct platform_data
*pdata
= dev_get_drvdata(dev
);
174 return sprintf(buf
, "%d\n", pdata
->core_data
[attr
->index
]->tjmax
);
177 static ssize_t
show_ttarget(struct device
*dev
,
178 struct device_attribute
*devattr
, char *buf
)
180 struct sensor_device_attribute
*attr
= to_sensor_dev_attr(devattr
);
181 struct platform_data
*pdata
= dev_get_drvdata(dev
);
183 return sprintf(buf
, "%d\n", pdata
->core_data
[attr
->index
]->ttarget
);
186 static ssize_t
store_ttarget(struct device
*dev
,
187 struct device_attribute
*devattr
,
188 const char *buf
, size_t count
)
190 struct platform_data
*pdata
= dev_get_drvdata(dev
);
191 struct sensor_device_attribute
*attr
= to_sensor_dev_attr(devattr
);
192 struct temp_data
*tdata
= pdata
->core_data
[attr
->index
];
197 if (strict_strtoul(buf
, 10, &val
))
201 * THERM_MASK_THRESHOLD1 is 7 bits wide. Values are entered in terms
202 * of milli degree celsius. Hence don't accept val > (127 * 1000)
204 if (val
> tdata
->tjmax
|| val
> 127000)
207 diff
= (tdata
->tjmax
- val
) / 1000;
209 mutex_lock(&tdata
->update_lock
);
210 rdmsr_on_cpu(tdata
->cpu
, tdata
->intrpt_reg
, &eax
, &edx
);
211 eax
= (eax
& ~THERM_MASK_THRESHOLD1
) |
212 (diff
<< THERM_SHIFT_THRESHOLD1
);
213 wrmsr_on_cpu(tdata
->cpu
, tdata
->intrpt_reg
, eax
, edx
);
214 tdata
->ttarget
= val
;
215 mutex_unlock(&tdata
->update_lock
);
220 static ssize_t
show_tmin(struct device
*dev
,
221 struct device_attribute
*devattr
, char *buf
)
223 struct sensor_device_attribute
*attr
= to_sensor_dev_attr(devattr
);
224 struct platform_data
*pdata
= dev_get_drvdata(dev
);
226 return sprintf(buf
, "%d\n", pdata
->core_data
[attr
->index
]->tmin
);
229 static ssize_t
store_tmin(struct device
*dev
,
230 struct device_attribute
*devattr
,
231 const char *buf
, size_t count
)
233 struct platform_data
*pdata
= dev_get_drvdata(dev
);
234 struct sensor_device_attribute
*attr
= to_sensor_dev_attr(devattr
);
235 struct temp_data
*tdata
= pdata
->core_data
[attr
->index
];
240 if (strict_strtoul(buf
, 10, &val
))
244 * THERM_MASK_THRESHOLD0 is 7 bits wide. Values are entered in terms
245 * of milli degree celsius. Hence don't accept val > (127 * 1000)
247 if (val
> tdata
->tjmax
|| val
> 127000)
250 diff
= (tdata
->tjmax
- val
) / 1000;
252 mutex_lock(&tdata
->update_lock
);
253 rdmsr_on_cpu(tdata
->cpu
, tdata
->intrpt_reg
, &eax
, &edx
);
254 eax
= (eax
& ~THERM_MASK_THRESHOLD0
) |
255 (diff
<< THERM_SHIFT_THRESHOLD0
);
256 wrmsr_on_cpu(tdata
->cpu
, tdata
->intrpt_reg
, eax
, edx
);
258 mutex_unlock(&tdata
->update_lock
);
263 static ssize_t
show_temp(struct device
*dev
,
264 struct device_attribute
*devattr
, char *buf
)
267 struct sensor_device_attribute
*attr
= to_sensor_dev_attr(devattr
);
268 struct platform_data
*pdata
= dev_get_drvdata(dev
);
269 struct temp_data
*tdata
= pdata
->core_data
[attr
->index
];
271 mutex_lock(&tdata
->update_lock
);
273 /* Check whether the time interval has elapsed */
274 if (!tdata
->valid
|| time_after(jiffies
, tdata
->last_updated
+ HZ
)) {
275 rdmsr_on_cpu(tdata
->cpu
, tdata
->status_reg
, &eax
, &edx
);
277 /* Check whether the data is valid */
278 if (eax
& 0x80000000) {
279 tdata
->temp
= tdata
->tjmax
-
280 ((eax
>> 16) & 0x7f) * 1000;
283 tdata
->last_updated
= jiffies
;
286 mutex_unlock(&tdata
->update_lock
);
287 return tdata
->valid
? sprintf(buf
, "%d\n", tdata
->temp
) : -EAGAIN
;
290 static int adjust_tjmax(struct cpuinfo_x86
*c
, u32 id
, struct device
*dev
)
292 /* The 100C is default for both mobile and non mobile CPUs */
295 int tjmax_ee
= 85000;
299 struct pci_dev
*host_bridge
;
301 /* Early chips have no MSR for TjMax */
303 if (c
->x86_model
== 0xf && c
->x86_mask
< 4)
308 if (c
->x86_model
== 0x1c) {
311 host_bridge
= pci_get_bus_and_slot(0, PCI_DEVFN(0, 0));
313 if (host_bridge
&& host_bridge
->vendor
== PCI_VENDOR_ID_INTEL
314 && (host_bridge
->device
== 0xa000 /* NM10 based nettop */
315 || host_bridge
->device
== 0xa010)) /* NM10 based netbook */
320 pci_dev_put(host_bridge
);
323 if (c
->x86_model
> 0xe && usemsr_ee
) {
327 * Now we can detect the mobile CPU using Intel provided table
328 * http://softwarecommunity.intel.com/Wiki/Mobility/720.htm
329 * For Core2 cores, check MSR 0x17, bit 28 1 = Mobile CPU
331 err
= rdmsr_safe_on_cpu(id
, 0x17, &eax
, &edx
);
334 "Unable to access MSR 0x17, assuming desktop"
337 } else if (c
->x86_model
< 0x17 && !(eax
& 0x10000000)) {
339 * Trust bit 28 up to Penryn, I could not find any
340 * documentation on that; if you happen to know
341 * someone at Intel please ask
345 /* Platform ID bits 52:50 (EDX starts at bit 32) */
346 platform_id
= (edx
>> 18) & 0x7;
349 * Mobile Penryn CPU seems to be platform ID 7 or 5
352 if (c
->x86_model
== 0x17 &&
353 (platform_id
== 5 || platform_id
== 7)) {
355 * If MSR EE bit is set, set it to 90 degrees C,
356 * otherwise 105 degrees C
365 err
= rdmsr_safe_on_cpu(id
, 0xee, &eax
, &edx
);
368 "Unable to access MSR 0xEE, for Tjmax, left"
370 } else if (eax
& 0x40000000) {
373 } else if (tjmax
== 100000) {
375 * If we don't use msr EE it means we are desktop CPU
376 * (with exeception of Atom)
378 dev_warn(dev
, "Using relative temperature scale!\n");
384 static int get_tjmax(struct cpuinfo_x86
*c
, u32 id
, struct device
*dev
)
391 * A new feature of current Intel(R) processors, the
392 * IA32_TEMPERATURE_TARGET contains the TjMax value
394 err
= rdmsr_safe_on_cpu(id
, MSR_IA32_TEMPERATURE_TARGET
, &eax
, &edx
);
396 if (c
->x86_model
> 0xe && c
->x86_model
!= 0x1c)
397 dev_warn(dev
, "Unable to read TjMax from CPU %u\n", id
);
399 val
= (eax
>> 16) & 0xff;
401 * If the TjMax is not plausible, an assumption
405 dev_dbg(dev
, "TjMax is %d degrees C\n", val
);
411 dev_notice(dev
, "TjMax forced to %d degrees C by user\n",
413 return force_tjmax
* 1000;
417 * An assumption is made for early CPUs and unreadable MSR.
418 * NOTE: the calculated value may not be correct.
420 return adjust_tjmax(c
, id
, dev
);
423 static void __devinit
get_ucode_rev_on_cpu(void *edx
)
427 wrmsr(MSR_IA32_UCODE_REV
, 0, 0);
429 rdmsr(MSR_IA32_UCODE_REV
, eax
, *(u32
*)edx
);
432 static int create_name_attr(struct platform_data
*pdata
, struct device
*dev
)
434 sysfs_attr_init(&pdata
->name_attr
.attr
);
435 pdata
->name_attr
.attr
.name
= "name";
436 pdata
->name_attr
.attr
.mode
= S_IRUGO
;
437 pdata
->name_attr
.show
= show_name
;
438 return device_create_file(dev
, &pdata
->name_attr
);
441 static int create_core_attrs(struct temp_data
*tdata
, struct device
*dev
,
445 static ssize_t (*rd_ptr
[TOTAL_ATTRS
]) (struct device
*dev
,
446 struct device_attribute
*devattr
, char *buf
) = {
447 show_label
, show_crit_alarm
, show_temp
, show_tjmax
,
448 show_max_alarm
, show_ttarget
, show_tmin
};
449 static ssize_t (*rw_ptr
[TOTAL_ATTRS
]) (struct device
*dev
,
450 struct device_attribute
*devattr
, const char *buf
,
451 size_t count
) = { NULL
, NULL
, NULL
, NULL
, NULL
,
452 store_ttarget
, store_tmin
};
453 static const char *names
[TOTAL_ATTRS
] = {
454 "temp%d_label", "temp%d_crit_alarm",
455 "temp%d_input", "temp%d_crit",
456 "temp%d_max_alarm", "temp%d_max",
459 for (i
= 0; i
< tdata
->attr_size
; i
++) {
460 snprintf(tdata
->attr_name
[i
], CORETEMP_NAME_LENGTH
, names
[i
],
462 sysfs_attr_init(&tdata
->sd_attrs
[i
].dev_attr
.attr
);
463 tdata
->sd_attrs
[i
].dev_attr
.attr
.name
= tdata
->attr_name
[i
];
464 tdata
->sd_attrs
[i
].dev_attr
.attr
.mode
= S_IRUGO
;
466 tdata
->sd_attrs
[i
].dev_attr
.attr
.mode
|= S_IWUSR
;
467 tdata
->sd_attrs
[i
].dev_attr
.store
= rw_ptr
[i
];
469 tdata
->sd_attrs
[i
].dev_attr
.show
= rd_ptr
[i
];
470 tdata
->sd_attrs
[i
].index
= attr_no
;
471 err
= device_create_file(dev
, &tdata
->sd_attrs
[i
].dev_attr
);
479 device_remove_file(dev
, &tdata
->sd_attrs
[i
].dev_attr
);
484 static int __devinit
chk_ucode_version(struct platform_device
*pdev
)
486 struct cpuinfo_x86
*c
= &cpu_data(pdev
->id
);
491 * Check if we have problem with errata AE18 of Core processors:
492 * Readings might stop update when processor visited too deep sleep,
493 * fixed for stepping D0 (6EC).
495 if (c
->x86_model
== 0xe && c
->x86_mask
< 0xc) {
496 /* check for microcode update */
497 err
= smp_call_function_single(pdev
->id
, get_ucode_rev_on_cpu
,
501 "Cannot determine microcode revision of "
502 "CPU#%u (%d)!\n", pdev
->id
, err
);
504 } else if (edx
< 0x39) {
506 "Errata AE18 not fixed, update BIOS or "
507 "microcode of the CPU!\n");
514 static struct platform_device
*coretemp_get_pdev(unsigned int cpu
)
516 u16 phys_proc_id
= TO_PHYS_ID(cpu
);
517 struct pdev_entry
*p
;
519 mutex_lock(&pdev_list_mutex
);
521 list_for_each_entry(p
, &pdev_list
, list
)
522 if (p
->phys_proc_id
== phys_proc_id
) {
523 mutex_unlock(&pdev_list_mutex
);
527 mutex_unlock(&pdev_list_mutex
);
531 static struct temp_data
*init_temp_data(unsigned int cpu
, int pkg_flag
)
533 struct temp_data
*tdata
;
535 tdata
= kzalloc(sizeof(struct temp_data
), GFP_KERNEL
);
539 tdata
->status_reg
= pkg_flag
? MSR_IA32_PACKAGE_THERM_STATUS
:
540 MSR_IA32_THERM_STATUS
;
541 tdata
->intrpt_reg
= pkg_flag
? MSR_IA32_PACKAGE_THERM_INTERRUPT
:
542 MSR_IA32_THERM_INTERRUPT
;
543 tdata
->is_pkg_data
= pkg_flag
;
545 tdata
->cpu_core_id
= TO_CORE_ID(cpu
);
546 tdata
->attr_size
= MAX_CORE_ATTRS
;
547 mutex_init(&tdata
->update_lock
);
551 static int create_core_data(struct platform_data
*pdata
,
552 struct platform_device
*pdev
,
553 unsigned int cpu
, int pkg_flag
)
555 struct temp_data
*tdata
;
556 struct cpuinfo_x86
*c
= &cpu_data(cpu
);
561 * Find attr number for sysfs:
562 * We map the attr number to core id of the CPU
563 * The attr number is always core id + 2
564 * The Pkgtemp will always show up as temp1_*, if available
566 attr_no
= pkg_flag
? 1 : TO_ATTR_NO(cpu
);
568 if (attr_no
> MAX_CORE_DATA
- 1)
572 * Provide a single set of attributes for all HT siblings of a core
573 * to avoid duplicate sensors (the processor ID and core ID of all
574 * HT siblings of a core are the same).
575 * Skip if a HT sibling of this core is already registered.
576 * This is not an error.
578 if (pdata
->core_data
[attr_no
] != NULL
)
581 tdata
= init_temp_data(cpu
, pkg_flag
);
585 /* Test if we can access the status register */
586 err
= rdmsr_safe_on_cpu(cpu
, tdata
->status_reg
, &eax
, &edx
);
590 /* We can access status register. Get Critical Temperature */
591 tdata
->tjmax
= get_tjmax(c
, cpu
, &pdev
->dev
);
594 * Test if we can access the intrpt register. If so, increase the
595 * 'size' enough to have ttarget/tmin/max_alarm interfaces.
596 * Initialize ttarget with bits 16:22 of MSR_IA32_THERM_INTERRUPT
598 err
= rdmsr_safe_on_cpu(cpu
, tdata
->intrpt_reg
, &eax
, &edx
);
600 tdata
->attr_size
+= MAX_THRESH_ATTRS
;
601 tdata
->tmin
= tdata
->tjmax
-
602 ((eax
& THERM_MASK_THRESHOLD0
) >>
603 THERM_SHIFT_THRESHOLD0
) * 1000;
604 tdata
->ttarget
= tdata
->tjmax
-
605 ((eax
& THERM_MASK_THRESHOLD1
) >>
606 THERM_SHIFT_THRESHOLD1
) * 1000;
609 pdata
->core_data
[attr_no
] = tdata
;
611 /* Create sysfs interfaces */
612 err
= create_core_attrs(tdata
, &pdev
->dev
, attr_no
);
622 static void coretemp_add_core(unsigned int cpu
, int pkg_flag
)
624 struct platform_data
*pdata
;
625 struct platform_device
*pdev
= coretemp_get_pdev(cpu
);
631 pdata
= platform_get_drvdata(pdev
);
633 err
= create_core_data(pdata
, pdev
, cpu
, pkg_flag
);
635 dev_err(&pdev
->dev
, "Adding Core %u failed\n", cpu
);
638 static void coretemp_remove_core(struct platform_data
*pdata
,
639 struct device
*dev
, int indx
)
642 struct temp_data
*tdata
= pdata
->core_data
[indx
];
644 /* Remove the sysfs attributes */
645 for (i
= 0; i
< tdata
->attr_size
; i
++)
646 device_remove_file(dev
, &tdata
->sd_attrs
[i
].dev_attr
);
648 kfree(pdata
->core_data
[indx
]);
649 pdata
->core_data
[indx
] = NULL
;
652 static int __devinit
coretemp_probe(struct platform_device
*pdev
)
654 struct platform_data
*pdata
;
657 /* Check the microcode version of the CPU */
658 err
= chk_ucode_version(pdev
);
662 /* Initialize the per-package data structures */
663 pdata
= kzalloc(sizeof(struct platform_data
), GFP_KERNEL
);
667 err
= create_name_attr(pdata
, &pdev
->dev
);
671 pdata
->phys_proc_id
= TO_PHYS_ID(pdev
->id
);
672 platform_set_drvdata(pdev
, pdata
);
674 pdata
->hwmon_dev
= hwmon_device_register(&pdev
->dev
);
675 if (IS_ERR(pdata
->hwmon_dev
)) {
676 err
= PTR_ERR(pdata
->hwmon_dev
);
677 dev_err(&pdev
->dev
, "Class registration failed (%d)\n", err
);
683 device_remove_file(&pdev
->dev
, &pdata
->name_attr
);
684 platform_set_drvdata(pdev
, NULL
);
690 static int __devexit
coretemp_remove(struct platform_device
*pdev
)
692 struct platform_data
*pdata
= platform_get_drvdata(pdev
);
695 for (i
= MAX_CORE_DATA
- 1; i
>= 0; --i
)
696 if (pdata
->core_data
[i
])
697 coretemp_remove_core(pdata
, &pdev
->dev
, i
);
699 device_remove_file(&pdev
->dev
, &pdata
->name_attr
);
700 hwmon_device_unregister(pdata
->hwmon_dev
);
701 platform_set_drvdata(pdev
, NULL
);
706 static struct platform_driver coretemp_driver
= {
708 .owner
= THIS_MODULE
,
711 .probe
= coretemp_probe
,
712 .remove
= __devexit_p(coretemp_remove
),
715 static int __cpuinit
coretemp_device_add(unsigned int cpu
)
718 struct platform_device
*pdev
;
719 struct pdev_entry
*pdev_entry
;
721 mutex_lock(&pdev_list_mutex
);
723 pdev
= platform_device_alloc(DRVNAME
, cpu
);
726 pr_err("Device allocation failed\n");
730 pdev_entry
= kzalloc(sizeof(struct pdev_entry
), GFP_KERNEL
);
733 goto exit_device_put
;
736 err
= platform_device_add(pdev
);
738 pr_err("Device addition failed (%d)\n", err
);
739 goto exit_device_free
;
742 pdev_entry
->pdev
= pdev
;
743 pdev_entry
->phys_proc_id
= TO_PHYS_ID(cpu
);
745 list_add_tail(&pdev_entry
->list
, &pdev_list
);
746 mutex_unlock(&pdev_list_mutex
);
753 platform_device_put(pdev
);
755 mutex_unlock(&pdev_list_mutex
);
759 static void coretemp_device_remove(unsigned int cpu
)
761 struct pdev_entry
*p
, *n
;
762 u16 phys_proc_id
= TO_PHYS_ID(cpu
);
764 mutex_lock(&pdev_list_mutex
);
765 list_for_each_entry_safe(p
, n
, &pdev_list
, list
) {
766 if (p
->phys_proc_id
!= phys_proc_id
)
768 platform_device_unregister(p
->pdev
);
772 mutex_unlock(&pdev_list_mutex
);
775 static bool is_any_core_online(struct platform_data
*pdata
)
779 /* Find online cores, except pkgtemp data */
780 for (i
= MAX_CORE_DATA
- 1; i
>= 0; --i
) {
781 if (pdata
->core_data
[i
] &&
782 !pdata
->core_data
[i
]->is_pkg_data
) {
789 static void __cpuinit
get_core_online(unsigned int cpu
)
791 struct cpuinfo_x86
*c
= &cpu_data(cpu
);
792 struct platform_device
*pdev
= coretemp_get_pdev(cpu
);
796 * CPUID.06H.EAX[0] indicates whether the CPU has thermal
797 * sensors. We check this bit only, all the early CPUs
798 * without thermal sensors will be filtered out.
800 if (!cpu_has(c
, X86_FEATURE_DTS
))
805 * Alright, we have DTS support.
806 * We are bringing the _first_ core in this pkg
807 * online. So, initialize per-pkg data structures and
808 * then bring this core online.
810 err
= coretemp_device_add(cpu
);
814 * Check whether pkgtemp support is available.
815 * If so, add interfaces for pkgtemp.
817 if (cpu_has(c
, X86_FEATURE_PTS
))
818 coretemp_add_core(cpu
, 1);
821 * Physical CPU device already exists.
822 * So, just add interfaces for this core.
824 coretemp_add_core(cpu
, 0);
827 static void __cpuinit
put_core_offline(unsigned int cpu
)
830 struct platform_data
*pdata
;
831 struct platform_device
*pdev
= coretemp_get_pdev(cpu
);
833 /* If the physical CPU device does not exist, just return */
837 pdata
= platform_get_drvdata(pdev
);
839 indx
= TO_ATTR_NO(cpu
);
841 if (pdata
->core_data
[indx
] && pdata
->core_data
[indx
]->cpu
== cpu
)
842 coretemp_remove_core(pdata
, &pdev
->dev
, indx
);
845 * If a HT sibling of a core is taken offline, but another HT sibling
846 * of the same core is still online, register the alternate sibling.
847 * This ensures that exactly one set of attributes is provided as long
848 * as at least one HT sibling of a core is online.
850 for_each_sibling(i
, cpu
) {
854 * Display temperature sensor data for one HT sibling
855 * per core only, so abort the loop after one such
856 * sibling has been found.
862 * If all cores in this pkg are offline, remove the device.
863 * coretemp_device_remove calls unregister_platform_device,
864 * which in turn calls coretemp_remove. This removes the
865 * pkgtemp entry and does other clean ups.
867 if (!is_any_core_online(pdata
))
868 coretemp_device_remove(cpu
);
871 static int __cpuinit
coretemp_cpu_callback(struct notifier_block
*nfb
,
872 unsigned long action
, void *hcpu
)
874 unsigned int cpu
= (unsigned long) hcpu
;
878 case CPU_DOWN_FAILED
:
879 get_core_online(cpu
);
881 case CPU_DOWN_PREPARE
:
882 put_core_offline(cpu
);
888 static struct notifier_block coretemp_cpu_notifier __refdata
= {
889 .notifier_call
= coretemp_cpu_callback
,
892 static int __init
coretemp_init(void)
894 int i
, err
= -ENODEV
;
896 /* quick check if we run Intel */
897 if (cpu_data(0).x86_vendor
!= X86_VENDOR_INTEL
)
900 err
= platform_driver_register(&coretemp_driver
);
904 for_each_online_cpu(i
)
907 #ifndef CONFIG_HOTPLUG_CPU
908 if (list_empty(&pdev_list
)) {
910 goto exit_driver_unreg
;
914 register_hotcpu_notifier(&coretemp_cpu_notifier
);
917 #ifndef CONFIG_HOTPLUG_CPU
919 platform_driver_unregister(&coretemp_driver
);
925 static void __exit
coretemp_exit(void)
927 struct pdev_entry
*p
, *n
;
929 unregister_hotcpu_notifier(&coretemp_cpu_notifier
);
930 mutex_lock(&pdev_list_mutex
);
931 list_for_each_entry_safe(p
, n
, &pdev_list
, list
) {
932 platform_device_unregister(p
->pdev
);
936 mutex_unlock(&pdev_list_mutex
);
937 platform_driver_unregister(&coretemp_driver
);
940 MODULE_AUTHOR("Rudolf Marek <r.marek@assembler.cz>");
941 MODULE_DESCRIPTION("Intel Core temperature monitor");
942 MODULE_LICENSE("GPL");
944 module_init(coretemp_init
)
945 module_exit(coretemp_exit
)