442 lines
15 KiB
C
442 lines
15 KiB
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;
|
||
|
|
}
|