| /* | |
| * linux/kernel/power/user.c | |
| * | |
| * This file provides the user space interface for software suspend/resume. | |
| * | |
| * Copyright (C) 2006 Rafael J. Wysocki <rjw@sisk.pl> | |
| * | |
| * This file is released under the GPLv2. | |
| * | |
| */ | |
| #include <linux/suspend.h> | |
| #include <linux/syscalls.h> | |
| #include <linux/reboot.h> | |
| #include <linux/string.h> | |
| #include <linux/device.h> | |
| #include <linux/miscdevice.h> | |
| #include <linux/mm.h> | |
| #include <linux/swap.h> | |
| #include <linux/swapops.h> | |
| #include <linux/pm.h> | |
| #include <linux/fs.h> | |
| #include <linux/compat.h> | |
| #include <linux/console.h> | |
| #include <linux/cpu.h> | |
| #include <linux/freezer.h> | |
| #include <asm/uaccess.h> | |
| #include "power.h" | |
| #define SNAPSHOT_MINOR 231 | |
| static struct snapshot_data { | |
| struct snapshot_handle handle; | |
| int swap; | |
| int mode; | |
| char frozen; | |
| char ready; | |
| char platform_support; | |
| } snapshot_state; | |
| atomic_t snapshot_device_available = ATOMIC_INIT(1); | |
| static int snapshot_open(struct inode *inode, struct file *filp) | |
| { | |
| struct snapshot_data *data; | |
| int error; | |
| lock_system_sleep(); | |
| if (!atomic_add_unless(&snapshot_device_available, -1, 0)) { | |
| error = -EBUSY; | |
| goto Unlock; | |
| } | |
| if ((filp->f_flags & O_ACCMODE) == O_RDWR) { | |
| atomic_inc(&snapshot_device_available); | |
| error = -ENOSYS; | |
| goto Unlock; | |
| } | |
| if(create_basic_memory_bitmaps()) { | |
| atomic_inc(&snapshot_device_available); | |
| error = -ENOMEM; | |
| goto Unlock; | |
| } | |
| nonseekable_open(inode, filp); | |
| data = &snapshot_state; | |
| filp->private_data = data; | |
| memset(&data->handle, 0, sizeof(struct snapshot_handle)); | |
| if ((filp->f_flags & O_ACCMODE) == O_RDONLY) { | |
| /* Hibernating. The image device should be accessible. */ | |
| data->swap = swsusp_resume_device ? | |
| swap_type_of(swsusp_resume_device, 0, NULL) : -1; | |
| data->mode = O_RDONLY; | |
| error = pm_notifier_call_chain(PM_HIBERNATION_PREPARE); | |
| if (error) | |
| pm_notifier_call_chain(PM_POST_HIBERNATION); | |
| } else { | |
| /* | |
| * Resuming. We may need to wait for the image device to | |
| * appear. | |
| */ | |
| wait_for_device_probe(); | |
| data->swap = -1; | |
| data->mode = O_WRONLY; | |
| error = pm_notifier_call_chain(PM_RESTORE_PREPARE); | |
| if (error) | |
| pm_notifier_call_chain(PM_POST_RESTORE); | |
| } | |
| if (error) { | |
| free_basic_memory_bitmaps(); | |
| atomic_inc(&snapshot_device_available); | |
| } | |
| data->frozen = 0; | |
| data->ready = 0; | |
| data->platform_support = 0; | |
| Unlock: | |
| unlock_system_sleep(); | |
| return error; | |
| } | |
| static int snapshot_release(struct inode *inode, struct file *filp) | |
| { | |
| struct snapshot_data *data; | |
| lock_system_sleep(); | |
| swsusp_free(); | |
| free_basic_memory_bitmaps(); | |
| data = filp->private_data; | |
| free_all_swap_pages(data->swap); | |
| if (data->frozen) { | |
| pm_restore_gfp_mask(); | |
| thaw_processes(); | |
| } | |
| pm_notifier_call_chain(data->mode == O_RDONLY ? | |
| PM_POST_HIBERNATION : PM_POST_RESTORE); | |
| atomic_inc(&snapshot_device_available); | |
| unlock_system_sleep(); | |
| return 0; | |
| } | |
| static ssize_t snapshot_read(struct file *filp, char __user *buf, | |
| size_t count, loff_t *offp) | |
| { | |
| struct snapshot_data *data; | |
| ssize_t res; | |
| loff_t pg_offp = *offp & ~PAGE_MASK; | |
| lock_system_sleep(); | |
| data = filp->private_data; | |
| if (!data->ready) { | |
| res = -ENODATA; | |
| goto Unlock; | |
| } | |
| if (!pg_offp) { /* on page boundary? */ | |
| res = snapshot_read_next(&data->handle); | |
| if (res <= 0) | |
| goto Unlock; | |
| } else { | |
| res = PAGE_SIZE - pg_offp; | |
| } | |
| res = simple_read_from_buffer(buf, count, &pg_offp, | |
| data_of(data->handle), res); | |
| if (res > 0) | |
| *offp += res; | |
| Unlock: | |
| unlock_system_sleep(); | |
| return res; | |
| } | |
| static ssize_t snapshot_write(struct file *filp, const char __user *buf, | |
| size_t count, loff_t *offp) | |
| { | |
| struct snapshot_data *data; | |
| ssize_t res; | |
| loff_t pg_offp = *offp & ~PAGE_MASK; | |
| lock_system_sleep(); | |
| data = filp->private_data; | |
| if (!pg_offp) { | |
| res = snapshot_write_next(&data->handle); | |
| if (res <= 0) | |
| goto unlock; | |
| } else { | |
| res = PAGE_SIZE - pg_offp; | |
| } | |
| res = simple_write_to_buffer(data_of(data->handle), res, &pg_offp, | |
| buf, count); | |
| if (res > 0) | |
| *offp += res; | |
| unlock: | |
| unlock_system_sleep(); | |
| return res; | |
| } | |
| static long snapshot_ioctl(struct file *filp, unsigned int cmd, | |
| unsigned long arg) | |
| { | |
| int error = 0; | |
| struct snapshot_data *data; | |
| loff_t size; | |
| sector_t offset; | |
| if (_IOC_TYPE(cmd) != SNAPSHOT_IOC_MAGIC) | |
| return -ENOTTY; | |
| if (_IOC_NR(cmd) > SNAPSHOT_IOC_MAXNR) | |
| return -ENOTTY; | |
| if (!capable(CAP_SYS_ADMIN)) | |
| return -EPERM; | |
| if (!mutex_trylock(&pm_mutex)) | |
| return -EBUSY; | |
| data = filp->private_data; | |
| switch (cmd) { | |
| case SNAPSHOT_FREEZE: | |
| if (data->frozen) | |
| break; | |
| printk("Syncing filesystems ... "); | |
| sys_sync(); | |
| printk("done.\n"); | |
| error = freeze_processes(); | |
| if (!error) | |
| data->frozen = 1; | |
| break; | |
| case SNAPSHOT_UNFREEZE: | |
| if (!data->frozen || data->ready) | |
| break; | |
| pm_restore_gfp_mask(); | |
| thaw_processes(); | |
| data->frozen = 0; | |
| break; | |
| case SNAPSHOT_CREATE_IMAGE: | |
| if (data->mode != O_RDONLY || !data->frozen || data->ready) { | |
| error = -EPERM; | |
| break; | |
| } | |
| pm_restore_gfp_mask(); | |
| error = hibernation_snapshot(data->platform_support); | |
| if (!error) { | |
| error = put_user(in_suspend, (int __user *)arg); | |
| data->ready = !freezer_test_done && !error; | |
| freezer_test_done = false; | |
| } | |
| break; | |
| case SNAPSHOT_ATOMIC_RESTORE: | |
| snapshot_write_finalize(&data->handle); | |
| if (data->mode != O_WRONLY || !data->frozen || | |
| !snapshot_image_loaded(&data->handle)) { | |
| error = -EPERM; | |
| break; | |
| } | |
| error = hibernation_restore(data->platform_support); | |
| break; | |
| case SNAPSHOT_FREE: | |
| swsusp_free(); | |
| memset(&data->handle, 0, sizeof(struct snapshot_handle)); | |
| data->ready = 0; | |
| /* | |
| * It is necessary to thaw kernel threads here, because | |
| * SNAPSHOT_CREATE_IMAGE may be invoked directly after | |
| * SNAPSHOT_FREE. In that case, if kernel threads were not | |
| * thawed, the preallocation of memory carried out by | |
| * hibernation_snapshot() might run into problems (i.e. it | |
| * might fail or even deadlock). | |
| */ | |
| thaw_kernel_threads(); | |
| break; | |
| case SNAPSHOT_PREF_IMAGE_SIZE: | |
| image_size = arg; | |
| break; | |
| case SNAPSHOT_GET_IMAGE_SIZE: | |
| if (!data->ready) { | |
| error = -ENODATA; | |
| break; | |
| } | |
| size = snapshot_get_image_size(); | |
| size <<= PAGE_SHIFT; | |
| error = put_user(size, (loff_t __user *)arg); | |
| break; | |
| case SNAPSHOT_AVAIL_SWAP_SIZE: | |
| size = count_swap_pages(data->swap, 1); | |
| size <<= PAGE_SHIFT; | |
| error = put_user(size, (loff_t __user *)arg); | |
| break; | |
| case SNAPSHOT_ALLOC_SWAP_PAGE: | |
| if (data->swap < 0 || data->swap >= MAX_SWAPFILES) { | |
| error = -ENODEV; | |
| break; | |
| } | |
| offset = alloc_swapdev_block(data->swap); | |
| if (offset) { | |
| offset <<= PAGE_SHIFT; | |
| error = put_user(offset, (loff_t __user *)arg); | |
| } else { | |
| error = -ENOSPC; | |
| } | |
| break; | |
| case SNAPSHOT_FREE_SWAP_PAGES: | |
| if (data->swap < 0 || data->swap >= MAX_SWAPFILES) { | |
| error = -ENODEV; | |
| break; | |
| } | |
| free_all_swap_pages(data->swap); | |
| break; | |
| case SNAPSHOT_S2RAM: | |
| if (!data->frozen) { | |
| error = -EPERM; | |
| break; | |
| } | |
| /* | |
| * Tasks are frozen and the notifiers have been called with | |
| * PM_HIBERNATION_PREPARE | |
| */ | |
| error = suspend_devices_and_enter(PM_SUSPEND_MEM); | |
| data->ready = 0; | |
| break; | |
| case SNAPSHOT_PLATFORM_SUPPORT: | |
| data->platform_support = !!arg; | |
| break; | |
| case SNAPSHOT_POWER_OFF: | |
| if (data->platform_support) | |
| error = hibernation_platform_enter(); | |
| break; | |
| case SNAPSHOT_SET_SWAP_AREA: | |
| if (swsusp_swap_in_use()) { | |
| error = -EPERM; | |
| } else { | |
| struct resume_swap_area swap_area; | |
| dev_t swdev; | |
| error = copy_from_user(&swap_area, (void __user *)arg, | |
| sizeof(struct resume_swap_area)); | |
| if (error) { | |
| error = -EFAULT; | |
| break; | |
| } | |
| /* | |
| * User space encodes device types as two-byte values, | |
| * so we need to recode them | |
| */ | |
| swdev = new_decode_dev(swap_area.dev); | |
| if (swdev) { | |
| offset = swap_area.offset; | |
| data->swap = swap_type_of(swdev, offset, NULL); | |
| if (data->swap < 0) | |
| error = -ENODEV; | |
| } else { | |
| data->swap = -1; | |
| error = -EINVAL; | |
| } | |
| } | |
| break; | |
| default: | |
| error = -ENOTTY; | |
| } | |
| mutex_unlock(&pm_mutex); | |
| return error; | |
| } | |
| #ifdef CONFIG_COMPAT | |
| struct compat_resume_swap_area { | |
| compat_loff_t offset; | |
| u32 dev; | |
| } __packed; | |
| static long | |
| snapshot_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg) | |
| { | |
| BUILD_BUG_ON(sizeof(loff_t) != sizeof(compat_loff_t)); | |
| switch (cmd) { | |
| case SNAPSHOT_GET_IMAGE_SIZE: | |
| case SNAPSHOT_AVAIL_SWAP_SIZE: | |
| case SNAPSHOT_ALLOC_SWAP_PAGE: { | |
| compat_loff_t __user *uoffset = compat_ptr(arg); | |
| loff_t offset; | |
| mm_segment_t old_fs; | |
| int err; | |
| old_fs = get_fs(); | |
| set_fs(KERNEL_DS); | |
| err = snapshot_ioctl(file, cmd, (unsigned long) &offset); | |
| set_fs(old_fs); | |
| if (!err && put_user(offset, uoffset)) | |
| err = -EFAULT; | |
| return err; | |
| } | |
| case SNAPSHOT_CREATE_IMAGE: | |
| return snapshot_ioctl(file, cmd, | |
| (unsigned long) compat_ptr(arg)); | |
| case SNAPSHOT_SET_SWAP_AREA: { | |
| struct compat_resume_swap_area __user *u_swap_area = | |
| compat_ptr(arg); | |
| struct resume_swap_area swap_area; | |
| mm_segment_t old_fs; | |
| int err; | |
| err = get_user(swap_area.offset, &u_swap_area->offset); | |
| err |= get_user(swap_area.dev, &u_swap_area->dev); | |
| if (err) | |
| return -EFAULT; | |
| old_fs = get_fs(); | |
| set_fs(KERNEL_DS); | |
| err = snapshot_ioctl(file, SNAPSHOT_SET_SWAP_AREA, | |
| (unsigned long) &swap_area); | |
| set_fs(old_fs); | |
| return err; | |
| } | |
| default: | |
| return snapshot_ioctl(file, cmd, arg); | |
| } | |
| } | |
| #endif /* CONFIG_COMPAT */ | |
| static const struct file_operations snapshot_fops = { | |
| .open = snapshot_open, | |
| .release = snapshot_release, | |
| .read = snapshot_read, | |
| .write = snapshot_write, | |
| .llseek = no_llseek, | |
| .unlocked_ioctl = snapshot_ioctl, | |
| #ifdef CONFIG_COMPAT | |
| .compat_ioctl = snapshot_compat_ioctl, | |
| #endif | |
| }; | |
| static struct miscdevice snapshot_device = { | |
| .minor = SNAPSHOT_MINOR, | |
| .name = "snapshot", | |
| .fops = &snapshot_fops, | |
| }; | |
| static int __init snapshot_device_init(void) | |
| { | |
| return misc_register(&snapshot_device); | |
| }; | |
| device_initcall(snapshot_device_init); |