toolbox/powerd.c

#include <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <string.h>
#include <errno.h>
#include <time.h>
#include <sys/select.h>
#include <sys/inotify.h>

#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))

//#include <linux/input.h> // this does not compile

// from <linux/input.h>

struct input_event {
	struct timeval time;
	__u16 type;
	__u16 code;
	__s32 value;
};

#define EVIOCGVERSION		_IOR('E', 0x01, int)			/* get driver version */
#define EVIOCGID		_IOR('E', 0x02, struct input_id)	/* get device ID */
#define EVIOCGKEYCODE		_IOR('E', 0x04, int[2])			/* get keycode */
#define EVIOCSKEYCODE		_IOW('E', 0x04, int[2])			/* set keycode */

#define EVIOCGNAME(len)		_IOC(_IOC_READ, 'E', 0x06, len)		/* get device name */
#define EVIOCGPHYS(len)		_IOC(_IOC_READ, 'E', 0x07, len)		/* get physical location */
#define EVIOCGUNIQ(len)		_IOC(_IOC_READ, 'E', 0x08, len)		/* get unique identifier */

#define EVIOCGKEY(len)		_IOC(_IOC_READ, 'E', 0x18, len)		/* get global keystate */
#define EVIOCGLED(len)		_IOC(_IOC_READ, 'E', 0x19, len)		/* get all LEDs */
#define EVIOCGSND(len)		_IOC(_IOC_READ, 'E', 0x1a, len)		/* get all sounds status */
#define EVIOCGSW(len)		_IOC(_IOC_READ, 'E', 0x1b, len)		/* get all switch states */

#define EVIOCGBIT(ev,len)	_IOC(_IOC_READ, 'E', 0x20 + ev, len)	/* get event bits */
#define EVIOCGABS(abs)		_IOR('E', 0x40 + abs, struct input_absinfo)		/* get abs value/limits */
#define EVIOCSABS(abs)		_IOW('E', 0xc0 + abs, struct input_absinfo)		/* set abs value/limits */

#define EVIOCSFF		_IOC(_IOC_WRITE, 'E', 0x80, sizeof(struct ff_effect))	/* send a force effect to a force feedback device */
#define EVIOCRMFF		_IOW('E', 0x81, int)			/* Erase a force effect */
#define EVIOCGEFFECTS		_IOR('E', 0x84, int)			/* Report number of effects playable at the same time */

#define EVIOCGRAB		_IOW('E', 0x90, int)			/* Grab/Release device */

/*
 * Event types
 */

#define EV_SYN			0x00
#define EV_KEY			0x01
#define EV_REL			0x02
#define EV_ABS			0x03
#define EV_MSC			0x04
#define EV_SW			0x05
#define EV_LED			0x11
#define EV_SND			0x12
#define EV_REP			0x14
#define EV_FF			0x15
#define EV_PWR			0x16
#define EV_FF_STATUS		0x17
#define EV_MAX			0x1f

#define KEY_POWER		116
#define KEY_SLEEP		142
#define SW_0		0x00

// end <linux/input.h>

struct notify_entry {
    int id;
    int (*handler)(struct notify_entry *entry, struct inotify_event *event);
    const char *filename;
};

int charging_state_notify_handler(struct notify_entry *entry, struct inotify_event *event)
{
    static int state = -1;
    int last_state;
    char buf[40];
    int read_len;
    int fd;

    last_state = state;
    fd = open(entry->filename, O_RDONLY);
    read_len = read(fd, buf, sizeof(buf));
    if(read_len > 0) {
        //printf("charging_state_notify_handler: \"%s\"\n", buf);
        state = !(strncmp(buf, "Unknown", 7) == 0 
                  || strncmp(buf, "Discharging", 11) == 0);
    }
    close(fd);
    //printf("charging_state_notify_handler: %d -> %d\n", last_state, state);
    return state > last_state;
}

struct notify_entry watched_files[] = {
    {
        .filename = "/sys/android_power/charging_state",
        .handler = charging_state_notify_handler
    }
};

