forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
215 lines
5.3 KiB
215 lines
5.3 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
#include <linux/err.h> |
|
#include <linux/module.h> |
|
#include <linux/reboot.h> |
|
#include <linux/jiffies.h> |
|
#include <linux/hwmon.h> |
|
#include <linux/hwmon-sysfs.h> |
|
|
|
#include <loongson.h> |
|
#include <boot_param.h> |
|
#include <loongson_hwmon.h> |
|
#include <loongson_regs.h> |
|
|
|
static int csr_temp_enable; |
|
|
|
/* |
|
* Loongson-3 series cpu has two sensors inside, |
|
* each of them from 0 to 255, |
|
* if more than 127, that is dangerous. |
|
* here only provide sensor1 data, because it always hot than sensor0 |
|
*/ |
|
int loongson3_cpu_temp(int cpu) |
|
{ |
|
u32 reg, prid_rev; |
|
|
|
if (csr_temp_enable) { |
|
reg = (csr_readl(LOONGSON_CSR_CPUTEMP) & 0xff); |
|
goto out; |
|
} |
|
|
|
reg = LOONGSON_CHIPTEMP(cpu); |
|
prid_rev = read_c0_prid() & PRID_REV_MASK; |
|
|
|
switch (prid_rev) { |
|
case PRID_REV_LOONGSON3A_R1: |
|
reg = (reg >> 8) & 0xff; |
|
break; |
|
case PRID_REV_LOONGSON3B_R1: |
|
case PRID_REV_LOONGSON3B_R2: |
|
case PRID_REV_LOONGSON3A_R2_0: |
|
case PRID_REV_LOONGSON3A_R2_1: |
|
reg = ((reg >> 8) & 0xff) - 100; |
|
break; |
|
case PRID_REV_LOONGSON3A_R3_0: |
|
case PRID_REV_LOONGSON3A_R3_1: |
|
default: |
|
reg = (reg & 0xffff) * 731 / 0x4000 - 273; |
|
break; |
|
} |
|
|
|
out: |
|
return (int)reg * 1000; |
|
} |
|
|
|
static int nr_packages; |
|
static struct device *cpu_hwmon_dev; |
|
|
|
static SENSOR_DEVICE_ATTR(name, 0444, NULL, NULL, 0); |
|
|
|
static struct attribute *cpu_hwmon_attributes[] = { |
|
&sensor_dev_attr_name.dev_attr.attr, |
|
NULL |
|
}; |
|
|
|
/* Hwmon device attribute group */ |
|
static struct attribute_group cpu_hwmon_attribute_group = { |
|
.attrs = cpu_hwmon_attributes, |
|
}; |
|
|
|
static ssize_t get_cpu_temp(struct device *dev, |
|
struct device_attribute *attr, char *buf); |
|
static ssize_t cpu_temp_label(struct device *dev, |
|
struct device_attribute *attr, char *buf); |
|
|
|
static SENSOR_DEVICE_ATTR(temp1_input, 0444, get_cpu_temp, NULL, 1); |
|
static SENSOR_DEVICE_ATTR(temp1_label, 0444, cpu_temp_label, NULL, 1); |
|
static SENSOR_DEVICE_ATTR(temp2_input, 0444, get_cpu_temp, NULL, 2); |
|
static SENSOR_DEVICE_ATTR(temp2_label, 0444, cpu_temp_label, NULL, 2); |
|
static SENSOR_DEVICE_ATTR(temp3_input, 0444, get_cpu_temp, NULL, 3); |
|
static SENSOR_DEVICE_ATTR(temp3_label, 0444, cpu_temp_label, NULL, 3); |
|
static SENSOR_DEVICE_ATTR(temp4_input, 0444, get_cpu_temp, NULL, 4); |
|
static SENSOR_DEVICE_ATTR(temp4_label, 0444, cpu_temp_label, NULL, 4); |
|
|
|
static const struct attribute *hwmon_cputemp[4][3] = { |
|
{ |
|
&sensor_dev_attr_temp1_input.dev_attr.attr, |
|
&sensor_dev_attr_temp1_label.dev_attr.attr, |
|
NULL |
|
}, |
|
{ |
|
&sensor_dev_attr_temp2_input.dev_attr.attr, |
|
&sensor_dev_attr_temp2_label.dev_attr.attr, |
|
NULL |
|
}, |
|
{ |
|
&sensor_dev_attr_temp3_input.dev_attr.attr, |
|
&sensor_dev_attr_temp3_label.dev_attr.attr, |
|
NULL |
|
}, |
|
{ |
|
&sensor_dev_attr_temp4_input.dev_attr.attr, |
|
&sensor_dev_attr_temp4_label.dev_attr.attr, |
|
NULL |
|
} |
|
}; |
|
|
|
static ssize_t cpu_temp_label(struct device *dev, |
|
struct device_attribute *attr, char *buf) |
|
{ |
|
int id = (to_sensor_dev_attr(attr))->index - 1; |
|
|
|
return sprintf(buf, "CPU %d Temperature\n", id); |
|
} |
|
|
|
static ssize_t get_cpu_temp(struct device *dev, |
|
struct device_attribute *attr, char *buf) |
|
{ |
|
int id = (to_sensor_dev_attr(attr))->index - 1; |
|
int value = loongson3_cpu_temp(id); |
|
|
|
return sprintf(buf, "%d\n", value); |
|
} |
|
|
|
static int create_sysfs_cputemp_files(struct kobject *kobj) |
|
{ |
|
int i, ret = 0; |
|
|
|
for (i = 0; i < nr_packages; i++) |
|
ret = sysfs_create_files(kobj, hwmon_cputemp[i]); |
|
|
|
return ret; |
|
} |
|
|
|
static void remove_sysfs_cputemp_files(struct kobject *kobj) |
|
{ |
|
int i; |
|
|
|
for (i = 0; i < nr_packages; i++) |
|
sysfs_remove_files(kobj, hwmon_cputemp[i]); |
|
} |
|
|
|
#define CPU_THERMAL_THRESHOLD 90000 |
|
static struct delayed_work thermal_work; |
|
|
|
static void do_thermal_timer(struct work_struct *work) |
|
{ |
|
int i, value; |
|
|
|
for (i = 0; i < nr_packages; i++) { |
|
value = loongson3_cpu_temp(i); |
|
if (value > CPU_THERMAL_THRESHOLD) { |
|
pr_emerg("Power off due to high temp: %d\n", value); |
|
orderly_poweroff(true); |
|
} |
|
} |
|
|
|
schedule_delayed_work(&thermal_work, msecs_to_jiffies(5000)); |
|
} |
|
|
|
static int __init loongson_hwmon_init(void) |
|
{ |
|
int ret; |
|
|
|
pr_info("Loongson Hwmon Enter...\n"); |
|
|
|
if (cpu_has_csr()) |
|
csr_temp_enable = csr_readl(LOONGSON_CSR_FEATURES) & |
|
LOONGSON_CSRF_TEMP; |
|
|
|
cpu_hwmon_dev = hwmon_device_register_with_info(NULL, "cpu_hwmon", NULL, NULL, NULL); |
|
if (IS_ERR(cpu_hwmon_dev)) { |
|
ret = PTR_ERR(cpu_hwmon_dev); |
|
pr_err("hwmon_device_register fail!\n"); |
|
goto fail_hwmon_device_register; |
|
} |
|
|
|
nr_packages = loongson_sysconf.nr_cpus / |
|
loongson_sysconf.cores_per_package; |
|
|
|
ret = create_sysfs_cputemp_files(&cpu_hwmon_dev->kobj); |
|
if (ret) { |
|
pr_err("fail to create cpu temperature interface!\n"); |
|
goto fail_create_sysfs_cputemp_files; |
|
} |
|
|
|
INIT_DEFERRABLE_WORK(&thermal_work, do_thermal_timer); |
|
schedule_delayed_work(&thermal_work, msecs_to_jiffies(20000)); |
|
|
|
return ret; |
|
|
|
fail_create_sysfs_cputemp_files: |
|
sysfs_remove_group(&cpu_hwmon_dev->kobj, |
|
&cpu_hwmon_attribute_group); |
|
hwmon_device_unregister(cpu_hwmon_dev); |
|
|
|
fail_hwmon_device_register: |
|
return ret; |
|
} |
|
|
|
static void __exit loongson_hwmon_exit(void) |
|
{ |
|
cancel_delayed_work_sync(&thermal_work); |
|
remove_sysfs_cputemp_files(&cpu_hwmon_dev->kobj); |
|
sysfs_remove_group(&cpu_hwmon_dev->kobj, |
|
&cpu_hwmon_attribute_group); |
|
hwmon_device_unregister(cpu_hwmon_dev); |
|
} |
|
|
|
module_init(loongson_hwmon_init); |
|
module_exit(loongson_hwmon_exit); |
|
|
|
MODULE_AUTHOR("Yu Xiang <[email protected]>"); |
|
MODULE_AUTHOR("Huacai Chen <[email protected]>"); |
|
MODULE_DESCRIPTION("Loongson CPU Hwmon driver"); |
|
MODULE_LICENSE("GPL");
|
|
|