rpi_gpio 0.3.0 → 0.5.0

data/ext/rpi_gpio/event_gpio.c

@@ -1,575 +0,0 @@
-/*
-Original code by Ben Croston modified for Ruby by Nick Lowery
-(github.com/clockvapor)
-Copyright (c) 2014-2016 Nick Lowery
-
-Copyright (c) 2013-2016 Ben Croston
-
-Permission is hereby granted, free of charge, to any person obtaining a copy of
-this software and associated documentation files (the "Software"), to deal in
-the Software without restriction, including without limitation the rights to
-use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies
-of the Software, and to permit persons to whom the Software is furnished to do
-so, subject to the following conditions:
-
-The above copyright notice and this permission notice shall be included in all
-copies or substantial portions of the Software.
-
-THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
-IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
-FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
-AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
-LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
-OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
-SOFTWARE.
-*/
-
-#include <pthread.h>
-#include <sys/epoll.h>
-#include <stdio.h>
-#include <stdlib.h>
-#include <fcntl.h>
-#include <unistd.h>
-#include <string.h>
-#include <sys/time.h>
-#include "event_gpio.h"
-
-const char *stredge[4] = {"none", "rising", "falling", "both"};
-
-struct gpios
-{
-    unsigned int gpio;
-    int value_fd;
-    int exported;
-    int edge;
-    int initial_thread;
-    int initial_wait;
-    int thread_added;
-    int bouncetime;
-    unsigned long long lastcall;
-    struct gpios *next;
-};
-struct gpios *gpio_list = NULL;
-
-// event callbacks
-struct callback
-{
-    unsigned int gpio;
-    void (*func)(unsigned int gpio);
-    struct callback *next;
-};
-struct callback *callbacks = NULL;
-
-pthread_t threads;
-int event_occurred[54] = { 0 };
-int thread_running = 0;
-int epfd_thread = -1;
-int epfd_blocking = -1;
-
-/************* /sys/class/gpio functions ************/
-int gpio_export(unsigned int gpio)
-{
-    int fd, len;
-    char str_gpio[3];
-
-    if ((fd = open("/sys/class/gpio/export", O_WRONLY)) < 0)
-       return -1;
-
-    len = snprintf(str_gpio, sizeof(str_gpio), "%d", gpio);
-    write(fd, str_gpio, len);
-    close(fd);
-
-    return 0;
-}
-
-int gpio_unexport(unsigned int gpio)
-{
-    int fd, len;
-    char str_gpio[3];
-
-    if ((fd = open("/sys/class/gpio/unexport", O_WRONLY)) < 0)
-        return -1;
-
-    len = snprintf(str_gpio, sizeof(str_gpio), "%d", gpio);
-    write(fd, str_gpio, len);
-    close(fd);
-
-    return 0;
-}
-
-int gpio_set_direction(unsigned int gpio, unsigned int in_flag)
-{
-    int retry;
-    struct timespec delay;
-    int fd;
-    char filename[33];
-
-    snprintf(filename, sizeof(filename), "/sys/class/gpio/gpio%d/direction", gpio);
-
-    // retry waiting for udev to set correct file permissions
-    delay.tv_sec = 0;
-    delay.tv_nsec = 10000000L; // 10ms
-    for (retry=0; retry<100; retry++) {
-        if ((fd = open(filename, O_WRONLY)) >= 0)
-            break;
-        nanosleep(&delay, NULL);
-    }
-    if (retry >= 100) {
-        return -1;
-    }
-
-    if (in_flag) {
-        write(fd, "in", 3);
-    } else {
-        write(fd, "out", 4);
-    }
-
-    close(fd);
-    return 0;
-}
-
-int gpio_set_edge(unsigned int gpio, unsigned int edge)
-{
-    int fd;
-    char filename[28];
-
-    snprintf(filename, sizeof(filename), "/sys/class/gpio/gpio%d/edge", gpio);
-
-    if ((fd = open(filename, O_WRONLY)) < 0)
-        return -1;
-
-    write(fd, stredge[edge], strlen(stredge[edge]) + 1);
-    close(fd);
-    return 0;
-}
-
-int open_value_file(unsigned int gpio)
-{
-    int fd;
-    char filename[29];
-
-    // create file descriptor of value file
-    snprintf(filename, sizeof(filename), "/sys/class/gpio/gpio%d/value", gpio);
-    if ((fd = open(filename, O_RDONLY | O_NONBLOCK)) < 0)
-        return -1;
-    return fd;
-}
-
-/********* gpio list functions **********/
-struct gpios *get_gpio(unsigned int gpio)
-{
-    struct gpios *g = gpio_list;
-    while (g != NULL) {
-        if (g->gpio == gpio)
-            return g;
-        g = g->next;
-    }
-    return NULL;
-}
-
-struct gpios *get_gpio_from_value_fd(int fd)
-{
-    struct gpios *g = gpio_list;
-    while (g != NULL) {
-        if (g->value_fd == fd)
-           return g;
-        g = g->next;
-    }
-    return NULL;
-}
-
-struct gpios *new_gpio(unsigned int gpio)
-{
-    struct gpios *new_gpio;
-
-    new_gpio = malloc(sizeof(struct gpios));
-    if (new_gpio == 0) {
-        return NULL;  // out of memory
-    }
-
-    new_gpio->gpio = gpio;
-    if (gpio_export(gpio) != 0) {
-        free(new_gpio);
-        return NULL;
-    }
-    new_gpio->exported = 1;
-
-    if (gpio_set_direction(gpio,1) != 0) { // 1==input
-        free(new_gpio);
-        return NULL;
-    }
-
-    if ((new_gpio->value_fd = open_value_file(gpio)) == -1) {
-        gpio_unexport(gpio);
-        free(new_gpio);
-        return NULL;
-    }
-
-    new_gpio->initial_thread = 1;
-    new_gpio->initial_wait = 1;
-    new_gpio->bouncetime = -666;
-    new_gpio->lastcall = 0;
-    new_gpio->thread_added = 0;
-
-    if (gpio_list == NULL) {
-        new_gpio->next = NULL;
-    } else {
-        new_gpio->next = gpio_list;
-    }
-    gpio_list = new_gpio;
-    return new_gpio;
-}
-
-void delete_gpio(unsigned int gpio)
-{
-    struct gpios *g = gpio_list;
-    struct gpios *temp;
-    struct gpios *prev = NULL;
-
-    while (g != NULL) {
-        if (g->gpio == gpio) {
-            if (prev == NULL)
-                gpio_list = g->next;
-            else
-                prev->next = g->next;
-            temp = g;
-            g = g->next;
-            free(temp);
-            return;
-        } else {
-            prev = g;
-            g = g->next;
-        }
-    }
-}
-
-int gpio_event_added(unsigned int gpio)
-{
-    struct gpios *g = gpio_list;
-    while (g != NULL) {
-        if (g->gpio == gpio)
-            return g->edge;
-        g = g->next;
-    }
-    return 0;
-}
-
-/******* callback list functions ********/
-int add_edge_callback(unsigned int gpio, void (*func)(unsigned int gpio))
-{
-    struct callback *cb = callbacks;
-    struct callback *new_cb;
-
-    new_cb = malloc(sizeof(struct callback));
-    if (new_cb == 0)
-        return -1;  // out of memory
-
-    new_cb->gpio = gpio;
-    new_cb->func = func;
-    new_cb->next = NULL;
-
-    if (callbacks == NULL) {
-        // start new list
-        callbacks = new_cb;
-    } else {
-        // add to end of list
-        while (cb->next != NULL)
-            cb = cb->next;
-        cb->next = new_cb;
-    }
-    return 0;
-}
-
-int callback_exists(unsigned int gpio)
-{
-    struct callback *cb = callbacks;
-    while (cb != NULL) {
-        if (cb->gpio == gpio)
-            return 1;
-        cb = cb->next;
-    }
-    return 0;
-}
-
-void run_callbacks(unsigned int gpio)
-{
-    struct callback *cb = callbacks;
-    while (cb != NULL)
-    {
-        if (cb->gpio == gpio)
-            cb->func(cb->gpio);
-        cb = cb->next;
-    }
-}
-
-void remove_callbacks(unsigned int gpio)
-{
-    struct callback *cb = callbacks;
-    struct callback *temp;
-    struct callback *prev = NULL;
-
-    while (cb != NULL)
-    {
-        if (cb->gpio == gpio)
-        {
-            if (prev == NULL)
-                callbacks = cb->next;
-            else
-                prev->next = cb->next;
-            temp = cb;
-            cb = cb->next;
-            free(temp);
-        } else {
-            prev = cb;
-            cb = cb->next;
-        }
-    }
-}
-
-void *poll_thread(void *threadarg)
-{
-    struct epoll_event events;
-    char buf;
-    struct timeval tv_timenow;
-    unsigned long long timenow;
-    struct gpios *g;
-    int n;
-
-    thread_running = 1;
-    while (thread_running) {
-        if ((n = epoll_wait(epfd_thread, &events, 1, -1)) == -1) {
-            thread_running = 0;
-            pthread_exit(NULL);
-        }
-        if (n > 0) {
-            lseek(events.data.fd, 0, SEEK_SET);
-            if (read(events.data.fd, &buf, 1) != 1) {
-                thread_running = 0;
-                pthread_exit(NULL);
-            }
-            g = get_gpio_from_value_fd(events.data.fd);
-            if (g->initial_thread) {     // ignore first epoll trigger
-                g->initial_thread = 0;
-            } else {
-                gettimeofday(&tv_timenow, NULL);
-                timenow = tv_timenow.tv_sec*1E6 + tv_timenow.tv_usec;
-                if (g->bouncetime == -666 || timenow - g->lastcall > g->bouncetime*1000 || g->lastcall == 0 || g->lastcall > timenow) {
-                    g->lastcall = timenow;
-                    event_occurred[g->gpio] = 1;
-                    run_callbacks(g->gpio);
-                }
-            }
-        }
-    }
-    thread_running = 0;
-    pthread_exit(NULL);
-}
-
-void remove_edge_detect(unsigned int gpio)
-{
-    struct epoll_event ev;
-    struct gpios *g = get_gpio(gpio);
-
-    if (g == NULL)
-        return;
-
-    // delete epoll of fd
-
-    ev.events = EPOLLIN | EPOLLET | EPOLLPRI;
-    ev.data.fd = g->value_fd;
-    epoll_ctl(epfd_thread, EPOLL_CTL_DEL, g->value_fd, &ev);
-
-    // delete callbacks for gpio
-    remove_callbacks(gpio);
-
-    // btc fixme - check return result??
-    gpio_set_edge(gpio, NO_EDGE);
-    g->edge = NO_EDGE;
-
-    if (g->value_fd != -1)
-        close(g->value_fd);
-
-    // btc fixme - check return result??
-    gpio_unexport(gpio);
-    event_occurred[gpio] = 0;
-
-    delete_gpio(gpio);
-}
-
-int event_detected(unsigned int gpio)
-{
-    if (event_occurred[gpio]) {
-        event_occurred[gpio] = 0;
-        return 1;
-    } else {
-        return 0;
-    }
-}
-
-void event_cleanup(unsigned int gpio)
-// gpio of -666 means clean every channel used
-{
-    struct gpios *g = gpio_list;
-    struct gpios *temp = NULL;
-
-    while (g != NULL) {
-        if ((gpio == -666) || (g->gpio == gpio))
-            temp = g->next;
-            remove_edge_detect(g->gpio);
-            g = temp;
-    }
-    if (gpio_list == NULL)
-        if (epfd_blocking != -1)
-            close(epfd_blocking);
-            epfd_blocking = -1;
-        if (epfd_thread != -1)
-            close(epfd_thread);
-            epfd_thread = -1;
-        thread_running = 0;
-}
-
-void event_cleanup_all(void)
-{
-   event_cleanup(-666);
-}
-
-int add_edge_detect(unsigned int gpio, unsigned int edge, int bouncetime)
-// return values:
-// 0 - Success
-// 1 - Edge detection already added
-// 2 - Other error
-{
-    pthread_t threads;
-    struct epoll_event ev;
-    long t = 0;
-    struct gpios *g;
-    int i = -1;
-
-    i = gpio_event_added(gpio);
-    if (i == 0) {    // event not already added
-        if ((g = new_gpio(gpio)) == NULL)
-            return 2;
-
-        gpio_set_edge(gpio, edge);
-        g->edge = edge;
-        g->bouncetime = bouncetime;
-    } else if (i == edge) {  // get existing event
-        g = get_gpio(gpio);
-        if ((bouncetime != -666 && g->bouncetime != bouncetime) ||  // different event bouncetime used
-            (g->thread_added))                // event already added
-            return 1;
-    } else {
-        return 1;
-    }
-
-    // create epfd_thread if not already open
-    if ((epfd_thread == -1) && ((epfd_thread = epoll_create(1)) == -1))
-        return 2;
-
-    // add to epoll fd
-    ev.events = EPOLLIN | EPOLLET | EPOLLPRI;
-    ev.data.fd = g->value_fd;
-    if (epoll_ctl(epfd_thread, EPOLL_CTL_ADD, g->value_fd, &ev) == -1) {
-        remove_edge_detect(gpio);
-        return 2;
-    }
-    g->thread_added = 1;
-
-    // start poll thread if it is not already running
-    if (!thread_running) {
-        if (pthread_create(&threads, NULL, poll_thread, (void *)t) != 0) {
-           remove_edge_detect(gpio);
-           return 2;
-        }
-    }
-    return 0;
-}
-
-int blocking_wait_for_edge(unsigned int gpio, unsigned int edge, int bouncetime, int timeout)
-// return values:
-//    1 - Success (edge detected)
-//    0 - Timeout
-//   -1 - Edge detection already added
-//   -2 - Other error
-{
-    int n, ed;
-    struct epoll_event events, ev;
-    char buf;
-    struct gpios *g = NULL;
-    struct timeval tv_timenow;
-    unsigned long long timenow;
-    int finished = 0;
-    int initial_edge = 1;
-
-    if (callback_exists(gpio)) {
-        return -1;
-    }
-
-    // add gpio if it has not been added already
-    ed = gpio_event_added(gpio);
-    if (ed == edge) {   // get existing record
-        g = get_gpio(gpio);
-        if (g->bouncetime != -666 && g->bouncetime != bouncetime) {
-            return -1;
-        }
-    } else if (ed == NO_EDGE) {   // not found so add event
-        if ((g = new_gpio(gpio)) == NULL) {
-            return -2;
-        }
-        gpio_set_edge(gpio, edge);
-        g->edge = edge;
-        g->bouncetime = bouncetime;
-    } else {    // ed != edge - event for a different edge
-        g = get_gpio(gpio);
-        gpio_set_edge(gpio, edge);
-        g->edge = edge;
-        g->bouncetime = bouncetime;
-        g->initial_wait = 1;
-    }
-
-    // create epfd_blocking if not already open
-    if ((epfd_blocking == -1) && ((epfd_blocking = epoll_create(1)) == -1)) {
-        return -2;
-    }
-
-    // add to epoll fd
-    ev.events = EPOLLIN | EPOLLET | EPOLLPRI;
-    ev.data.fd = g->value_fd;
-    if (epoll_ctl(epfd_blocking, EPOLL_CTL_ADD, g->value_fd, &ev) == -1) {
-        return -2;
-    }
-
-    // wait for edge
-    while (!finished) {
-        if ((n = epoll_wait(epfd_blocking, &events, 1, timeout)) == -1) {
-            epoll_ctl(epfd_blocking, EPOLL_CTL_DEL, g->value_fd, &ev);
-            return -2;
-        }
-        if (initial_edge) { // first time triggers with current state, so ignore  
-            initial_edge = 0;
-        } else {
-            gettimeofday(&tv_timenow, NULL);
-            timenow = tv_timenow.tv_sec*1E6 + tv_timenow.tv_usec;
-            if (g->bouncetime == -666 || timenow - g->lastcall > g->bouncetime*1000 || g->lastcall == 0 || g->lastcall > timenow) {
-                g->lastcall = timenow;
-                finished = 1;
-            }
-        }
-    }
-
-    // check event was valid
-    if (n > 0) {
-        lseek(events.data.fd, 0, SEEK_SET);
-        if ((read(events.data.fd, &buf, 1) != 1) || (events.data.fd != g->value_fd)) {
-            epoll_ctl(epfd_blocking, EPOLL_CTL_DEL, g->value_fd, &ev);
-            return -2;
-        }
-    }
-
-    epoll_ctl(epfd_blocking, EPOLL_CTL_DEL, g->value_fd, &ev);
-    if (n == 0) {
-       return 0; // timeout
-    } else {
-       return 1; // edge found
-    }
-}