int call_notify_handler(struct inotify_event *event)
{
    unsigned int start, i;
    start = event->wd - watched_files[0].id;
    if(start >= ARRAY_SIZE(watched_files))
        start = 0;
    //printf("%d: %08x \"%s\"\n", event->wd, event->mask, event->len ? event->name : "");
    for(i = start; i < ARRAY_SIZE(watched_files); i++) {
        if(event->wd == watched_files[i].id) {
            if(watched_files[i].handler) {
                return watched_files[i].handler(&watched_files[i], event);
            }
            return 1;
        }
    }
    for(i = 0; i < start; i++) {
        if(event->wd == watched_files[i].id) {
            if(watched_files[i].handler) {
                return watched_files[i].handler(&watched_files[i], event);
            }
            return 1;
        }
    }
    return 0;
}

int handle_inotify_event(int nfd)
{
    int res;
    int wake_up = 0;
    struct inotify_event *event;
    char event_buf[512];
    int event_pos = 0;

    res = read(nfd, event_buf, sizeof(event_buf));
    if(res < (int)sizeof(*event)) {
        if(errno == EINTR)
            return 0;
        fprintf(stderr, "could not get event, %s\n", strerror(errno));
        return 0;
    }
    printf("got %d bytes of event information\n", res);
    while(res >= (int)sizeof(*event)) {
        int event_size;
        event = (struct inotify_event *)(event_buf + event_pos);
        wake_up |= call_notify_handler(event);
        event_size = sizeof(*event) + event->len;
        res -= event_size;
        event_pos += event_size;
    }
    return wake_up;
}

