mirror of https://github.com/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.
267 lines
5.7 KiB
267 lines
5.7 KiB
// SPDX-License-Identifier: GPL-2.0-or-later |
|
/* |
|
* Toshiba HDD Active Protection Sensor (HAPS) driver |
|
* |
|
* Copyright (C) 2014 Azael Avalos <[email protected]> |
|
*/ |
|
|
|
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
|
|
|
#include <linux/kernel.h> |
|
#include <linux/module.h> |
|
#include <linux/init.h> |
|
#include <linux/types.h> |
|
#include <linux/acpi.h> |
|
|
|
MODULE_AUTHOR("Azael Avalos <[email protected]>"); |
|
MODULE_DESCRIPTION("Toshiba HDD Active Protection Sensor"); |
|
MODULE_LICENSE("GPL"); |
|
|
|
struct toshiba_haps_dev { |
|
struct acpi_device *acpi_dev; |
|
|
|
int protection_level; |
|
}; |
|
|
|
static struct toshiba_haps_dev *toshiba_haps; |
|
|
|
/* HAPS functions */ |
|
static int toshiba_haps_reset_protection(acpi_handle handle) |
|
{ |
|
acpi_status status; |
|
|
|
status = acpi_evaluate_object(handle, "RSSS", NULL, NULL); |
|
if (ACPI_FAILURE(status)) { |
|
pr_err("Unable to reset the HDD protection\n"); |
|
return -EIO; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static int toshiba_haps_protection_level(acpi_handle handle, int level) |
|
{ |
|
acpi_status status; |
|
|
|
status = acpi_execute_simple_method(handle, "PTLV", level); |
|
if (ACPI_FAILURE(status)) { |
|
pr_err("Error while setting the protection level\n"); |
|
return -EIO; |
|
} |
|
|
|
pr_debug("HDD protection level set to: %d\n", level); |
|
|
|
return 0; |
|
} |
|
|
|
/* sysfs files */ |
|
static ssize_t protection_level_show(struct device *dev, |
|
struct device_attribute *attr, char *buf) |
|
{ |
|
struct toshiba_haps_dev *haps = dev_get_drvdata(dev); |
|
|
|
return sprintf(buf, "%i\n", haps->protection_level); |
|
} |
|
|
|
static ssize_t protection_level_store(struct device *dev, |
|
struct device_attribute *attr, |
|
const char *buf, size_t count) |
|
{ |
|
struct toshiba_haps_dev *haps = dev_get_drvdata(dev); |
|
int level; |
|
int ret; |
|
|
|
ret = kstrtoint(buf, 0, &level); |
|
if (ret) |
|
return ret; |
|
/* |
|
* Check for supported levels, which can be: |
|
* 0 - Disabled | 1 - Low | 2 - Medium | 3 - High |
|
*/ |
|
if (level < 0 || level > 3) |
|
return -EINVAL; |
|
|
|
/* Set the sensor level */ |
|
ret = toshiba_haps_protection_level(haps->acpi_dev->handle, level); |
|
if (ret != 0) |
|
return ret; |
|
|
|
haps->protection_level = level; |
|
|
|
return count; |
|
} |
|
static DEVICE_ATTR_RW(protection_level); |
|
|
|
static ssize_t reset_protection_store(struct device *dev, |
|
struct device_attribute *attr, |
|
const char *buf, size_t count) |
|
{ |
|
struct toshiba_haps_dev *haps = dev_get_drvdata(dev); |
|
int reset; |
|
int ret; |
|
|
|
ret = kstrtoint(buf, 0, &reset); |
|
if (ret) |
|
return ret; |
|
/* The only accepted value is 1 */ |
|
if (reset != 1) |
|
return -EINVAL; |
|
|
|
/* Reset the protection interface */ |
|
ret = toshiba_haps_reset_protection(haps->acpi_dev->handle); |
|
if (ret != 0) |
|
return ret; |
|
|
|
return count; |
|
} |
|
static DEVICE_ATTR_WO(reset_protection); |
|
|
|
static struct attribute *haps_attributes[] = { |
|
&dev_attr_protection_level.attr, |
|
&dev_attr_reset_protection.attr, |
|
NULL, |
|
}; |
|
|
|
static const struct attribute_group haps_attr_group = { |
|
.attrs = haps_attributes, |
|
}; |
|
|
|
/* |
|
* ACPI stuff |
|
*/ |
|
static void toshiba_haps_notify(struct acpi_device *device, u32 event) |
|
{ |
|
pr_debug("Received event: 0x%x", event); |
|
|
|
acpi_bus_generate_netlink_event(device->pnp.device_class, |
|
dev_name(&device->dev), |
|
event, 0); |
|
} |
|
|
|
static int toshiba_haps_remove(struct acpi_device *device) |
|
{ |
|
sysfs_remove_group(&device->dev.kobj, &haps_attr_group); |
|
|
|
if (toshiba_haps) |
|
toshiba_haps = NULL; |
|
|
|
return 0; |
|
} |
|
|
|
/* Helper function */ |
|
static int toshiba_haps_available(acpi_handle handle) |
|
{ |
|
acpi_status status; |
|
u64 hdd_present; |
|
|
|
/* |
|
* A non existent device as well as having (only) |
|
* Solid State Drives can cause the call to fail. |
|
*/ |
|
status = acpi_evaluate_integer(handle, "_STA", NULL, &hdd_present); |
|
if (ACPI_FAILURE(status)) { |
|
pr_err("ACPI call to query HDD protection failed\n"); |
|
return 0; |
|
} |
|
|
|
if (!hdd_present) { |
|
pr_info("HDD protection not available or using SSD\n"); |
|
return 0; |
|
} |
|
|
|
return 1; |
|
} |
|
|
|
static int toshiba_haps_add(struct acpi_device *acpi_dev) |
|
{ |
|
struct toshiba_haps_dev *haps; |
|
int ret; |
|
|
|
if (toshiba_haps) |
|
return -EBUSY; |
|
|
|
if (!toshiba_haps_available(acpi_dev->handle)) |
|
return -ENODEV; |
|
|
|
pr_info("Toshiba HDD Active Protection Sensor device\n"); |
|
|
|
haps = kzalloc(sizeof(struct toshiba_haps_dev), GFP_KERNEL); |
|
if (!haps) |
|
return -ENOMEM; |
|
|
|
haps->acpi_dev = acpi_dev; |
|
haps->protection_level = 2; |
|
acpi_dev->driver_data = haps; |
|
dev_set_drvdata(&acpi_dev->dev, haps); |
|
|
|
/* Set the protection level, currently at level 2 (Medium) */ |
|
ret = toshiba_haps_protection_level(acpi_dev->handle, 2); |
|
if (ret != 0) |
|
return ret; |
|
|
|
ret = sysfs_create_group(&acpi_dev->dev.kobj, &haps_attr_group); |
|
if (ret) |
|
return ret; |
|
|
|
toshiba_haps = haps; |
|
|
|
return 0; |
|
} |
|
|
|
#ifdef CONFIG_PM_SLEEP |
|
static int toshiba_haps_suspend(struct device *device) |
|
{ |
|
struct toshiba_haps_dev *haps; |
|
int ret; |
|
|
|
haps = acpi_driver_data(to_acpi_device(device)); |
|
|
|
/* Deactivate the protection on suspend */ |
|
ret = toshiba_haps_protection_level(haps->acpi_dev->handle, 0); |
|
|
|
return ret; |
|
} |
|
|
|
static int toshiba_haps_resume(struct device *device) |
|
{ |
|
struct toshiba_haps_dev *haps; |
|
int ret; |
|
|
|
haps = acpi_driver_data(to_acpi_device(device)); |
|
|
|
/* Set the stored protection level */ |
|
ret = toshiba_haps_protection_level(haps->acpi_dev->handle, |
|
haps->protection_level); |
|
|
|
/* Reset the protection on resume */ |
|
ret = toshiba_haps_reset_protection(haps->acpi_dev->handle); |
|
if (ret != 0) |
|
return ret; |
|
|
|
return ret; |
|
} |
|
#endif |
|
|
|
static SIMPLE_DEV_PM_OPS(toshiba_haps_pm, |
|
toshiba_haps_suspend, toshiba_haps_resume); |
|
|
|
static const struct acpi_device_id haps_device_ids[] = { |
|
{"TOS620A", 0}, |
|
{"", 0}, |
|
}; |
|
MODULE_DEVICE_TABLE(acpi, haps_device_ids); |
|
|
|
static struct acpi_driver toshiba_haps_driver = { |
|
.name = "Toshiba HAPS", |
|
.owner = THIS_MODULE, |
|
.ids = haps_device_ids, |
|
.flags = ACPI_DRIVER_ALL_NOTIFY_EVENTS, |
|
.ops = { |
|
.add = toshiba_haps_add, |
|
.remove = toshiba_haps_remove, |
|
.notify = toshiba_haps_notify, |
|
}, |
|
.drv.pm = &toshiba_haps_pm, |
|
}; |
|
|
|
module_acpi_driver(toshiba_haps_driver);
|
|
|