lkml.org 
[lkml]   [2016]   [Mar]   [14]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
Patch in this message
/
From
Subject[PATCH 2/2] misc: nirtfeatures: physical interface elements
Date
From: Gratian Crisan <gratian.crisan@ni.com>

These changes add support for PIEs (physical interface elements), which
are defined as physical elements fixed to a controller/chassis with
which a user can interact (e.g. LEDs and switches) and whose meaning
is user-defined and implementation-specific.

The support for these elements, in terms of enumerating and interacting
with them (i.e. retrieving the list of elements, getting/setting their
current state, enabling notifications, etc.) is embedded within the
BIOS as a set of ACPI methods. The changes to the CPLD driver act as a
bridge between these methods and existing Linux kernel facilities as
described below to expose the elements and any applicable metadata to
user mode. The metadata or knowledge needed for the interpretation
thereof is not a prerequisite to interacting with the elements--it is
there for upper-level value add software to use to improve the user
experience. In other words, Linux users familiar with the class drivers
by which the elements are surfaced should not have any issues
interfacing with them without knowing the meaning of the attached
metadata.

Output elements, which consist currently of LEDs, are surfaced via the
LED class driver. Each LED and color becomes its own LED class device
with the naming convention 'nilrt:{name}:{color}'. Any additional
attributes/metadata intended for upper-level software are appended to
the name, each separated by colons, as suggested by the LED class driver
documentation in the Linux kernel proper, except where there is already
a standard way to communicate a specific piece of metadata (e.g.,
maximum brightness, which is exposed via the /sys/class/leds/.../
max_brightness attribute node).

Input elements as surfaced via the input class driver. As with output
elements, each input element registers its own separate driver whose
name and associated metadata are transmitted via the name attribute
attached to the input device, retrievable via the EVIOCGNAME ioctl,
using the same convention as described above for output elements. The
input class driver model is that events are pushed (i.e. reported) to
indicate state changes, so to facilitate this, the CPLD driver has an
ACPI notify callback that is invoked when an input element changes state
and its BIOS support generates a general purpose event per the ACPI
GPE model. The notify callback checks the instantaneous state of the
input element and reports a keyboard event on its particular device with
a scan code of 256 (BTN_0), where a key down event means that the input
element is in the '1' state (down, engaged, on, pressed, etc.) and a key
up event means that the input element is in the '0' state (off,
disengaged, released, etc.). User mode software can then monitor for
these specific events to determine when the state of the element has
changed, or can use the EVIOCGKEY ioctl on the appropriate input device
to retrieve the instantaneous state of the element.

Signed-off-by: Aaron Rossetto <aaron.rossetto@ni.com>
Signed-off-by: Josh Cartwright <joshc@ni.com>
Signed-off-by: Gratian Crisan <gratian.crisan@ni.com>
Signed-off-by: Kyle Roeschley <kyle.roeschley@ni.com>
---
drivers/misc/nirtfeatures.c | 753 ++++++++++++++++++++++++++++++++++++++++----
1 file changed, 694 insertions(+), 59 deletions(-)

diff --git a/drivers/misc/nirtfeatures.c b/drivers/misc/nirtfeatures.c
index 37298f2..2feedb5 100644
--- a/drivers/misc/nirtfeatures.c
+++ b/drivers/misc/nirtfeatures.c
@@ -20,6 +20,8 @@
#include <linux/leds.h>
#include <linux/module.h>

+#include <acpi/acpi.h>
+
#define MODULE_NAME "nirtfeatures"

/* Register addresses */
@@ -60,13 +62,48 @@
#define NIRTF_SYSTEM_LEDS_POWER_GREEN 0x02
#define NIRTF_SYSTEM_LEDS_POWER_YELLOW 0x01

-#define NIRTF_RT_LEDS_USER2_GREEN 0x08
-#define NIRTF_RT_LEDS_USER2_YELLOW 0x04
-#define NIRTF_RT_LEDS_USER1_GREEN 0x02
-#define NIRTF_RT_LEDS_USER1_YELLOW 0x01
-
#define to_nirtfeatures(dev) acpi_driver_data(to_acpi_device(dev))