int powerd_main(int argc, char *argv[])
{
    int c;
    unsigned int i;
    int res;
    struct timeval tv;
    int eventfd;
    int notifyfd;
    int powerfd;
    int powerfd_is_sleep;
    int user_activity_fd;
    int acquire_partial_wake_lock_fd;
    int acquire_full_wake_lock_fd;
    int release_wake_lock_fd;
    char *eventdev = "/dev/input/event0";
    const char *android_sleepdev = "/sys/android_power/request_sleep";
    const char *android_autooff_dev = "/sys/android_power/auto_off_timeout";
    const char *android_user_activity_dev = "/sys/android_power/last_user_activity";
    const char *android_acquire_partial_wake_lock_dev = "/sys/android_power/acquire_partial_wake_lock";
    const char *android_acquire_full_wake_lock_dev = "/sys/android_power/acquire_full_wake_lock";
    const char *android_release_wake_lock_dev = "/sys/android_power/release_wake_lock";
    const char *powerdev = "/sys/power/state";
    const char suspendstring[] = "standby";
    const char wakelockstring[] = "powerd";
    fd_set rfds;
    struct input_event event;
    struct input_event light_event;
    struct input_event light_event2;
    int gotkey = 1;
    time_t idle_time = 5;
    const char *idle_time_string = "5";
    time_t lcd_light_time = 0;
    time_t key_light_time = 0;
    int verbose = 1;
    int event_sleep = 0;
    int got_power_key_down = 0;
    struct timeval power_key_down_time = { 0, 0 };

    light_event.type = EV_LED;
    light_event.code = 4; // bright lcd backlight
    light_event.value = 0; // light off -- sleep after timeout

    light_event2.type = EV_LED;
    light_event2.code = 8; // keyboard backlight
    light_event2.value = 0; // light off -- sleep after timeout

    do {
        c = getopt(argc, argv, "e:ni:vql:k:");
        if (c == EOF)
            break;
        switch (c) {
        case 'e':
            eventdev = optarg;
            break;
        case 'n':
            gotkey = 0;
            break;
        case 'i':
            idle_time = atoi(optarg);
            idle_time_string = optarg;
            break;
        case 'v':
            verbose = 2;
            break;
        case 'q':
            verbose = 0;
            break;
        case 'l':
            lcd_light_time = atoi(optarg);
            break;
        case 'k':
            key_light_time = atoi(optarg);
            break;
        case '?':
            fprintf(stderr, "%s: invalid option -%c\n",
                argv[0], optopt);
            exit(1);
        }
    } while (1);
    if(optind  != argc) {
        fprintf(stderr,"%s [-e eventdev]\n", argv[0]);
        return 1;
    }

    eventfd = open(eventdev, O_RDWR | O_NONBLOCK);
    if(eventfd < 0) {
        fprintf(stderr, "could not open %s, %s\n", eventdev, strerror(errno));
        return 1;
    }
    if(key_light_time >= lcd_light_time) {
        lcd_light_time = key_light_time + 1;
        fprintf(stderr,"lcd bright backlight time must be longer than keyboard backlight time.\n"
            "Setting lcd bright backlight time to %ld seconds\n", lcd_light_time);
    }

    user_activity_fd = open(android_user_activity_dev, O_RDWR);
    if(user_activity_fd >= 0) {
        int auto_off_fd = open(android_autooff_dev, O_RDWR);
        write(auto_off_fd, idle_time_string, strlen(idle_time_string));
        close(auto_off_fd);
    }

    powerfd = open(android_sleepdev, O_RDWR);
    if(powerfd >= 0) {
        powerfd_is_sleep = 1;
        if(verbose > 0)
            printf("Using android sleep dev: %s\n", android_sleepdev);
    }
    else {
        powerfd_is_sleep = 0;
        powerfd = open(powerdev, O_RDWR);
        if(powerfd >= 0) {
            if(verbose > 0)
                printf("Using linux power dev: %s\n", powerdev);
        }
    }
    if(powerfd < 0) {
        fprintf(stderr, "could not open %s, %s\n", powerdev, strerror(errno));
        return 1;
    }

    notifyfd = inotify_init();
    if(notifyfd < 0) {
        fprintf(stderr, "inotify_init failed, %s\n", strerror(errno));
        return 1;
    }
    fcntl(notifyfd, F_SETFL, O_NONBLOCK | fcntl(notifyfd, F_GETFL));
    for(i = 0; i < ARRAY_SIZE(watched_files); i++) {
        watched_files[i].id = inotify_add_watch(notifyfd, watched_files[i].filename, IN_MODIFY);
        printf("Watching %s, id %d\n", watched_files[i].filename, watched_files[i].id);
    }

    acquire_partial_wake_lock_fd = open(android_acquire_partial_wake_lock_dev, O_RDWR);
    acquire_full_wake_lock_fd = open(android_acquire_full_wake_lock_dev, O_RDWR);
    release_wake_lock_fd = open(android_release_wake_lock_dev, O_RDWR);

    if(user_activity_fd >= 0) {
        idle_time = 60*60*24; // driver handles real timeout
    }
    if(gotkey) {
        tv.tv_sec = idle_time;
        tv.tv_usec = 0;
    }
    else {
        tv.tv_sec = 0;
        tv.tv_usec = 500000;
    }
    
    while(1) {
        FD_ZERO(&rfds);
        //FD_SET(0, &rfds);
        FD_SET(eventfd, &rfds);
        FD_SET(notifyfd, &rfds);
        res = select(((notifyfd > eventfd) ? notifyfd : eventfd) + 1, &rfds, NULL, NULL, &tv);
        if(res < 0) {
            fprintf(stderr, "select failed, %s\n", strerror(errno));
            return 1;
        }
        if(res == 0) {
            if(light_event2.value == 1)
                goto light2_off;
            if(light_event.value == 1)
                goto light_off;
            if(user_activity_fd < 0) {
                if(gotkey && verbose > 0)
                    printf("Idle - sleep\n");
                if(!gotkey && verbose > 1)
                    printf("Reenter sleep\n");
                goto sleep;
            }
            else {
                tv.tv_sec = 60*60*24;
                tv.tv_usec = 0;
            }
        }
        if(res > 0) {
            //if(FD_ISSET(0, &rfds)) {
            //  printf("goto data on stdin quit\n");
            //  return 0;
            //}
            if(FD_ISSET(notifyfd, &rfds)) {
                write(acquire_partial_wake_lock_fd, wakelockstring, sizeof(wakelockstring) - 1);
                if(handle_inotify_event(notifyfd) > 0) {
                    write(acquire_full_wake_lock_fd, wakelockstring, sizeof(wakelockstring) - 1);
                }
                write(release_wake_lock_fd, wakelockstring, sizeof(wakelockstring) - 1);
            }
            if(FD_ISSET(eventfd, &rfds)) {
                write(acquire_partial_wake_lock_fd, wakelockstring, sizeof(wakelockstring) - 1);
                res = read(eventfd, &event, sizeof(event));
                if(res < (int)sizeof(event)) {
                    fprintf(stderr, "could not get event\n");
                    write(release_wake_lock_fd, wakelockstring, sizeof(wakelockstring) - 1);
                    return 1;
                }
                if(event.type == EV_PWR && event.code == KEY_SLEEP) {
                    event_sleep = event.value;
                }
                if(event.type == EV_KEY || (event.type == EV_SW && event.code == SW_0 && event.value == 1)) {
                    gotkey = 1;
                    if(user_activity_fd >= 0) {
                        char buf[32];
                        int len;
                        len = sprintf(buf, "%ld%06lu000", event.time.tv_sec, event.time.tv_usec);
                        write(user_activity_fd, buf, len);
                    }
                    if(lcd_light_time | key_light_time) {
                        tv.tv_sec = key_light_time;
                        light_event.value = 1;
                        write(eventfd, &light_event, sizeof(light_event));
                        light_event2.value = 1;
                        write(eventfd, &light_event2, sizeof(light_event2));
                    }
                    else {
                        tv.tv_sec = idle_time;
                    }
                    tv.tv_usec = 0;
                    if(verbose > 1)
                        printf("got %s %s %d%s\n", event.type == EV_KEY ? "key" : "switch", event.value ? "down" : "up", event.code, event_sleep ? " from sleep" : "");
                    if(event.code == KEY_POWER) {
                        if(event.value == 0) {
                            int tmp_got_power_key_down = got_power_key_down;
                            got_power_key_down = 0;
                            if(tmp_got_power_key_down) {
                                // power key released
                                if(verbose > 0)
                                    printf("Power key released - sleep\n");
                                write(release_wake_lock_fd, wakelockstring, sizeof(wakelockstring) - 1);
                                goto sleep;
                            }
                        }
                        else if(event_sleep == 0) {
                            got_power_key_down = 1;
                            power_key_down_time = event.time;
                        }
                    }
                }
                if(event.type == EV_SW && event.code == SW_0 && event.value == 0) {
                    if(verbose > 0)
                        printf("Flip closed - sleep\n");
                    power_key_down_time = event.time;
                    write(release_wake_lock_fd, wakelockstring, sizeof(wakelockstring) - 1);
                    goto sleep;
                }
                write(release_wake_lock_fd, wakelockstring, sizeof(wakelockstring) - 1);
            }
        }
        if(0) {
light_off:
            light_event.value = 0;
            write(eventfd, &light_event, sizeof(light_event));
            tv.tv_sec = idle_time - lcd_light_time;
        }
        if(0) {
light2_off:
            light_event2.value = 0;
            write(eventfd, &light_event2, sizeof(light_event2));
            tv.tv_sec = lcd_light_time - key_light_time;
        }
        if(0) {
sleep:
            if(light_event.value == 1) {
                light_event.value = 0;
                write(eventfd, &light_event, sizeof(light_event));
                light_event2.value = 0;
                write(eventfd, &light_event2, sizeof(light_event2));
                tv.tv_sec = idle_time - lcd_light_time;
            }
            if(powerfd_is_sleep) {
                char buf[32];
                int len;
                len = sprintf(buf, "%ld%06lu000", power_key_down_time.tv_sec, power_key_down_time.tv_usec);
                write(powerfd, buf, len);
            }
            else
                write(powerfd, suspendstring, sizeof(suspendstring) - 1);
            gotkey = 0;
            tv.tv_sec = 0;
            tv.tv_usec = 500000;
        }
    }

    return 0;
}