-rw-r--r-- | core/opiealarm/opiealarm.c | 10 |
1 files changed, 10 insertions, 0 deletions
diff --git a/core/opiealarm/opiealarm.c b/core/opiealarm/opiealarm.c index a4d46ed..71367b3 100644 --- a/core/opiealarm/opiealarm.c +++ b/core/opiealarm/opiealarm.c | |||
@@ -199,80 +199,90 @@ int suspend ( int fix_rtc ) | |||
199 | time_t alrt, syst, rtct; | 199 | time_t alrt, syst, rtct; |
200 | struct tm alr, sys, rtc; | 200 | struct tm alr, sys, rtc; |
201 | int fd; | 201 | int fd; |
202 | int rtc_sys_diff; | 202 | int rtc_sys_diff; |
203 | 203 | ||
204 | 204 | ||
205 | if ( !fork_with_pidfile ( )) | 205 | if ( !fork_with_pidfile ( )) |
206 | return 3; | 206 | return 3; |
207 | 207 | ||
208 | log = fopen ( "/tmp/opiealarm.log", "w" ); | 208 | log = fopen ( "/tmp/opiealarm.log", "w" ); |
209 | log_msg ( "STARTING\n" ); | 209 | log_msg ( "STARTING\n" ); |
210 | 210 | ||
211 | 211 | ||
212 | 212 | ||
213 | if (!( fp = fopen ( "/etc/resumeat", "r" ))) | 213 | if (!( fp = fopen ( "/etc/resumeat", "r" ))) |
214 | error_msg_and_die ( 1, "/etc/resumeat" ); | 214 | error_msg_and_die ( 1, "/etc/resumeat" ); |
215 | 215 | ||
216 | if ( !fgets ( buf, sizeof( buf ) - 1, fp )) | 216 | if ( !fgets ( buf, sizeof( buf ) - 1, fp )) |
217 | error_msg_and_die ( 1, "/etc/resumeat" ); | 217 | error_msg_and_die ( 1, "/etc/resumeat" ); |
218 | 218 | ||
219 | fclose ( fp ); | 219 | fclose ( fp ); |
220 | 220 | ||
221 | alrt = atoi ( buf ); | 221 | alrt = atoi ( buf ); |
222 | 222 | ||
223 | if ( alrt == 0 ) | 223 | if ( alrt == 0 ) |
224 | error_msg_and_die ( 0, "/etc/resumeat contains an invalid time description" ); | 224 | error_msg_and_die ( 0, "/etc/resumeat contains an invalid time description" ); |
225 | 225 | ||
226 | /* subtract 5 sec from event time... */ | 226 | /* subtract 5 sec from event time... */ |
227 | alrt -= 5; | 227 | alrt -= 5; |
228 | 228 | ||
229 | if ( log ) | 229 | if ( log ) |
230 | fprintf ( log, "Setting RTC alarm to %d\n", alrt ); | 230 | fprintf ( log, "Setting RTC alarm to %d\n", alrt ); |
231 | |||
232 | tzset ( ); | ||
231 | 233 | ||
232 | alr = *gmtime ( &alrt ); | 234 | alr = *gmtime ( &alrt ); |
233 | 235 | ||
234 | // get system time | 236 | // get system time |
235 | time ( &syst ); | 237 | time ( &syst ); |
236 | sys = *localtime ( &syst ); | 238 | sys = *localtime ( &syst ); |
237 | 239 | ||
238 | // Write alarm time to RTC | 240 | // Write alarm time to RTC |
239 | if (( fd = open ( "/dev/misc/rtc", O_RDWR )) < 0 ) | 241 | if (( fd = open ( "/dev/misc/rtc", O_RDWR )) < 0 ) |
240 | error_msg_and_die ( 1, "/dev/misc/rtc" ); | 242 | error_msg_and_die ( 1, "/dev/misc/rtc" ); |
241 | 243 | ||
242 | // get RTC time | 244 | // get RTC time |
245 | memset ( &rtc, 0, sizeof ( struct tm )); | ||
243 | if ( ioctl ( fd, RTC_ALM_SET, &rtc ) < 0 ) | 246 | if ( ioctl ( fd, RTC_ALM_SET, &rtc ) < 0 ) |
244 | error_msg_and_die ( 1, "ioctl RTC_RD_TIME" ); | 247 | error_msg_and_die ( 1, "ioctl RTC_RD_TIME" ); |
245 | rtct = mktime ( &rtc ); | 248 | rtct = mktime ( &rtc ); |
246 | 249 | ||
250 | fprintf ( log, "System time: %02d.%02d.%04d %02d:%02d:%02d DST: %d (TZ: %s, offset: %d)\n", sys. tm_mday, sys. tm_mon + 1, sys. tm_year + 1900, sys. tm_hour, sys. tm_min, sys. tm_sec, sys. tm_isdst, sys. tm_zone, sys. tm_gmtoff ); | ||
251 | fprintf ( log, "RTC time: %02d.%02d.%04d %02d:%02d:%02d DST: %d (TZ: %s, offset: %d)\n", rtc. tm_mday, rtc. tm_mon + 1, rtc. tm_year + 1900, rtc. tm_hour, rtc. tm_min, rtc. tm_sec, rtc. tm_isdst, rtc. tm_zone, rtc. tm_gmtoff ); | ||
252 | fprintf ( log, "Wakeup time: %02d.%02d.%04d %02d:%02d:%02d DST: %d (TZ: %s, offset: %d)\n", alr. tm_mday, alr. tm_mon + 1, alr. tm_year + 1900, alr. tm_hour, alr. tm_min, alr. tm_sec, alr. tm_isdst, alr. tm_zone, alr. tm_gmtoff ); | ||
253 | |||
254 | fprintf ( log, "System/RTC diff: %d seconds\n", ( syst - rtct ) - sys. tm_gmtoff ); | ||
255 | |||
256 | |||
247 | rtc_sys_diff = ( syst - rtct ) - sys. tm_gmtoff; | 257 | rtc_sys_diff = ( syst - rtct ) - sys. tm_gmtoff; |
248 | 258 | ||
249 | if ( fix_rtc && (( rtc_sys_diff < -4 ) || ( rtc_sys_diff > 4 ))) { | 259 | if ( fix_rtc && (( rtc_sys_diff < -4 ) || ( rtc_sys_diff > 4 ))) { |
250 | struct tm set; | 260 | struct tm set; |
251 | 261 | ||
252 | set = *gmtime ( &syst ); | 262 | set = *gmtime ( &syst ); |
253 | 263 | ||
254 | fprintf ( log, "Correcting RTC: %d seconds\n", rtc_sys_diff ); | 264 | fprintf ( log, "Correcting RTC: %d seconds\n", rtc_sys_diff ); |
255 | 265 | ||
256 | if ( ioctl ( fd, RTC_SET_TIME, &set ) < 0 ) | 266 | if ( ioctl ( fd, RTC_SET_TIME, &set ) < 0 ) |
257 | error_msg_and_die ( 1, "ioctl RTC_SET_TIME" ); | 267 | error_msg_and_die ( 1, "ioctl RTC_SET_TIME" ); |
258 | } | 268 | } |
259 | 269 | ||
260 | // set alarm time | 270 | // set alarm time |
261 | if ( ioctl ( fd, RTC_ALM_SET, &alr ) < 0 ) | 271 | if ( ioctl ( fd, RTC_ALM_SET, &alr ) < 0 ) |
262 | error_msg_and_die ( 1, "ioctl RTC_ALM_SET" ); | 272 | error_msg_and_die ( 1, "ioctl RTC_ALM_SET" ); |
263 | // enable alarm irq | 273 | // enable alarm irq |
264 | if ( ioctl ( fd, RTC_AIE_ON, 0 ) < 0 ) | 274 | if ( ioctl ( fd, RTC_AIE_ON, 0 ) < 0 ) |
265 | error_msg_and_die ( 1, "ioctl RTC_AIE_ON" ); | 275 | error_msg_and_die ( 1, "ioctl RTC_AIE_ON" ); |
266 | 276 | ||
267 | log_msg ( "SLEEPING\n" ); | 277 | log_msg ( "SLEEPING\n" ); |
268 | 278 | ||
269 | // wait for alarm irq | 279 | // wait for alarm irq |
270 | if ( read ( fd, buf, sizeof( unsigned long )) < 0 ) | 280 | if ( read ( fd, buf, sizeof( unsigned long )) < 0 ) |
271 | error_msg_and_die ( 1, "read rtc alarm" ); | 281 | error_msg_and_die ( 1, "read rtc alarm" ); |
272 | 282 | ||
273 | log_msg ( "WAKEUP\n" ); | 283 | log_msg ( "WAKEUP\n" ); |
274 | 284 | ||
275 | // disable alarm irq | 285 | // disable alarm irq |
276 | if ( ioctl ( fd, RTC_AIE_OFF, 0 ) < 0 ) | 286 | if ( ioctl ( fd, RTC_AIE_OFF, 0 ) < 0 ) |
277 | error_msg_and_die ( 1, "ioctl RTC_AIE_OFF" ); | 287 | error_msg_and_die ( 1, "ioctl RTC_AIE_OFF" ); |
278 | 288 | ||