/* drivers/rtc/alarm.c * * Copyright (C) 2007 Google, Inc. * * This software is licensed under the terms of the GNU General Public * License version 2, as published by the Free Software Foundation, and * may be copied, distributed, and modified under those terms. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * */ #include #include #include #include #include #include #include #include #include #define ANDROID_ALARM_PRINT_ERRORS (1U << 0) #define ANDROID_ALARM_PRINT_INIT_STATUS (1U << 1) #define ANDROID_ALARM_PRINT_INFO (1U << 2) #define ANDROID_ALARM_PRINT_IO (1U << 3) #define ANDROID_ALARM_PRINT_INT (1U << 4) #define ANDROID_ALARM_PRINT_FLOW (1U << 5) #if 0 #define ANDROID_ALARM_DPRINTF_MASK (~0) #define ANDROID_ALARM_DPRINTF(debug_level_mask, args...) \ do { \ if (ANDROID_ALARM_DPRINTF_MASK & debug_level_mask) { \ printk(args); \ } \ } while (0) #else #define ANDROID_ALARM_DPRINTF(args...) #endif #define ANDROID_ALARM_WAKEUP_MASK ( \ ANDROID_ALARM_RTC_WAKEUP_MASK | \ ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP_MASK) /* support old usespace code */ #define ANDROID_ALARM_SET_OLD _IOW('a', 2, time_t) /* set alarm */ #define ANDROID_ALARM_SET_AND_WAIT_OLD _IOW('a', 3, time_t) static struct rtc_device *alarm_rtc_dev; static int alarm_opened; static DEFINE_SPINLOCK(alarm_slock); static DEFINE_MUTEX(alarm_setrtc_mutex); static struct wake_lock alarm_wake_lock; static struct wake_lock alarm_rtc_wake_lock; static DECLARE_WAIT_QUEUE_HEAD(alarm_wait_queue); static uint32_t alarm_pending; static uint32_t alarm_enabled; static uint32_t wait_pending; static struct platform_device *alarm_platform_dev; static struct hrtimer alarm_timer[ANDROID_ALARM_TYPE_COUNT]; static struct timespec alarm_time[ANDROID_ALARM_TYPE_COUNT]; static struct timespec elapsed_rtc_delta; static void alarm_start_hrtimer(enum android_alarm_type alarm_type) { struct timespec hr_alarm_time; if (!(alarm_enabled & (1U << alarm_type))) return; hr_alarm_time = alarm_time[alarm_type]; if (alarm_type == ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP || alarm_type == ANDROID_ALARM_ELAPSED_REALTIME) set_normalized_timespec(&hr_alarm_time, hr_alarm_time.tv_sec + elapsed_rtc_delta.tv_sec, hr_alarm_time.tv_nsec + elapsed_rtc_delta.tv_nsec); ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_FLOW, "alarm start hrtimer %d at %ld.%09ld\n", alarm_type, hr_alarm_time.tv_sec, hr_alarm_time.tv_nsec); hrtimer_start(&alarm_timer[alarm_type], timespec_to_ktime(hr_alarm_time), HRTIMER_MODE_ABS); } static long alarm_ioctl(struct file *file, unsigned int cmd, unsigned long arg) { int rv = 0; unsigned long flags; int i; struct timespec new_alarm_time; struct timespec new_rtc_time; struct timespec tmp_time; struct rtc_time rtc_new_rtc_time; enum android_alarm_type alarm_type = ANDROID_ALARM_IOCTL_TO_TYPE(cmd); uint32_t alarm_type_mask = 1U << alarm_type; if (alarm_type >= ANDROID_ALARM_TYPE_COUNT) return -EINVAL; if (ANDROID_ALARM_BASE_CMD(cmd) != ANDROID_ALARM_GET_TIME(0)) { if ((file->f_flags & O_ACCMODE) == O_RDONLY) return -EPERM; if (file->private_data == NULL && cmd != ANDROID_ALARM_SET_RTC) { spin_lock_irqsave(&alarm_slock, flags); if (alarm_opened) { spin_unlock_irqrestore(&alarm_slock, flags); return -EBUSY; } alarm_opened = 1; file->private_data = (void *)1; spin_unlock_irqrestore(&alarm_slock, flags); } } switch (ANDROID_ALARM_BASE_CMD(cmd)) { case ANDROID_ALARM_CLEAR(0): spin_lock_irqsave(&alarm_slock, flags); ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_IO, "alarm %d clear\n", alarm_type); hrtimer_try_to_cancel(&alarm_timer[alarm_type]); if (alarm_pending) { alarm_pending &= ~alarm_type_mask; if (!alarm_pending && !wait_pending) wake_unlock(&alarm_wake_lock); } alarm_enabled &= ~alarm_type_mask; spin_unlock_irqrestore(&alarm_slock, flags); break; case ANDROID_ALARM_SET_OLD: case ANDROID_ALARM_SET_AND_WAIT_OLD: if (get_user(new_alarm_time.tv_sec, (int __user *)arg)) { rv = -EFAULT; goto err1; } new_alarm_time.tv_nsec = 0; goto from_old_alarm_set; case ANDROID_ALARM_SET_AND_WAIT(0): case ANDROID_ALARM_SET(0): if (copy_from_user(&new_alarm_time, (void __user *)arg, sizeof(new_alarm_time))) { rv = -EFAULT; goto err1; } from_old_alarm_set: spin_lock_irqsave(&alarm_slock, flags); ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_IO, "alarm %d set %ld.%09ld\n", alarm_type, new_alarm_time.tv_sec, new_alarm_time.tv_nsec); alarm_time[alarm_type] = new_alarm_time; alarm_enabled |= alarm_type_mask; alarm_start_hrtimer(alarm_type); spin_unlock_irqrestore(&alarm_slock, flags); if (ANDROID_ALARM_BASE_CMD(cmd) != ANDROID_ALARM_SET_AND_WAIT(0) && cmd != ANDROID_ALARM_SET_AND_WAIT_OLD) break; /* fall though */ case ANDROID_ALARM_WAIT: spin_lock_irqsave(&alarm_slock, flags); ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_IO, "alarm wait\n"); if (!alarm_pending && wait_pending) { wake_unlock(&alarm_wake_lock); wait_pending = 0; } spin_unlock_irqrestore(&alarm_slock, flags); rv = wait_event_interruptible(alarm_wait_queue, alarm_pending); if (rv) goto err1; spin_lock_irqsave(&alarm_slock, flags); rv = alarm_pending; wait_pending = 1; alarm_pending = 0; if (rv & ANDROID_ALARM_WAKEUP_MASK) wake_unlock(&alarm_rtc_wake_lock); spin_unlock_irqrestore(&alarm_slock, flags); break; case ANDROID_ALARM_SET_RTC: if (copy_from_user(&new_rtc_time, (void __user *)arg, sizeof(new_rtc_time))) { rv = -EFAULT; goto err1; } rtc_time_to_tm(new_rtc_time.tv_sec, &rtc_new_rtc_time); ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_IO, "set rtc %ld %ld - rtc %02d:%02d:%02d %02d/%02d/%04d\n", new_rtc_time.tv_sec, new_rtc_time.tv_nsec, rtc_new_rtc_time.tm_hour, rtc_new_rtc_time.tm_min, rtc_new_rtc_time.tm_sec, rtc_new_rtc_time.tm_mon + 1, rtc_new_rtc_time.tm_mday, rtc_new_rtc_time.tm_year + 1900); mutex_lock(&alarm_setrtc_mutex); spin_lock_irqsave(&alarm_slock, flags); for (i = 0; i < ANDROID_ALARM_SYSTEMTIME; i++) hrtimer_try_to_cancel(&alarm_timer[i]); getnstimeofday(&tmp_time); elapsed_rtc_delta = timespec_sub(elapsed_rtc_delta, timespec_sub(tmp_time, new_rtc_time)); spin_unlock_irqrestore(&alarm_slock, flags); rv = do_settimeofday(&new_rtc_time); spin_lock_irqsave(&alarm_slock, flags); for (i = 0; i < ANDROID_ALARM_SYSTEMTIME; i++) alarm_start_hrtimer(i); spin_unlock_irqrestore(&alarm_slock, flags); if (rv < 0) { ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_ERRORS, "Failed to set time\n"); mutex_unlock(&alarm_setrtc_mutex); goto err1; } rv = rtc_set_time(alarm_rtc_dev, &rtc_new_rtc_time); spin_lock_irqsave(&alarm_slock, flags); alarm_pending |= ANDROID_ALARM_TIME_CHANGE_MASK; wake_up(&alarm_wait_queue); spin_unlock_irqrestore(&alarm_slock, flags); mutex_unlock(&alarm_setrtc_mutex); if (rv < 0) { ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_ERRORS, "Failed to set RTC, time will be lost on reboot\n"); goto err1; } break; case ANDROID_ALARM_GET_TIME(0): mutex_lock(&alarm_setrtc_mutex); spin_lock_irqsave(&alarm_slock, flags); if (alarm_type != ANDROID_ALARM_SYSTEMTIME) { getnstimeofday(&tmp_time); if (alarm_type >= ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP) tmp_time = timespec_sub(tmp_time, elapsed_rtc_delta); } else ktime_get_ts(&tmp_time); spin_unlock_irqrestore(&alarm_slock, flags); mutex_unlock(&alarm_setrtc_mutex); if (copy_to_user((void __user *)arg, &tmp_time, sizeof(tmp_time))) { rv = -EFAULT; goto err1; } break; default: rv = -EINVAL; goto err1; } err1: return rv; } static int alarm_open(struct inode *inode, struct file *file) { file->private_data = NULL; return 0; } static int alarm_release(struct inode *inode, struct file *file) { int i; unsigned long flags; spin_lock_irqsave(&alarm_slock, flags); if (file->private_data != 0) { for (i = 0; i < ANDROID_ALARM_TYPE_COUNT; i++) { uint32_t alarm_type_mask = 1U << i; if (alarm_enabled & alarm_type_mask) { ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_INFO, "alarm_release: clear alarm, " "pending %d\n", !!(alarm_pending & alarm_type_mask)); alarm_enabled &= ~alarm_type_mask; } spin_unlock_irqrestore(&alarm_slock, flags); hrtimer_cancel(&alarm_timer[i]); spin_lock_irqsave(&alarm_slock, flags); } if (alarm_pending | wait_pending) { if (alarm_pending) ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_INFO, "alarm_release: clear pending alarms " "%x\n", alarm_pending); wake_unlock(&alarm_wake_lock); wait_pending = 0; alarm_pending = 0; } alarm_opened = 0; } spin_unlock_irqrestore(&alarm_slock, flags); return 0; } static enum hrtimer_restart alarm_timer_triggered(struct hrtimer *timer) { unsigned long flags; enum android_alarm_type alarm_type = (timer - alarm_timer); uint32_t alarm_type_mask = 1U << alarm_type; ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_INT, "alarm_timer_triggered type %d\n", alarm_type); spin_lock_irqsave(&alarm_slock, flags); if (alarm_enabled & alarm_type_mask) { wake_lock_timeout(&alarm_wake_lock, 5 * HZ); alarm_enabled &= ~alarm_type_mask; alarm_pending |= alarm_type_mask; wake_up(&alarm_wait_queue); } spin_unlock_irqrestore(&alarm_slock, flags); return HRTIMER_NORESTART; } static void alarm_triggered_func(void *p) { struct rtc_device *rtc = alarm_rtc_dev; if (!(rtc->irq_data & RTC_AF)) return; ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_INT, "rtc alarm triggered\n"); wake_lock_timeout(&alarm_rtc_wake_lock, 1 * HZ); } void save_time_delta(struct timespec *delta, struct timespec *rtc) { set_normalized_timespec(delta, xtime.tv_sec - rtc->tv_sec, xtime.tv_nsec - rtc->tv_nsec); } int alarm_suspend(struct platform_device *pdev, pm_message_t state) { int err = 0; unsigned long flags; struct rtc_wkalrm rtc_alarm; struct rtc_time rtc_current_rtc_time; unsigned long rtc_current_time; unsigned long rtc_alarm_time; struct timespec rtc_current_timespec; struct timespec rtc_delta; struct timespec elapsed_realtime_alarm_time; ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_FLOW, "alarm_suspend(%p, %d)\n", pdev, state.event); spin_lock_irqsave(&alarm_slock, flags); if (alarm_pending && !wake_lock_active(&alarm_wake_lock)) { ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_INFO, "alarm pending\n"); err = -EBUSY; goto err1; } if (alarm_enabled & ANDROID_ALARM_WAKEUP_MASK) { spin_unlock_irqrestore(&alarm_slock, flags); if (alarm_enabled & ANDROID_ALARM_RTC_WAKEUP_MASK) hrtimer_cancel(&alarm_timer[ANDROID_ALARM_RTC_WAKEUP]); if (alarm_enabled & ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP_MASK) hrtimer_cancel(&alarm_timer[ ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP]); rtc_read_time(alarm_rtc_dev, &rtc_current_rtc_time); rtc_current_timespec.tv_nsec = 0; rtc_tm_to_time(&rtc_current_rtc_time, &rtc_current_timespec.tv_sec); save_time_delta(&rtc_delta, &rtc_current_timespec); set_normalized_timespec(&elapsed_realtime_alarm_time, alarm_time[ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP] .tv_sec + elapsed_rtc_delta.tv_sec, alarm_time[ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP] .tv_nsec + elapsed_rtc_delta.tv_nsec); if ((alarm_enabled & ANDROID_ALARM_RTC_WAKEUP_MASK) && (!(alarm_enabled & ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP_MASK) || timespec_compare(&alarm_time[ANDROID_ALARM_RTC_WAKEUP], &elapsed_realtime_alarm_time) < 0)) rtc_alarm_time = timespec_sub( alarm_time[ANDROID_ALARM_RTC_WAKEUP], rtc_delta).tv_sec; else rtc_alarm_time = timespec_sub( elapsed_realtime_alarm_time, rtc_delta).tv_sec; rtc_time_to_tm(rtc_alarm_time, &rtc_alarm.time); rtc_alarm.enabled = 1; rtc_set_alarm(alarm_rtc_dev, &rtc_alarm); rtc_read_time(alarm_rtc_dev, &rtc_current_rtc_time); rtc_tm_to_time(&rtc_current_rtc_time, &rtc_current_time); ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_INFO, "rtc alarm set at %ld, now %ld, rtc delta %ld.%09ld\n", rtc_alarm_time, rtc_current_time, rtc_delta.tv_sec, rtc_delta.tv_nsec); if (rtc_current_time + 1 >= rtc_alarm_time) { ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_INFO, "alarm about to go off\n"); memset(&rtc_alarm, 0, sizeof(rtc_alarm)); rtc_alarm.enabled = 0; rtc_set_alarm(alarm_rtc_dev, &rtc_alarm); spin_lock_irqsave(&alarm_slock, flags); wake_lock_timeout(&alarm_rtc_wake_lock, 2 * HZ); alarm_start_hrtimer(ANDROID_ALARM_RTC_WAKEUP); alarm_start_hrtimer( ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP); err = -EBUSY; spin_unlock_irqrestore(&alarm_slock, flags); } } else { err1: spin_unlock_irqrestore(&alarm_slock, flags); } return err; } int alarm_resume(struct platform_device *pdev) { struct rtc_wkalrm alarm; ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_FLOW, "alarm_resume(%p)\n", pdev); if (alarm_enabled & ANDROID_ALARM_WAKEUP_MASK) { memset(&alarm, 0, sizeof(alarm)); alarm.enabled = 0; rtc_set_alarm(alarm_rtc_dev, &alarm); alarm_start_hrtimer(ANDROID_ALARM_RTC_WAKEUP); alarm_start_hrtimer(ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP); } return 0; } static struct rtc_task alarm_rtc_task = { .func = alarm_triggered_func }; static struct file_operations alarm_fops = { .owner = THIS_MODULE, .unlocked_ioctl = alarm_ioctl, .open = alarm_open, .release = alarm_release, }; static struct miscdevice alarm_device = { .minor = MISC_DYNAMIC_MINOR, .name = "alarm", .fops = &alarm_fops, }; static int rtc_alarm_add_device(struct device *dev, struct class_interface *class_intf) { int err; struct rtc_device *rtc = to_rtc_device(dev); mutex_lock(&alarm_setrtc_mutex); if (alarm_rtc_dev) { err = -EBUSY; goto err1; } err = misc_register(&alarm_device); if (err) goto err1; alarm_platform_dev = platform_device_register_simple("alarm", -1, NULL, 0); if (IS_ERR(alarm_platform_dev)) { err = PTR_ERR(alarm_platform_dev); goto err2; } err = rtc_irq_register(rtc, &alarm_rtc_task); if (err) goto err3; alarm_rtc_dev = rtc; mutex_unlock(&alarm_setrtc_mutex); ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_INFO, "alarm: parent %p\n", alarm_platform_dev->dev.power.pm_parent); return 0; err3: platform_device_unregister(alarm_platform_dev); err2: misc_deregister(&alarm_device); err1: mutex_unlock(&alarm_setrtc_mutex); return err; } static void rtc_alarm_remove_device(struct device *dev, struct class_interface *class_intf) { if (dev == &alarm_rtc_dev->dev) { rtc_irq_unregister(alarm_rtc_dev, &alarm_rtc_task); platform_device_unregister(alarm_platform_dev); misc_deregister(&alarm_device); alarm_rtc_dev = NULL; } } static struct class_interface rtc_alarm_interface = { .add_dev = &rtc_alarm_add_device, .remove_dev = &rtc_alarm_remove_device, }; static struct platform_driver alarm_driver = { .suspend = alarm_suspend, .resume = alarm_resume, .driver = { .name = "alarm" } }; static int __init alarm_late_init(void) { unsigned long flags; struct timespec system_time; /* this needs to run after the rtc is read at boot */ spin_lock_irqsave(&alarm_slock, flags); /* We read the current rtc and system time so we can later calulate * elasped realtime to be (boot_systemtime + rtc - boot_rtc) == * (rtc - (boot_rtc - boot_systemtime)) */ getnstimeofday(&elapsed_rtc_delta); ktime_get_ts(&system_time); elapsed_rtc_delta = timespec_sub(elapsed_rtc_delta, system_time); spin_unlock_irqrestore(&alarm_slock, flags); ANDROID_ALARM_DPRINTF(ANDROID_ALARM_PRINT_INFO, "alarm_late_init: rtc to elapsed realtime delta %ld.%09ld\n", elapsed_rtc_delta.tv_sec, elapsed_rtc_delta.tv_nsec); return 0; } static int __init alarm_init(void) { int err; int i; for (i = 0; i < ANDROID_ALARM_SYSTEMTIME; i++) { hrtimer_init(&alarm_timer[i], CLOCK_REALTIME, HRTIMER_MODE_ABS); alarm_timer[i].function = alarm_timer_triggered; } hrtimer_init(&alarm_timer[ANDROID_ALARM_SYSTEMTIME], CLOCK_MONOTONIC, HRTIMER_MODE_ABS); alarm_timer[ANDROID_ALARM_SYSTEMTIME].function = alarm_timer_triggered; err = platform_driver_register(&alarm_driver); if (err < 0) goto err1; wake_lock_init(&alarm_wake_lock, WAKE_LOCK_SUSPEND, "alarm"); wake_lock_init(&alarm_rtc_wake_lock, WAKE_LOCK_SUSPEND, "alarm_rtc"); rtc_alarm_interface.class = rtc_class; err = class_interface_register(&rtc_alarm_interface); if (err < 0) goto err2; return 0; err2: wake_lock_destroy(&alarm_rtc_wake_lock); wake_lock_destroy(&alarm_wake_lock); platform_driver_unregister(&alarm_driver); err1: return err; } static void __exit alarm_exit(void) { class_interface_unregister(&rtc_alarm_interface); wake_lock_destroy(&alarm_rtc_wake_lock); wake_lock_destroy(&alarm_wake_lock); platform_driver_unregister(&alarm_driver); } late_initcall(alarm_late_init); module_init(alarm_init); module_exit(alarm_exit);