system76-dkms/src/hwmon.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * fan.c
 *
 * Copyright (C) 2017 Jeremy Soller <jeremy@system76.com>
 * Copyright (C) 2014-2016 Arnoud Willemsen <mail@lynthium.com>
 * Copyright (C) 2013-2015 TUXEDO Computers GmbH <tux@tuxedocomputers.com>
 */

#define EXPERIMENTAL

#if S76_HAS_HWMON

struct s76_hwmon {
	struct device *dev;
};

static struct s76_hwmon *s76_hwmon;

static int s76_read_fan(int idx)
{
	u8 value;
	int raw_rpm;

	ec_read(0xd0 + 0x2 * idx, &value);
	raw_rpm = value << 8;
	ec_read(0xd1 + 0x2 * idx, &value);
	raw_rpm += value;
	if (!raw_rpm)
		return 0;
	return 2156220 / raw_rpm;
}

static int s76_read_pwm(int idx)
{
	u8 value;

	ec_read(0xce + idx, &value);
	return value;
}

static int s76_write_pwm(int idx, u8 duty)
{
	u8 values[] = {idx + 1, duty};

	return ec_transaction(0x99, values, sizeof(values), NULL, 0);
}

static int s76_write_pwm_auto(int idx)
{
	u8 values[] = {0xff, idx + 1};

	return ec_transaction(0x99, values, sizeof(values), NULL, 0);
}

static ssize_t s76_hwmon_show_fan_input(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	int index = to_sensor_dev_attr(attr)->index;

	return sysfs_emit(buf, "%i\n", s76_read_fan(index));
}

static ssize_t s76_hwmon_show_fan_label(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	switch (to_sensor_dev_attr(attr)->index) {
	case 0:
		return sysfs_emit(buf, "CPU fan\n");
	case 1:
		return sysfs_emit(buf, "GPU fan\n");
	}
	return 0;
}

static int pwm_enabled[] = {2, 2};

static ssize_t s76_hwmon_show_pwm(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	int index = to_sensor_dev_attr(attr)->index;

	return sysfs_emit(buf, "%i\n", s76_read_pwm(index));
}

static ssize_t s76_hwmon_set_pwm(struct device *dev,
		struct device_attribute *attr, const char *buf, size_t count)
{
	u32 value;
	int err;
	int index = to_sensor_dev_attr(attr)->index;

	err = kstrtou32(buf, 10, &value);
	if (err)
		return err;
	if (value > 255)
		return -EINVAL;
	err = s76_write_pwm(index, value);
	if (err)
		return err;
	pwm_enabled[index] = 1;
	return count;
}

static ssize_t s76_hwmon_show_pwm_enable(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	int index = to_sensor_dev_attr(attr)->index;

	return sysfs_emit(buf, "%i\n", pwm_enabled[index]);
}

static ssize_t s76_hwmon_set_pwm_enable(struct device *dev,
		struct device_attribute *attr, const char *buf, size_t count)
{
	u32 value;
	int err;
	int index = to_sensor_dev_attr(attr)->index;

	err = kstrtou32(buf, 10, &value);
	if (err)
		return err;
	if (value == 0) {
		err = s76_write_pwm(index, 255);
		if (err)
			return err;
		pwm_enabled[index] = value;
		return count;
	}
	if (value == 1) {
		err = s76_write_pwm(index, 0);
		if (err)
			return err;
		pwm_enabled[index] = value;
		return count;
	}
	if (value == 2) {
		err = s76_write_pwm_auto(index);
		if (err)
			return err;
		pwm_enabled[index] = value;
		return count;
	}
	return -EINVAL;
}

static ssize_t s76_hwmon_show_temp1_input(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	u8 value;

	ec_read(0x07, &value);
	return sysfs_emit(buf, "%i\n", value * 1000);
}

static ssize_t s76_hwmon_show_temp1_label(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	return sysfs_emit(buf, "CPU temperature\n");
}

#ifdef EXPERIMENTAL
static ssize_t s76_hwmon_show_temp2_input(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	u8 value;

	ec_read(0xcd, &value);
	return sysfs_emit(buf, "%i\n", value * 1000);
}

static ssize_t s76_hwmon_show_temp2_label(struct device *dev,
		struct device_attribute *attr, char *buf)
{
	return sysfs_emit(buf, "GPU temperature\n");
}
#endif

