-rw-r--r-- | core/opiealarm/opiealarm.c | 73 |
1 files changed, 42 insertions, 31 deletions
diff --git a/core/opiealarm/opiealarm.c b/core/opiealarm/opiealarm.c index bb2e684..5ea24b7 100644 --- a/core/opiealarm/opiealarm.c +++ b/core/opiealarm/opiealarm.c @@ -175,170 +175,181 @@ int main ( int argc, char **argv ) } } if ( geteuid ( ) != 0 ) { fprintf ( stderr, "You need root priviledges to run opiealarm." ); return 2; } if ( !mode ) usage ( ); parent_pid = getpid ( ); // kill running opiealarm opiealarm_was_running = kill_with_pidfile ( ); remove_pidfile ( ); switch ( mode ) { case 'r': opt = resume ( ac_resusp ); break; case 's': default : opt = suspend ( fix_rtc ); break; } parent_pid = 0; return opt; } int suspend ( int fix_rtc ) { FILE *fp; char buf [64]; time_t alrt, syst, rtct; struct tm alr, sys, rtc; int fd; int rtc_sys_diff; if ( !fork_with_pidfile ( )) return 3; // we are the child process from here on ... tzset ( ); // not sure if it is really needed -- it probably doesn't hurt ... - do { // try/catch simulation + time ( &syst );// get the UNIX system time + sys = *localtime ( &syst ); - // read the wakeup time from /etc/resumeat - if (!( fp = fopen ( "/etc/resumeat", "r" ))) - break; // ( 1, "/etc/resumeat" ); - - if ( !fgets ( buf, sizeof( buf ) - 1, fp )) - break; // ( 1, "/etc/resumeat" ); - - fclose ( fp ); - - alrt = atoi ( buf ); // get the alarm time - if ( alrt == 0 ) - break; // ( 0, "/etc/resumeat contains an invalid time description" ); - alrt -= 5; // wake up 5 sec before the specified time - alr = *gmtime ( &alrt ); - - time ( &syst );// get the UNIX system time - sys = *localtime ( &syst ); + do { if (( fd = open ( "/dev/misc/rtc", O_RDWR )) < 0 ) if (( fd = open ( "/dev/rtc", O_RDWR )) < 0 ) break; // ( 1, "rtc" ); - + memset ( &rtc, 0, sizeof ( struct tm )); // get the RTC time + if ( ioctl ( fd, RTC_RD_TIME, &rtc ) < 0 ) break; // ( 1, "ioctl RTC_RD_TIME" ); + rtct = mktime ( &rtc ); rtc_sys_diff = ( syst - rtct ) - sys. tm_gmtoff; // calculate the difference between system and hardware time if ( fix_rtc && (( rtc_sys_diff < -3 ) || ( rtc_sys_diff > 3 ))) { struct tm set; set = *gmtime ( &syst ); - + // if the difference between system and hardware time is more than 3 seconds, // we have to set the RTC (hwclock --systohc), or alarms won't work reliably. - - if ( ioctl ( fd, RTC_SET_TIME, &set ) < 0 ) - break; // ( 1, "ioctl RTC_SET_TIME" ); + + if ( ioctl ( fd, RTC_SET_TIME, &set ) < 0 ) + break; // ( 1, "ioctl RTC_SET_TIME" ); } + // read the wakeup time from /etc/resumeat + if (!( fp = fopen ( "/etc/resumeat", "r" ))) + break; // ( 1, "/etc/resumeat" ); + + if ( !fgets ( buf, sizeof( buf ) - 1, fp )) + break; // ( 1, "/etc/resumeat" ); + + fclose ( fp ); + + alrt = atoi ( buf ); // get the alarm time + + if ( alrt == 0 ) + break; // ( 0, "/etc/resumeat contains an invalid time description" ); + alrt -= 5; // wake up 5 sec before the specified time + + alr = *gmtime ( &alrt ); + if ( ioctl ( fd, RTC_ALM_SET, &alr ) < 0 ) // set RTC alarm time break; // ( 1, "ioctl RTC_ALM_SET" ); - if ( ioctl ( fd, RTC_AIE_ON, 0 ) < 0 ) + + if ( ioctl ( fd, RTC_AIE_ON, 0 ) < 0 ) break; // ( 1, "ioctl RTC_AIE_ON" ); // enable RTC alarm irq // tell the parent it is safe to exit now .. we have set the RTC alarm kill ( parent_pid, SIGUSR1 ); if ( read ( fd, buf, sizeof( unsigned long )) < 0 ) // wait for the RTC alarm irq break; // ( 1, "read rtc alarm" ); // iPAQ woke up via RTC irq -- otherwise we would have received a SIGUSR2 // from the "resume instance" of opiealarm. if ( ioctl ( fd, RTC_AIE_OFF, 0 ) < 0 ) // disable RTC alarm irq break; // ( 1, "ioctl RTC_AIE_OFF" ); - + close ( fd ); - - remove_pidfile ( ); // normal exit - return 0; - } while ( 0 ); + remove_pidfile ( ); + + return 0; + + } while ( 0 ) + + if ( fp != NULL ) + fclose ( fp ); - kill ( parent_pid, SIGUSR1 ); // parent is still running - it can exit now + if ( fd != -1 ) + close ( fd ); + + kill ( parent_pid, SIGUSR1 ); while ( 1 ) // pretend that we are waiting on RTC, so opiealarm -r can kill us sleep ( 1000 ); // if we don't do this, the "resuspend on AC" would be triggerd return 0; } - int onac ( void ) { FILE *fp; int on = 0; // check the apm proc interface for AC status if (( fp = fopen ( APMFILE, "r" ))) { int ac = 0; if ( fscanf ( fp, "%*[^ ] %*d.%*d 0x%*x 0x%x 0x%*x 0x%*x %*d%% %*i %*c", &ac ) == 1 ) on = ( ac == 0x01 ) ? 1 : 0; fclose ( fp ); } return on; } int resume ( int resuspend ) { FILE *fp; // re-suspend when on AC (optional) when woken up via RTC if ( !opiealarm_was_running ) { // if opiealarm -s didn't wake up via RTC, the old process gets killed // by kill_by_pidfile(), which is recorded in opiealarm_was_running if ( resuspend && onac ( )) { time_t start, now; char *argv [4]; if ( !fork_with_pidfile ( )) return 4; // we can't wait for the resuspend timeout in the parent process. // so we fork and tell the parent it can exit immediatly kill ( parent_pid, SIGUSR1 ); // sleep <resuspend> seconds - this method is much more precise than sleep() ! time ( &start ); do { sleep ( 1 ); time ( &now ); } while (( now - start ) < resuspend ); if ( onac ( )) { // still on ac ? |