diff options
Diffstat (limited to 'src/kevent.c')
| -rw-r--r-- | src/kevent.c | 182 |
1 files changed, 182 insertions, 0 deletions
diff --git a/src/kevent.c b/src/kevent.c new file mode 100644 index 0000000..4d84fbb --- /dev/null +++ b/src/kevent.c @@ -0,0 +1,182 @@ +/* + * Copyright (C) ST-Ericsson SA 2011 + * Author: Per Persson per.xb.persson@stericsson.com for + * ST-Ericsson. + * + * License terms: + * 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 <unistd.h> /* Symbolic Constants */ +#include <sys/types.h> /* Primitive System Data Types */ +#include <linux/types.h> +#include <errno.h> /* Errors */ +#include <stdarg.h> +#include <stdio.h> /* Input/Output */ +#include <stdlib.h> /* General Utilities */ +#include <pthread.h> /* POSIX Threads */ +#include <string.h> /* String handling */ +#include <fcntl.h> +#include <time.h> +#include <ctype.h> +#include <sys/poll.h> +#ifdef ANDROID +#include <utils/Log.h> +#endif +#include "../include/hdmi_service_api.h" +#include "../include/hdmi_service_local.h" + +static int hdmieventfile_open(struct pollfd *pollfds) +{ + + pollfds->fd = open(EVENT_FILE, O_RDONLY); + if (pollfds->fd < 0) { + LOGHDMILIB(" failed to open %s", EVENT_FILE); + return -1; + } + + pollfds->events = POLLERR | POLLPRI; + return 0; +} + +static int hdmieventfile_read(int fd) +{ + int read_res; + char buf[128]; + int events; + + read_res = read(fd, buf, sizeof(buf)); + /* seek back so we can read the new state */ + lseek(fd, 0, SEEK_SET); + + LOGHDMILIB2("read_res:%d", read_res); + + if (read_res != POLL_READ_SIZE) + return HDMIEVENT_POLLSIZEFAIL; + + events = *buf; + + LOGHDMILIB2("events read:%02x", events); + return events; +} + +static int hdmieventfile_poll(struct pollfd *pollfds) +{ + int result; + int timeout = -1; /* Timeout in msec. */ + + result = poll(pollfds, 1, timeout); + switch (result) { + case 0: + LOGHDMILIB2("%s", "timeout"); + break; + case -1: + LOGHDMILIB2("%s", "poll error"); + break; + default: + if (pollfds->revents & POLLERR) + LOGHDMILIB2("res:%d poll done", result); + else { + LOGHDMILIB2("rev:%x res:%d poll done2", + pollfds->revents, result); + } + break; + } + return 0; +} + +static int hdmieventfile_close(int fd) +{ + LOGHDMILIB("%s", __func__); + close(fd); + return 0; +} + +int hdmievclr(__u8 mask) +{ + int evclrfd; + int ret = 0; + + evclrfd = open(EVENTCLR_FILE, O_WRONLY); + if (evclrfd < 0) { + LOGHDMILIB(" failed to open %s", EVENTCLR_FILE); + return -1; + } + if (write(evclrfd, &mask, 1) != 1) + ret = -2; + close(evclrfd); + return ret; +} + +/* + * Reading of kernel events + */ +void thread_kevent_fn(void *arg) +{ + int event; + struct pollfd pollfds; + + LOGHDMILIB("%s begin", __func__); + + /* + * Note: events are subscribed at call to api function hdmi_enable + * Until then no events will occur. + */ + + /* Open the event file */ + hdmieventfile_open(&pollfds); + + while (1) { + /* Read poll event file */ + event = hdmieventfile_read(pollfds.fd); + LOGHDMILIB("kevent:%x", event); + + if (event == HDMIEVENT_POLLSIZEFAIL) { + usleep(100000); + + /* Close event file */ + hdmieventfile_close(pollfds.fd); + + /* Open the event file */ + hdmieventfile_open(&pollfds); + + } else { + /* Signal main thread */ + hdmi_event(event); + + if (event & HDMIEVENT_WAKEUP) + break; + + } + + /* Poll plug event file */ + hdmieventfile_poll(&pollfds); + } + + /* Clear events */ + hdmievclr(EVENTMASK_ALL); + + /* Close event file */ + hdmieventfile_close(pollfds.fd); + + LOGHDMILIB("%s end", __func__); + + /* Exit thread */ + pthread_exit(NULL); +} |