static SENSOR_DEVICE_ATTR(fan1_input, 0444, s76_hwmon_show_fan_input, NULL, 0);
static SENSOR_DEVICE_ATTR(fan1_label, 0444, s76_hwmon_show_fan_label, NULL, 0);
static SENSOR_DEVICE_ATTR(pwm1, 0644, s76_hwmon_show_pwm, s76_hwmon_set_pwm, 0);
static SENSOR_DEVICE_ATTR(pwm1_enable, 0644, s76_hwmon_show_pwm_enable, s76_hwmon_set_pwm_enable, 0);
#ifdef EXPERIMENTAL
static SENSOR_DEVICE_ATTR(fan2_input, 0444, s76_hwmon_show_fan_input, NULL, 1);
static SENSOR_DEVICE_ATTR(fan2_label, 0444, s76_hwmon_show_fan_label, NULL, 1);
static SENSOR_DEVICE_ATTR(pwm2, 0644, s76_hwmon_show_pwm, s76_hwmon_set_pwm, 1);
static SENSOR_DEVICE_ATTR(pwm2_enable, 0644, s76_hwmon_show_pwm_enable, s76_hwmon_set_pwm_enable, 1);
#endif
static SENSOR_DEVICE_ATTR(temp1_input, 0444, s76_hwmon_show_temp1_input, NULL, 0);
static SENSOR_DEVICE_ATTR(temp1_label, 0444, s76_hwmon_show_temp1_label, NULL, 0);
#ifdef EXPERIMENTAL
static SENSOR_DEVICE_ATTR(temp2_input, 0444, s76_hwmon_show_temp2_input, NULL, 1);
static SENSOR_DEVICE_ATTR(temp2_label, 0444, s76_hwmon_show_temp2_label, NULL, 1);
#endif

static struct attribute *hwmon_default_attributes[] = {
	&sensor_dev_attr_fan1_input.dev_attr.attr,
	&sensor_dev_attr_fan1_label.dev_attr.attr,
	&sensor_dev_attr_pwm1.dev_attr.attr,
	&sensor_dev_attr_pwm1_enable.dev_attr.attr,
#ifdef EXPERIMENTAL
	&sensor_dev_attr_fan2_input.dev_attr.attr,
	&sensor_dev_attr_fan2_label.dev_attr.attr,
	&sensor_dev_attr_pwm2.dev_attr.attr,
	&sensor_dev_attr_pwm2_enable.dev_attr.attr,
#endif
	&sensor_dev_attr_temp1_input.dev_attr.attr,
	&sensor_dev_attr_temp1_label.dev_attr.attr,
#ifdef EXPERIMENTAL
	&sensor_dev_attr_temp2_input.dev_attr.attr,
	&sensor_dev_attr_temp2_label.dev_attr.attr,
#endif
	NULL
};

static const struct attribute_group hwmon_default_group = {
	.attrs = hwmon_default_attributes,
};
__ATTRIBUTE_GROUPS(hwmon_default);

static int s76_hwmon_reboot_callback(struct notifier_block *nb,
		unsigned long action, void *data)
{
	s76_write_pwm_auto(0);
	#ifdef EXPERIMENTAL
		s76_write_pwm_auto(1);
	#endif
	return NOTIFY_DONE;
}

static struct notifier_block s76_hwmon_reboot_notifier = {
	.notifier_call = s76_hwmon_reboot_callback
};

static int s76_hwmon_init(struct device *dev)
{
	s76_hwmon = devm_kzalloc(dev, sizeof(*s76_hwmon), GFP_KERNEL);
	if (!s76_hwmon)
		return -ENOMEM;

	s76_hwmon->dev = devm_hwmon_device_register_with_groups(dev, S76_DRIVER_NAME, NULL, hwmon_default_groups);
	if (IS_ERR(s76_hwmon->dev)) {
		return PTR_ERR(s76_hwmon->dev);
	}

	(void)devm_register_reboot_notifier(dev, &s76_hwmon_reboot_notifier);
	s76_write_pwm_auto(0);
	#ifdef EXPERIMENTAL
	s76_write_pwm_auto(1);
	#endif
	return 0;
}

static int s76_hwmon_fini(struct device *dev)
{
	if (!s76_hwmon || IS_ERR_OR_NULL(s76_hwmon->dev))
		return 0;

	s76_write_pwm_auto(0);
	#ifdef EXPERIMENTAL
	s76_write_pwm_auto(1);
	#endif
	return 0;
}

#endif // S76_HAS_HWMON