+/*
+ *=====================================================================
+ * ACPI NI physical interface element support
+ *=====================================================================
+ */
+#define MAX_NAMELEN 64
+#define MAX_NODELEN 128
+#define MIN_PIE_CAPS_VERSION 2
+#define MAX_PIE_CAPS_VERSION 2
+
+enum nirtfeatures_pie_class {
+ PIE_CLASS_INPUT = 0,
+ PIE_CLASS_OUTPUT = 1
+};
+
+enum nirtfeatures_pie_type {
+ PIE_TYPE_UNKNOWN = 0,
+ PIE_TYPE_SWITCH = 1,
+ PIE_TYPE_LED = 2
+};
+
+struct nirtfeatures_pie_descriptor {
+ char name[MAX_NAMELEN];
+ enum nirtfeatures_pie_class pie_class;
+ enum nirtfeatures_pie_type pie_type;
+ bool is_user_visible;
+ unsigned int notification_value;
+};
+
+struct nirtfeatures_pie_descriptor_led_color {
+ char name[MAX_NAMELEN];
+ int brightness_range_low;
+ int brightness_range_high;
+};
+
+struct nirtfeatures_pie_location {
+ unsigned int element;
+ unsigned int subelement;
+};
+
/* Structures */

struct nirtfeatures {
@@ -75,19 +112,34 @@ struct nirtfeatures {
spinlock_t lock;
u8 revision[5];
const char *bpstring;
- struct nirtfeatures_led *extra_leds;
- unsigned num_extra_leds;
};

struct nirtfeatures_led {
struct led_classdev cdev;
struct nirtfeatures *nirtfeatures;
+ struct nirtfeatures_pie_location pie_location;
+ char name_string[MAX_NODELEN];
u8 address;
u8 mask;
u8 pattern_hi_addr;
u8 pattern_lo_addr;
+ struct list_head node;
};

+static LIST_HEAD(nirtfeatures_led_pie_list);
+
+struct nirtfeatures_switch {
+ struct input_dev *cdev;
+ struct nirtfeatures *nirtfeatures;
+ struct nirtfeatures_pie_descriptor pie_descriptor;
+ struct nirtfeatures_pie_location pie_location;
+ char name_string[MAX_NODELEN];
+ char phys_location_string[MAX_NODELEN];
+ struct list_head node;
+};
+
+static LIST_HEAD(nirtfeatures_switch_pie_list);
+
/* sysfs files */

static ssize_t revision_show(struct device *dev, struct device_attribute *attr,
@@ -323,20 +375,6 @@ nirtfeatures_led_brightness_get(struct led_classdev *led_cdev)
static struct nirtfeatures_led nirtfeatures_leds_common[] = {
{
{
- .name = "nilrt:user1:green",
- },
- .address = NIRTF_RT_LEDS,
- .mask = NIRTF_RT_LEDS_USER1_GREEN,
- },
- {
- {
- .name = "nilrt:user1:yellow",
- },
- .address = NIRTF_RT_LEDS,
- .mask = NIRTF_RT_LEDS_USER1_YELLOW,
- },
- {
- {
.name = "nilrt:status:red",
},
.address = NIRTF_SYSTEM_LEDS,
@@ -368,22 +406,571 @@ static struct nirtfeatures_led nirtfeatures_leds_common[] = {
},
};

-static struct nirtfeatures_led nirtfeatures_leds_cdaq[] = {
- {
- {
- .name = "nilrt:user2:green",
- },
- .address = NIRTF_RT_LEDS,
- .mask = NIRTF_RT_LEDS_USER2_GREEN,
- },
- {
- {
- .name = "nilrt:user2:yellow",
- },
- .address = NIRTF_RT_LEDS,
- .mask = NIRTF_RT_LEDS_USER2_YELLOW,
- },
-};
+/*
+ *=====================================================================
+ * ACPI NI physical interface element support
+ *=====================================================================
+ */
+
+/* Note that callers of this function are responsible for deallocating
+ * the buffer allocated by acpi_evaluate_object() by calling
+ * kfree() on the pointer passed back in result_buffer.
+ */
+static int
+nirtfeatures_call_acpi_method(struct acpi_device *device,
+ const char *method_name, int argc,
+ union acpi_object *argv, acpi_size *result_size,
+ void **result_buffer)
+{
+ acpi_status acpi_ret;
+ acpi_handle acpi_hdl;
+ struct acpi_object_list acpi_params;
+ struct acpi_buffer acpi_result = { ACPI_ALLOCATE_BUFFER, NULL };
+
+ if (!device || !result_size || !result_buffer)
+ return -EINVAL;
+
+ acpi_ret = acpi_get_handle(device->handle, (acpi_string)method_name,
+ &acpi_hdl);
+ if (ACPI_FAILURE(acpi_ret)) {
+ dev_err(&device->dev, "ACPI get handle for %s failed (%d)\n",
+ method_name, acpi_ret);
+ return -1;
+ }
+
+ acpi_params.count = argc;
+ acpi_params.pointer = argv;
+
+ acpi_ret = acpi_evaluate_object(acpi_hdl, NULL, &acpi_params,
+ &acpi_result);
+ if (ACPI_FAILURE(acpi_ret)) {
+ dev_err(&device->dev, "ACPI evaluate for %s failed (%d)\n",
+ method_name, acpi_ret);
+ return -1;
+ }
+
+ *result_size = acpi_result.length;
+ *result_buffer = acpi_result.pointer;
+
+ return 0;
+}
+
+/* This is the generic PIE set state wrapper. It invokes the PIES
+ * ACPI method to modify the state of the given PIE.
+ */
+static int nirtfeatures_pie_set_state(struct nirtfeatures *nirtfeatures,
+ unsigned int element,
+ unsigned int subelement, int state)
+{
+ union acpi_object pies_args[3];
+ acpi_size result_size;
+ void *result_buffer;
+ union acpi_object *acpi_buffer;
+ int err;
+
+ if (!nirtfeatures)
+ return -EINVAL;
+
+ pies_args[0].type = ACPI_TYPE_INTEGER;
+ pies_args[0].integer.value = element;
+ pies_args[1].type = ACPI_TYPE_INTEGER;
+ pies_args[1].integer.value = subelement;
+ pies_args[2].type = ACPI_TYPE_INTEGER;
+ pies_args[2].integer.value = state;
+
+ /* evaluate PIES(element, subelement, value) ACPI method */
+ err = nirtfeatures_call_acpi_method(nirtfeatures->acpi_device, "PIES",
+ 3, &pies_args[0], &result_size,
+ &result_buffer);
+ if (err)
+ return err;
+
+ acpi_buffer = (union acpi_object *)result_buffer;
+ if (acpi_buffer->type == ACPI_TYPE_INTEGER)
+ err = (int)acpi_buffer->integer.value;
+ kfree(result_buffer);
+
+ return err;
+}
+
+/* This is the generic PIE get state wrapper. It invokes the PIEG
+ * ACPI method to query the state of the given PIE.
+ */
+static int nirtfeatures_pie_get_state(struct nirtfeatures *nirtfeatures,
+ unsigned int element,
+ unsigned int subelement, int *result)
+{
+ union acpi_object pies_args[2];
+ acpi_size result_size;
+ void *result_buffer;
+ union acpi_object *acpi_buffer;
+ int err;
+
+ if (!nirtfeatures || !result)
+ return -EINVAL;
+
+ pies_args[0].type = ACPI_TYPE_INTEGER;
+ pies_args[0].integer.value = element;
+ pies_args[1].type = ACPI_TYPE_INTEGER;
+ pies_args[1].integer.value = subelement;
+
+ /* evaluate PIEG(element, subelement) ACPI method */
+ err = nirtfeatures_call_acpi_method(nirtfeatures->acpi_device, "PIEG",
+ 2, &pies_args[0], &result_size,
+ &result_buffer);
+ if (err)
+ return err;
+
+ acpi_buffer = (union acpi_object *)result_buffer;
+ if (acpi_buffer->type == ACPI_TYPE_INTEGER)
+ *result = (int)acpi_buffer->integer.value;
+ kfree(result_buffer);
+
+ return 0;
+}
+
+/* This function enables or disables notifications for a particular
+ * input class PIE.
+ */
+static int
+nirtfeatures_pie_enable_notifications(struct nirtfeatures *nirtfeatures,
+ unsigned int element,
+ unsigned int subelement, int enable)
+{
+ union acpi_object pies_args[3];
+ acpi_size result_size;
+ void *result_buffer;
+ union acpi_object *acpi_buffer;
+ int err;
+
+ if (!nirtfeatures)
+ return -EINVAL;
+
+ pies_args[0].type = ACPI_TYPE_INTEGER;
+ pies_args[0].integer.value = element;
+ pies_args[1].type = ACPI_TYPE_INTEGER;
+ pies_args[1].integer.value = subelement;
+ pies_args[2].type = ACPI_TYPE_INTEGER;
+ pies_args[2].integer.value = enable;
+
+ /* evaluate PIEF(element, subelement, enable) ACPI method */
+ err = nirtfeatures_call_acpi_method(nirtfeatures->acpi_device, "PIEF",
+ 3, &pies_args[0], &result_size,
+ &result_buffer);
+ if (err)
+ return err;
+
+ acpi_buffer = (union acpi_object *)result_buffer;
+ if (acpi_buffer->type == ACPI_TYPE_INTEGER)
+ err = (int)acpi_buffer->integer.value;
+ kfree(result_buffer);
+
+ return err;
+}
+
+/* This is the set_brightness callback for a PIE-enumerated LED.
+ */
+static void
+nirtfeatures_led_pie_brightness_set(struct led_classdev *led_cdev,
+ enum led_brightness brightness)
+{
+ struct nirtfeatures_led *led = (struct nirtfeatures_led *)led_cdev;
+
+ spin_lock(&led->nirtfeatures->lock);
+
+ /* Delegate the control of the PIE to the ACPI method. */
+ if (nirtfeatures_pie_set_state(led->nirtfeatures,
+ led->pie_location.element,
+ led->pie_location.subelement,
+ brightness)) {
+ dev_err(&led->nirtfeatures->acpi_device->dev,
+ "set brightness failed for %s\n", led->name_string);
+ }
+
+ spin_unlock(&led->nirtfeatures->lock);
+}
+
+/* This is the get_brightness callback for a PIE-enumerated LED.
+ */
+static enum
+led_brightness nirtfeatures_led_pie_brightness_get(struct led_classdev
+ *led_cdev)
+{
+ struct nirtfeatures_led *led = (struct nirtfeatures_led *)led_cdev;
+ int state = 0;
+
+ spin_lock(&led->nirtfeatures->lock);
+
+ if (nirtfeatures_pie_get_state(led->nirtfeatures,
+ led->pie_location.element,
+ led->pie_location.subelement, &state)) {
+ dev_err(&led->nirtfeatures->acpi_device->dev,
+ "get brightness failed for %s\n", led->name_string);
+ }
+
+ spin_unlock(&led->nirtfeatures->lock);
+ return state;
+}
+
+/* Parse a PIE LED color caps package and populate the
+ * corresponding nirtfeatures_pie_descriptor_led_color structure.
+ */
+static int
+nirtfeatures_parse_led_pie_color(unsigned int pie_caps_version,
+ struct nirtfeatures_pie_descriptor_led_color
+ *led_color_desc,
+ union acpi_object *acpi_buffer)
+{
+ union acpi_object *elements;
+ unsigned int i;
+
+ if (!led_color_desc || !acpi_buffer)
+ return -EINVAL;
+
+ elements = acpi_buffer->package.elements;
+
+ if (elements[0].type != ACPI_TYPE_BUFFER ||
+ elements[1].type != ACPI_TYPE_INTEGER ||
+ elements[2].type != ACPI_TYPE_INTEGER)
+ return -EINVAL;
+
+ /* element 0 of a PIE LED color caps package is the name */
+ for (i = 0; i < elements[0].buffer.length; i++) {
+ /* get pointer to Nth Unicode character in name */
+ unsigned short *unicode_char = (unsigned short *)
+ (elements[0].buffer.pointer + (2 * i));
+ /* naive convert to ASCII */
+ led_color_desc->name[i] = (char)*unicode_char & 0xff;
+ }
+
+ /* element 1 is the brightness min value */
+ led_color_desc->brightness_range_low = (int)elements[1].integer.value;
+
+ /* element 2 is the brightness max value */
+ led_color_desc->brightness_range_high = (int)elements[2].integer.value;
+
+ return 0;
+}
+
+/* Parse a PIE LED caps package and create an LED class device
+ * with the appropriate metadata.
+ */
+static int nirtfeatures_parse_led_pie(struct nirtfeatures *nirtfeatures,
+ unsigned int pie_caps_version,
+ unsigned int pie_element,
+ struct nirtfeatures_pie_descriptor *pie,
+ union acpi_object *acpi_buffer)
+{
+ struct nirtfeatures_pie_descriptor_led_color led_descriptor;
+ struct nirtfeatures_led *led_dev;
+ struct led_classdev *cdev;
+ unsigned int num_colors;
+ unsigned int i;
+ int err;
+
+ if (!nirtfeatures || !pie || !acpi_buffer ||
+ acpi_buffer->type != ACPI_TYPE_PACKAGE ||
+ acpi_buffer->package.elements[0].type != ACPI_TYPE_INTEGER)
+ return -EINVAL;
+
+ /* element 0 is the number of colors */
+ num_colors = (unsigned)acpi_buffer->package.elements[0].integer.value;
+
+ /* parse color caps and create LED class device */
+ for (i = 0; i < num_colors; i++) {
+ if (nirtfeatures_parse_led_pie_color(pie_caps_version,
+ &led_descriptor,
+ &(acpi_buffer->package.
+ elements[i + 1])))
+ return -EINVAL;
+
+ /* create an LED class device for this LED */
+ led_dev = devm_kzalloc(&nirtfeatures->acpi_device->dev,
+ sizeof(*led_dev), GFP_KERNEL);
+ if (!led_dev)
+ return -ENOMEM;
+
+ /*
+ * for compatibility with existing LVRT support, PIEs beginning
+ * with 'user' should not affix the uservisible attribute to
+ * their name
+ */
+ if (strncasecmp(pie->name, "user", strlen("user")) != 0 &&
+ strncasecmp(pie->name, "wifi", strlen("wifi")) != 0)
+ snprintf(led_dev->name_string, MAX_NODELEN,
+ "nilrt:%s:%s:uservisible=%d", pie->name,
+ led_descriptor.name, pie->is_user_visible);
+ else
+ snprintf(led_dev->name_string, MAX_NODELEN,
+ "nilrt:%s:%s", pie->name,
+ led_descriptor.name);
+
+ cdev = &led_dev->cdev;
+ cdev->name = led_dev->name_string;
+ cdev->brightness = led_descriptor.brightness_range_low;
+ cdev->max_brightness = led_descriptor.brightness_range_high;
+ cdev->brightness_set = nirtfeatures_led_pie_brightness_set;
+ cdev->brightness_get = nirtfeatures_led_pie_brightness_get;
+ led_dev->nirtfeatures = nirtfeatures;
+ led_dev->pie_location.element = pie_element;
+ led_dev->pie_location.subelement = i;
+
+ err =
+ devm_led_classdev_register(&nirtfeatures->acpi_device->dev,
+ cdev);
+ if (err)
+ return err;
+
+ list_add_tail(&led_dev->node, &nirtfeatures_led_pie_list);
+ }
+
+ return 0;
+}
+
+/* Parse a PIE switch caps package and create an input class device
+ * with the appropriate metadata.
+ */
+static int
+nirtfeatures_parse_switch_pie(struct nirtfeatures *nirtfeatures,
+ unsigned int pie_caps_version,
+ unsigned int pie_element,
+ struct nirtfeatures_pie_descriptor *pie,
+ union acpi_object *acpi_buffer)
+{
+ struct nirtfeatures_switch *switch_dev;
+ union acpi_object *elements;
+ unsigned int num_states;
+ unsigned int *states;
+ unsigned int i;
+ int err = 0;
+
+ if (!nirtfeatures || !pie || !acpi_buffer ||
+ acpi_buffer->type != ACPI_TYPE_PACKAGE)
+ return -EINVAL;
+
+ elements = acpi_buffer->package.elements;
+
+ /* element 0 is the number of states */
+ if (elements[0].type != ACPI_TYPE_INTEGER)
+ return -EINVAL;
+ num_states = (unsigned)elements[0].integer.value;
+
+ /* allocate storage for switch descriptor */
+ states = kmalloc_array(num_states, sizeof(*states), GFP_KERNEL);
+ if (!states)
+ return -ENOMEM;
+
+ /* parse individual states in elements 1..N-1 */
+ for (i = 0; i < num_states; i++) {
+ if (elements[i + 1].type != ACPI_TYPE_INTEGER) {
+ err = -EINVAL;
+ goto exit;
+ }
+
+ states[i] = (int)elements[i + 1].integer.value;
+ }
+
+ /* create an input class device for this switch */
+ switch_dev = devm_kzalloc(&nirtfeatures->acpi_device->dev,
+ sizeof(*switch_dev), GFP_KERNEL);
+ if (!switch_dev) {
+ err = -ENOMEM;
+ goto exit;
+ }
+
+ switch_dev->cdev =
+ devm_input_allocate_device(&nirtfeatures->acpi_device->dev);
+ if (!switch_dev->cdev) {
+ err = -ENOMEM;
+ goto exit;
+ }
+
+ switch_dev->nirtfeatures = nirtfeatures;
+ switch_dev->pie_location.element = pie_element;
+ switch_dev->pie_location.subelement = 0;
+ memcpy(&switch_dev->pie_descriptor, pie, sizeof(*pie));
+
+ snprintf(switch_dev->name_string, MAX_NODELEN,
+ "nilrt:%s:uservisible=%d:states=(", pie->name,
+ pie->is_user_visible);
+ for (i = 0; i < num_states; i++) {
+ char temp[4] = { '\0' };
+
+ sprintf(temp, "%d%c", states[i],
+ (i < num_states - 1) ? ',' : ')');
+ strncat(switch_dev->name_string, temp, MAX_NODELEN);
+ }
+
+ snprintf(switch_dev->phys_location_string, MAX_NODELEN, "nilrt/%s/%s",
+ nirtfeatures->bpstring, pie->name);
+
+ switch_dev->cdev->name = switch_dev->name_string;
+ switch_dev->cdev->phys = switch_dev->phys_location_string;
+ switch_dev->cdev->id.bustype = BUS_HOST;
+ switch_dev->cdev->id.vendor = 0x3923;
+ switch_dev->cdev->id.product = pie->pie_type;
+ switch_dev->cdev->id.version = pie_caps_version;
+ switch_dev->cdev->dev.parent = &nirtfeatures->acpi_device->dev;
+ switch_dev->cdev->evbit[0] = BIT_MASK(EV_KEY);
+ set_bit(BTN_0, switch_dev->cdev->keybit);
+
+ err = input_register_device(switch_dev->cdev);
+ if (err) {
+ input_free_device(switch_dev->cdev);
+ goto exit;
+ }
+
+ /* if this PIE supports notifications, enable them now */
+ if (pie->notification_value != 0) {
+ err = nirtfeatures_pie_enable_notifications(nirtfeatures,
+ pie_element, 0, 1);
+ if (err) {
+ input_unregister_device(switch_dev->cdev);
+ goto exit;
+ }
+ }
+
+ /* add the new device to our list of switch PIEs */
+ list_add_tail(&switch_dev->node, &nirtfeatures_switch_pie_list);
+ goto exit;
+
+exit:
+ kfree(states);
+ return err;
+}
+
+/* Parse a single PIE caps package from the PIEC buffer, determine the
+ * type of PIE it is, then dispatch to the appropriate parsing routine.
+ */
+static int nirtfeatures_parse_pie(struct nirtfeatures *nirtfeatures,
+ unsigned int pie_caps_version,
+ unsigned int pie_element,
+ union acpi_object *acpi_buffer)
+{
+ struct nirtfeatures_pie_descriptor pie;
+ union acpi_object *elements;
+ unsigned int i;
+
+ if (!nirtfeatures || !acpi_buffer ||
+ acpi_buffer->type != ACPI_TYPE_PACKAGE ||
+ acpi_buffer->package.count != 6)
+ return -EINVAL;
+
+ elements = acpi_buffer->package.elements;
+ if (elements[0].type != ACPI_TYPE_BUFFER ||
+ elements[1].type != ACPI_TYPE_INTEGER ||
+ elements[2].type != ACPI_TYPE_INTEGER ||
+ elements[4].type != ACPI_TYPE_INTEGER ||
+ elements[5].type != ACPI_TYPE_INTEGER)
+ return -EINVAL;
+
+ /* element 0 of the package is the name */
+ for (i = 0; i < elements[0].buffer.length && i < MAX_NAMELEN; i++) {
+ /* get pointer to Nth Unicode character in name */
+ unsigned short *unicode_char = (unsigned short *)
+ (elements[0].buffer.pointer + (2 * i));
+ /* naive convert to ASCII */
+ pie.name[i] = (char)*unicode_char & 0xff;
+ }
+
+ /* element 1 of the package is the PIE class */
+ pie.pie_class = (enum nirtfeatures_pie_class)
+ elements[1].integer.value;
+
+ /* element 2 of the package is the PIE type */
+ pie.pie_type = (enum nirtfeatures_pie_type)
+ elements[2].integer.value;
+
+ /* element 4 of an package is the visible flag */
+ pie.is_user_visible = (elements[4].integer.value != 0);
+
+ /* element 5 of the package is the notification value */
+ pie.notification_value = elements[5].integer.value;
+
+ /* parse the type-specific descriptor in element 3 */
+ switch (pie.pie_type) {
+ case PIE_TYPE_LED:
+ if (nirtfeatures_parse_led_pie(nirtfeatures,
+ pie_caps_version, pie_element,
+ &pie, &(elements[3])))
+ return -EINVAL;
+ break;
+ case PIE_TYPE_SWITCH:
+ if (nirtfeatures_parse_switch_pie(nirtfeatures,
+ pie_caps_version,
+ pie_element, &pie,
+ &(elements[3])))
+ return -EINVAL;
+ break;
+
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+/* Populate the list of physical interface elements from the table in
+ * the DSDT and then generate the appropriate class devices.
+ */
+static int nirtfeatures_populate_pies(struct nirtfeatures *nirtfeatures)
+{
+ acpi_size result_size;
+ void *result_buffer;
+ union acpi_object *acpi_buffer;
+ union acpi_object *elements;
+ unsigned int pie_caps_version;
+ unsigned int i;
+ unsigned int err = 0;
+ int ret;
+
+ if (!nirtfeatures)
+ return -EINVAL;
+
+ /* get the PIE descriptor buffer from DSDT */
+ ret = nirtfeatures_call_acpi_method(nirtfeatures->acpi_device, "PIEC",
+ 0, NULL, &result_size,
+ &result_buffer);
+ if (ret)
+ return ret;
+
+ acpi_buffer = (union acpi_object *)result_buffer;
+ if (acpi_buffer->type != ACPI_TYPE_PACKAGE) {
+ err = -EINVAL;
+ goto exit;
+ }
+
+ elements = acpi_buffer->package.elements;
+ if (elements[0].type != ACPI_TYPE_INTEGER ||
+ elements[1].type != ACPI_TYPE_INTEGER) {
+ err = -EINVAL;
+ goto exit;
+ }
+
+ /* the first element of the package is the caps version */
+ pie_caps_version = (unsigned int)elements[0].integer.value;
+
+ if (pie_caps_version < MIN_PIE_CAPS_VERSION ||
+ pie_caps_version > MAX_PIE_CAPS_VERSION) {
+ dev_err(&nirtfeatures->acpi_device->dev,
+ "invalid PIE caps version\n");
+ err = -EINVAL;
+ goto exit;
+ }
+
+ /* element 1 is not needed, parse elements 2..N as PIE descriptors */
+ for (i = 2; i < acpi_buffer->package.count; i++) {
+ err = nirtfeatures_parse_pie(nirtfeatures,
+ pie_caps_version, i - 2,
+ &(elements[i]));
+ if (err)
+ break;
+ }
+
+exit:
+ kfree(result_buffer);
+ return err;
+}

static int nirtfeatures_create_leds(struct nirtfeatures *nirtfeatures)
{
@@ -409,27 +996,35 @@ static int nirtfeatures_create_leds(struct nirtfeatures *nirtfeatures)
return err;
}

- for (i = 0; i < nirtfeatures->num_extra_leds; ++i) {
-
- nirtfeatures->extra_leds[i].nirtfeatures = nirtfeatures;
-
- if (nirtfeatures->extra_leds[i].cdev.max_brightness == 0)
- nirtfeatures->extra_leds[i].cdev.max_brightness = 1;
+ return 0;
+}

- nirtfeatures->extra_leds[i].cdev.brightness_set =
- nirtfeatures_led_brightness_set;
+static void nirtfeatures_remove_switch_pies(struct nirtfeatures *nirtfeatures)
+{
+ struct nirtfeatures_switch *cdev_iter;
+ struct nirtfeatures_switch *temp;

- nirtfeatures->extra_leds[i].cdev.brightness_get =
- nirtfeatures_led_brightness_get;
+ spin_lock(&nirtfeatures->lock);

- err = devm_led_classdev_register(
- &nirtfeatures->acpi_device->dev,
- &nirtfeatures->extra_leds[i].cdev);
- if (err)
- return err;
+ /* walk the list of switch devices and unregister/free each one */
+ list_for_each_entry_safe(cdev_iter, temp,
+ &nirtfeatures_switch_pie_list, node) {
+ /* disable notifications for this PIE if supported */
+ if (cdev_iter->pie_descriptor.notification_value != 0) {
+ nirtfeatures_pie_enable_notifications(nirtfeatures,
+ cdev_iter->
+ pie_location.
+ element,
+ cdev_iter->
+ pie_location.
+ subelement, 0);
+ }
+ input_unregister_device(cdev_iter->cdev);
+ input_free_device(cdev_iter->cdev);
+ kfree(cdev_iter);
}

- return 0;
+ spin_unlock(&nirtfeatures->lock);
}

/* ACPI driver */
@@ -468,6 +1063,42 @@ static acpi_status nirtfeatures_resources(struct acpi_resource *res,
return AE_OK;
}

+/* Process a notification from ACPI, which typically occurs when a switch
+ * PIE is signalling a change of state via its GPE.
+ */
+static void nirtfeatures_acpi_notify(struct acpi_device *device, u32 event)
+{
+ /* find the switch PIE for which this notification was generated,
+ * and push an event into its associated input subsystem node
+ */
+ struct nirtfeatures *nirtfeatures = acpi_driver_data(device);
+ struct nirtfeatures_switch *iter;
+ int state;
+
+ spin_lock(&nirtfeatures->lock);
+
+ list_for_each_entry(iter, &nirtfeatures_switch_pie_list, node) {
+ if (event == iter->pie_descriptor.notification_value) {
+ /* query instantaneous switch state */
+ if (!nirtfeatures_pie_get_state(iter->nirtfeatures,
+ iter->pie_location.element,
+ iter->pie_location.subelement,
+ &state)) {
+ /* push current state of switch */
+ input_report_key(iter->cdev, BTN_0, !!state);
+ input_sync(iter->cdev);
+ }
+ spin_unlock(&nirtfeatures->lock);
+ return;
+ }
+ }
+
+ spin_unlock(&nirtfeatures->lock);
+
+ dev_err(&device->dev, "no input found for notification (event %02X)\n",
+ event);
+}
+
static int nirtfeatures_acpi_add(struct acpi_device *device)
{
struct nirtfeatures *nirtfeatures;
@@ -499,15 +1130,9 @@ static int nirtfeatures_acpi_add(struct acpi_device *device)
break;
case NIRTF_PLATFORM_MISC_ID_HAMMERHEAD:
nirtfeatures->bpstring = "Hammerhead";
- nirtfeatures->extra_leds = nirtfeatures_leds_cdaq;
- nirtfeatures->num_extra_leds =
- ARRAY_SIZE(nirtfeatures_leds_cdaq);
break;
case NIRTF_PLATFORM_MISC_ID_WINGHEAD:
nirtfeatures->bpstring = "Winghead";
- nirtfeatures->extra_leds = nirtfeatures_leds_cdaq;
- nirtfeatures->num_extra_leds =
- ARRAY_SIZE(nirtfeatures_leds_cdaq);
break;
default:
dev_err(&nirtfeatures->acpi_device->dev,
@@ -518,6 +1143,12 @@ static int nirtfeatures_acpi_add(struct acpi_device *device)

spin_lock_init(&nirtfeatures->lock);

+ err = nirtfeatures_populate_pies(nirtfeatures);
+ if (err) {
+ dev_err(&device->dev, "could not populate PIEs\n");
+ return err;
+ }
+
nirtfeatures->revision[0] = inb(nirtfeatures->io_base + NIRTF_YEAR);
nirtfeatures->revision[1] = inb(nirtfeatures->io_base + NIRTF_MONTH);
nirtfeatures->revision[2] = inb(nirtfeatures->io_base + NIRTF_DAY);
@@ -548,7 +1179,10 @@ static int nirtfeatures_acpi_add(struct acpi_device *device)

static int nirtfeatures_acpi_remove(struct acpi_device *device)
{
+ struct nirtfeatures *nirtfeatures = acpi_driver_data(device);
+
sysfs_remove_files(&device->dev.kobj, nirtfeatures_attrs);
+ nirtfeatures_remove_switch_pies(nirtfeatures);

return 0;
}
@@ -564,6 +1198,7 @@ static struct acpi_driver nirtfeatures_acpi_driver = {
.ops = {
.add = nirtfeatures_acpi_add,
.remove = nirtfeatures_acpi_remove,
+ .notify = nirtfeatures_acpi_notify,
},
};

--
2.7.0
\
 
 \ /
  Last update: 2016-03-14 23:41    [W:0.284 / U:1.304 seconds]
©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site