[PATCH v2 4/6] Add GPIO v2 ioctl decoding
Kent Gibson
warthog618 at gmail.com
Mon Jan 11 15:09:10 UTC 2021
Add decoding of GPIO uAPI v2 ioctls added in Linux v5.10.
Signed-off-by: Kent Gibson <warthog618 at gmail.com>
---
gpio_ioctl.c | 304 ++++++++++++++++++++++++++++++++++
xlat/gpio_v2_line_attr_ids.in | 5 +
xlat/gpio_v2_line_flags.in | 13 ++
3 files changed, 322 insertions(+)
create mode 100644 xlat/gpio_v2_line_attr_ids.in
create mode 100644 xlat/gpio_v2_line_flags.in
diff --git a/gpio_ioctl.c b/gpio_ioctl.c
index 7bd5dfc8..f1acaaad 100644
--- a/gpio_ioctl.c
+++ b/gpio_ioctl.c
@@ -32,6 +32,68 @@ struct gpiohandle_config {
# define GPIO_GET_LINEINFO_UNWATCH_IOCTL _IOWR(0xB4, 0x0C, uint32_t)
#endif
+#ifndef GPIO_V2_GET_LINEINFO_IOCTL
+/* added in Linux v5.10 */
+# define GPIO_V2_GET_LINEINFO_IOCTL _IOWR(0xB4, 0x05, struct gpio_v2_line_info)
+# define GPIO_V2_GET_LINEINFO_WATCH_IOCTL _IOWR(0xB4, 0x06, struct gpio_v2_line_info)
+# define GPIO_V2_GET_LINE_IOCTL _IOWR(0xB4, 0x07, struct gpio_v2_line_request)
+# define GPIO_V2_LINE_SET_CONFIG_IOCTL _IOWR(0xB4, 0x0D, struct gpio_v2_line_config)
+# define GPIO_V2_LINE_GET_VALUES_IOCTL _IOWR(0xB4, 0x0E, struct gpio_v2_line_values)
+# define GPIO_V2_LINE_SET_VALUES_IOCTL _IOWR(0xB4, 0x0F, struct gpio_v2_line_values)
+
+# define GPIO_MAX_NAME_SIZE 32
+# define GPIO_V2_LINES_MAX 64
+# define GPIO_V2_LINE_NUM_ATTRS_MAX 10
+
+struct gpio_v2_line_values {
+ uint64_t bits;
+ uint64_t mask;
+};
+
+struct gpio_v2_line_attribute {
+ uint32_t id;
+ uint32_t padding;
+ union {
+ uint64_t flags;
+ uint64_t values;
+ uint32_t debounce_period_us;
+ };
+};
+
+struct gpio_v2_line_config_attribute {
+ struct gpio_v2_line_attribute attr;
+ uint64_t mask;
+};
+
+struct gpio_v2_line_config {
+ uint64_t flags;
+ uint32_t num_attrs;
+ uint32_t padding[5];
+ struct gpio_v2_line_config_attribute attrs[GPIO_V2_LINE_NUM_ATTRS_MAX];
+};
+
+struct gpio_v2_line_request {
+ uint32_t offsets[GPIO_V2_LINES_MAX];
+ char consumer[GPIO_MAX_NAME_SIZE];
+ struct gpio_v2_line_config config;
+ uint32_t num_lines;
+ uint32_t event_buffer_size;
+ uint32_t padding[5];
+ int32_t fd;
+};
+
+struct gpio_v2_line_info {
+ char name[GPIO_MAX_NAME_SIZE];
+ char consumer[GPIO_MAX_NAME_SIZE];
+ uint32_t offset;
+ uint32_t num_attrs;
+ uint64_t flags;
+ struct gpio_v2_line_attribute attrs[GPIO_V2_LINE_NUM_ATTRS_MAX];
+ uint32_t padding[4];
+};
+
+#endif /* GPIO_V2_GET_LINEINFO_IOCTL */
+
static int
print_gpiochip_info(struct tcb *const tcp, const kernel_ulong_t arg)
{
@@ -230,6 +292,237 @@ print_gpiohandle_set_config(struct tcb *const tcp, const kernel_ulong_t arg)
return RVAL_IOCTL_DECODED;
}
+#include "xlat/gpio_v2_line_flags.h"
+#include "xlat/gpio_v2_line_attr_ids.h"
+
+static void
+print_gpio_v2_line_attribute(struct tcb *const tcp,
+ struct gpio_v2_line_attribute *attr)
+{
+ switch (attr->id) {
+ case GPIO_V2_LINE_ATTR_ID_FLAGS:
+ PRINT_FIELD_FLAGS("", *attr, flags, gpio_v2_line_flags,
+ "GPIO_V2_LINE_FLAG_???");
+ break;
+ case GPIO_V2_LINE_ATTR_ID_OUTPUT_VALUES:
+ PRINT_FIELD_X("", *attr, values);
+ break;
+ case GPIO_V2_LINE_ATTR_ID_DEBOUNCE:
+ PRINT_FIELD_U("", *attr, debounce_period_us);
+ break;
+ default:
+ tprintf("(id=%u)=%#" PRIx64, attr->id, (uint64_t)attr->values);
+ break;
+ }
+}
+
+static void
+print_gpio_v2_line_config_attribute(struct tcb *const tcp,
+ struct gpio_v2_line_config_attribute *attr)
+{
+ tprints("{");
+ print_gpio_v2_line_attribute(tcp, &attr->attr);
+ PRINT_FIELD_X(", ", *attr, mask);
+ tprints("}");
+}
+
+static bool
+print_gpio_v2_line_attr_array_member(struct tcb *tcp, void *elem_buf,
+ size_t elem_size, void *data)
+{
+ struct gpio_v2_line_attribute *la;
+
+ la = (struct gpio_v2_line_attribute *)elem_buf;
+ if (la->padding) {
+ PRINT_FIELD_X("{", *la, padding);
+ tprints(", ");
+ }
+ print_gpio_v2_line_attribute(tcp, la);
+ if (la->padding)
+ tprints("}");
+
+ return true;
+}
+
+
+static bool
+print_gpio_v2_line_config_attr_array_member(struct tcb *tcp, void *elem_buf,
+ size_t elem_size, void *data)
+{
+ print_gpio_v2_line_config_attribute(tcp,
+ (struct gpio_v2_line_config_attribute *)elem_buf);
+
+ return true;
+}
+
+static void
+print_gpio_v2_line_config(struct tcb *const tcp, struct gpio_v2_line_config *lc)
+{
+ uint32_t num_attrs = lc->num_attrs;
+
+ PRINT_FIELD_FLAGS("{", *lc, flags, gpio_v2_line_flags,
+ "GPIO_V2_LINE_FLAG_???");
+ PRINT_FIELD_U(", ", *lc, num_attrs);
+ if (!IS_ARRAY_ZERO(lc->padding))
+ PRINT_FIELD_X_ARRAY(", ", *lc, padding);
+ if (num_attrs) {
+ if (num_attrs > GPIO_V2_LINE_NUM_ATTRS_MAX)
+ num_attrs = GPIO_V2_LINE_NUM_ATTRS_MAX;
+ tprints(", attrs=");
+ print_local_array_ex(tcp, lc->attrs, num_attrs,
+ sizeof(lc->attrs[0]),
+ print_gpio_v2_line_config_attr_array_member,
+ NULL, 0, NULL, NULL);
+ }
+ tprints("}");
+}
+
+static void
+print_gpio_v2_line_values(struct tcb *const tcp, struct gpio_v2_line_values *vals)
+{
+ PRINT_FIELD_X("{", *vals, bits);
+ PRINT_FIELD_X(", ", *vals, mask);
+ tprints("}");
+}
+
+static int
+print_gpio_v2_line_info(struct tcb *const tcp, const kernel_ulong_t arg)
+{
+ struct gpio_v2_line_info li;
+
+ if (entering(tcp))
+ tprints(", ");
+ else if (syserror(tcp))
+ return RVAL_IOCTL_DECODED;
+ else
+ tprints(" => ");
+
+ if (umove_or_printaddr(tcp, arg, &li))
+ return RVAL_IOCTL_DECODED;
+
+ if (entering(tcp)) {
+ PRINT_FIELD_U("{", li, offset);
+ tprints("}");
+ return 0;
+ }
+
+ /* exiting */
+ PRINT_FIELD_CSTRING("{", li, name);
+ PRINT_FIELD_CSTRING(", ", li, consumer);
+ PRINT_FIELD_FLAGS(", ", li, flags, gpio_v2_line_flags, "GPIO_V2_LINE_FLAG_???");
+ PRINT_FIELD_U(", ", li, num_attrs);
+ if (li.num_attrs) {
+ if (li.num_attrs > GPIO_V2_LINE_NUM_ATTRS_MAX)
+ li.num_attrs = GPIO_V2_LINE_NUM_ATTRS_MAX;
+ tprints(", attrs=");
+ print_local_array_ex(tcp, li.attrs, li.num_attrs,
+ sizeof(li.attrs[0]), print_gpio_v2_line_attr_array_member,
+ NULL, 0, NULL, NULL);
+ }
+ if (!IS_ARRAY_ZERO(li.padding))
+ PRINT_FIELD_X_ARRAY(", ", li, padding);
+ tprints("}");
+
+ return RVAL_IOCTL_DECODED;
+}
+
+static int
+print_gpio_v2_line_request(struct tcb *const tcp, const kernel_ulong_t arg)
+{
+ struct gpio_v2_line_request lr;
+
+ if (entering(tcp))
+ tprints(", ");
+ else if (syserror(tcp))
+ return RVAL_IOCTL_DECODED;
+ else
+ tprints(" => ");
+
+ if (umove_or_printaddr(tcp, arg, &lr))
+ return RVAL_IOCTL_DECODED;
+
+ if (entering(tcp)) {
+ PRINT_FIELD_U("{", lr, num_lines);
+ if (lr.num_lines > GPIO_V2_LINES_MAX)
+ lr.num_lines = GPIO_V2_LINES_MAX;
+ tprints(", offsets=");
+ print_local_array_ex(tcp, lr.offsets, lr.num_lines,
+ sizeof(lr.offsets[0]), print_uint32_array_member,
+ NULL, 0, NULL, NULL);
+ tprints(", config=");
+ print_gpio_v2_line_config(tcp, &lr.config);
+ PRINT_FIELD_CSTRING(", ", lr, consumer);
+ if (lr.event_buffer_size)
+ PRINT_FIELD_U(", ", lr, event_buffer_size);
+ if (!IS_ARRAY_ZERO(lr.padding))
+ PRINT_FIELD_X_ARRAY(", ", lr, padding);
+ tprints("}");
+ return 0;
+ }
+
+ /* exiting */
+ PRINT_FIELD_FD("{", lr, fd, tcp);
+ tprints("}");
+
+ return RVAL_IOCTL_DECODED;
+}
+
+static int
+print_gpio_v2_line_get_values(struct tcb *const tcp, const kernel_ulong_t arg)
+{
+ struct gpio_v2_line_values vals;
+
+ if (entering(tcp))
+ tprints(", ");
+ else if (syserror(tcp))
+ return RVAL_IOCTL_DECODED;
+ else
+ tprints(" => ");
+
+ if (umove_or_printaddr(tcp, arg, &vals))
+ return RVAL_IOCTL_DECODED;
+
+ if (entering(tcp)) {
+ PRINT_FIELD_X("{", vals, mask);
+ tprints("}");
+ return 0;
+ }
+
+ /* exiting */
+ PRINT_FIELD_X("{", vals, bits);
+ tprints("}");
+
+ return RVAL_IOCTL_DECODED;
+}
+
+static int
+print_gpio_v2_line_set_values(struct tcb *const tcp, const kernel_ulong_t arg)
+{
+ struct gpio_v2_line_values vals;
+
+ tprints(", ");
+ if (umove_or_printaddr(tcp, arg, &vals))
+ return RVAL_IOCTL_DECODED;
+
+ print_gpio_v2_line_values(tcp, &vals);
+
+ return RVAL_IOCTL_DECODED;
+}
+
+static int
+print_gpio_v2_line_set_config(struct tcb *const tcp, const kernel_ulong_t arg)
+{
+ struct gpio_v2_line_config lc;
+
+ tprints(", ");
+ if (umove_or_printaddr(tcp, arg, &lc))
+ return RVAL_IOCTL_DECODED;
+
+ print_gpio_v2_line_config(tcp, &lc);
+
+ return RVAL_IOCTL_DECODED;
+}
+
int
gpio_ioctl(struct tcb *const tcp, const unsigned int code,
const kernel_ulong_t arg)
@@ -239,6 +532,17 @@ gpio_ioctl(struct tcb *const tcp, const unsigned int code,
return print_gpiochip_info(tcp, arg);
case GPIO_GET_LINEINFO_UNWATCH_IOCTL:
return print_gpioline_info_unwatch(tcp, arg);
+ case GPIO_V2_GET_LINEINFO_IOCTL:
+ case GPIO_V2_GET_LINEINFO_WATCH_IOCTL:
+ return print_gpio_v2_line_info(tcp, arg);
+ case GPIO_V2_GET_LINE_IOCTL:
+ return print_gpio_v2_line_request(tcp, arg);
+ case GPIO_V2_LINE_SET_CONFIG_IOCTL:
+ return print_gpio_v2_line_set_config(tcp, arg);
+ case GPIO_V2_LINE_GET_VALUES_IOCTL:
+ return print_gpio_v2_line_get_values(tcp, arg);
+ case GPIO_V2_LINE_SET_VALUES_IOCTL:
+ return print_gpio_v2_line_set_values(tcp, arg);
case GPIO_GET_LINEINFO_IOCTL:
case GPIO_GET_LINEINFO_WATCH_IOCTL:
return print_gpioline_info(tcp, arg);
diff --git a/xlat/gpio_v2_line_attr_ids.in b/xlat/gpio_v2_line_attr_ids.in
new file mode 100644
index 00000000..5217e400
--- /dev/null
+++ b/xlat/gpio_v2_line_attr_ids.in
@@ -0,0 +1,5 @@
+#enum
+#include <linux/gpio.h>
+GPIO_V2_LINE_ATTR_ID_FLAGS 0x00000001
+GPIO_V2_LINE_ATTR_ID_OUTPUT_VALUES 0x00000002
+GPIO_V2_LINE_ATTR_ID_DEBOUNCE 0x00000003
diff --git a/xlat/gpio_v2_line_flags.in b/xlat/gpio_v2_line_flags.in
new file mode 100644
index 00000000..04ffa9e4
--- /dev/null
+++ b/xlat/gpio_v2_line_flags.in
@@ -0,0 +1,13 @@
+#enum
+#include <linux/gpio.h>
+GPIO_V2_LINE_FLAG_USED 0x00000001
+GPIO_V2_LINE_FLAG_ACTIVE_LOW 0x00000002
+GPIO_V2_LINE_FLAG_INPUT 0x00000004
+GPIO_V2_LINE_FLAG_OUTPUT 0x00000008
+GPIO_V2_LINE_FLAG_EDGE_RISING 0x00000010
+GPIO_V2_LINE_FLAG_EDGE_FALLING 0x00000020
+GPIO_V2_LINE_FLAG_OPEN_DRAIN 0x00000040
+GPIO_V2_LINE_FLAG_OPEN_SOURCE 0x00000080
+GPIO_V2_LINE_FLAG_BIAS_PULL_UP 0x00000100
+GPIO_V2_LINE_FLAG_BIAS_PULL_DOWN 0x00000200
+GPIO_V2_LINE_FLAG_BIAS_DISABLED 0x00000400
--
2.30.0
More information about the Strace-devel
mailing list