| // SPDX-License-Identifier: GPL-2.0+ |
| /* |
| * System76 ACPI Driver |
| * |
| * Copyright (C) 2023 System76 |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| |
| #include <linux/acpi.h> |
| #include <linux/hwmon.h> |
| #include <linux/hwmon-sysfs.h> |
| #include <linux/init.h> |
| #include <linux/input.h> |
| #include <linux/kernel.h> |
| #include <linux/leds.h> |
| #include <linux/module.h> |
| #include <linux/pci_ids.h> |
| #include <linux/power_supply.h> |
| #include <linux/sysfs.h> |
| #include <linux/types.h> |
| |
| #include <acpi/battery.h> |
| |
| enum kbled_type { |
| KBLED_NONE, |
| KBLED_WHITE, |
| KBLED_RGB, |
| }; |
| |
| struct system76_data { |
| struct acpi_device *acpi_dev; |
| struct led_classdev ap_led; |
| struct led_classdev kb_led; |
| enum led_brightness kb_brightness; |
| enum led_brightness kb_toggle_brightness; |
| int kb_color; |
| struct device *therm; |
| union acpi_object *nfan; |
| union acpi_object *ntmp; |
| struct input_dev *input; |
| bool has_open_ec; |
| enum kbled_type kbled_type; |
| }; |
| |
| static const struct acpi_device_id device_ids[] = { |
| {"17761776", 0}, |
| {"", 0}, |
| }; |
| MODULE_DEVICE_TABLE(acpi, device_ids); |
| |
| // Array of keyboard LED brightness levels |
| static const enum led_brightness kb_levels[] = { |
| 48, |
| 72, |
| 96, |
| 144, |
| 192, |
| 255 |
| }; |
| |
| // Array of keyboard LED colors in 24-bit RGB format |
| static const int kb_colors[] = { |
| 0xFFFFFF, |
| 0x0000FF, |
| 0xFF0000, |
| 0xFF00FF, |
| 0x00FF00, |
| 0x00FFFF, |
| 0xFFFF00 |
| }; |
| |
| // Get a System76 ACPI device value by name |
| static int system76_get(struct system76_data *data, char *method) |
| { |
| acpi_handle handle; |
| acpi_status status; |
| unsigned long long ret = 0; |
| |
| handle = acpi_device_handle(data->acpi_dev); |
| status = acpi_evaluate_integer(handle, method, NULL, &ret); |
| if (ACPI_SUCCESS(status)) |
| return ret; |
| return -ENODEV; |
| } |
| |
| // Get a System76 ACPI device value by name with index |
| static int system76_get_index(struct system76_data *data, char *method, int index) |
| { |
| union acpi_object obj; |
| struct acpi_object_list obj_list; |
| acpi_handle handle; |
| acpi_status status; |
| unsigned long long ret = 0; |
| |
| obj.type = ACPI_TYPE_INTEGER; |
| obj.integer.value = index; |
| obj_list.count = 1; |
| obj_list.pointer = &obj; |
| |
| handle = acpi_device_handle(data->acpi_dev); |
| status = acpi_evaluate_integer(handle, method, &obj_list, &ret); |
| if (ACPI_SUCCESS(status)) |
| return ret; |
| return -ENODEV; |
| } |
| |
| // Get a System76 ACPI device object by name |
| static int system76_get_object(struct system76_data *data, char *method, union acpi_object **obj) |
| { |
| acpi_handle handle; |
| acpi_status status; |
| struct acpi_buffer buf = { ACPI_ALLOCATE_BUFFER, NULL }; |
| |
| handle = acpi_device_handle(data->acpi_dev); |
| status = acpi_evaluate_object(handle, method, NULL, &buf); |
| if (ACPI_SUCCESS(status)) { |
| *obj = buf.pointer; |
| return 0; |
| } |
| |
| return -ENODEV; |
| } |
| |
| // Get a name from a System76 ACPI device object |
| static char *system76_name(union acpi_object *obj, int index) |
| { |
| if (obj && obj->type == ACPI_TYPE_PACKAGE && index <= obj->package.count) { |
| if (obj->package.elements[index].type == ACPI_TYPE_STRING) |
| return obj->package.elements[index].string.pointer; |
| } |
| |
| return NULL; |
| } |
| |
| // Set a System76 ACPI device value by name |
| static int system76_set(struct system76_data *data, char *method, int value) |
| { |
| union acpi_object obj; |
| struct acpi_object_list obj_list; |
| acpi_handle handle; |
| acpi_status status; |
| |
| obj.type = ACPI_TYPE_INTEGER; |
| obj.integer.value = value; |
| obj_list.count = 1; |
| obj_list.pointer = &obj; |
| handle = acpi_device_handle(data->acpi_dev); |
| status = acpi_evaluate_object(handle, method, &obj_list, NULL); |
| if (ACPI_SUCCESS(status)) |
| return 0; |
| else |
| return -1; |
| } |
| |
| #define BATTERY_THRESHOLD_INVALID 0xFF |
| |
| enum { |
| THRESHOLD_START, |
| THRESHOLD_END, |
| }; |
| |
| static ssize_t battery_get_threshold(int which, char *buf) |
| { |
| struct acpi_object_list input; |
| union acpi_object param; |
| acpi_handle handle; |
| acpi_status status; |
| unsigned long long ret = BATTERY_THRESHOLD_INVALID; |
| |
| handle = ec_get_handle(); |
| if (!handle) |
| return -ENODEV; |
| |
| input.count = 1; |
| input.pointer = ¶m; |
| // Start/stop selection |
| param.type = ACPI_TYPE_INTEGER; |
| param.integer.value = which; |
| |
| status = acpi_evaluate_integer(handle, "GBCT", &input, &ret); |
| if (ACPI_FAILURE(status)) |
| return -EIO; |
| if (ret == BATTERY_THRESHOLD_INVALID) |
| return -EINVAL; |
| |
| return sysfs_emit(buf, "%d\n", (int)ret); |
| } |
| |
| static ssize_t battery_set_threshold(int which, const char *buf, size_t count) |
| { |
| struct acpi_object_list input; |
| union acpi_object params[2]; |
| acpi_handle handle; |
| acpi_status status; |
| unsigned int value; |
| int ret; |
| |
| handle = ec_get_handle(); |
| if (!handle) |
| return -ENODEV; |
| |
| ret = kstrtouint(buf, 10, &value); |
| if (ret) |
| return ret; |
| |
| if (value > 100) |
| return -EINVAL; |
| |
| input.count = 2; |
| input.pointer = params; |
| // Start/stop selection |
| params[0].type = ACPI_TYPE_INTEGER; |
| params[0].integer.value = which; |
| // Threshold value |
| params[1].type = ACPI_TYPE_INTEGER; |
| params[1].integer.value = value; |
| |
| status = acpi_evaluate_object(handle, "SBCT", &input, NULL); |
| if (ACPI_FAILURE(status)) |
| return -EIO; |
| |
| return count; |
| } |
| |
| static ssize_t charge_control_start_threshold_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| return battery_get_threshold(THRESHOLD_START, buf); |
| } |
| |
| static ssize_t charge_control_start_threshold_store(struct device *dev, |
| struct device_attribute *attr, const char *buf, size_t count) |
| { |
| return battery_set_threshold(THRESHOLD_START, buf, count); |
| } |
| |
| static DEVICE_ATTR_RW(charge_control_start_threshold); |
| |
| static ssize_t charge_control_end_threshold_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| return battery_get_threshold(THRESHOLD_END, buf); |
| } |
| |
| static ssize_t charge_control_end_threshold_store(struct device *dev, |
| struct device_attribute *attr, const char *buf, size_t count) |
| { |
| return battery_set_threshold(THRESHOLD_END, buf, count); |
| } |
| |
| static DEVICE_ATTR_RW(charge_control_end_threshold); |
| |
| static struct attribute *system76_battery_attrs[] = { |
| &dev_attr_charge_control_start_threshold.attr, |
| &dev_attr_charge_control_end_threshold.attr, |
| NULL, |
| }; |
| |
| ATTRIBUTE_GROUPS(system76_battery); |
| |
| static int system76_battery_add(struct power_supply *battery, struct acpi_battery_hook *hook) |
| { |
| // System76 EC only supports 1 battery |
| if (strcmp(battery->desc->name, "BAT0") != 0) |
| return -ENODEV; |
| |
| if (device_add_groups(&battery->dev, system76_battery_groups)) |
| return -ENODEV; |
| |
| return 0; |
| } |
| |
| static int system76_battery_remove(struct power_supply *battery, struct acpi_battery_hook *hook) |
| { |
| device_remove_groups(&battery->dev, system76_battery_groups); |
| return 0; |
| } |
| |
| static struct acpi_battery_hook system76_battery_hook = { |
| .add_battery = system76_battery_add, |
| .remove_battery = system76_battery_remove, |
| .name = "System76 Battery Extension", |
| }; |
| |
| static void system76_battery_init(void) |
| { |
| battery_hook_register(&system76_battery_hook); |
| } |
| |
| static void system76_battery_exit(void) |
| { |
| battery_hook_unregister(&system76_battery_hook); |
| } |
| |
| // Get the airplane mode LED brightness |
| static enum led_brightness ap_led_get(struct led_classdev *led) |
| { |
| struct system76_data *data; |
| int value; |
| |
| data = container_of(led, struct system76_data, ap_led); |
| value = system76_get(data, "GAPL"); |
| if (value > 0) |
| return (enum led_brightness)value; |
| else |
| return LED_OFF; |
| } |
| |
| // Set the airplane mode LED brightness |
| static int ap_led_set(struct led_classdev *led, enum led_brightness value) |
| { |
| struct system76_data *data; |
| |
| data = container_of(led, struct system76_data, ap_led); |
| return system76_set(data, "SAPL", value == LED_OFF ? 0 : 1); |
| } |
| |
| // Get the last set keyboard LED brightness |
| static enum led_brightness kb_led_get(struct led_classdev *led) |
| { |
| struct system76_data *data; |
| |
| data = container_of(led, struct system76_data, kb_led); |
| return data->kb_brightness; |
| } |
| |
| // Set the keyboard LED brightness |
| static int kb_led_set(struct led_classdev *led, enum led_brightness value) |
| { |
| struct system76_data *data; |
| |
| data = container_of(led, struct system76_data, kb_led); |
| data->kb_brightness = value; |
| if (acpi_has_method(acpi_device_handle(data->acpi_dev), "GKBK")) { |
| return system76_set(data, "SKBB", (int)data->kb_brightness); |
| } else { |
| return system76_set(data, "SKBL", (int)data->kb_brightness); |
| } |
| } |
| |
| // Get the last set keyboard LED color |
| static ssize_t kb_led_color_show( |
| struct device *dev, |
| struct device_attribute *dev_attr, |
| char *buf) |
| { |
| struct led_classdev *led; |
| struct system76_data *data; |
| |
| led = dev_get_drvdata(dev); |
| data = container_of(led, struct system76_data, kb_led); |
| return sysfs_emit(buf, "%06X\n", data->kb_color); |
| } |
| |
| // Set the keyboard LED color |
| static ssize_t kb_led_color_store( |
| struct device *dev, |
| struct device_attribute *dev_attr, |
| const char *buf, |
| size_t size) |
| { |
| struct led_classdev *led; |
| struct system76_data *data; |
| unsigned int val; |
| int ret; |
| |
| led = dev_get_drvdata(dev); |
| data = container_of(led, struct system76_data, kb_led); |
| ret = kstrtouint(buf, 16, &val); |
| if (ret) |
| return ret; |
| if (val > 0xFFFFFF) |
| return -EINVAL; |
| data->kb_color = (int)val; |
| system76_set(data, "SKBC", data->kb_color); |
| |
| return size; |
| } |
| |
| static struct device_attribute dev_attr_kb_led_color = { |
| .attr = { |
| .name = "color", |
| .mode = 0644, |
| }, |
| .show = kb_led_color_show, |
| .store = kb_led_color_store, |
| }; |
| |
| static struct attribute *system76_kb_led_color_attrs[] = { |
| &dev_attr_kb_led_color.attr, |
| NULL, |
| }; |
| |
| ATTRIBUTE_GROUPS(system76_kb_led_color); |
| |
| // Notify that the keyboard LED was changed by hardware |
| static void kb_led_notify(struct system76_data *data) |
| { |
| led_classdev_notify_brightness_hw_changed( |
| &data->kb_led, |
| data->kb_brightness |
| ); |
| } |
| |
| // Read keyboard LED brightness as set by hardware |
| static void kb_led_hotkey_hardware(struct system76_data *data) |
| { |
| int value; |
| |
| if (acpi_has_method(acpi_device_handle(data->acpi_dev), "GKBK")) { |
| value = system76_get(data, "GKBB"); |
| } else { |
| value = system76_get(data, "GKBL"); |
| } |
| |
| if (value < 0) |
| return; |
| data->kb_brightness = value; |
| kb_led_notify(data); |
| } |
| |
| // Toggle the keyboard LED |
| static void kb_led_hotkey_toggle(struct system76_data *data) |
| { |
| if (data->kb_brightness > 0) { |
| data->kb_toggle_brightness = data->kb_brightness; |
| kb_led_set(&data->kb_led, 0); |
| } else { |
| kb_led_set(&data->kb_led, data->kb_toggle_brightness); |
| } |
| kb_led_notify(data); |
| } |
| |
| // Decrease the keyboard LED brightness |
| static void kb_led_hotkey_down(struct system76_data *data) |
| { |
| int i; |
| |
| if (data->kb_brightness > 0) { |
| for (i = ARRAY_SIZE(kb_levels); i > 0; i--) { |
| if (kb_levels[i - 1] < data->kb_brightness) { |
| kb_led_set(&data->kb_led, kb_levels[i - 1]); |
| break; |
| } |
| } |
| } else { |
| kb_led_set(&data->kb_led, data->kb_toggle_brightness); |
| } |
| kb_led_notify(data); |
| } |
| |
| // Increase the keyboard LED brightness |
| static void kb_led_hotkey_up(struct system76_data *data) |
| { |
| int i; |
| |
| if (data->kb_brightness > 0) { |
| for (i = 0; i < ARRAY_SIZE(kb_levels); i++) { |
| if (kb_levels[i] > data->kb_brightness) { |
| kb_led_set(&data->kb_led, kb_levels[i]); |
| break; |
| } |
| } |
| } else { |
| kb_led_set(&data->kb_led, data->kb_toggle_brightness); |
| } |
| kb_led_notify(data); |
| } |
| |
| // Cycle the keyboard LED color |
| static void kb_led_hotkey_color(struct system76_data *data) |
| { |
| int i; |
| |
| if (data->kbled_type != KBLED_RGB) |
| return; |
| |
| if (data->kb_brightness > 0) { |
| for (i = 0; i < ARRAY_SIZE(kb_colors); i++) { |
| if (kb_colors[i] == data->kb_color) |
| break; |
| } |
| i += 1; |
| if (i >= ARRAY_SIZE(kb_colors)) |
| i = 0; |
| data->kb_color = kb_colors[i]; |
| system76_set(data, "SKBC", data->kb_color); |
| } else { |
| kb_led_set(&data->kb_led, data->kb_toggle_brightness); |
| } |
| kb_led_notify(data); |
| } |
| |
| static umode_t thermal_is_visible(const void *drvdata, enum hwmon_sensor_types type, |
| u32 attr, int channel) |
| { |
| const struct system76_data *data = drvdata; |
| |
| switch (type) { |
| case hwmon_fan: |
| case hwmon_pwm: |
| if (system76_name(data->nfan, channel)) |
| return 0444; |
| break; |
| |
| case hwmon_temp: |
| if (system76_name(data->ntmp, channel)) |
| return 0444; |
| break; |
| |
| default: |
| return 0; |
| } |
| |
| return 0; |
| } |
| |
| static int thermal_read(struct device *dev, enum hwmon_sensor_types type, u32 attr, |
| int channel, long *val) |
| { |
| struct system76_data *data = dev_get_drvdata(dev); |
| int raw; |
| |
| switch (type) { |
| case hwmon_fan: |
| if (attr == hwmon_fan_input) { |
| raw = system76_get_index(data, "GFAN", channel); |
| if (raw < 0) |
| return raw; |
| *val = (raw >> 8) & 0xFFFF; |
| return 0; |
| } |
| break; |
| |
| case hwmon_pwm: |
| if (attr == hwmon_pwm_input) { |
| raw = system76_get_index(data, "GFAN", channel); |
| if (raw < 0) |
| return raw; |
| *val = raw & 0xFF; |
| return 0; |
| } |
| break; |
| |
| case hwmon_temp: |
| if (attr == hwmon_temp_input) { |
| raw = system76_get_index(data, "GTMP", channel); |
| if (raw < 0) |
| return raw; |
| *val = raw * 1000; |
| return 0; |
| } |
| break; |
| |
| default: |
| return -EOPNOTSUPP; |
| } |
| |
| return -EOPNOTSUPP; |
| } |
| |
| static int thermal_read_string(struct device *dev, enum hwmon_sensor_types type, u32 attr, |
| int channel, const char **str) |
| { |
| struct system76_data *data = dev_get_drvdata(dev); |
| |
| switch (type) { |
| case hwmon_fan: |
| if (attr == hwmon_fan_label) { |
| *str = system76_name(data->nfan, channel); |
| if (*str) |
| return 0; |
| } |
| break; |
| |
| case hwmon_temp: |
| if (attr == hwmon_temp_label) { |
| *str = system76_name(data->ntmp, channel); |
| if (*str) |
| return 0; |
| } |
| break; |
| |
| default: |
| return -EOPNOTSUPP; |
| } |
| |
| return -EOPNOTSUPP; |
| } |
| |
| static const struct hwmon_ops thermal_ops = { |
| .is_visible = thermal_is_visible, |
| .read = thermal_read, |
| .read_string = thermal_read_string, |
| }; |
| |
| // Allocate up to 8 fans and temperatures |
| static const struct hwmon_channel_info * const thermal_channel_info[] = { |
| HWMON_CHANNEL_INFO(fan, |
| HWMON_F_INPUT | HWMON_F_LABEL, |
| HWMON_F_INPUT | HWMON_F_LABEL, |
| HWMON_F_INPUT | HWMON_F_LABEL, |
| HWMON_F_INPUT | HWMON_F_LABEL, |
| HWMON_F_INPUT | HWMON_F_LABEL, |
| HWMON_F_INPUT | HWMON_F_LABEL, |
| HWMON_F_INPUT | HWMON_F_LABEL, |
| HWMON_F_INPUT | HWMON_F_LABEL), |
| HWMON_CHANNEL_INFO(pwm, |
| HWMON_PWM_INPUT, |
| HWMON_PWM_INPUT, |
| HWMON_PWM_INPUT, |
| HWMON_PWM_INPUT, |
| HWMON_PWM_INPUT, |
| HWMON_PWM_INPUT, |
| HWMON_PWM_INPUT, |
| HWMON_PWM_INPUT), |
| HWMON_CHANNEL_INFO(temp, |
| HWMON_T_INPUT | HWMON_T_LABEL, |
| HWMON_T_INPUT | HWMON_T_LABEL, |
| HWMON_T_INPUT | HWMON_T_LABEL, |
| HWMON_T_INPUT | HWMON_T_LABEL, |
| HWMON_T_INPUT | HWMON_T_LABEL, |
| HWMON_T_INPUT | HWMON_T_LABEL, |
| HWMON_T_INPUT | HWMON_T_LABEL, |
| HWMON_T_INPUT | HWMON_T_LABEL), |
| NULL |
| }; |
| |
| static const struct hwmon_chip_info thermal_chip_info = { |
| .ops = &thermal_ops, |
| .info = thermal_channel_info, |
| }; |
| |
| static void input_key(struct system76_data *data, unsigned int code) |
| { |
| input_report_key(data->input, code, 1); |
| input_sync(data->input); |
| |
| input_report_key(data->input, code, 0); |
| input_sync(data->input); |
| } |
| |
| // Handle ACPI notification |
| static void system76_notify(struct acpi_device *acpi_dev, u32 event) |
| { |
| struct system76_data *data; |
| |
| data = acpi_driver_data(acpi_dev); |
| switch (event) { |
| case 0x80: |
| kb_led_hotkey_hardware(data); |
| break; |
| case 0x81: |
| kb_led_hotkey_toggle(data); |
| break; |
| case 0x82: |
| kb_led_hotkey_down(data); |
| break; |
| case 0x83: |
| kb_led_hotkey_up(data); |
| break; |
| case 0x84: |
| kb_led_hotkey_color(data); |
| break; |
| case 0x85: |
| input_key(data, KEY_SCREENLOCK); |
| break; |
| } |
| } |
| |
| // Add a System76 ACPI device |
| static int system76_add(struct acpi_device *acpi_dev) |
| { |
| struct system76_data *data; |
| int err; |
| |
| data = devm_kzalloc(&acpi_dev->dev, sizeof(*data), GFP_KERNEL); |
| if (!data) |
| return -ENOMEM; |
| acpi_dev->driver_data = data; |
| data->acpi_dev = acpi_dev; |
| |
| // Some models do not run open EC firmware. Check for an ACPI method |
| // that only exists on open EC to guard functionality specific to it. |
| data->has_open_ec = acpi_has_method(acpi_device_handle(data->acpi_dev), "NFAN"); |
| |
| err = system76_get(data, "INIT"); |
| if (err) |
| return err; |
| data->ap_led.name = "system76_acpi::airplane"; |
| data->ap_led.flags = LED_CORE_SUSPENDRESUME; |
| data->ap_led.brightness_get = ap_led_get; |
| data->ap_led.brightness_set_blocking = ap_led_set; |
| data->ap_led.max_brightness = 1; |
| data->ap_led.default_trigger = "rfkill-none"; |
| err = devm_led_classdev_register(&acpi_dev->dev, &data->ap_led); |
| if (err) |
| return err; |
| |
| data->kb_led.name = "system76_acpi::kbd_backlight"; |
| data->kb_led.flags = LED_BRIGHT_HW_CHANGED | LED_CORE_SUSPENDRESUME; |
| data->kb_led.brightness_get = kb_led_get; |
| data->kb_led.brightness_set_blocking = kb_led_set; |
| if (acpi_has_method(acpi_device_handle(data->acpi_dev), "GKBK")) { |
| // Use the new ACPI methods |
| data->kbled_type = system76_get(data, "GKBK"); |
| |
| switch (data->kbled_type) { |
| case KBLED_NONE: |
| // Nothing to do: Device will not be registered. |
| break; |
| case KBLED_WHITE: |
| data->kb_led.max_brightness = 255; |
| data->kb_toggle_brightness = 72; |
| break; |
| case KBLED_RGB: |
| data->kb_led.max_brightness = 255; |
| data->kb_led.groups = system76_kb_led_color_groups; |
| data->kb_toggle_brightness = 72; |
| data->kb_color = 0xffffff; |
| system76_set(data, "SKBC", data->kb_color); |
| break; |
| } |
| } else { |
| // Use the old ACPI methods |
| if (acpi_has_method(acpi_device_handle(data->acpi_dev), "SKBC")) { |
| data->kbled_type = KBLED_RGB; |
| data->kb_led.max_brightness = 255; |
| data->kb_led.groups = system76_kb_led_color_groups; |
| data->kb_toggle_brightness = 72; |
| data->kb_color = 0xffffff; |
| system76_set(data, "SKBC", data->kb_color); |
| } else { |
| data->kbled_type = KBLED_WHITE; |
| data->kb_led.max_brightness = 5; |
| } |
| } |
| |
| if (data->kbled_type != KBLED_NONE) { |
| err = devm_led_classdev_register(&acpi_dev->dev, &data->kb_led); |
| if (err) |
| return err; |
| } |
| |
| data->input = devm_input_allocate_device(&acpi_dev->dev); |
| if (!data->input) |
| return -ENOMEM; |
| |
| data->input->name = "System76 ACPI Hotkeys"; |
| data->input->phys = "system76_acpi/input0"; |
| data->input->id.bustype = BUS_HOST; |
| data->input->dev.parent = &acpi_dev->dev; |
| input_set_capability(data->input, EV_KEY, KEY_SCREENLOCK); |
| |
| err = input_register_device(data->input); |
| if (err) |
| goto error; |
| |
| if (data->has_open_ec) { |
| err = system76_get_object(data, "NFAN", &data->nfan); |
| if (err) |
| goto error; |
| |
| err = system76_get_object(data, "NTMP", &data->ntmp); |
| if (err) |
| goto error; |
| |
| data->therm = devm_hwmon_device_register_with_info(&acpi_dev->dev, |
| "system76_acpi", data, &thermal_chip_info, NULL); |
| err = PTR_ERR_OR_ZERO(data->therm); |
| if (err) |
| goto error; |
| |
| system76_battery_init(); |
| } |
| |
| return 0; |
| |
| error: |
| if (data->has_open_ec) { |
| kfree(data->ntmp); |
| kfree(data->nfan); |
| } |
| return err; |
| } |
| |
| // Remove a System76 ACPI device |
| static void system76_remove(struct acpi_device *acpi_dev) |
| { |
| struct system76_data *data; |
| |
| data = acpi_driver_data(acpi_dev); |
| |
| if (data->has_open_ec) { |
| system76_battery_exit(); |
| kfree(data->nfan); |
| kfree(data->ntmp); |
| } |
| |
| devm_led_classdev_unregister(&acpi_dev->dev, &data->ap_led); |
| devm_led_classdev_unregister(&acpi_dev->dev, &data->kb_led); |
| |
| system76_get(data, "FINI"); |
| } |
| |
| static struct acpi_driver system76_driver = { |
| .name = "System76 ACPI Driver", |
| .class = "hotkey", |
| .ids = device_ids, |
| .ops = { |
| .add = system76_add, |
| .remove = system76_remove, |
| .notify = system76_notify, |
| }, |
| }; |
| module_acpi_driver(system76_driver); |
| |
| MODULE_DESCRIPTION("System76 ACPI Driver"); |
| MODULE_AUTHOR("Jeremy Soller <jeremy@system76.com>"); |
| MODULE_LICENSE("GPL"); |