diff options
| author | Andriy Skulysh <askulysh@gmail.com> | 2006-09-27 03:20:22 -0400 |
|---|---|---|
| committer | Paul Mundt <lethal@linux-sh.org> | 2006-09-27 03:20:22 -0400 |
| commit | 3aa770e7972723f479122cf66b529017d2175289 (patch) | |
| tree | f70d870381cec8034693704e346c53b311db688f | |
| parent | ef48e8e3498605351f91f195cc9af0ef981b0dde (diff) | |
sh: APM/PM support.
This adds some simple PM stubs and the basic APM interfaces,
primarily for use by hp6xx, where the existing userland
expects it.
Signed-off-by: Andriy Skulysh <askulysh@gmail.com>
Signed-off-by: Paul Mundt <lethal@linux-sh.org>
| -rw-r--r-- | arch/sh/Kconfig | 10 | ||||
| -rw-r--r-- | arch/sh/boards/hp6xx/Makefile | 5 | ||||
| -rw-r--r-- | arch/sh/boards/hp6xx/hp6xx_apm.c | 123 | ||||
| -rw-r--r-- | arch/sh/boards/hp6xx/pm.c | 88 | ||||
| -rw-r--r-- | arch/sh/boards/hp6xx/pm_wakeup.S | 58 | ||||
| -rw-r--r-- | arch/sh/boards/hp6xx/setup.c | 14 | ||||
| -rw-r--r-- | arch/sh/kernel/Makefile | 2 | ||||
| -rw-r--r-- | arch/sh/kernel/apm.c | 539 | ||||
| -rw-r--r-- | arch/sh/kernel/entry.S | 4 | ||||
| -rw-r--r-- | arch/sh/kernel/pm.c | 88 | ||||
| -rw-r--r-- | arch/sh/kernel/sh_ksyms.c | 4 | ||||
| -rw-r--r-- | arch/sh/kernel/time.c | 25 | ||||
| -rw-r--r-- | arch/sh/kernel/timers/timer-tmu.c | 18 | ||||
| -rw-r--r-- | drivers/input/touchscreen/hp680_ts_input.c | 14 | ||||
| -rw-r--r-- | include/asm-sh/apm.h | 46 | ||||
| -rw-r--r-- | include/asm-sh/cpu-sh3/freq.h | 4 | ||||
| -rw-r--r-- | include/asm-sh/hd64461.h | 7 | ||||
| -rw-r--r-- | include/asm-sh/hp6xx/hp6xx.h | 53 | ||||
| -rw-r--r-- | include/asm-sh/pm.h | 17 | ||||
| -rw-r--r-- | include/asm-sh/system.h | 25 | ||||
| -rw-r--r-- | include/asm-sh/timer.h | 2 |
21 files changed, 1124 insertions, 22 deletions
diff --git a/arch/sh/Kconfig b/arch/sh/Kconfig index fe982f0eba23..d1d724447826 100644 --- a/arch/sh/Kconfig +++ b/arch/sh/Kconfig | |||
| @@ -638,6 +638,16 @@ source "fs/Kconfig.binfmt" | |||
| 638 | 638 | ||
| 639 | endmenu | 639 | endmenu |
| 640 | 640 | ||
| 641 | menu "Power management options (EXPERIMENTAL)" | ||
| 642 | depends on EXPERIMENTAL | ||
| 643 | |||
| 644 | source kernel/power/Kconfig | ||
| 645 | |||
| 646 | config APM | ||
| 647 | bool "Advanced Power Management Emulation" | ||
| 648 | depends on PM | ||
| 649 | endmenu | ||
| 650 | |||
| 641 | source "net/Kconfig" | 651 | source "net/Kconfig" |
| 642 | 652 | ||
| 643 | source "drivers/Kconfig" | 653 | source "drivers/Kconfig" |
diff --git a/arch/sh/boards/hp6xx/Makefile b/arch/sh/boards/hp6xx/Makefile index 927fe0aa5dfa..fdf98ffcf437 100644 --- a/arch/sh/boards/hp6xx/Makefile +++ b/arch/sh/boards/hp6xx/Makefile | |||
| @@ -2,5 +2,8 @@ | |||
| 2 | # Makefile for the HP6xx specific parts of the kernel | 2 | # Makefile for the HP6xx specific parts of the kernel |
| 3 | # | 3 | # |
| 4 | 4 | ||
| 5 | obj-y := mach.o setup.o | 5 | obj-y := mach.o setup.o |
| 6 | obj-$(CONFIG_PM) += pm.o pm_wakeup.o | ||
| 7 | obj-$(CONFIG_APM) += hp6xx_apm.o | ||
| 8 | |||
| 6 | 9 | ||
diff --git a/arch/sh/boards/hp6xx/hp6xx_apm.c b/arch/sh/boards/hp6xx/hp6xx_apm.c new file mode 100644 index 000000000000..ad0e712c29f6 --- /dev/null +++ b/arch/sh/boards/hp6xx/hp6xx_apm.c | |||
| @@ -0,0 +1,123 @@ | |||
| 1 | /* | ||
| 2 | * bios-less APM driver for hp680 | ||
| 3 | * | ||
| 4 | * Copyright 2005 (c) Andriy Skulysh <askulysh@gmail.com> | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or | ||
| 7 | * modify it under the terms of the GNU General Public License. | ||
| 8 | */ | ||
| 9 | #include <linux/config.h> | ||
| 10 | #include <linux/module.h> | ||
| 11 | #include <linux/apm_bios.h> | ||
| 12 | #include <linux/kernel.h> | ||
| 13 | #include <linux/init.h> | ||
| 14 | #include <linux/interrupt.h> | ||
| 15 | #include <asm/io.h> | ||
| 16 | #include <asm/apm.h> | ||
| 17 | #include <asm/adc.h> | ||
| 18 | #include <asm/hp6xx/hp6xx.h> | ||
| 19 | |||
| 20 | #define SH7709_PGDR 0xa400012c | ||
| 21 | |||
| 22 | #define APM_CRITICAL 10 | ||
| 23 | #define APM_LOW 30 | ||
| 24 | |||
| 25 | #define HP680_BATTERY_MAX 875 | ||
| 26 | #define HP680_BATTERY_MIN 600 | ||
| 27 | #define HP680_BATTERY_AC_ON 900 | ||
| 28 | |||
| 29 | #define MODNAME "hp6x0_apm" | ||
| 30 | |||
| 31 | static int hp6x0_apm_get_info(char *buf, char **start, off_t fpos, int length) | ||
| 32 | { | ||
| 33 | u8 pgdr; | ||
| 34 | char *p; | ||
| 35 | int battery_status; | ||
| 36 | int battery_flag; | ||
| 37 | int ac_line_status; | ||
| 38 | int time_units = APM_BATTERY_LIFE_UNKNOWN; | ||
| 39 | |||
| 40 | int battery = adc_single(ADC_CHANNEL_BATTERY); | ||
| 41 | int backup = adc_single(ADC_CHANNEL_BACKUP); | ||
| 42 | int charging = adc_single(ADC_CHANNEL_CHARGE); | ||
| 43 | int percentage; | ||
| 44 | |||
| 45 | percentage = 100 * (battery - HP680_BATTERY_MIN) / | ||
| 46 | (HP680_BATTERY_MAX - HP680_BATTERY_MIN); | ||
| 47 | |||
| 48 | ac_line_status = (battery > HP680_BATTERY_AC_ON) ? | ||
| 49 | APM_AC_ONLINE : APM_AC_OFFLINE; | ||
| 50 | |||
| 51 | p = buf; | ||
| 52 | |||
| 53 | pgdr = ctrl_inb(SH7709_PGDR); | ||
| 54 | if (pgdr & PGDR_MAIN_BATTERY_OUT) { | ||
| 55 | battery_status = APM_BATTERY_STATUS_NOT_PRESENT; | ||
| 56 | battery_flag = 0x80; | ||
| 57 | percentage = -1; | ||
| 58 | } else if (charging < 8 ) { | ||
| 59 | battery_status = APM_BATTERY_STATUS_CHARGING; | ||
| 60 | battery_flag = 0x08; | ||
| 61 | ac_line_status = 0xff; | ||
| 62 | } else if (percentage <= APM_CRITICAL) { | ||
| 63 | battery_status = APM_BATTERY_STATUS_CRITICAL; | ||
| 64 | battery_flag = 0x04; | ||
| 65 | } else if (percentage <= APM_LOW) { | ||
| 66 | battery_status = APM_BATTERY_STATUS_LOW; | ||
| 67 | battery_flag = 0x02; | ||
| 68 | } else { | ||
| 69 | battery_status = APM_BATTERY_STATUS_HIGH; | ||
| 70 | battery_flag = 0x01; | ||
| 71 | } | ||
| 72 | |||
| 73 | p += sprintf(p, "1.0 1.2 0x%02x 0x%02x 0x%02x 0x%02x %d%% %d %s\n", | ||
| 74 | APM_32_BIT_SUPPORT, | ||
| 75 | ac_line_status, | ||
| 76 | battery_status, | ||
| 77 | battery_flag, | ||
| 78 | percentage, | ||
| 79 | time_units, | ||
| 80 | "min"); | ||
| 81 | p += sprintf(p, "bat=%d backup=%d charge=%d\n", | ||
| 82 | battery, backup, charging); | ||
| 83 | |||
| 84 | return p - buf; | ||
| 85 | } | ||
| 86 | |||
| 87 | static irqreturn_t hp6x0_apm_interrupt(int irq, void *dev, struct pt_regs *regs) | ||
| 88 | { | ||
| 89 | if (!apm_suspended) | ||
| 90 | apm_queue_event(APM_USER_SUSPEND); | ||
| 91 | |||
| 92 | return IRQ_HANDLED; | ||
| 93 | } | ||
| 94 | |||
| 95 | static int __init hp6x0_apm_init(void) | ||
| 96 | { | ||
| 97 | int ret; | ||
| 98 | |||
| 99 | ret = request_irq(HP680_BTN_IRQ, hp6x0_apm_interrupt, | ||
| 100 | SA_INTERRUPT, MODNAME, 0); | ||
| 101 | if (unlikely(ret < 0)) { | ||
| 102 | printk(KERN_ERR MODNAME ": IRQ %d request failed\n", | ||
| 103 | HP680_BTN_IRQ); | ||
| 104 | return ret; | ||
| 105 | } | ||
| 106 | |||
| 107 | apm_get_info = hp6x0_apm_get_info; | ||
| 108 | |||
| 109 | return ret; | ||
| 110 | } | ||
| 111 | |||
| 112 | static void __exit hp6x0_apm_exit(void) | ||
| 113 | { | ||
| 114 | free_irq(HP680_BTN_IRQ, 0); | ||
| 115 | apm_get_info = 0; | ||
| 116 | } | ||
| 117 | |||
| 118 | module_init(hp6x0_apm_init); | ||
| 119 | module_exit(hp6x0_apm_exit); | ||
| 120 | |||
| 121 | MODULE_AUTHOR("Adriy Skulysh"); | ||
| 122 | MODULE_DESCRIPTION("hp6xx Advanced Power Management"); | ||
| 123 | MODULE_LICENSE("GPL"); | ||
diff --git a/arch/sh/boards/hp6xx/pm.c b/arch/sh/boards/hp6xx/pm.c new file mode 100644 index 000000000000..0e501bcbd7a9 --- /dev/null +++ b/arch/sh/boards/hp6xx/pm.c | |||
| @@ -0,0 +1,88 @@ | |||
| 1 | /* | ||
| 2 | * hp6x0 Power Management Routines | ||
| 3 | * | ||
| 4 | * Copyright (c) 2006 Andriy Skulysh <askulsyh@gmail.com> | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or | ||
| 7 | * modify it under the terms of the GNU General Public License. | ||
| 8 | */ | ||
| 9 | #include <linux/config.h> | ||
| 10 | #include <linux/init.h> | ||
| 11 | #include <linux/suspend.h> | ||
| 12 | #include <linux/errno.h> | ||
| 13 | #include <linux/time.h> | ||
| 14 | #include <asm/io.h> | ||
| 15 | #include <asm/hd64461.h> | ||
| 16 | #include <asm/hp6xx/hp6xx.h> | ||
| 17 | #include <asm/cpu/dac.h> | ||
| 18 | #include <asm/pm.h> | ||
| 19 | |||
| 20 | #define STBCR 0xffffff82 | ||
| 21 | #define STBCR2 0xffffff88 | ||
| 22 | |||
| 23 | static int hp6x0_pm_enter(suspend_state_t state) | ||
| 24 | { | ||
| 25 | u8 stbcr, stbcr2; | ||
| 26 | #ifdef CONFIG_HD64461_ENABLER | ||
| 27 | u8 scr; | ||
| 28 | u16 hd64461_stbcr; | ||
| 29 | #endif | ||
| 30 | |||
| 31 | if (state != PM_SUSPEND_MEM) | ||
| 32 | return -EINVAL; | ||
| 33 | |||
| 34 | #ifdef CONFIG_HD64461_ENABLER | ||
| 35 | outb(0, HD64461_PCC1CSCIER); | ||
| 36 | |||
| 37 | scr = inb(HD64461_PCC1SCR); | ||
| 38 | scr |= HD64461_PCCSCR_VCC1; | ||
| 39 | outb(scr, HD64461_PCC1SCR); | ||
| 40 | |||
| 41 | hd64461_stbcr = inw(HD64461_STBCR); | ||
| 42 | hd64461_stbcr |= HD64461_STBCR_SPC1ST; | ||
| 43 | outw(hd64461_stbcr, HD64461_STBCR); | ||
| 44 | #endif | ||
| 45 | |||
| 46 | ctrl_outb(0x1f, DACR); | ||
| 47 | |||
| 48 | stbcr = ctrl_inb(STBCR); | ||
| 49 | ctrl_outb(0x01, STBCR); | ||
| 50 | |||
| 51 | stbcr2 = ctrl_inb(STBCR2); | ||
| 52 | ctrl_outb(0x7f , STBCR2); | ||
| 53 | |||
| 54 | outw(0xf07f, HD64461_SCPUCR); | ||
| 55 | |||
| 56 | pm_enter(); | ||
| 57 | |||
| 58 | outw(0, HD64461_SCPUCR); | ||
| 59 | ctrl_outb(stbcr, STBCR); | ||
| 60 | ctrl_outb(stbcr2, STBCR2); | ||
| 61 | |||
| 62 | #ifdef CONFIG_HD64461_ENABLER | ||
| 63 | hd64461_stbcr = inw(HD64461_STBCR); | ||
| 64 | hd64461_stbcr &= ~HD64461_STBCR_SPC1ST; | ||
| 65 | outw(hd64461_stbcr, HD64461_STBCR); | ||
| 66 | |||
| 67 | outb(0x4c, HD64461_PCC1CSCIER); | ||
| 68 | outb(0x00, HD64461_PCC1CSCR); | ||
| 69 | #endif | ||
| 70 | |||
| 71 | return 0; | ||
| 72 | } | ||
| 73 | |||
| 74 | /* | ||
| 75 | * Set to PM_DISK_FIRMWARE so we can quickly veto suspend-to-disk. | ||
| 76 | */ | ||
| 77 | static struct pm_ops hp6x0_pm_ops = { | ||
| 78 | .pm_disk_mode = PM_DISK_FIRMWARE, | ||
| 79 | .enter = hp6x0_pm_enter, | ||
| 80 | }; | ||
| 81 | |||
| 82 | static int __init hp6x0_pm_init(void) | ||
| 83 | { | ||
| 84 | pm_set_ops(&hp6x0_pm_ops); | ||
| 85 | return 0; | ||
| 86 | } | ||
| 87 | |||
| 88 | late_initcall(hp6x0_pm_init); | ||
diff --git a/arch/sh/boards/hp6xx/pm_wakeup.S b/arch/sh/boards/hp6xx/pm_wakeup.S new file mode 100644 index 000000000000..45e9bf0b9115 --- /dev/null +++ b/arch/sh/boards/hp6xx/pm_wakeup.S | |||
| @@ -0,0 +1,58 @@ | |||
| 1 | /* | ||
| 2 | * Copyright (c) 2006 Andriy Skulysh <askulsyh@gmail.com> | ||
| 3 | * | ||
| 4 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 5 | * License. See the file "COPYING" in the main directory of this archive | ||
| 6 | * for more details. | ||
| 7 | * | ||
| 8 | */ | ||
| 9 | |||
| 10 | #include <linux/linkage.h> | ||
| 11 | #include <asm/cpu/mmu_context.h> | ||
| 12 | |||
| 13 | #define k0 r0 | ||
| 14 | #define k1 r1 | ||
| 15 | #define k2 r2 | ||
| 16 | #define k3 r3 | ||
| 17 | #define k4 r4 | ||
| 18 | |||
| 19 | /* | ||
| 20 | * Kernel mode register usage: | ||
| 21 | * k0 scratch | ||
| 22 | * k1 scratch | ||
| 23 | * k2 scratch (Exception code) | ||
| 24 | * k3 scratch (Return address) | ||
| 25 | * k4 scratch | ||
| 26 | * k5 reserved | ||
| 27 | * k6 Global Interrupt Mask (0--15 << 4) | ||
| 28 | * k7 CURRENT_THREAD_INFO (pointer to current thread info) | ||
| 29 | */ | ||
| 30 | |||
| 31 | ENTRY(wakeup_start) | ||
| 32 | ! clear STBY bit | ||
| 33 | mov #-126, k2 | ||
| 34 | and #127, k0 | ||
| 35 | mov.b k0, @k2 | ||
| 36 | ! enable refresh | ||
| 37 | mov.l 5f, k1 | ||
| 38 | mov.w 6f, k0 | ||
| 39 | mov.w k0, @k1 | ||
| 40 | ! jump to handler | ||
| 41 | mov.l 2f, k2 | ||
| 42 | mov.l 3f, k3 | ||
| 43 | mov.l @k2, k2 | ||
| 44 | |||
| 45 | mov.l 4f, k1 | ||
| 46 | jmp @k1 | ||
| 47 | nop | ||
| 48 | |||
| 49 | .align 2 | ||
| 50 | 1: .long EXPEVT | ||
| 51 | 2: .long INTEVT | ||
| 52 | 3: .long ret_from_irq | ||
| 53 | 4: .long handle_exception | ||
| 54 | 5: .long 0xffffff68 | ||
| 55 | 6: .word 0x0524 | ||
| 56 | |||
| 57 | ENTRY(wakeup_end) | ||
| 58 | nop | ||
diff --git a/arch/sh/boards/hp6xx/setup.c b/arch/sh/boards/hp6xx/setup.c index 71f315663cc9..5fc00f0727c4 100644 --- a/arch/sh/boards/hp6xx/setup.c +++ b/arch/sh/boards/hp6xx/setup.c | |||
| @@ -15,6 +15,9 @@ | |||
| 15 | #include <asm/hp6xx/hp6xx.h> | 15 | #include <asm/hp6xx/hp6xx.h> |
| 16 | #include <asm/cpu/dac.h> | 16 | #include <asm/cpu/dac.h> |
| 17 | 17 | ||
| 18 | #define SCPCR 0xa4000116 | ||
| 19 | #define SCPDR 0xa4000136 | ||
| 20 | |||
| 18 | const char *get_system_type(void) | 21 | const char *get_system_type(void) |
| 19 | { | 22 | { |
| 20 | return "HP6xx"; | 23 | return "HP6xx"; |
| @@ -24,6 +27,7 @@ int __init platform_setup(void) | |||
| 24 | { | 27 | { |
| 25 | u8 v8; | 28 | u8 v8; |
| 26 | u16 v; | 29 | u16 v; |
| 30 | |||
| 27 | v = inw(HD64461_STBCR); | 31 | v = inw(HD64461_STBCR); |
| 28 | v |= HD64461_STBCR_SURTST | HD64461_STBCR_SIRST | | 32 | v |= HD64461_STBCR_SURTST | HD64461_STBCR_SIRST | |
| 29 | HD64461_STBCR_STM1ST | HD64461_STBCR_STM0ST | | 33 | HD64461_STBCR_STM1ST | HD64461_STBCR_STM0ST | |
| @@ -50,5 +54,15 @@ int __init platform_setup(void) | |||
| 50 | v8 &= ~DACR_DAE; | 54 | v8 &= ~DACR_DAE; |
| 51 | ctrl_outb(v8,DACR); | 55 | ctrl_outb(v8,DACR); |
| 52 | 56 | ||
| 57 | v8 = ctrl_inb(SCPDR); | ||
| 58 | v8 |= SCPDR_TS_SCAN_X | SCPDR_TS_SCAN_Y; | ||
| 59 | v8 &= ~SCPDR_TS_SCAN_ENABLE; | ||
| 60 | ctrl_outb(v8, SCPDR); | ||
| 61 | |||
| 62 | v = ctrl_inw(SCPCR); | ||
| 63 | v &= ~SCPCR_TS_MASK; | ||
| 64 | v |= SCPCR_TS_ENABLE; | ||
| 65 | ctrl_outw(v, SCPCR); | ||
| 66 | |||
| 53 | return 0; | 67 | return 0; |
| 54 | } | 68 | } |
diff --git a/arch/sh/kernel/Makefile b/arch/sh/kernel/Makefile index 2de82b66af4a..0e2148f63e7e 100644 --- a/arch/sh/kernel/Makefile +++ b/arch/sh/kernel/Makefile | |||
| @@ -18,3 +18,5 @@ obj-$(CONFIG_SH_CPU_FREQ) += cpufreq.o | |||
| 18 | obj-$(CONFIG_MODULES) += module.o | 18 | obj-$(CONFIG_MODULES) += module.o |
| 19 | obj-$(CONFIG_EARLY_PRINTK) += early_printk.o | 19 | obj-$(CONFIG_EARLY_PRINTK) += early_printk.o |
| 20 | obj-$(CONFIG_KEXEC) += machine_kexec.o relocate_kernel.o | 20 | obj-$(CONFIG_KEXEC) += machine_kexec.o relocate_kernel.o |
| 21 | obj-$(CONFIG_APM) += apm.o | ||
| 22 | obj-$(CONFIG_PM) += pm.o | ||
diff --git a/arch/sh/kernel/apm.c b/arch/sh/kernel/apm.c new file mode 100644 index 000000000000..871e7d640002 --- /dev/null +++ b/arch/sh/kernel/apm.c | |||
| @@ -0,0 +1,539 @@ | |||
| 1 | /* | ||
| 2 | * bios-less APM driver for hp680 | ||
| 3 | * | ||
| 4 | * Copyright 2005 (c) Andriy Skulysh <askulysh@gmail.com> | ||
| 5 | * | ||
| 6 | * based on ARM APM driver by | ||
| 7 | * Jamey Hicks <jamey@crl.dec.com> | ||
| 8 | * | ||
| 9 | * adapted from the APM BIOS driver for Linux by | ||
| 10 | * Stephen Rothwell (sfr@linuxcare.com) | ||
| 11 | * | ||
| 12 | * APM 1.2 Reference: | ||
| 13 | * Intel Corporation, Microsoft Corporation. Advanced Power Management | ||
| 14 | * (APM) BIOS Interface Specification, Revision 1.2, February 1996. | ||
| 15 | * | ||
| 16 | * [This document is available from Microsoft at: | ||
| 17 | * http://www.microsoft.com/hwdev/busbios/amp_12.htm] | ||
| 18 | */ | ||
| 19 | #include <linux/config.h> | ||
| 20 | #include <linux/module.h> | ||
| 21 | #include <linux/poll.h> | ||
| 22 | #include <linux/timer.h> | ||
| 23 | #include <linux/slab.h> | ||
| 24 | #include <linux/proc_fs.h> | ||
| 25 | #include <linux/miscdevice.h> | ||
| 26 | #include <linux/apm_bios.h> | ||
| 27 | #include <linux/pm.h> | ||
| 28 | #include <linux/pm_legacy.h> | ||
| 29 | #include <asm/apm.h> | ||
| 30 | |||
| 31 | #define MODNAME "apm" | ||
| 32 | |||
| 33 | /* | ||
| 34 | * The apm_bios device is one of the misc char devices. | ||
| 35 | * This is its minor number. | ||
| 36 | */ | ||
| 37 | #define APM_MINOR_DEV 134 | ||
| 38 | |||
| 39 | /* | ||
| 40 | * Maximum number of events stored | ||
| 41 | */ | ||
| 42 | #define APM_MAX_EVENTS 16 | ||
| 43 | |||
| 44 | struct apm_queue { | ||
| 45 | unsigned int event_head; | ||
| 46 | unsigned int event_tail; | ||
| 47 | apm_event_t events[APM_MAX_EVENTS]; | ||
| 48 | }; | ||
| 49 | |||
| 50 | /* | ||
| 51 | * The per-file APM data | ||
| 52 | */ | ||
| 53 | struct apm_user { | ||
| 54 | struct list_head list; | ||
| 55 | |||
| 56 | unsigned int suser: 1; | ||
| 57 | unsigned int writer: 1; | ||
| 58 | unsigned int reader: 1; | ||
| 59 | |||
| 60 | int suspend_result; | ||
| 61 | unsigned int suspend_state; | ||
| 62 | #define SUSPEND_NONE 0 /* no suspend pending */ | ||
| 63 | #define SUSPEND_PENDING 1 /* suspend pending read */ | ||
| 64 | #define SUSPEND_READ 2 /* suspend read, pending ack */ | ||
| 65 | #define SUSPEND_ACKED 3 /* suspend acked */ | ||
| 66 | #define SUSPEND_DONE 4 /* suspend completed */ | ||
| 67 | |||
| 68 | struct apm_queue queue; | ||
| 69 | }; | ||
| 70 | |||
| 71 | /* | ||
| 72 | * Local variables | ||
| 73 | */ | ||
| 74 | static int suspends_pending; | ||
| 75 | |||
| 76 | static DECLARE_WAIT_QUEUE_HEAD(apm_waitqueue); | ||
| 77 | static DECLARE_WAIT_QUEUE_HEAD(apm_suspend_waitqueue); | ||
| 78 | |||
| 79 | /* | ||
| 80 | * This is a list of everyone who has opened /dev/apm_bios | ||
| 81 | */ | ||
| 82 | static DECLARE_RWSEM(user_list_lock); | ||
| 83 | static LIST_HEAD(apm_user_list); | ||
| 84 | |||
| 85 | /* | ||
| 86 | * kapmd info. kapmd provides us a process context to handle | ||
| 87 | * "APM" events within - specifically necessary if we're going | ||
| 88 | * to be suspending the system. | ||
| 89 | */ | ||
| 90 | static DECLARE_WAIT_QUEUE_HEAD(kapmd_wait); | ||
| 91 | static DECLARE_COMPLETION(kapmd_exit); | ||
| 92 | static DEFINE_SPINLOCK(kapmd_queue_lock); | ||
| 93 | static struct apm_queue kapmd_queue; | ||
| 94 | |||
| 95 | int apm_suspended; | ||
| 96 | EXPORT_SYMBOL(apm_suspended); | ||
| 97 | |||
| 98 | /* Platform-specific apm_read_proc(). */ | ||
| 99 | int (*apm_get_info)(char *buf, char **start, off_t fpos, int length); | ||
| 100 | EXPORT_SYMBOL(apm_get_info); | ||
| 101 | |||
| 102 | /* | ||
| 103 | * APM event queue management. | ||
| 104 | */ | ||
| 105 | static inline int queue_empty(struct apm_queue *q) | ||
| 106 | { | ||
| 107 | return q->event_head == q->event_tail; | ||
| 108 | } | ||
| 109 | |||
| 110 | static inline apm_event_t queue_get_event(struct apm_queue *q) | ||
| 111 | { | ||
| 112 | q->event_tail = (q->event_tail + 1) % APM_MAX_EVENTS; | ||
| 113 | return q->events[q->event_tail]; | ||
| 114 | } | ||
| 115 | |||
| 116 | static void queue_add_event(struct apm_queue *q, apm_event_t event) | ||
| 117 | { | ||
| 118 | q->event_head = (q->event_head + 1) % APM_MAX_EVENTS; | ||
| 119 | if (q->event_head == q->event_tail) { | ||
| 120 | static int notified; | ||
| 121 | |||
| 122 | if (notified++ == 0) | ||
| 123 | printk(KERN_ERR "apm: an event queue overflowed\n"); | ||
| 124 | |||
| 125 | q->event_tail = (q->event_tail + 1) % APM_MAX_EVENTS; | ||
| 126 | } | ||
| 127 | q->events[q->event_head] = event; | ||
| 128 | } | ||
| 129 | |||
| 130 | static void queue_event_one_user(struct apm_user *as, apm_event_t event) | ||
| 131 | { | ||
| 132 | if (as->suser && as->writer) { | ||
| 133 | switch (event) { | ||
| 134 | case APM_SYS_SUSPEND: | ||
| 135 | case APM_USER_SUSPEND: | ||
| 136 | /* | ||
| 137 | * If this user already has a suspend pending, | ||
| 138 | * don't queue another one. | ||
| 139 | */ | ||
| 140 | if (as->suspend_state != SUSPEND_NONE) | ||
| 141 | return; | ||
| 142 | |||
| 143 | as->suspend_state = SUSPEND_PENDING; | ||
| 144 | suspends_pending++; | ||
| 145 | break; | ||
| 146 | } | ||
| 147 | } | ||
| 148 | queue_add_event(&as->queue, event); | ||
| 149 | } | ||
| 150 | |||
| 151 | static void queue_event(apm_event_t event, struct apm_user *sender) | ||
| 152 | { | ||
| 153 | struct apm_user *as; | ||
| 154 | |||
| 155 | down_read(&user_list_lock); | ||
| 156 | |||
| 157 | list_for_each_entry(as, &apm_user_list, list) | ||
| 158 | if (as != sender && as->reader) | ||
| 159 | queue_event_one_user(as, event); | ||
| 160 | |||
| 161 | up_read(&user_list_lock); | ||
| 162 | wake_up_interruptible(&apm_waitqueue); | ||
| 163 | } | ||
| 164 | |||
| 165 | /** | ||
| 166 | * apm_queue_event - queue an APM event for kapmd | ||
| 167 | * @event: APM event | ||
| 168 | * | ||
| 169 | * Queue an APM event for kapmd to process and ultimately take the | ||
| 170 | * appropriate action. Only a subset of events are handled: | ||
| 171 | * %APM_LOW_BATTERY | ||
| 172 | * %APM_POWER_STATUS_CHANGE | ||
| 173 | * %APM_USER_SUSPEND | ||
| 174 | * %APM_SYS_SUSPEND | ||
| 175 | * %APM_CRITICAL_SUSPEND | ||
| 176 | */ | ||
| 177 | void apm_queue_event(apm_event_t event) | ||
| 178 | { | ||
| 179 | spin_lock_irq(&kapmd_queue_lock); | ||
| 180 | queue_add_event(&kapmd_queue, event); | ||
| 181 | spin_unlock_irq(&kapmd_queue_lock); | ||
| 182 | |||
| 183 | wake_up_interruptible(&kapmd_wait); | ||
| 184 | } | ||
| 185 | EXPORT_SYMBOL(apm_queue_event); | ||
| 186 | |||
| 187 | static void apm_suspend(void) | ||
| 188 | { | ||
| 189 | struct apm_user *as; | ||
| 190 | int err; | ||
| 191 | |||
| 192 | apm_suspended = 1; | ||
| 193 | err = pm_suspend(PM_SUSPEND_MEM); | ||
| 194 | |||
| 195 | /* | ||
| 196 | * Anyone on the APM queues will think we're still suspended. | ||
| 197 | * Send a message so everyone knows we're now awake again. | ||
| 198 | */ | ||
| 199 | queue_event(APM_NORMAL_RESUME, NULL); | ||
| 200 | |||
| 201 | /* | ||
| 202 | * Finally, wake up anyone who is sleeping on the suspend. | ||
| 203 | */ | ||
| 204 | down_read(&user_list_lock); | ||
| 205 | list_for_each_entry(as, &apm_user_list, list) { | ||
| 206 | as->suspend_result = err; | ||
| 207 | as->suspend_state = SUSPEND_DONE; | ||
| 208 | } | ||
| 209 | up_read(&user_list_lock); | ||
| 210 | |||
| 211 | wake_up(&apm_suspend_waitqueue); | ||
| 212 | apm_suspended = 0; | ||
| 213 | } | ||
| 214 | |||
| 215 | static ssize_t apm_read(struct file *fp, char __user *buf, | ||
| 216 | size_t count, loff_t *ppos) | ||
| 217 | { | ||
| 218 | struct apm_user *as = fp->private_data; | ||
| 219 | apm_event_t event; | ||
| 220 | int i = count, ret = 0; | ||
| 221 | |||
| 222 | if (count < sizeof(apm_event_t)) | ||
| 223 | return -EINVAL; | ||
| 224 | |||
| 225 | if (queue_empty(&as->queue) && fp->f_flags & O_NONBLOCK) | ||
| 226 | return -EAGAIN; | ||
| 227 | |||
| 228 | wait_event_interruptible(apm_waitqueue, !queue_empty(&as->queue)); | ||
| 229 | |||
| 230 | while ((i >= sizeof(event)) && !queue_empty(&as->queue)) { | ||
| 231 | event = queue_get_event(&as->queue); | ||
| 232 | |||
| 233 | ret = -EFAULT; | ||
| 234 | if (copy_to_user(buf, &event, sizeof(event))) | ||
| 235 | break; | ||
| 236 | |||
| 237 | if (event == APM_SYS_SUSPEND || event == APM_USER_SUSPEND) | ||
| 238 | as->suspend_state = SUSPEND_READ; | ||
| 239 | |||
| 240 | buf += sizeof(event); | ||
| 241 | i -= sizeof(event); | ||
| 242 | } | ||
| 243 | |||
| 244 | if (i < count) | ||
| 245 | ret = count - i; | ||
| 246 | |||
| 247 | return ret; | ||
| 248 | } | ||
| 249 | |||
| 250 | static unsigned int apm_poll(struct file *fp, poll_table * wait) | ||
| 251 | { | ||
| 252 | struct apm_user *as = fp->private_data; | ||
| 253 | |||
| 254 | poll_wait(fp, &apm_waitqueue, wait); | ||
| 255 | return queue_empty(&as->queue) ? 0 : POLLIN | POLLRDNORM; | ||
| 256 | } | ||
| 257 | |||
| 258 | /* | ||
| 259 | * apm_ioctl - handle APM ioctl | ||
| 260 | * | ||
| 261 | * APM_IOC_SUSPEND | ||
| 262 | * This IOCTL is overloaded, and performs two functions. It is used to: | ||
| 263 | * - initiate a suspend | ||
| 264 | * - acknowledge a suspend read from /dev/apm_bios. | ||
| 265 | * Only when everyone who has opened /dev/apm_bios with write permission | ||
| 266 | * has acknowledge does the actual suspend happen. | ||
| 267 | */ | ||
| 268 | static int | ||
| 269 | apm_ioctl(struct inode * inode, struct file *filp, u_int cmd, u_long arg) | ||
| 270 | { | ||
| 271 | struct apm_user *as = filp->private_data; | ||
| 272 | unsigned long flags; | ||
| 273 | int err = -EINVAL; | ||
| 274 | |||
| 275 | if (!as->suser || !as->writer) | ||
| 276 | return -EPERM; | ||
| 277 | |||
| 278 | switch (cmd) { | ||
| 279 | case APM_IOC_SUSPEND: | ||
| 280 | as->suspend_result = -EINTR; | ||
| 281 | |||
| 282 | if (as->suspend_state == SUSPEND_READ) { | ||
| 283 | /* | ||
| 284 | * If we read a suspend command from /dev/apm_bios, | ||
| 285 | * then the corresponding APM_IOC_SUSPEND ioctl is | ||
| 286 | * interpreted as an acknowledge. | ||
| 287 | */ | ||
| 288 | as->suspend_state = SUSPEND_ACKED; | ||
| 289 | suspends_pending--; | ||
| 290 | } else { | ||
| 291 | /* | ||
| 292 | * Otherwise it is a request to suspend the system. | ||
| 293 | * Queue an event for all readers, and expect an | ||
| 294 | * acknowledge from all writers who haven't already | ||
| 295 | * acknowledged. | ||
| 296 | */ | ||
| 297 | queue_event(APM_USER_SUSPEND, as); | ||
| 298 | } | ||
| 299 | |||
| 300 | /* | ||
| 301 | * If there are no further acknowledges required, suspend | ||
| 302 | * the system. | ||
| 303 | */ | ||
| 304 | if (suspends_pending == 0) | ||
| 305 | apm_suspend(); | ||
| 306 | |||
| 307 | /* | ||
| 308 | * Wait for the suspend/resume to complete. If there are | ||
| 309 | * pending acknowledges, we wait here for them. | ||
| 310 | * | ||
| 311 | * Note that we need to ensure that the PM subsystem does | ||
| 312 | * not kick us out of the wait when it suspends the threads. | ||
| 313 | */ | ||
| 314 | flags = current->flags; | ||
| 315 | current->flags |= PF_NOFREEZE; | ||
| 316 | |||
| 317 | /* | ||
| 318 | * Note: do not allow a thread which is acking the suspend | ||
| 319 | * to escape until the resume is complete. | ||
| 320 | */ | ||
| 321 | if (as->suspend_state == SUSPEND_ACKED) | ||
| 322 | wait_event(apm_suspend_waitqueue, | ||
| 323 | as->suspend_state == SUSPEND_DONE); | ||
| 324 | else | ||
| 325 | wait_event_interruptible(apm_suspend_waitqueue, | ||
| 326 | as->suspend_state == SUSPEND_DONE); | ||
| 327 | |||
| 328 | current->flags = flags; | ||
| 329 | err = as->suspend_result; | ||
| 330 | as->suspend_state = SUSPEND_NONE; | ||
| 331 | break; | ||
| 332 | } | ||
| 333 | |||
| 334 | return err; | ||
| 335 | } | ||
| 336 | |||
| 337 | static int apm_release(struct inode * inode, struct file * filp) | ||
| 338 | { | ||
| 339 | struct apm_user *as = filp->private_data; | ||
| 340 | filp->private_data = NULL; | ||
| 341 | |||
| 342 | down_write(&user_list_lock); | ||
| 343 | list_del(&as->list); | ||
| 344 | up_write(&user_list_lock); | ||
| 345 | |||
| 346 | /* | ||
| 347 | * We are now unhooked from the chain. As far as new | ||
| 348 | * events are concerned, we no longer exist. However, we | ||
| 349 | * need to balance suspends_pending, which means the | ||
| 350 | * possibility of sleeping. | ||
| 351 | */ | ||
| 352 | if (as->suspend_state != SUSPEND_NONE) { | ||
| 353 | suspends_pending -= 1; | ||
| 354 | if (suspends_pending == 0) | ||
| 355 | apm_suspend(); | ||
| 356 | } | ||
| 357 | |||
| 358 | kfree(as); | ||
| 359 | return 0; | ||
| 360 | } | ||
| 361 | |||
| 362 | static int apm_open(struct inode * inode, struct file * filp) | ||
| 363 | { | ||
| 364 | struct apm_user *as; | ||
| 365 | |||
| 366 | as = kzalloc(sizeof(*as), GFP_KERNEL); | ||
| 367 | if (as) { | ||
| 368 | /* | ||
| 369 | * XXX - this is a tiny bit broken, when we consider BSD | ||
| 370 | * process accounting. If the device is opened by root, we | ||
| 371 | * instantly flag that we used superuser privs. Who knows, | ||
| 372 | * we might close the device immediately without doing a | ||
| 373 | * privileged operation -- cevans | ||
| 374 | */ | ||
| 375 | as->suser = capable(CAP_SYS_ADMIN); | ||
| 376 | as->writer = (filp->f_mode & FMODE_WRITE) == FMODE_WRITE; | ||
| 377 | as->reader = (filp->f_mode & FMODE_READ) == FMODE_READ; | ||
| 378 | |||
| 379 | down_write(&user_list_lock); | ||
| 380 | list_add(&as->list, &apm_user_list); | ||
| 381 | up_write(&user_list_lock); | ||
| 382 | |||
| 383 | filp->private_data = as; | ||
| 384 | } | ||
| 385 | |||
| 386 | return as ? 0 : -ENOMEM; | ||
| 387 | } | ||
| 388 | |||
| 389 | static struct file_operations apm_bios_fops = { | ||
| 390 | .owner = THIS_MODULE, | ||
| 391 | .read = apm_read, | ||
| 392 | .poll = apm_poll, | ||
| 393 | .ioctl = apm_ioctl, | ||
| 394 | .open = apm_open, | ||
| 395 | .release = apm_release, | ||
| 396 | }; | ||
| 397 | |||
| 398 | static struct miscdevice apm_device = { | ||
| 399 | .minor = APM_MINOR_DEV, | ||
| 400 | .name = "apm_bios", | ||
| 401 | .fops = &apm_bios_fops | ||
| 402 | }; | ||
| 403 | |||
| 404 | |||
| 405 | #ifdef CONFIG_PROC_FS | ||
| 406 | /* | ||
| 407 | * Arguments, with symbols from linux/apm_bios.h. | ||
| 408 | * | ||
| 409 | * 0) Linux driver version (this will change if format changes) | ||
| 410 | * 1) APM BIOS Version. Usually 1.0, 1.1 or 1.2. | ||
| 411 | * 2) APM flags from APM Installation Check (0x00): | ||
| 412 | * bit 0: APM_16_BIT_SUPPORT | ||
| 413 | * bit 1: APM_32_BIT_SUPPORT | ||
| 414 | * bit 2: APM_IDLE_SLOWS_CLOCK | ||
| 415 | * bit 3: APM_BIOS_DISABLED | ||
| 416 | * bit 4: APM_BIOS_DISENGAGED | ||
| 417 | * 3) AC line status | ||
| 418 | * 0x00: Off-line | ||
| 419 | * 0x01: On-line | ||
| 420 | * 0x02: On backup power (BIOS >= 1.1 only) | ||
| 421 | * 0xff: Unknown | ||
| 422 | * 4) Battery status | ||
| 423 | * 0x00: High | ||
| 424 | * 0x01: Low | ||
| 425 | * 0x02: Critical | ||
| 426 | * 0x03: Charging | ||
| 427 | * 0x04: Selected battery not present (BIOS >= 1.2 only) | ||
| 428 | * 0xff: Unknown | ||
| 429 | * 5) Battery flag | ||
| 430 | * bit 0: High | ||
| 431 | * bit 1: Low | ||
| 432 | * bit 2: Critical | ||
| 433 | * bit 3: Charging | ||
| 434 | * bit 7: No system battery | ||
| 435 | * 0xff: Unknown | ||
| 436 | * 6) Remaining battery life (percentage of charge): | ||
| 437 | * 0-100: valid | ||
| 438 | * -1: Unknown | ||
| 439 | * 7) Remaining battery life (time units): | ||
| 440 | * Number of remaining minutes or seconds | ||
| 441 | * -1: Unknown | ||
| 442 | * 8) min = minutes; sec = seconds | ||
| 443 | */ | ||
| 444 | static int apm_read_proc(char *buf, char **start, off_t fpos, int length) | ||
| 445 | { | ||
| 446 | if (likely(apm_get_info)) | ||
| 447 | return apm_get_info(buf, start, fpos, length); | ||
| 448 | |||
| 449 | return -EINVAL; | ||
| 450 | } | ||
| 451 | #endif | ||
| 452 | |||
| 453 | static int kapmd(void *arg) | ||
| 454 | { | ||
| 455 | daemonize("kapmd"); | ||
| 456 | current->flags |= PF_NOFREEZE; | ||
| 457 | |||
| 458 | do { | ||
| 459 | apm_event_t event; | ||
| 460 | |||
| 461 | wait_event_interruptible(kapmd_wait, | ||
| 462 | !queue_empty(&kapmd_queue) || !pm_active); | ||
| 463 | |||
| 464 | if (!pm_active) | ||
| 465 | break; | ||
| 466 | |||
| 467 | spin_lock_irq(&kapmd_queue_lock); | ||
| 468 | event = 0; | ||
| 469 | if (!queue_empty(&kapmd_queue)) | ||
| 470 | event = queue_get_event(&kapmd_queue); | ||
| 471 | spin_unlock_irq(&kapmd_queue_lock); | ||
| 472 | |||
| 473 | switch (event) { | ||
| 474 | case 0: | ||
| 475 | break; | ||
| 476 | |||
| 477 | case APM_LOW_BATTERY: | ||
| 478 | case APM_POWER_STATUS_CHANGE: | ||
| 479 | queue_event(event, NULL); | ||
| 480 | break; | ||
| 481 | |||
| 482 | case APM_USER_SUSPEND: | ||
| 483 | case APM_SYS_SUSPEND: | ||
| 484 | queue_event(event, NULL); | ||
| 485 | if (suspends_pending == 0) | ||
| 486 | apm_suspend(); | ||
| 487 | break; | ||
| 488 | |||
| 489 | case APM_CRITICAL_SUSPEND: | ||
| 490 | apm_suspend(); | ||
| 491 | break; | ||
| 492 | } | ||
| 493 | } while (1); | ||
| 494 | |||
| 495 | complete_and_exit(&kapmd_exit, 0); | ||
| 496 | } | ||
| 497 | |||
| 498 | static int __init apm_init(void) | ||
| 499 | { | ||
| 500 | int ret; | ||
| 501 | |||
| 502 | pm_active = 1; | ||
| 503 | |||
| 504 | ret = kernel_thread(kapmd, NULL, CLONE_KERNEL); | ||
| 505 | if (unlikely(ret < 0)) { | ||
| 506 | pm_active = 0; | ||
| 507 | return ret; | ||
| 508 | } | ||
| 509 | |||
| 510 | create_proc_info_entry("apm", 0, NULL, apm_read_proc); | ||
| 511 | |||
| 512 | ret = misc_register(&apm_device); | ||
| 513 | if (unlikely(ret != 0)) { | ||
| 514 | remove_proc_entry("apm", NULL); | ||
| 515 | |||
| 516 | pm_active = 0; | ||
| 517 | wake_up(&kapmd_wait); | ||
| 518 | wait_for_completion(&kapmd_exit); | ||
| 519 | } | ||
| 520 | |||
| 521 | return ret; | ||
| 522 | } | ||
| 523 | |||
| 524 | static void __exit apm_exit(void) | ||
| 525 | { | ||
| 526 | misc_deregister(&apm_device); | ||
| 527 | remove_proc_entry("apm", NULL); | ||
| 528 | |||
| 529 | pm_active = 0; | ||
| 530 | wake_up(&kapmd_wait); | ||
| 531 | wait_for_completion(&kapmd_exit); | ||
| 532 | } | ||
| 533 | |||
| 534 | module_init(apm_init); | ||
| 535 | module_exit(apm_exit); | ||
| 536 | |||
| 537 | MODULE_AUTHOR("Stephen Rothwell, Andriy Skulysh"); | ||
| 538 | MODULE_DESCRIPTION("Advanced Power Management"); | ||
| 539 | MODULE_LICENSE("GPL"); | ||
diff --git a/arch/sh/kernel/entry.S b/arch/sh/kernel/entry.S index 306eb8d83de5..b087d34dba35 100644 --- a/arch/sh/kernel/entry.S +++ b/arch/sh/kernel/entry.S | |||
| @@ -308,7 +308,7 @@ ENTRY(exception_error) | |||
| 308 | .align 2 | 308 | .align 2 |
| 309 | ret_from_exception: | 309 | ret_from_exception: |
| 310 | preempt_stop() | 310 | preempt_stop() |
| 311 | ret_from_irq: | 311 | ENTRY(ret_from_irq) |
| 312 | ! | 312 | ! |
| 313 | mov #OFF_SR, r0 | 313 | mov #OFF_SR, r0 |
| 314 | mov.l @(r0,r15), r0 ! get status register | 314 | mov.l @(r0,r15), r0 ! get status register |
| @@ -704,7 +704,7 @@ interrupt: | |||
| 704 | ! | 704 | ! |
| 705 | ! | 705 | ! |
| 706 | .align 2 | 706 | .align 2 |
| 707 | handle_exception: | 707 | ENTRY(handle_exception) |
| 708 | ! Using k0, k1 for scratch registers (r0_bank1, r1_bank), | 708 | ! Using k0, k1 for scratch registers (r0_bank1, r1_bank), |
| 709 | ! save all registers onto stack. | 709 | ! save all registers onto stack. |
| 710 | ! | 710 | ! |
diff --git a/arch/sh/kernel/pm.c b/arch/sh/kernel/pm.c new file mode 100644 index 000000000000..10ab62c9aede --- /dev/null +++ b/arch/sh/kernel/pm.c | |||
| @@ -0,0 +1,88 @@ | |||
| 1 | /* | ||
| 2 | * Generic Power Management Routine | ||
| 3 | * | ||
| 4 | * Copyright (c) 2006 Andriy Skulysh <askulsyh@gmail.com> | ||
| 5 | * | ||
| 6 | * This program is free software; you can redistribute it and/or | ||
| 7 | * modify it under the terms of the GNU General Public License. | ||
| 8 | */ | ||
| 9 | #include <linux/suspend.h> | ||
| 10 | #include <linux/delay.h> | ||
| 11 | #include <linux/gfp.h> | ||
| 12 | #include <asm/freq.h> | ||
| 13 | #include <asm/io.h> | ||
| 14 | #include <asm/watchdog.h> | ||
| 15 | #include <asm/pm.h> | ||
| 16 | |||
| 17 | #define INTR_OFFSET 0x600 | ||
| 18 | |||
| 19 | #define STBCR 0xffffff82 | ||
| 20 | #define STBCR2 0xffffff88 | ||
| 21 | |||
| 22 | #define STBCR_STBY 0x80 | ||
| 23 | #define STBCR_MSTP2 0x04 | ||
| 24 | |||
| 25 | #define MCR 0xffffff68 | ||
| 26 | #define RTCNT 0xffffff70 | ||
| 27 | |||
| 28 | #define MCR_RMODE 2 | ||
| 29 | #define MCR_RFSH 4 | ||
| 30 | |||
| 31 | void pm_enter(void) | ||
| 32 | { | ||
| 33 | u8 stbcr, csr; | ||
| 34 | u16 frqcr, mcr; | ||
| 35 | u32 vbr_new, vbr_old; | ||
| 36 | |||
| 37 | set_bl_bit(); | ||
| 38 | |||
| 39 | /* set wdt */ | ||
| 40 | csr = sh_wdt_read_csr(); | ||
| 41 | csr &= ~WTCSR_TME; | ||
| 42 | csr |= WTCSR_CKS_4096; | ||
| 43 | sh_wdt_write_csr(csr); | ||
| 44 | csr = sh_wdt_read_csr(); | ||
| 45 | sh_wdt_write_cnt(0); | ||
| 46 | |||
| 47 | /* disable PLL1 */ | ||
| 48 | frqcr = ctrl_inw(FRQCR); | ||
| 49 | frqcr &= ~(FRQCR_PLLEN | FRQCR_PSTBY); | ||
| 50 | ctrl_outw(frqcr, FRQCR); | ||
| 51 | |||
| 52 | /* enable standby */ | ||
| 53 | stbcr = ctrl_inb(STBCR); | ||
| 54 | ctrl_outb(stbcr | STBCR_STBY | STBCR_MSTP2, STBCR); | ||
| 55 | |||
| 56 | /* set self-refresh */ | ||
| 57 | mcr = ctrl_inw(MCR); | ||
| 58 | ctrl_outw(mcr & ~MCR_RFSH, MCR); | ||
| 59 | |||
| 60 | /* set interrupt handler */ | ||
| 61 | asm volatile("stc vbr, %0" : "=r" (vbr_old)); | ||
| 62 | vbr_new = get_zeroed_page(GFP_ATOMIC); | ||
| 63 | udelay(50); | ||
| 64 | memcpy((void*)(vbr_new + INTR_OFFSET), | ||
| 65 | &wakeup_start, &wakeup_end - &wakeup_start); | ||
| 66 | asm volatile("ldc %0, vbr" : : "r" (vbr_new)); | ||
| 67 | |||
| 68 | ctrl_outw(0, RTCNT); | ||
| 69 | ctrl_outw(mcr | MCR_RFSH | MCR_RMODE, MCR); | ||
| 70 | |||
| 71 | cpu_sleep(); | ||
| 72 | |||
| 73 | asm volatile("ldc %0, vbr" : : "r" (vbr_old)); | ||
| 74 | |||
| 75 | free_page(vbr_new); | ||
| 76 | |||
| 77 | /* enable PLL1 */ | ||
| 78 | frqcr = ctrl_inw(FRQCR); | ||
| 79 | frqcr |= FRQCR_PSTBY; | ||
| 80 | ctrl_outw(frqcr, FRQCR); | ||
| 81 | udelay(50); | ||
| 82 | frqcr |= FRQCR_PLLEN; | ||
| 83 | ctrl_outw(frqcr, FRQCR); | ||
| 84 | |||
| 85 | ctrl_outb(stbcr, STBCR); | ||
| 86 | |||
| 87 | clear_bl_bit(); | ||
| 88 | } | ||
diff --git a/arch/sh/kernel/sh_ksyms.c b/arch/sh/kernel/sh_ksyms.c index b73feafcd06e..fd73ab0326e9 100644 --- a/arch/sh/kernel/sh_ksyms.c +++ b/arch/sh/kernel/sh_ksyms.c | |||
| @@ -116,6 +116,10 @@ EXPORT_SYMBOL(__down_trylock); | |||
| 116 | EXPORT_SYMBOL(synchronize_irq); | 116 | EXPORT_SYMBOL(synchronize_irq); |
| 117 | #endif | 117 | #endif |
| 118 | 118 | ||
| 119 | #ifdef CONFIG_PM | ||
| 120 | EXPORT_SYMBOL(pm_suspend); | ||
| 121 | #endif | ||
| 122 | |||
| 119 | EXPORT_SYMBOL(csum_partial); | 123 | EXPORT_SYMBOL(csum_partial); |
| 120 | #ifdef CONFIG_IPV6 | 124 | #ifdef CONFIG_IPV6 |
| 121 | EXPORT_SYMBOL(csum_ipv6_magic); | 125 | EXPORT_SYMBOL(csum_ipv6_magic); |
diff --git a/arch/sh/kernel/time.c b/arch/sh/kernel/time.c index a1589f85499d..c8db6ca4f9d1 100644 --- a/arch/sh/kernel/time.c +++ b/arch/sh/kernel/time.c | |||
| @@ -143,8 +143,33 @@ void handle_timer_tick(struct pt_regs *regs) | |||
| 143 | } | 143 | } |
| 144 | } | 144 | } |
| 145 | 145 | ||
| 146 | #ifdef CONFIG_PM | ||
| 147 | int timer_suspend(struct sys_device *dev, pm_message_t state) | ||
| 148 | { | ||
| 149 | struct sys_timer *sys_timer = container_of(dev, struct sys_timer, dev); | ||
| 150 | |||
| 151 | sys_timer->ops->stop(); | ||
| 152 | |||
| 153 | return 0; | ||
| 154 | } | ||
| 155 | |||
| 156 | int timer_resume(struct sys_device *dev) | ||
| 157 | { | ||
| 158 | struct sys_timer *sys_timer = container_of(dev, struct sys_timer, dev); | ||
| 159 | |||
| 160 | sys_timer->ops->start(); | ||
| 161 | |||
| 162 | return 0; | ||
| 163 | } | ||
| 164 | #else | ||
| 165 | #define timer_suspend NULL | ||
| 166 | #define timer_resume NULL | ||
| 167 | #endif | ||
| 168 | |||
| 146 | static struct sysdev_class timer_sysclass = { | 169 | static struct sysdev_class timer_sysclass = { |
| 147 | set_kset_name("timer"), | 170 | set_kset_name("timer"), |
| 171 | .suspend = timer_suspend, | ||
| 172 | .resume = timer_resume, | ||
| 148 | }; | 173 | }; |
| 149 | 174 | ||
| 150 | static int __init timer_init_sysfs(void) | 175 | static int __init timer_init_sysfs(void) |
diff --git a/arch/sh/kernel/timers/timer-tmu.c b/arch/sh/kernel/timers/timer-tmu.c index d4212add53b2..ea4bdf8cdf0d 100644 --- a/arch/sh/kernel/timers/timer-tmu.c +++ b/arch/sh/kernel/timers/timer-tmu.c | |||
| @@ -188,6 +188,18 @@ static struct clk tmu0_clk = { | |||
| 188 | .ops = &tmu_clk_ops, | 188 | .ops = &tmu_clk_ops, |
| 189 | }; | 189 | }; |
| 190 | 190 | ||
| 191 | static int tmu_timer_start(void) | ||
| 192 | { | ||
| 193 | ctrl_outb(TMU_TSTR_INIT, TMU_TSTR); | ||
| 194 | return 0; | ||
| 195 | } | ||
| 196 | |||
| 197 | static int tmu_timer_stop(void) | ||
| 198 | { | ||
| 199 | ctrl_outb(0, TMU_TSTR); | ||
| 200 | return 0; | ||
| 201 | } | ||
| 202 | |||
| 191 | static int tmu_timer_init(void) | 203 | static int tmu_timer_init(void) |
| 192 | { | 204 | { |
| 193 | unsigned long interval; | 205 | unsigned long interval; |
| @@ -197,7 +209,7 @@ static int tmu_timer_init(void) | |||
| 197 | tmu0_clk.parent = clk_get("module_clk"); | 209 | tmu0_clk.parent = clk_get("module_clk"); |
| 198 | 210 | ||
| 199 | /* Start TMU0 */ | 211 | /* Start TMU0 */ |
| 200 | ctrl_outb(0, TMU_TSTR); | 212 | tmu_timer_stop(); |
| 201 | #if !defined(CONFIG_CPU_SUBTYPE_SH7300) && !defined(CONFIG_CPU_SUBTYPE_SH7760) | 213 | #if !defined(CONFIG_CPU_SUBTYPE_SH7300) && !defined(CONFIG_CPU_SUBTYPE_SH7760) |
| 202 | ctrl_outb(TMU_TOCR_INIT, TMU_TOCR); | 214 | ctrl_outb(TMU_TOCR_INIT, TMU_TOCR); |
| 203 | #endif | 215 | #endif |
| @@ -211,13 +223,15 @@ static int tmu_timer_init(void) | |||
| 211 | ctrl_outl(interval, TMU0_TCOR); | 223 | ctrl_outl(interval, TMU0_TCOR); |
| 212 | ctrl_outl(interval, TMU0_TCNT); | 224 | ctrl_outl(interval, TMU0_TCNT); |
| 213 | 225 | ||
| 214 | ctrl_outb(TMU_TSTR_INIT, TMU_TSTR); | 226 | tmu_timer_start(); |
| 215 | 227 | ||
| 216 | return 0; | 228 | return 0; |
| 217 | } | 229 | } |
| 218 | 230 | ||
| 219 | struct sys_timer_ops tmu_timer_ops = { | 231 | struct sys_timer_ops tmu_timer_ops = { |
| 220 | .init = tmu_timer_init, | 232 | .init = tmu_timer_init, |
| 233 | .start = tmu_timer_start, | ||
| 234 | .stop = tmu_timer_stop, | ||
| 221 | .get_frequency = tmu_timer_get_frequency, | 235 | .get_frequency = tmu_timer_get_frequency, |
| 222 | .get_offset = tmu_timer_get_offset, | 236 | .get_offset = tmu_timer_get_offset, |
| 223 | }; | 237 | }; |
diff --git a/drivers/input/touchscreen/hp680_ts_input.c b/drivers/input/touchscreen/hp680_ts_input.c index fa97e0f79e7e..ee6c2f40cdf6 100644 --- a/drivers/input/touchscreen/hp680_ts_input.c +++ b/drivers/input/touchscreen/hp680_ts_input.c | |||
| @@ -15,7 +15,6 @@ | |||
| 15 | #define HP680_TS_ABS_Y_MIN 80 | 15 | #define HP680_TS_ABS_Y_MIN 80 |
| 16 | #define HP680_TS_ABS_Y_MAX 910 | 16 | #define HP680_TS_ABS_Y_MAX 910 |
| 17 | 17 | ||
| 18 | #define SCPCR 0xa4000116 | ||
| 19 | #define PHDR 0xa400012e | 18 | #define PHDR 0xa400012e |
| 20 | #define SCPDR 0xa4000136 | 19 | #define SCPDR 0xa4000136 |
| 21 | 20 | ||
| @@ -77,19 +76,6 @@ static irqreturn_t hp680_ts_interrupt(int irq, void *dev, struct pt_regs *regs) | |||
| 77 | 76 | ||
| 78 | static int __init hp680_ts_init(void) | 77 | static int __init hp680_ts_init(void) |
| 79 | { | 78 | { |
| 80 | u8 scpdr; | ||
| 81 | u16 scpcr; | ||
| 82 | |||
| 83 | scpdr = ctrl_inb(SCPDR); | ||
| 84 | scpdr |= SCPDR_TS_SCAN_X | SCPDR_TS_SCAN_Y; | ||
| 85 | scpdr &= ~SCPDR_TS_SCAN_ENABLE; | ||
| 86 | ctrl_outb(scpdr, SCPDR); | ||
| 87 | |||
| 88 | scpcr = ctrl_inw(SCPCR); | ||
| 89 | scpcr &= ~SCPCR_TS_MASK; | ||
| 90 | scpcr |= SCPCR_TS_ENABLE; | ||
| 91 | ctrl_outw(scpcr, SCPCR); | ||
| 92 | |||
| 93 | hp680_ts_dev = input_allocate_device(); | 79 | hp680_ts_dev = input_allocate_device(); |
| 94 | if (!hp680_ts_dev) | 80 | if (!hp680_ts_dev) |
| 95 | return -ENOMEM; | 81 | return -ENOMEM; |
diff --git a/include/asm-sh/apm.h b/include/asm-sh/apm.h new file mode 100644 index 000000000000..8b091e93651f --- /dev/null +++ b/include/asm-sh/apm.h | |||
| @@ -0,0 +1,46 @@ | |||
| 1 | /* | ||
| 2 | * Copyright 2006 (c) Andriy Skulysh <askulysh@gmail.com> | ||
| 3 | * | ||
| 4 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 5 | * License. See the file "COPYING" in the main directory of this archive | ||
| 6 | * for more details. | ||
| 7 | * | ||
| 8 | */ | ||
| 9 | |||
| 10 | #ifndef __ASM_SH_APM_H | ||
| 11 | #define __ASM_SH_APM_H | ||
| 12 | |||
| 13 | #define APM_AC_OFFLINE 0 | ||
| 14 | #define APM_AC_ONLINE 1 | ||
| 15 | #define APM_AC_BACKUP 2 | ||
| 16 | #define APM_AC_UNKNOWN 0xff | ||
| 17 | |||
| 18 | #define APM_BATTERY_STATUS_HIGH 0 | ||
| 19 | #define APM_BATTERY_STATUS_LOW 1 | ||
| 20 | #define APM_BATTERY_STATUS_CRITICAL 2 | ||
| 21 | #define APM_BATTERY_STATUS_CHARGING 3 | ||
| 22 | #define APM_BATTERY_STATUS_NOT_PRESENT 4 | ||
| 23 | #define APM_BATTERY_STATUS_UNKNOWN 0xff | ||
| 24 | |||
| 25 | #define APM_BATTERY_LIFE_UNKNOWN 0xFFFF | ||
| 26 | #define APM_BATTERY_LIFE_MINUTES 0x8000 | ||
| 27 | #define APM_BATTERY_LIFE_VALUE_MASK 0x7FFF | ||
| 28 | |||
| 29 | #define APM_BATTERY_FLAG_HIGH (1 << 0) | ||
| 30 | #define APM_BATTERY_FLAG_LOW (1 << 1) | ||
| 31 | #define APM_BATTERY_FLAG_CRITICAL (1 << 2) | ||
| 32 | #define APM_BATTERY_FLAG_CHARGING (1 << 3) | ||
| 33 | #define APM_BATTERY_FLAG_NOT_PRESENT (1 << 7) | ||
| 34 | #define APM_BATTERY_FLAG_UNKNOWN 0xff | ||
| 35 | |||
| 36 | #define APM_UNITS_MINS 0 | ||
| 37 | #define APM_UNITS_SECS 1 | ||
| 38 | #define APM_UNITS_UNKNOWN -1 | ||
| 39 | |||
| 40 | |||
| 41 | extern int (*apm_get_info)(char *buf, char **start, off_t fpos, int length); | ||
| 42 | extern int apm_suspended; | ||
| 43 | |||
| 44 | void apm_queue_event(apm_event_t event); | ||
| 45 | |||
| 46 | #endif | ||
diff --git a/include/asm-sh/cpu-sh3/freq.h b/include/asm-sh/cpu-sh3/freq.h index b61b6e331df0..273f3229785c 100644 --- a/include/asm-sh/cpu-sh3/freq.h +++ b/include/asm-sh/cpu-sh3/freq.h | |||
| @@ -18,5 +18,9 @@ | |||
| 18 | #define MIN_DIVISOR_NR 0 | 18 | #define MIN_DIVISOR_NR 0 |
| 19 | #define MAX_DIVISOR_NR 4 | 19 | #define MAX_DIVISOR_NR 4 |
| 20 | 20 | ||
| 21 | #define FRQCR_CKOEN 0x0100 | ||
| 22 | #define FRQCR_PLLEN 0x0080 | ||
| 23 | #define FRQCR_PSTBY 0x0040 | ||
| 24 | |||
| 21 | #endif /* __ASM_CPU_SH3_FREQ_H */ | 25 | #endif /* __ASM_CPU_SH3_FREQ_H */ |
| 22 | 26 | ||
diff --git a/include/asm-sh/hd64461.h b/include/asm-sh/hd64461.h index 0f2e2132cc35..27e5c34e2659 100644 --- a/include/asm-sh/hd64461.h +++ b/include/asm-sh/hd64461.h | |||
| @@ -40,7 +40,12 @@ | |||
| 40 | #define HD64461_LCDCBAR 0x11000 | 40 | #define HD64461_LCDCBAR 0x11000 |
| 41 | #define HD64461_LCDCLOR 0x11002 | 41 | #define HD64461_LCDCLOR 0x11002 |
| 42 | #define HD64461_LCDCCR 0x11004 | 42 | #define HD64461_LCDCCR 0x11004 |
| 43 | #define HD64461_LCDCCR_MOFF 0x80 | 43 | #define HD64461_LCDCCR_STBACK 0x0400 |
| 44 | #define HD64461_LCDCCR_STREQ 0x0100 | ||
| 45 | #define HD64461_LCDCCR_MOFF 0x0080 | ||
| 46 | #define HD64461_LCDCCR_REFSEL 0x0040 | ||
| 47 | #define HD64461_LCDCCR_EPON 0x0020 | ||
| 48 | #define HD64461_LCDCCR_SPON 0x0010 | ||
| 44 | 49 | ||
| 45 | #define HD64461_LDR1 0x11010 | 50 | #define HD64461_LDR1 0x11010 |
| 46 | #define HD64461_LDR1_DON 0x01 | 51 | #define HD64461_LDR1_DON 0x01 |
diff --git a/include/asm-sh/hp6xx/hp6xx.h b/include/asm-sh/hp6xx/hp6xx.h index a26247fd3d87..f35134c159dd 100644 --- a/include/asm-sh/hp6xx/hp6xx.h +++ b/include/asm-sh/hp6xx/hp6xx.h | |||
| @@ -2,16 +2,33 @@ | |||
| 2 | #define __ASM_SH_HP6XX_H | 2 | #define __ASM_SH_HP6XX_H |
| 3 | 3 | ||
| 4 | /* | 4 | /* |
| 5 | * Copyright (C) 2003 Andriy Skulysh | 5 | * Copyright (C) 2003, 2004, 2005 Andriy Skulysh |
| 6 | * | ||
| 7 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 8 | * License. See the file "COPYING" in the main directory of this archive | ||
| 9 | * for more details. | ||
| 10 | * | ||
| 6 | */ | 11 | */ |
| 7 | 12 | ||
| 8 | #define HP680_TS_IRQ IRQ3_IRQ | 13 | #define HP680_BTN_IRQ IRQ0_IRQ |
| 14 | #define HP680_TS_IRQ IRQ3_IRQ | ||
| 15 | #define HP680_HD64461_IRQ IRQ4_IRQ | ||
| 9 | 16 | ||
| 10 | #define DAC_LCD_BRIGHTNESS 0 | 17 | #define DAC_LCD_BRIGHTNESS 0 |
| 11 | #define DAC_SPEAKER_VOLUME 1 | 18 | #define DAC_SPEAKER_VOLUME 1 |
| 12 | 19 | ||
| 20 | #define PGDR_OPENED 0x01 | ||
| 21 | #define PGDR_MAIN_BATTERY_OUT 0x04 | ||
| 22 | #define PGDR_PLAY_BUTTON 0x08 | ||
| 23 | #define PGDR_REWIND_BUTTON 0x10 | ||
| 24 | #define PGDR_RECORD_BUTTON 0x20 | ||
| 25 | |||
| 13 | #define PHDR_TS_PEN_DOWN 0x08 | 26 | #define PHDR_TS_PEN_DOWN 0x08 |
| 14 | 27 | ||
| 28 | #define PJDR_LED_BLINK 0x02 | ||
| 29 | |||
| 30 | #define PKDR_LED_GREEN 0x10 | ||
| 31 | |||
| 15 | #define SCPDR_TS_SCAN_ENABLE 0x20 | 32 | #define SCPDR_TS_SCAN_ENABLE 0x20 |
| 16 | #define SCPDR_TS_SCAN_Y 0x02 | 33 | #define SCPDR_TS_SCAN_Y 0x02 |
| 17 | #define SCPDR_TS_SCAN_X 0x01 | 34 | #define SCPDR_TS_SCAN_X 0x01 |
| @@ -21,11 +38,43 @@ | |||
| 21 | 38 | ||
| 22 | #define ADC_CHANNEL_TS_Y 1 | 39 | #define ADC_CHANNEL_TS_Y 1 |
| 23 | #define ADC_CHANNEL_TS_X 2 | 40 | #define ADC_CHANNEL_TS_X 2 |
| 41 | #define ADC_CHANNEL_BATTERY 3 | ||
| 42 | #define ADC_CHANNEL_BACKUP 4 | ||
| 43 | #define ADC_CHANNEL_CHARGE 5 | ||
| 24 | 44 | ||
| 25 | #define HD64461_GPADR_SPEAKER 0x01 | 45 | #define HD64461_GPADR_SPEAKER 0x01 |
| 26 | #define HD64461_GPADR_PCMCIA0 (0x02|0x08) | 46 | #define HD64461_GPADR_PCMCIA0 (0x02|0x08) |
| 47 | |||
| 27 | #define HD64461_GPBDR_LCDOFF 0x01 | 48 | #define HD64461_GPBDR_LCDOFF 0x01 |
| 49 | #define HD64461_GPBDR_LCD_CONTRAST_MASK 0x78 | ||
| 28 | #define HD64461_GPBDR_LED_RED 0x80 | 50 | #define HD64461_GPBDR_LED_RED 0x80 |
| 29 | 51 | ||
| 52 | #include <asm/hd64461.h> | ||
| 53 | #include <asm/io.h> | ||
| 54 | |||
| 55 | #define PJDR 0xa4000130 | ||
| 56 | #define PKDR 0xa4000132 | ||
| 57 | |||
| 58 | static inline void hp6xx_led_red(int on) | ||
| 59 | { | ||
| 60 | u16 v16; | ||
| 61 | v16 = ctrl_inw(CONFIG_HD64461_IOBASE + HD64461_GPBDR - 0x10000); | ||
| 62 | if (on) | ||
| 63 | ctrl_outw(v16 & (~HD64461_GPBDR_LED_RED), CONFIG_HD64461_IOBASE + HD64461_GPBDR - 0x10000); | ||
| 64 | else | ||
| 65 | ctrl_outw(v16 | HD64461_GPBDR_LED_RED, CONFIG_HD64461_IOBASE + HD64461_GPBDR - 0x10000); | ||
| 66 | } | ||
| 67 | |||
| 68 | static inline void hp6xx_led_green(int on) | ||
| 69 | { | ||
| 70 | u8 v8; | ||
| 71 | |||
| 72 | v8 = ctrl_inb(PKDR); | ||
| 73 | if (on) | ||
| 74 | ctrl_outb(v8 & (~PKDR_LED_GREEN), PKDR); | ||
| 75 | else | ||
| 76 | ctrl_outb(v8 | PKDR_LED_GREEN, PKDR); | ||
| 77 | } | ||
| 78 | |||
| 30 | 79 | ||
| 31 | #endif /* __ASM_SH_HP6XX_H */ | 80 | #endif /* __ASM_SH_HP6XX_H */ |
diff --git a/include/asm-sh/pm.h b/include/asm-sh/pm.h new file mode 100644 index 000000000000..56fdbd6b1c94 --- /dev/null +++ b/include/asm-sh/pm.h | |||
| @@ -0,0 +1,17 @@ | |||
| 1 | /* | ||
| 2 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 3 | * License. See the file "COPYING" in the main directory of this archive | ||
| 4 | * for more details. | ||
| 5 | * | ||
| 6 | * Copyright 2006 (c) Andriy Skulysh <askulysh@gmail.com> | ||
| 7 | * | ||
| 8 | */ | ||
| 9 | #ifndef __ASM_SH_PM_H | ||
| 10 | #define __ASM_SH_PM_H | ||
| 11 | |||
| 12 | extern u8 wakeup_start; | ||
| 13 | extern u8 wakeup_end; | ||
| 14 | |||
| 15 | void pm_enter(void); | ||
| 16 | |||
| 17 | #endif | ||
diff --git a/include/asm-sh/system.h b/include/asm-sh/system.h index bd7dc0554b11..477422afeb0d 100644 --- a/include/asm-sh/system.h +++ b/include/asm-sh/system.h | |||
| @@ -172,6 +172,31 @@ static __inline__ void local_irq_disable(void) | |||
| 172 | : "memory"); | 172 | : "memory"); |
| 173 | } | 173 | } |
| 174 | 174 | ||
| 175 | static __inline__ void set_bl_bit(void) | ||
| 176 | { | ||
| 177 | unsigned long __dummy0, __dummy1; | ||
| 178 | |||
| 179 | __asm__ __volatile__ ("stc sr, %0\n\t" | ||
| 180 | "or %2, %0\n\t" | ||
| 181 | "and %3, %0\n\t" | ||
| 182 | "ldc %0, sr" | ||
| 183 | : "=&r" (__dummy0), "=r" (__dummy1) | ||
| 184 | : "r" (0x10000000), "r" (0xffffff0f) | ||
| 185 | : "memory"); | ||
| 186 | } | ||
| 187 | |||
| 188 | static __inline__ void clear_bl_bit(void) | ||
| 189 | { | ||
| 190 | unsigned long __dummy0, __dummy1; | ||
| 191 | |||
| 192 | __asm__ __volatile__ ("stc sr, %0\n\t" | ||
| 193 | "and %2, %0\n\t" | ||
| 194 | "ldc %0, sr" | ||
| 195 | : "=&r" (__dummy0), "=r" (__dummy1) | ||
| 196 | : "1" (~0x10000000) | ||
| 197 | : "memory"); | ||
| 198 | } | ||
| 199 | |||
| 175 | #define local_save_flags(x) \ | 200 | #define local_save_flags(x) \ |
| 176 | __asm__("stc sr, %0; and #0xf0, %0" : "=&z" (x) :/**/: "memory" ) | 201 | __asm__("stc sr, %0; and #0xf0, %0" : "=&z" (x) :/**/: "memory" ) |
| 177 | 202 | ||
diff --git a/include/asm-sh/timer.h b/include/asm-sh/timer.h index dd6579c0b04c..c7ab28095ba0 100644 --- a/include/asm-sh/timer.h +++ b/include/asm-sh/timer.h | |||
| @@ -6,6 +6,8 @@ | |||
| 6 | 6 | ||
| 7 | struct sys_timer_ops { | 7 | struct sys_timer_ops { |
| 8 | int (*init)(void); | 8 | int (*init)(void); |
| 9 | int (*start)(void); | ||
| 10 | int (*stop)(void); | ||
| 9 | unsigned long (*get_offset)(void); | 11 | unsigned long (*get_offset)(void); |
| 10 | unsigned long (*get_frequency)(void); | 12 | unsigned long (*get_frequency)(void); |
| 11 | }; | 13 | }; |
