--- /dev/null
+/*
+ * GPIO chip API for libgpiod.
+ *
+ * Copyright (C) 2017 Bartosz Golaszewski <bartekgola@gmail.com>
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of version 2.1 of the GNU Lesser General Public License
+ * as published by the Free Software Foundation.
+ */
+
+#include "gpiod-internal.h"
+
+#include <stdio.h>
+#include <string.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <ctype.h>
+#include <sys/ioctl.h>
+#include <linux/gpio.h>
+
+struct gpiod_chip {
+ int fd;
+ struct gpiochip_info cinfo;
+ struct gpiod_line *lines;
+};
+
+static bool is_unsigned_int(const char *str)
+{
+ for (; *str && isdigit(*str); str++);
+
+ return *str == '\0';
+}
+
+int chip_get_fd(struct gpiod_chip *chip)
+{
+ return chip->fd;
+}
+
+struct gpiod_chip * gpiod_chip_open(const char *path)
+{
+ struct gpiod_chip *chip;
+ int status, fd;
+
+ fd = open(path, O_RDWR | O_CLOEXEC);
+ if (fd < 0)
+ return NULL;
+
+ chip = malloc(sizeof(*chip));
+ if (!chip) {
+ close(fd);
+ return NULL;
+ }
+
+ memset(chip, 0, sizeof(*chip));
+ chip->fd = fd;
+
+ status = ioctl(fd, GPIO_GET_CHIPINFO_IOCTL, &chip->cinfo);
+ if (status < 0) {
+ close(chip->fd);
+ free(chip);
+ return NULL;
+ }
+
+ chip->lines = line_array_alloc(chip->cinfo.lines);
+ if (!chip->lines) {
+ close(chip->fd);
+ free(chip);
+ return NULL;
+ }
+
+ return chip;
+}
+
+struct gpiod_chip * gpiod_chip_open_by_name(const char *name)
+{
+ struct gpiod_chip *chip;
+ char *path;
+ int status;
+
+ status = asprintf(&path, "/dev/%s", name);
+ if (status < 0)
+ return NULL;
+
+ chip = gpiod_chip_open(path);
+ free(path);
+
+ return chip;
+}
+
+struct gpiod_chip * gpiod_chip_open_by_number(unsigned int num)
+{
+ struct gpiod_chip *chip;
+ char *path;
+ int status;
+
+ status = asprintf(&path, "/dev/gpiochip%u", num);
+ if (!status)
+ return NULL;
+
+ chip = gpiod_chip_open(path);
+ free(path);
+
+ return chip;
+}
+
+struct gpiod_chip * gpiod_chip_open_by_label(const char *label)
+{
+ struct gpiod_chip_iter *iter;
+ struct gpiod_chip *chip;
+
+ iter = gpiod_chip_iter_new();
+ if (!iter)
+ return NULL;
+
+ gpiod_foreach_chip(iter, chip) {
+ if (gpiod_chip_iter_err(iter))
+ goto out;
+
+ if (strcmp(label, gpiod_chip_label(chip)) == 0) {
+ gpiod_chip_iter_free_noclose(iter);
+ return chip;
+ }
+ }
+
+out:
+ gpiod_chip_iter_free(iter);
+ return NULL;
+}
+
+struct gpiod_chip * gpiod_chip_open_lookup(const char *descr)
+{
+ struct gpiod_chip *chip;
+
+ if (is_unsigned_int(descr)) {
+ chip = gpiod_chip_open_by_number(strtoul(descr, NULL, 10));
+ } else {
+ chip = gpiod_chip_open_by_label(descr);
+ if (!chip) {
+ if (strncmp(descr, "/dev/", 5))
+ chip = gpiod_chip_open_by_name(descr);
+ else
+ chip = gpiod_chip_open(descr);
+ }
+ }
+
+ return chip;
+}
+
+void gpiod_chip_close(struct gpiod_chip *chip)
+{
+ unsigned int i;
+
+ for (i = 0; i < chip->cinfo.lines; i++)
+ gpiod_line_release(line_array_member(chip->lines, i));
+
+ close(chip->fd);
+ line_array_free(chip->lines);
+ free(chip);
+}
+
+const char * gpiod_chip_name(struct gpiod_chip *chip)
+{
+ return chip->cinfo.name[0] == '\0' ? NULL : chip->cinfo.name;
+}
+
+const char * gpiod_chip_label(struct gpiod_chip *chip)
+{
+ return chip->cinfo.label[0] == '\0' ? NULL : chip->cinfo.label;
+}
+
+unsigned int gpiod_chip_num_lines(struct gpiod_chip *chip)
+{
+ return (unsigned int)chip->cinfo.lines;
+}
+
+struct gpiod_line *
+gpiod_chip_get_line(struct gpiod_chip *chip, unsigned int offset)
+{
+ struct gpiod_line *line;
+ int status;
+
+ if (offset >= chip->cinfo.lines) {
+ errno = EINVAL;
+ return NULL;
+ }
+
+ line = line_array_member(chip->lines, offset);
+ line_set_offset(line, offset);
+ line_set_chip(line, chip);
+
+ status = gpiod_line_update(line);
+ if (status < 0)
+ return NULL;
+
+ return line;
+}
+
* as published by the Free Software Foundation.
*/
-#include <gpiod.h>
+#include "gpiod-internal.h"
#include <stdlib.h>
#include <stdio.h>
#include <dirent.h>
#include <ctype.h>
#include <unistd.h>
-#include <fcntl.h>
#include <sys/ioctl.h>
#include <poll.h>
#include <linux/gpio.h>
-struct gpiod_chip {
- int fd;
- struct gpiochip_info cinfo;
- struct gpiod_line *lines;
-};
-
enum {
LINE_FREE = 0,
LINE_TAKEN,
};
};
-static const char dev_dir[] = "/dev/";
-static const char cdev_prefix[] = "gpiochip";
-
-static bool is_unsigned_int(const char *str)
-{
- for (; *str && isdigit(*str); str++);
-
- return *str == '\0';
-}
-
-static void line_set_offset(struct gpiod_line *line, unsigned int offset)
+void line_set_offset(struct gpiod_line *line, unsigned int offset)
{
line->info.line_offset = offset;
}
line->info.flags = 0;
chip = gpiod_line_get_chip(line);
- fd = chip->fd;
+ fd = chip_get_fd(chip);;
status = ioctl(fd, GPIO_GET_LINEINFO_IOCTL, &line->info);
if (status < 0)
sizeof(req->consumer_label) - 1);
chip = gpiod_line_get_chip(bulk->lines[0]);
- fd = chip->fd;
+ fd = chip_get_fd(chip);;
status = ioctl(fd, GPIO_GET_LINEHANDLE_IOCTL, req);
if (status < 0)
req->eventflags |= GPIOEVENT_REQUEST_BOTH_EDGES;
chip = gpiod_line_get_chip(line);
- fd = chip->fd;
+ fd = chip_get_fd(chip);;
status = ioctl(fd, GPIO_GET_LINEEVENT_IOCTL, req);
if (status < 0)
return 0;
}
-struct gpiod_chip * gpiod_chip_open(const char *path)
-{
- struct gpiod_chip *chip;
- int status, fd;
-
- fd = open(path, O_RDWR | O_CLOEXEC);
- if (fd < 0)
- return NULL;
-
- chip = malloc(sizeof(*chip));
- if (!chip) {
- close(fd);
- return NULL;
- }
-
- memset(chip, 0, sizeof(*chip));
- chip->fd = fd;
-
- status = ioctl(fd, GPIO_GET_CHIPINFO_IOCTL, &chip->cinfo);
- if (status < 0) {
- close(chip->fd);
- free(chip);
- return NULL;
- }
-
- chip->lines = calloc(chip->cinfo.lines, sizeof(*chip->lines));
- if (!chip->lines) {
- close(chip->fd);
- free(chip);
- return NULL;
- }
-
- return chip;
-}
-
-struct gpiod_chip * gpiod_chip_open_by_name(const char *name)
-{
- struct gpiod_chip *chip;
- char *path;
- int status;
-
- status = asprintf(&path, "%s%s", dev_dir, name);
- if (status < 0)
- return NULL;
-
- chip = gpiod_chip_open(path);
- free(path);
-
- return chip;
-}
-
-struct gpiod_chip * gpiod_chip_open_by_number(unsigned int num)
-{
- struct gpiod_chip *chip;
- char *path;
- int status;
-
- status = asprintf(&path, "%s%s%u", dev_dir, cdev_prefix, num);
- if (!status)
- return NULL;
-
- chip = gpiod_chip_open(path);
- free(path);
-
- return chip;
-}
-
-struct gpiod_chip * gpiod_chip_open_by_label(const char *label)
-{
- struct gpiod_chip_iter *iter;
- struct gpiod_chip *chip;
-
- iter = gpiod_chip_iter_new();
- if (!iter)
- return NULL;
-
- gpiod_foreach_chip(iter, chip) {
- if (gpiod_chip_iter_err(iter))
- goto out;
-
- if (strcmp(label, gpiod_chip_label(chip)) == 0) {
- gpiod_chip_iter_free_noclose(iter);
- return chip;
- }
- }
-
-out:
- gpiod_chip_iter_free(iter);
- return NULL;
-}
-
-struct gpiod_chip * gpiod_chip_open_lookup(const char *descr)
-{
- struct gpiod_chip *chip;
-
- if (is_unsigned_int(descr)) {
- chip = gpiod_chip_open_by_number(strtoul(descr, NULL, 10));
- } else {
- chip = gpiod_chip_open_by_label(descr);
- if (!chip) {
- if (strncmp(descr, dev_dir, sizeof(dev_dir) - 1))
- chip = gpiod_chip_open_by_name(descr);
- else
- chip = gpiod_chip_open(descr);
- }
- }
-
- return chip;
-}
-
-void gpiod_chip_close(struct gpiod_chip *chip)
+struct gpiod_chip * gpiod_line_get_chip(struct gpiod_line *line)
{
- unsigned int i;
-
- for (i = 0; i < chip->cinfo.lines; i++)
- gpiod_line_release(&chip->lines[i]);
-
- close(chip->fd);
- free(chip->lines);
- free(chip);
+ return line->chip;
}
-const char * gpiod_chip_name(struct gpiod_chip *chip)
+struct gpiod_line * line_array_alloc(size_t numlines)
{
- return chip->cinfo.name[0] == '\0' ? NULL : chip->cinfo.name;
+ return calloc(numlines, sizeof(struct gpiod_line));
}
-const char * gpiod_chip_label(struct gpiod_chip *chip)
+void line_array_free(struct gpiod_line *lines)
{
- return chip->cinfo.label[0] == '\0' ? NULL : chip->cinfo.label;
+ free(lines);
}
-unsigned int gpiod_chip_num_lines(struct gpiod_chip *chip)
+struct gpiod_line * line_array_member(struct gpiod_line *lines, size_t index)
{
- return (unsigned int)chip->cinfo.lines;
+ return &lines[index];
}
-struct gpiod_line *
-gpiod_chip_get_line(struct gpiod_chip *chip, unsigned int offset)
+void line_set_chip(struct gpiod_line *line, struct gpiod_chip *chip)
{
- struct gpiod_line *line;
- int status;
-
- if (offset >= chip->cinfo.lines) {
- errno = EINVAL;
- return NULL;
- }
-
- line = &chip->lines[offset];
- line_set_offset(line, offset);
line->chip = chip;
-
- status = gpiod_line_update(line);
- if (status < 0)
- return NULL;
-
- return line;
-}
-
-struct gpiod_chip * gpiod_line_get_chip(struct gpiod_line *line)
-{
- return line->chip;
}
projects / qemu-gpiodev / libgpiod.git / commitdiff