diff options
| author | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
|---|---|---|
| committer | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
| commit | fcc9d2e5a6c89d22b8b773a64fb4ad21ac318446 (patch) | |
| tree | a57612d1888735a2ec7972891b68c1ac5ec8faea /arch/sh/kernel | |
| parent | 8dea78da5cee153b8af9c07a2745f6c55057fe12 (diff) | |
Diffstat (limited to 'arch/sh/kernel')
| -rw-r--r-- | arch/sh/kernel/cpu/hwblk.c | 159 | ||||
| -rw-r--r-- | arch/sh/kernel/cpu/sh4a/hwblk-sh7722.c | 106 | ||||
| -rw-r--r-- | arch/sh/kernel/cpu/sh4a/hwblk-sh7723.c | 117 | ||||
| -rw-r--r-- | arch/sh/kernel/cpu/sh4a/hwblk-sh7724.c | 121 | ||||
| -rw-r--r-- | arch/sh/kernel/cpu/shmobile/pm_runtime.c | 319 | ||||
| -rw-r--r-- | arch/sh/kernel/init_task.c | 30 | ||||
| -rw-r--r-- | arch/sh/kernel/sys_sh64.c | 50 |
7 files changed, 902 insertions, 0 deletions
diff --git a/arch/sh/kernel/cpu/hwblk.c b/arch/sh/kernel/cpu/hwblk.c new file mode 100644 index 00000000000..3e985aae5d9 --- /dev/null +++ b/arch/sh/kernel/cpu/hwblk.c | |||
| @@ -0,0 +1,159 @@ | |||
| 1 | #include <linux/clk.h> | ||
| 2 | #include <linux/compiler.h> | ||
| 3 | #include <linux/io.h> | ||
| 4 | #include <linux/spinlock.h> | ||
| 5 | #include <asm/suspend.h> | ||
| 6 | #include <asm/hwblk.h> | ||
| 7 | #include <asm/clock.h> | ||
| 8 | |||
| 9 | static DEFINE_SPINLOCK(hwblk_lock); | ||
| 10 | |||
| 11 | static void hwblk_area_mod_cnt(struct hwblk_info *info, | ||
| 12 | int area, int counter, int value, int goal) | ||
| 13 | { | ||
| 14 | struct hwblk_area *hap = info->areas + area; | ||
| 15 | |||
| 16 | hap->cnt[counter] += value; | ||
| 17 | |||
| 18 | if (hap->cnt[counter] != goal) | ||
| 19 | return; | ||
| 20 | |||
| 21 | if (hap->flags & HWBLK_AREA_FLAG_PARENT) | ||
| 22 | hwblk_area_mod_cnt(info, hap->parent, counter, value, goal); | ||
| 23 | } | ||
| 24 | |||
| 25 | |||
| 26 | static int __hwblk_mod_cnt(struct hwblk_info *info, int hwblk, | ||
| 27 | int counter, int value, int goal) | ||
| 28 | { | ||
| 29 | struct hwblk *hp = info->hwblks + hwblk; | ||
| 30 | |||
| 31 | hp->cnt[counter] += value; | ||
| 32 | if (hp->cnt[counter] == goal) | ||
| 33 | hwblk_area_mod_cnt(info, hp->area, counter, value, goal); | ||
| 34 | |||
| 35 | return hp->cnt[counter]; | ||
| 36 | } | ||
| 37 | |||
| 38 | static void hwblk_mod_cnt(struct hwblk_info *info, int hwblk, | ||
| 39 | int counter, int value, int goal) | ||
| 40 | { | ||
| 41 | unsigned long flags; | ||
| 42 | |||
| 43 | spin_lock_irqsave(&hwblk_lock, flags); | ||
| 44 | __hwblk_mod_cnt(info, hwblk, counter, value, goal); | ||
| 45 | spin_unlock_irqrestore(&hwblk_lock, flags); | ||
| 46 | } | ||
| 47 | |||
| 48 | void hwblk_cnt_inc(struct hwblk_info *info, int hwblk, int counter) | ||
| 49 | { | ||
| 50 | hwblk_mod_cnt(info, hwblk, counter, 1, 1); | ||
| 51 | } | ||
| 52 | |||
| 53 | void hwblk_cnt_dec(struct hwblk_info *info, int hwblk, int counter) | ||
| 54 | { | ||
| 55 | hwblk_mod_cnt(info, hwblk, counter, -1, 0); | ||
| 56 | } | ||
| 57 | |||
| 58 | void hwblk_enable(struct hwblk_info *info, int hwblk) | ||
| 59 | { | ||
| 60 | struct hwblk *hp = info->hwblks + hwblk; | ||
| 61 | unsigned long tmp; | ||
| 62 | unsigned long flags; | ||
| 63 | int ret; | ||
| 64 | |||
| 65 | spin_lock_irqsave(&hwblk_lock, flags); | ||
| 66 | |||
| 67 | ret = __hwblk_mod_cnt(info, hwblk, HWBLK_CNT_USAGE, 1, 1); | ||
| 68 | if (ret == 1) { | ||
| 69 | tmp = __raw_readl(hp->mstp); | ||
| 70 | tmp &= ~(1 << hp->bit); | ||
| 71 | __raw_writel(tmp, hp->mstp); | ||
| 72 | } | ||
| 73 | |||
| 74 | spin_unlock_irqrestore(&hwblk_lock, flags); | ||
| 75 | } | ||
| 76 | |||
| 77 | void hwblk_disable(struct hwblk_info *info, int hwblk) | ||
| 78 | { | ||
| 79 | struct hwblk *hp = info->hwblks + hwblk; | ||
| 80 | unsigned long tmp; | ||
| 81 | unsigned long flags; | ||
| 82 | int ret; | ||
| 83 | |||
| 84 | spin_lock_irqsave(&hwblk_lock, flags); | ||
| 85 | |||
| 86 | ret = __hwblk_mod_cnt(info, hwblk, HWBLK_CNT_USAGE, -1, 0); | ||
| 87 | if (ret == 0) { | ||
| 88 | tmp = __raw_readl(hp->mstp); | ||
| 89 | tmp |= 1 << hp->bit; | ||
| 90 | __raw_writel(tmp, hp->mstp); | ||
| 91 | } | ||
| 92 | |||
| 93 | spin_unlock_irqrestore(&hwblk_lock, flags); | ||
| 94 | } | ||
| 95 | |||
| 96 | struct hwblk_info *hwblk_info; | ||
| 97 | |||
| 98 | int __init hwblk_register(struct hwblk_info *info) | ||
| 99 | { | ||
| 100 | hwblk_info = info; | ||
| 101 | return 0; | ||
| 102 | } | ||
| 103 | |||
| 104 | int __init __weak arch_hwblk_init(void) | ||
| 105 | { | ||
| 106 | return 0; | ||
| 107 | } | ||
| 108 | |||
| 109 | int __weak arch_hwblk_sleep_mode(void) | ||
| 110 | { | ||
| 111 | return SUSP_SH_SLEEP; | ||
| 112 | } | ||
| 113 | |||
| 114 | int __init hwblk_init(void) | ||
| 115 | { | ||
| 116 | return arch_hwblk_init(); | ||
| 117 | } | ||
| 118 | |||
| 119 | /* allow clocks to enable and disable hardware blocks */ | ||
| 120 | static int sh_hwblk_clk_enable(struct clk *clk) | ||
| 121 | { | ||
| 122 | if (!hwblk_info) | ||
| 123 | return -ENOENT; | ||
| 124 | |||
| 125 | hwblk_enable(hwblk_info, clk->arch_flags); | ||
| 126 | return 0; | ||
| 127 | } | ||
| 128 | |||
| 129 | static void sh_hwblk_clk_disable(struct clk *clk) | ||
| 130 | { | ||
| 131 | if (hwblk_info) | ||
| 132 | hwblk_disable(hwblk_info, clk->arch_flags); | ||
| 133 | } | ||
| 134 | |||
| 135 | static struct clk_ops sh_hwblk_clk_ops = { | ||
| 136 | .enable = sh_hwblk_clk_enable, | ||
| 137 | .disable = sh_hwblk_clk_disable, | ||
| 138 | .recalc = followparent_recalc, | ||
| 139 | }; | ||
| 140 | |||
| 141 | int __init sh_hwblk_clk_register(struct clk *clks, int nr) | ||
| 142 | { | ||
| 143 | struct clk *clkp; | ||
| 144 | int ret = 0; | ||
| 145 | int k; | ||
| 146 | |||
| 147 | for (k = 0; !ret && (k < nr); k++) { | ||
| 148 | clkp = clks + k; | ||
| 149 | |||
| 150 | /* skip over clocks using hwblk 0 (HWBLK_UNKNOWN) */ | ||
| 151 | if (!clkp->arch_flags) | ||
| 152 | continue; | ||
| 153 | |||
| 154 | clkp->ops = &sh_hwblk_clk_ops; | ||
| 155 | ret |= clk_register(clkp); | ||
| 156 | } | ||
| 157 | |||
| 158 | return ret; | ||
| 159 | } | ||
diff --git a/arch/sh/kernel/cpu/sh4a/hwblk-sh7722.c b/arch/sh/kernel/cpu/sh4a/hwblk-sh7722.c new file mode 100644 index 00000000000..a288b5d9234 --- /dev/null +++ b/arch/sh/kernel/cpu/sh4a/hwblk-sh7722.c | |||
| @@ -0,0 +1,106 @@ | |||
| 1 | /* | ||
| 2 | * arch/sh/kernel/cpu/sh4a/hwblk-sh7722.c | ||
| 3 | * | ||
| 4 | * SH7722 hardware block support | ||
| 5 | * | ||
| 6 | * Copyright (C) 2009 Magnus Damm | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License as published by | ||
| 10 | * the Free Software Foundation; either version 2 of the License | ||
| 11 | * | ||
| 12 | * This program is distributed in the hope that it will be useful, | ||
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 15 | * GNU General Public License for more details. | ||
| 16 | * | ||
| 17 | * You should have received a copy of the GNU General Public License | ||
| 18 | * along with this program; if not, write to the Free Software | ||
| 19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 20 | */ | ||
| 21 | #include <linux/init.h> | ||
| 22 | #include <linux/kernel.h> | ||
| 23 | #include <linux/io.h> | ||
| 24 | #include <asm/suspend.h> | ||
| 25 | #include <asm/hwblk.h> | ||
| 26 | #include <cpu/sh7722.h> | ||
| 27 | |||
| 28 | /* SH7722 registers */ | ||
| 29 | #define MSTPCR0 0xa4150030 | ||
| 30 | #define MSTPCR1 0xa4150034 | ||
| 31 | #define MSTPCR2 0xa4150038 | ||
| 32 | |||
| 33 | /* SH7722 Power Domains */ | ||
| 34 | enum { CORE_AREA, SUB_AREA, CORE_AREA_BM }; | ||
| 35 | static struct hwblk_area sh7722_hwblk_area[] = { | ||
| 36 | [CORE_AREA] = HWBLK_AREA(0, 0), | ||
| 37 | [CORE_AREA_BM] = HWBLK_AREA(HWBLK_AREA_FLAG_PARENT, CORE_AREA), | ||
| 38 | [SUB_AREA] = HWBLK_AREA(0, 0), | ||
| 39 | }; | ||
| 40 | |||
| 41 | /* Table mapping HWBLK to Module Stop Bit and Power Domain */ | ||
| 42 | static struct hwblk sh7722_hwblk[HWBLK_NR] = { | ||
| 43 | [HWBLK_TLB] = HWBLK(MSTPCR0, 31, CORE_AREA), | ||
| 44 | [HWBLK_IC] = HWBLK(MSTPCR0, 30, CORE_AREA), | ||
| 45 | [HWBLK_OC] = HWBLK(MSTPCR0, 29, CORE_AREA), | ||
| 46 | [HWBLK_URAM] = HWBLK(MSTPCR0, 28, CORE_AREA), | ||
| 47 | [HWBLK_XYMEM] = HWBLK(MSTPCR0, 26, CORE_AREA), | ||
| 48 | [HWBLK_INTC] = HWBLK(MSTPCR0, 22, CORE_AREA), | ||
| 49 | [HWBLK_DMAC] = HWBLK(MSTPCR0, 21, CORE_AREA_BM), | ||
| 50 | [HWBLK_SHYWAY] = HWBLK(MSTPCR0, 20, CORE_AREA), | ||
| 51 | [HWBLK_HUDI] = HWBLK(MSTPCR0, 19, CORE_AREA), | ||
| 52 | [HWBLK_UBC] = HWBLK(MSTPCR0, 17, CORE_AREA), | ||
| 53 | [HWBLK_TMU] = HWBLK(MSTPCR0, 15, CORE_AREA), | ||
| 54 | [HWBLK_CMT] = HWBLK(MSTPCR0, 14, SUB_AREA), | ||
| 55 | [HWBLK_RWDT] = HWBLK(MSTPCR0, 13, SUB_AREA), | ||
| 56 | [HWBLK_FLCTL] = HWBLK(MSTPCR0, 10, CORE_AREA), | ||
| 57 | [HWBLK_SCIF0] = HWBLK(MSTPCR0, 7, CORE_AREA), | ||
| 58 | [HWBLK_SCIF1] = HWBLK(MSTPCR0, 6, CORE_AREA), | ||
| 59 | [HWBLK_SCIF2] = HWBLK(MSTPCR0, 5, CORE_AREA), | ||
| 60 | [HWBLK_SIO] = HWBLK(MSTPCR0, 3, CORE_AREA), | ||
| 61 | [HWBLK_SIOF0] = HWBLK(MSTPCR0, 2, CORE_AREA), | ||
| 62 | [HWBLK_SIOF1] = HWBLK(MSTPCR0, 1, CORE_AREA), | ||
| 63 | |||
| 64 | [HWBLK_IIC] = HWBLK(MSTPCR1, 9, CORE_AREA), | ||
| 65 | [HWBLK_RTC] = HWBLK(MSTPCR1, 8, SUB_AREA), | ||
| 66 | |||
| 67 | [HWBLK_TPU] = HWBLK(MSTPCR2, 25, CORE_AREA), | ||
| 68 | [HWBLK_IRDA] = HWBLK(MSTPCR2, 24, CORE_AREA), | ||
| 69 | [HWBLK_SDHI] = HWBLK(MSTPCR2, 18, CORE_AREA), | ||
| 70 | [HWBLK_SIM] = HWBLK(MSTPCR2, 16, CORE_AREA), | ||
| 71 | [HWBLK_KEYSC] = HWBLK(MSTPCR2, 14, SUB_AREA), | ||
| 72 | [HWBLK_TSIF] = HWBLK(MSTPCR2, 13, SUB_AREA), | ||
| 73 | [HWBLK_USBF] = HWBLK(MSTPCR2, 11, CORE_AREA), | ||
| 74 | [HWBLK_2DG] = HWBLK(MSTPCR2, 9, CORE_AREA_BM), | ||
| 75 | [HWBLK_SIU] = HWBLK(MSTPCR2, 8, CORE_AREA), | ||
| 76 | [HWBLK_JPU] = HWBLK(MSTPCR2, 6, CORE_AREA_BM), | ||
| 77 | [HWBLK_VOU] = HWBLK(MSTPCR2, 5, CORE_AREA_BM), | ||
| 78 | [HWBLK_BEU] = HWBLK(MSTPCR2, 4, CORE_AREA_BM), | ||
| 79 | [HWBLK_CEU] = HWBLK(MSTPCR2, 3, CORE_AREA_BM), | ||
| 80 | [HWBLK_VEU] = HWBLK(MSTPCR2, 2, CORE_AREA_BM), | ||
| 81 | [HWBLK_VPU] = HWBLK(MSTPCR2, 1, CORE_AREA_BM), | ||
| 82 | [HWBLK_LCDC] = HWBLK(MSTPCR2, 0, CORE_AREA_BM), | ||
| 83 | }; | ||
| 84 | |||
| 85 | static struct hwblk_info sh7722_hwblk_info = { | ||
| 86 | .areas = sh7722_hwblk_area, | ||
| 87 | .nr_areas = ARRAY_SIZE(sh7722_hwblk_area), | ||
| 88 | .hwblks = sh7722_hwblk, | ||
| 89 | .nr_hwblks = ARRAY_SIZE(sh7722_hwblk), | ||
| 90 | }; | ||
| 91 | |||
| 92 | int arch_hwblk_sleep_mode(void) | ||
| 93 | { | ||
| 94 | if (!sh7722_hwblk_area[CORE_AREA].cnt[HWBLK_CNT_USAGE]) | ||
| 95 | return SUSP_SH_STANDBY | SUSP_SH_SF; | ||
| 96 | |||
| 97 | if (!sh7722_hwblk_area[CORE_AREA_BM].cnt[HWBLK_CNT_USAGE]) | ||
| 98 | return SUSP_SH_SLEEP | SUSP_SH_SF; | ||
| 99 | |||
| 100 | return SUSP_SH_SLEEP; | ||
| 101 | } | ||
| 102 | |||
| 103 | int __init arch_hwblk_init(void) | ||
| 104 | { | ||
| 105 | return hwblk_register(&sh7722_hwblk_info); | ||
| 106 | } | ||
diff --git a/arch/sh/kernel/cpu/sh4a/hwblk-sh7723.c b/arch/sh/kernel/cpu/sh4a/hwblk-sh7723.c new file mode 100644 index 00000000000..a7f4684d203 --- /dev/null +++ b/arch/sh/kernel/cpu/sh4a/hwblk-sh7723.c | |||
| @@ -0,0 +1,117 @@ | |||
| 1 | /* | ||
| 2 | * arch/sh/kernel/cpu/sh4a/hwblk-sh7723.c | ||
| 3 | * | ||
| 4 | * SH7723 hardware block support | ||
| 5 | * | ||
| 6 | * Copyright (C) 2009 Magnus Damm | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License as published by | ||
| 10 | * the Free Software Foundation; either version 2 of the License | ||
| 11 | * | ||
| 12 | * This program is distributed in the hope that it will be useful, | ||
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 15 | * GNU General Public License for more details. | ||
| 16 | * | ||
| 17 | * You should have received a copy of the GNU General Public License | ||
| 18 | * along with this program; if not, write to the Free Software | ||
| 19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 20 | */ | ||
| 21 | #include <linux/init.h> | ||
| 22 | #include <linux/kernel.h> | ||
| 23 | #include <linux/io.h> | ||
| 24 | #include <asm/suspend.h> | ||
| 25 | #include <asm/hwblk.h> | ||
| 26 | #include <cpu/sh7723.h> | ||
| 27 | |||
| 28 | /* SH7723 registers */ | ||
| 29 | #define MSTPCR0 0xa4150030 | ||
| 30 | #define MSTPCR1 0xa4150034 | ||
| 31 | #define MSTPCR2 0xa4150038 | ||
| 32 | |||
| 33 | /* SH7723 Power Domains */ | ||
| 34 | enum { CORE_AREA, SUB_AREA, CORE_AREA_BM }; | ||
| 35 | static struct hwblk_area sh7723_hwblk_area[] = { | ||
| 36 | [CORE_AREA] = HWBLK_AREA(0, 0), | ||
| 37 | [CORE_AREA_BM] = HWBLK_AREA(HWBLK_AREA_FLAG_PARENT, CORE_AREA), | ||
| 38 | [SUB_AREA] = HWBLK_AREA(0, 0), | ||
| 39 | }; | ||
| 40 | |||
| 41 | /* Table mapping HWBLK to Module Stop Bit and Power Domain */ | ||
| 42 | static struct hwblk sh7723_hwblk[HWBLK_NR] = { | ||
| 43 | [HWBLK_TLB] = HWBLK(MSTPCR0, 31, CORE_AREA), | ||
| 44 | [HWBLK_IC] = HWBLK(MSTPCR0, 30, CORE_AREA), | ||
| 45 | [HWBLK_OC] = HWBLK(MSTPCR0, 29, CORE_AREA), | ||
| 46 | [HWBLK_L2C] = HWBLK(MSTPCR0, 28, CORE_AREA), | ||
| 47 | [HWBLK_ILMEM] = HWBLK(MSTPCR0, 27, CORE_AREA), | ||
| 48 | [HWBLK_FPU] = HWBLK(MSTPCR0, 24, CORE_AREA), | ||
| 49 | [HWBLK_INTC] = HWBLK(MSTPCR0, 22, CORE_AREA), | ||
| 50 | [HWBLK_DMAC0] = HWBLK(MSTPCR0, 21, CORE_AREA_BM), | ||
| 51 | [HWBLK_SHYWAY] = HWBLK(MSTPCR0, 20, CORE_AREA), | ||
| 52 | [HWBLK_HUDI] = HWBLK(MSTPCR0, 19, CORE_AREA), | ||
| 53 | [HWBLK_DBG] = HWBLK(MSTPCR0, 18, CORE_AREA), | ||
| 54 | [HWBLK_UBC] = HWBLK(MSTPCR0, 17, CORE_AREA), | ||
| 55 | [HWBLK_SUBC] = HWBLK(MSTPCR0, 16, CORE_AREA), | ||
| 56 | [HWBLK_TMU0] = HWBLK(MSTPCR0, 15, CORE_AREA), | ||
| 57 | [HWBLK_CMT] = HWBLK(MSTPCR0, 14, SUB_AREA), | ||
| 58 | [HWBLK_RWDT] = HWBLK(MSTPCR0, 13, SUB_AREA), | ||
| 59 | [HWBLK_DMAC1] = HWBLK(MSTPCR0, 12, CORE_AREA_BM), | ||
| 60 | [HWBLK_TMU1] = HWBLK(MSTPCR0, 11, CORE_AREA), | ||
| 61 | [HWBLK_FLCTL] = HWBLK(MSTPCR0, 10, CORE_AREA), | ||
| 62 | [HWBLK_SCIF0] = HWBLK(MSTPCR0, 9, CORE_AREA), | ||
| 63 | [HWBLK_SCIF1] = HWBLK(MSTPCR0, 8, CORE_AREA), | ||
| 64 | [HWBLK_SCIF2] = HWBLK(MSTPCR0, 7, CORE_AREA), | ||
| 65 | [HWBLK_SCIF3] = HWBLK(MSTPCR0, 6, CORE_AREA), | ||
| 66 | [HWBLK_SCIF4] = HWBLK(MSTPCR0, 5, CORE_AREA), | ||
| 67 | [HWBLK_SCIF5] = HWBLK(MSTPCR0, 4, CORE_AREA), | ||
| 68 | [HWBLK_MSIOF0] = HWBLK(MSTPCR0, 2, CORE_AREA), | ||
| 69 | [HWBLK_MSIOF1] = HWBLK(MSTPCR0, 1, CORE_AREA), | ||
| 70 | [HWBLK_MERAM] = HWBLK(MSTPCR0, 0, CORE_AREA), | ||
| 71 | |||
| 72 | [HWBLK_IIC] = HWBLK(MSTPCR1, 9, CORE_AREA), | ||
| 73 | [HWBLK_RTC] = HWBLK(MSTPCR1, 8, SUB_AREA), | ||
| 74 | |||
| 75 | [HWBLK_ATAPI] = HWBLK(MSTPCR2, 28, CORE_AREA_BM), | ||
| 76 | [HWBLK_ADC] = HWBLK(MSTPCR2, 27, CORE_AREA), | ||
| 77 | [HWBLK_TPU] = HWBLK(MSTPCR2, 25, CORE_AREA), | ||
| 78 | [HWBLK_IRDA] = HWBLK(MSTPCR2, 24, CORE_AREA), | ||
| 79 | [HWBLK_TSIF] = HWBLK(MSTPCR2, 22, CORE_AREA), | ||
| 80 | [HWBLK_ICB] = HWBLK(MSTPCR2, 21, CORE_AREA_BM), | ||
| 81 | [HWBLK_SDHI0] = HWBLK(MSTPCR2, 18, CORE_AREA), | ||
| 82 | [HWBLK_SDHI1] = HWBLK(MSTPCR2, 17, CORE_AREA), | ||
| 83 | [HWBLK_KEYSC] = HWBLK(MSTPCR2, 14, SUB_AREA), | ||
| 84 | [HWBLK_USB] = HWBLK(MSTPCR2, 11, CORE_AREA), | ||
| 85 | [HWBLK_2DG] = HWBLK(MSTPCR2, 10, CORE_AREA_BM), | ||
| 86 | [HWBLK_SIU] = HWBLK(MSTPCR2, 8, CORE_AREA), | ||
| 87 | [HWBLK_VEU2H1] = HWBLK(MSTPCR2, 6, CORE_AREA_BM), | ||
| 88 | [HWBLK_VOU] = HWBLK(MSTPCR2, 5, CORE_AREA_BM), | ||
| 89 | [HWBLK_BEU] = HWBLK(MSTPCR2, 4, CORE_AREA_BM), | ||
| 90 | [HWBLK_CEU] = HWBLK(MSTPCR2, 3, CORE_AREA_BM), | ||
| 91 | [HWBLK_VEU2H0] = HWBLK(MSTPCR2, 2, CORE_AREA_BM), | ||
| 92 | [HWBLK_VPU] = HWBLK(MSTPCR2, 1, CORE_AREA_BM), | ||
| 93 | [HWBLK_LCDC] = HWBLK(MSTPCR2, 0, CORE_AREA_BM), | ||
| 94 | }; | ||
| 95 | |||
| 96 | static struct hwblk_info sh7723_hwblk_info = { | ||
| 97 | .areas = sh7723_hwblk_area, | ||
| 98 | .nr_areas = ARRAY_SIZE(sh7723_hwblk_area), | ||
| 99 | .hwblks = sh7723_hwblk, | ||
| 100 | .nr_hwblks = ARRAY_SIZE(sh7723_hwblk), | ||
| 101 | }; | ||
| 102 | |||
| 103 | int arch_hwblk_sleep_mode(void) | ||
| 104 | { | ||
| 105 | if (!sh7723_hwblk_area[CORE_AREA].cnt[HWBLK_CNT_USAGE]) | ||
| 106 | return SUSP_SH_STANDBY | SUSP_SH_SF; | ||
| 107 | |||
| 108 | if (!sh7723_hwblk_area[CORE_AREA_BM].cnt[HWBLK_CNT_USAGE]) | ||
| 109 | return SUSP_SH_SLEEP | SUSP_SH_SF; | ||
| 110 | |||
| 111 | return SUSP_SH_SLEEP; | ||
| 112 | } | ||
| 113 | |||
| 114 | int __init arch_hwblk_init(void) | ||
| 115 | { | ||
| 116 | return hwblk_register(&sh7723_hwblk_info); | ||
| 117 | } | ||
diff --git a/arch/sh/kernel/cpu/sh4a/hwblk-sh7724.c b/arch/sh/kernel/cpu/sh4a/hwblk-sh7724.c new file mode 100644 index 00000000000..1613ad6013c --- /dev/null +++ b/arch/sh/kernel/cpu/sh4a/hwblk-sh7724.c | |||
| @@ -0,0 +1,121 @@ | |||
| 1 | /* | ||
| 2 | * arch/sh/kernel/cpu/sh4a/hwblk-sh7724.c | ||
| 3 | * | ||
| 4 | * SH7724 hardware block support | ||
| 5 | * | ||
| 6 | * Copyright (C) 2009 Magnus Damm | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License as published by | ||
| 10 | * the Free Software Foundation; either version 2 of the License | ||
| 11 | * | ||
| 12 | * This program is distributed in the hope that it will be useful, | ||
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| 15 | * GNU General Public License for more details. | ||
| 16 | * | ||
| 17 | * You should have received a copy of the GNU General Public License | ||
| 18 | * along with this program; if not, write to the Free Software | ||
| 19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
| 20 | */ | ||
| 21 | #include <linux/init.h> | ||
| 22 | #include <linux/kernel.h> | ||
| 23 | #include <linux/io.h> | ||
| 24 | #include <asm/suspend.h> | ||
| 25 | #include <asm/hwblk.h> | ||
| 26 | #include <cpu/sh7724.h> | ||
| 27 | |||
| 28 | /* SH7724 registers */ | ||
| 29 | #define MSTPCR0 0xa4150030 | ||
| 30 | #define MSTPCR1 0xa4150034 | ||
| 31 | #define MSTPCR2 0xa4150038 | ||
| 32 | |||
| 33 | /* SH7724 Power Domains */ | ||
| 34 | enum { CORE_AREA, SUB_AREA, CORE_AREA_BM }; | ||
| 35 | static struct hwblk_area sh7724_hwblk_area[] = { | ||
| 36 | [CORE_AREA] = HWBLK_AREA(0, 0), | ||
| 37 | [CORE_AREA_BM] = HWBLK_AREA(HWBLK_AREA_FLAG_PARENT, CORE_AREA), | ||
| 38 | [SUB_AREA] = HWBLK_AREA(0, 0), | ||
| 39 | }; | ||
| 40 | |||
| 41 | /* Table mapping HWBLK to Module Stop Bit and Power Domain */ | ||
| 42 | static struct hwblk sh7724_hwblk[HWBLK_NR] = { | ||
| 43 | [HWBLK_TLB] = HWBLK(MSTPCR0, 31, CORE_AREA), | ||
| 44 | [HWBLK_IC] = HWBLK(MSTPCR0, 30, CORE_AREA), | ||
| 45 | [HWBLK_OC] = HWBLK(MSTPCR0, 29, CORE_AREA), | ||
| 46 | [HWBLK_RSMEM] = HWBLK(MSTPCR0, 28, CORE_AREA), | ||
| 47 | [HWBLK_ILMEM] = HWBLK(MSTPCR0, 27, CORE_AREA), | ||
| 48 | [HWBLK_L2C] = HWBLK(MSTPCR0, 26, CORE_AREA), | ||
| 49 | [HWBLK_FPU] = HWBLK(MSTPCR0, 24, CORE_AREA), | ||
| 50 | [HWBLK_INTC] = HWBLK(MSTPCR0, 22, CORE_AREA), | ||
| 51 | [HWBLK_DMAC0] = HWBLK(MSTPCR0, 21, CORE_AREA_BM), | ||
| 52 | [HWBLK_SHYWAY] = HWBLK(MSTPCR0, 20, CORE_AREA), | ||
| 53 | [HWBLK_HUDI] = HWBLK(MSTPCR0, 19, CORE_AREA), | ||
| 54 | [HWBLK_DBG] = HWBLK(MSTPCR0, 18, CORE_AREA), | ||
| 55 | [HWBLK_UBC] = HWBLK(MSTPCR0, 17, CORE_AREA), | ||
| 56 | [HWBLK_TMU0] = HWBLK(MSTPCR0, 15, CORE_AREA), | ||
| 57 | [HWBLK_CMT] = HWBLK(MSTPCR0, 14, SUB_AREA), | ||
| 58 | [HWBLK_RWDT] = HWBLK(MSTPCR0, 13, SUB_AREA), | ||
| 59 | [HWBLK_DMAC1] = HWBLK(MSTPCR0, 12, CORE_AREA_BM), | ||
| 60 | [HWBLK_TMU1] = HWBLK(MSTPCR0, 10, CORE_AREA), | ||
| 61 | [HWBLK_SCIF0] = HWBLK(MSTPCR0, 9, CORE_AREA), | ||
| 62 | [HWBLK_SCIF1] = HWBLK(MSTPCR0, 8, CORE_AREA), | ||
| 63 | [HWBLK_SCIF2] = HWBLK(MSTPCR0, 7, CORE_AREA), | ||
| 64 | [HWBLK_SCIF3] = HWBLK(MSTPCR0, 6, CORE_AREA), | ||
| 65 | [HWBLK_SCIF4] = HWBLK(MSTPCR0, 5, CORE_AREA), | ||
| 66 | [HWBLK_SCIF5] = HWBLK(MSTPCR0, 4, CORE_AREA), | ||
| 67 | [HWBLK_MSIOF0] = HWBLK(MSTPCR0, 2, CORE_AREA), | ||
| 68 | [HWBLK_MSIOF1] = HWBLK(MSTPCR0, 1, CORE_AREA), | ||
| 69 | |||
| 70 | [HWBLK_KEYSC] = HWBLK(MSTPCR1, 12, SUB_AREA), | ||
| 71 | [HWBLK_RTC] = HWBLK(MSTPCR1, 11, SUB_AREA), | ||
| 72 | [HWBLK_IIC0] = HWBLK(MSTPCR1, 9, CORE_AREA), | ||
| 73 | [HWBLK_IIC1] = HWBLK(MSTPCR1, 8, CORE_AREA), | ||
| 74 | |||
| 75 | [HWBLK_MMC] = HWBLK(MSTPCR2, 29, CORE_AREA), | ||
| 76 | [HWBLK_ETHER] = HWBLK(MSTPCR2, 28, CORE_AREA_BM), | ||
| 77 | [HWBLK_ATAPI] = HWBLK(MSTPCR2, 26, CORE_AREA_BM), | ||
| 78 | [HWBLK_TPU] = HWBLK(MSTPCR2, 25, CORE_AREA), | ||
| 79 | [HWBLK_IRDA] = HWBLK(MSTPCR2, 24, CORE_AREA), | ||
| 80 | [HWBLK_TSIF] = HWBLK(MSTPCR2, 22, CORE_AREA), | ||
| 81 | [HWBLK_USB1] = HWBLK(MSTPCR2, 21, CORE_AREA), | ||
| 82 | [HWBLK_USB0] = HWBLK(MSTPCR2, 20, CORE_AREA), | ||
| 83 | [HWBLK_2DG] = HWBLK(MSTPCR2, 19, CORE_AREA_BM), | ||
| 84 | [HWBLK_SDHI0] = HWBLK(MSTPCR2, 18, CORE_AREA), | ||
| 85 | [HWBLK_SDHI1] = HWBLK(MSTPCR2, 17, CORE_AREA), | ||
| 86 | [HWBLK_VEU1] = HWBLK(MSTPCR2, 15, CORE_AREA_BM), | ||
| 87 | [HWBLK_CEU1] = HWBLK(MSTPCR2, 13, CORE_AREA_BM), | ||
| 88 | [HWBLK_BEU1] = HWBLK(MSTPCR2, 12, CORE_AREA_BM), | ||
| 89 | [HWBLK_2DDMAC] = HWBLK(MSTPCR2, 10, CORE_AREA_BM), | ||
| 90 | [HWBLK_SPU] = HWBLK(MSTPCR2, 9, CORE_AREA_BM), | ||
| 91 | [HWBLK_JPU] = HWBLK(MSTPCR2, 6, CORE_AREA_BM), | ||
| 92 | [HWBLK_VOU] = HWBLK(MSTPCR2, 5, CORE_AREA_BM), | ||
| 93 | [HWBLK_BEU0] = HWBLK(MSTPCR2, 4, CORE_AREA_BM), | ||
| 94 | [HWBLK_CEU0] = HWBLK(MSTPCR2, 3, CORE_AREA_BM), | ||
| 95 | [HWBLK_VEU0] = HWBLK(MSTPCR2, 2, CORE_AREA_BM), | ||
| 96 | [HWBLK_VPU] = HWBLK(MSTPCR2, 1, CORE_AREA_BM), | ||
| 97 | [HWBLK_LCDC] = HWBLK(MSTPCR2, 0, CORE_AREA_BM), | ||
| 98 | }; | ||
| 99 | |||
| 100 | static struct hwblk_info sh7724_hwblk_info = { | ||
| 101 | .areas = sh7724_hwblk_area, | ||
| 102 | .nr_areas = ARRAY_SIZE(sh7724_hwblk_area), | ||
| 103 | .hwblks = sh7724_hwblk, | ||
| 104 | .nr_hwblks = ARRAY_SIZE(sh7724_hwblk), | ||
| 105 | }; | ||
| 106 | |||
| 107 | int arch_hwblk_sleep_mode(void) | ||
| 108 | { | ||
| 109 | if (!sh7724_hwblk_area[CORE_AREA].cnt[HWBLK_CNT_USAGE]) | ||
| 110 | return SUSP_SH_STANDBY | SUSP_SH_SF; | ||
| 111 | |||
| 112 | if (!sh7724_hwblk_area[CORE_AREA_BM].cnt[HWBLK_CNT_USAGE]) | ||
| 113 | return SUSP_SH_SLEEP | SUSP_SH_SF; | ||
| 114 | |||
| 115 | return SUSP_SH_SLEEP; | ||
| 116 | } | ||
| 117 | |||
| 118 | int __init arch_hwblk_init(void) | ||
| 119 | { | ||
| 120 | return hwblk_register(&sh7724_hwblk_info); | ||
| 121 | } | ||
diff --git a/arch/sh/kernel/cpu/shmobile/pm_runtime.c b/arch/sh/kernel/cpu/shmobile/pm_runtime.c new file mode 100644 index 00000000000..bf280c812d2 --- /dev/null +++ b/arch/sh/kernel/cpu/shmobile/pm_runtime.c | |||
| @@ -0,0 +1,319 @@ | |||
| 1 | /* | ||
| 2 | * arch/sh/kernel/cpu/shmobile/pm_runtime.c | ||
| 3 | * | ||
| 4 | * Runtime PM support code for SuperH Mobile | ||
| 5 | * | ||
| 6 | * Copyright (C) 2009 Magnus Damm | ||
| 7 | * | ||
| 8 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 9 | * License. See the file "COPYING" in the main directory of this archive | ||
| 10 | * for more details. | ||
| 11 | */ | ||
| 12 | #include <linux/init.h> | ||
| 13 | #include <linux/kernel.h> | ||
| 14 | #include <linux/io.h> | ||
| 15 | #include <linux/pm_runtime.h> | ||
| 16 | #include <linux/platform_device.h> | ||
| 17 | #include <linux/mutex.h> | ||
| 18 | #include <asm/hwblk.h> | ||
| 19 | |||
| 20 | static DEFINE_SPINLOCK(hwblk_lock); | ||
| 21 | static LIST_HEAD(hwblk_idle_list); | ||
| 22 | static struct work_struct hwblk_work; | ||
| 23 | |||
| 24 | extern struct hwblk_info *hwblk_info; | ||
| 25 | |||
| 26 | static void platform_pm_runtime_not_idle(struct platform_device *pdev) | ||
| 27 | { | ||
| 28 | unsigned long flags; | ||
| 29 | |||
| 30 | /* remove device from idle list */ | ||
| 31 | spin_lock_irqsave(&hwblk_lock, flags); | ||
| 32 | if (test_bit(PDEV_ARCHDATA_FLAG_IDLE, &pdev->archdata.flags)) { | ||
| 33 | list_del(&pdev->archdata.entry); | ||
| 34 | __clear_bit(PDEV_ARCHDATA_FLAG_IDLE, &pdev->archdata.flags); | ||
| 35 | } | ||
| 36 | spin_unlock_irqrestore(&hwblk_lock, flags); | ||
| 37 | } | ||
| 38 | |||
| 39 | static int __platform_pm_runtime_resume(struct platform_device *pdev) | ||
| 40 | { | ||
| 41 | struct device *d = &pdev->dev; | ||
| 42 | struct pdev_archdata *ad = &pdev->archdata; | ||
| 43 | int hwblk = ad->hwblk_id; | ||
| 44 | int ret = -ENOSYS; | ||
| 45 | |||
| 46 | dev_dbg(d, "__platform_pm_runtime_resume() [%d]\n", hwblk); | ||
| 47 | |||
| 48 | if (d->driver) { | ||
| 49 | hwblk_enable(hwblk_info, hwblk); | ||
| 50 | ret = 0; | ||
| 51 | |||
| 52 | if (test_bit(PDEV_ARCHDATA_FLAG_SUSP, &ad->flags)) { | ||
| 53 | if (d->driver->pm && d->driver->pm->runtime_resume) | ||
| 54 | ret = d->driver->pm->runtime_resume(d); | ||
| 55 | |||
| 56 | if (!ret) | ||
| 57 | clear_bit(PDEV_ARCHDATA_FLAG_SUSP, &ad->flags); | ||
| 58 | else | ||
| 59 | hwblk_disable(hwblk_info, hwblk); | ||
| 60 | } | ||
| 61 | } | ||
| 62 | |||
| 63 | dev_dbg(d, "__platform_pm_runtime_resume() [%d] - returns %d\n", | ||
| 64 | hwblk, ret); | ||
| 65 | |||
| 66 | return ret; | ||
| 67 | } | ||
| 68 | |||
| 69 | static int __platform_pm_runtime_suspend(struct platform_device *pdev) | ||
| 70 | { | ||
| 71 | struct device *d = &pdev->dev; | ||
| 72 | struct pdev_archdata *ad = &pdev->archdata; | ||
| 73 | int hwblk = ad->hwblk_id; | ||
| 74 | int ret = -ENOSYS; | ||
| 75 | |||
| 76 | dev_dbg(d, "__platform_pm_runtime_suspend() [%d]\n", hwblk); | ||
| 77 | |||
| 78 | if (d->driver) { | ||
| 79 | BUG_ON(!test_bit(PDEV_ARCHDATA_FLAG_IDLE, &ad->flags)); | ||
| 80 | ret = 0; | ||
| 81 | |||
| 82 | if (d->driver->pm && d->driver->pm->runtime_suspend) { | ||
| 83 | hwblk_enable(hwblk_info, hwblk); | ||
| 84 | ret = d->driver->pm->runtime_suspend(d); | ||
| 85 | hwblk_disable(hwblk_info, hwblk); | ||
| 86 | } | ||
| 87 | |||
| 88 | if (!ret) { | ||
| 89 | set_bit(PDEV_ARCHDATA_FLAG_SUSP, &ad->flags); | ||
| 90 | platform_pm_runtime_not_idle(pdev); | ||
| 91 | hwblk_cnt_dec(hwblk_info, hwblk, HWBLK_CNT_IDLE); | ||
| 92 | } | ||
| 93 | } | ||
| 94 | |||
| 95 | dev_dbg(d, "__platform_pm_runtime_suspend() [%d] - returns %d\n", | ||
| 96 | hwblk, ret); | ||
| 97 | |||
| 98 | return ret; | ||
| 99 | } | ||
| 100 | |||
| 101 | static void platform_pm_runtime_work(struct work_struct *work) | ||
| 102 | { | ||
| 103 | struct platform_device *pdev; | ||
| 104 | unsigned long flags; | ||
| 105 | int ret; | ||
| 106 | |||
| 107 | /* go through the idle list and suspend one device at a time */ | ||
| 108 | do { | ||
| 109 | spin_lock_irqsave(&hwblk_lock, flags); | ||
| 110 | if (list_empty(&hwblk_idle_list)) | ||
| 111 | pdev = NULL; | ||
| 112 | else | ||
| 113 | pdev = list_first_entry(&hwblk_idle_list, | ||
| 114 | struct platform_device, | ||
| 115 | archdata.entry); | ||
| 116 | spin_unlock_irqrestore(&hwblk_lock, flags); | ||
| 117 | |||
| 118 | if (pdev) { | ||
| 119 | mutex_lock(&pdev->archdata.mutex); | ||
| 120 | ret = __platform_pm_runtime_suspend(pdev); | ||
| 121 | |||
| 122 | /* at this point the platform device may be: | ||
| 123 | * suspended: ret = 0, FLAG_SUSP set, clock stopped | ||
| 124 | * failed: ret < 0, FLAG_IDLE set, clock stopped | ||
| 125 | */ | ||
| 126 | mutex_unlock(&pdev->archdata.mutex); | ||
| 127 | } else { | ||
| 128 | ret = -ENODEV; | ||
| 129 | } | ||
| 130 | } while (!ret); | ||
| 131 | } | ||
| 132 | |||
| 133 | /* this function gets called from cpuidle context when all devices in the | ||
| 134 | * main power domain are unused but some are counted as idle, ie the hwblk | ||
| 135 | * counter values are (HWBLK_CNT_USAGE == 0) && (HWBLK_CNT_IDLE != 0) | ||
| 136 | */ | ||
| 137 | void platform_pm_runtime_suspend_idle(void) | ||
| 138 | { | ||
| 139 | queue_work(pm_wq, &hwblk_work); | ||
| 140 | } | ||
| 141 | |||
| 142 | static int default_platform_runtime_suspend(struct device *dev) | ||
| 143 | { | ||
| 144 | struct platform_device *pdev = to_platform_device(dev); | ||
| 145 | struct pdev_archdata *ad = &pdev->archdata; | ||
| 146 | unsigned long flags; | ||
| 147 | int hwblk = ad->hwblk_id; | ||
| 148 | int ret = 0; | ||
| 149 | |||
| 150 | dev_dbg(dev, "%s() [%d]\n", __func__, hwblk); | ||
| 151 | |||
| 152 | /* ignore off-chip platform devices */ | ||
| 153 | if (!hwblk) | ||
| 154 | goto out; | ||
| 155 | |||
| 156 | /* interrupt context not allowed */ | ||
| 157 | might_sleep(); | ||
| 158 | |||
| 159 | /* catch misconfigured drivers not starting with resume */ | ||
| 160 | if (test_bit(PDEV_ARCHDATA_FLAG_INIT, &ad->flags)) { | ||
| 161 | ret = -EINVAL; | ||
| 162 | goto out; | ||
| 163 | } | ||
| 164 | |||
| 165 | /* serialize */ | ||
| 166 | mutex_lock(&ad->mutex); | ||
| 167 | |||
| 168 | /* disable clock */ | ||
| 169 | hwblk_disable(hwblk_info, hwblk); | ||
| 170 | |||
| 171 | /* put device on idle list */ | ||
| 172 | spin_lock_irqsave(&hwblk_lock, flags); | ||
| 173 | list_add_tail(&ad->entry, &hwblk_idle_list); | ||
| 174 | __set_bit(PDEV_ARCHDATA_FLAG_IDLE, &ad->flags); | ||
| 175 | spin_unlock_irqrestore(&hwblk_lock, flags); | ||
| 176 | |||
| 177 | /* increase idle count */ | ||
| 178 | hwblk_cnt_inc(hwblk_info, hwblk, HWBLK_CNT_IDLE); | ||
| 179 | |||
| 180 | /* at this point the platform device is: | ||
| 181 | * idle: ret = 0, FLAG_IDLE set, clock stopped | ||
| 182 | */ | ||
| 183 | mutex_unlock(&ad->mutex); | ||
| 184 | |||
| 185 | out: | ||
| 186 | dev_dbg(dev, "%s() [%d] returns %d\n", | ||
| 187 | __func__, hwblk, ret); | ||
| 188 | |||
| 189 | return ret; | ||
| 190 | } | ||
| 191 | |||
| 192 | static int default_platform_runtime_resume(struct device *dev) | ||
| 193 | { | ||
| 194 | struct platform_device *pdev = to_platform_device(dev); | ||
| 195 | struct pdev_archdata *ad = &pdev->archdata; | ||
| 196 | int hwblk = ad->hwblk_id; | ||
| 197 | int ret = 0; | ||
| 198 | |||
| 199 | dev_dbg(dev, "%s() [%d]\n", __func__, hwblk); | ||
| 200 | |||
| 201 | /* ignore off-chip platform devices */ | ||
| 202 | if (!hwblk) | ||
| 203 | goto out; | ||
| 204 | |||
| 205 | /* interrupt context not allowed */ | ||
| 206 | might_sleep(); | ||
| 207 | |||
| 208 | /* serialize */ | ||
| 209 | mutex_lock(&ad->mutex); | ||
| 210 | |||
| 211 | /* make sure device is removed from idle list */ | ||
| 212 | platform_pm_runtime_not_idle(pdev); | ||
| 213 | |||
| 214 | /* decrease idle count */ | ||
| 215 | if (!test_bit(PDEV_ARCHDATA_FLAG_INIT, &pdev->archdata.flags) && | ||
| 216 | !test_bit(PDEV_ARCHDATA_FLAG_SUSP, &pdev->archdata.flags)) | ||
| 217 | hwblk_cnt_dec(hwblk_info, hwblk, HWBLK_CNT_IDLE); | ||
| 218 | |||
| 219 | /* resume the device if needed */ | ||
| 220 | ret = __platform_pm_runtime_resume(pdev); | ||
| 221 | |||
| 222 | /* the driver has been initialized now, so clear the init flag */ | ||
| 223 | clear_bit(PDEV_ARCHDATA_FLAG_INIT, &pdev->archdata.flags); | ||
| 224 | |||
| 225 | /* at this point the platform device may be: | ||
| 226 | * resumed: ret = 0, flags = 0, clock started | ||
| 227 | * failed: ret < 0, FLAG_SUSP set, clock stopped | ||
| 228 | */ | ||
| 229 | mutex_unlock(&ad->mutex); | ||
| 230 | out: | ||
| 231 | dev_dbg(dev, "%s() [%d] returns %d\n", | ||
| 232 | __func__, hwblk, ret); | ||
| 233 | |||
| 234 | return ret; | ||
| 235 | } | ||
| 236 | |||
| 237 | static int default_platform_runtime_idle(struct device *dev) | ||
| 238 | { | ||
| 239 | struct platform_device *pdev = to_platform_device(dev); | ||
| 240 | int hwblk = pdev->archdata.hwblk_id; | ||
| 241 | int ret = 0; | ||
| 242 | |||
| 243 | dev_dbg(dev, "%s() [%d]\n", __func__, hwblk); | ||
| 244 | |||
| 245 | /* ignore off-chip platform devices */ | ||
| 246 | if (!hwblk) | ||
| 247 | goto out; | ||
| 248 | |||
| 249 | /* interrupt context not allowed, use pm_runtime_put()! */ | ||
| 250 | might_sleep(); | ||
| 251 | |||
| 252 | /* suspend synchronously to disable clocks immediately */ | ||
| 253 | ret = pm_runtime_suspend(dev); | ||
| 254 | out: | ||
| 255 | dev_dbg(dev, "%s() [%d] done!\n", __func__, hwblk); | ||
| 256 | return ret; | ||
| 257 | } | ||
| 258 | |||
| 259 | static struct dev_pm_domain default_pm_domain = { | ||
| 260 | .ops = { | ||
| 261 | .runtime_suspend = default_platform_runtime_suspend, | ||
| 262 | .runtime_resume = default_platform_runtime_resume, | ||
| 263 | .runtime_idle = default_platform_runtime_idle, | ||
| 264 | USE_PLATFORM_PM_SLEEP_OPS | ||
| 265 | }, | ||
| 266 | }; | ||
| 267 | |||
| 268 | static int platform_bus_notify(struct notifier_block *nb, | ||
| 269 | unsigned long action, void *data) | ||
| 270 | { | ||
| 271 | struct device *dev = data; | ||
| 272 | struct platform_device *pdev = to_platform_device(dev); | ||
| 273 | int hwblk = pdev->archdata.hwblk_id; | ||
| 274 | |||
| 275 | /* ignore off-chip platform devices */ | ||
| 276 | if (!hwblk) | ||
| 277 | return 0; | ||
| 278 | |||
| 279 | switch (action) { | ||
| 280 | case BUS_NOTIFY_ADD_DEVICE: | ||
| 281 | INIT_LIST_HEAD(&pdev->archdata.entry); | ||
| 282 | mutex_init(&pdev->archdata.mutex); | ||
| 283 | /* platform devices without drivers should be disabled */ | ||
| 284 | hwblk_enable(hwblk_info, hwblk); | ||
| 285 | hwblk_disable(hwblk_info, hwblk); | ||
| 286 | /* make sure driver re-inits itself once */ | ||
| 287 | __set_bit(PDEV_ARCHDATA_FLAG_INIT, &pdev->archdata.flags); | ||
| 288 | dev->pm_domain = &default_pm_domain; | ||
| 289 | break; | ||
| 290 | /* TODO: add BUS_NOTIFY_BIND_DRIVER and increase idle count */ | ||
| 291 | case BUS_NOTIFY_BOUND_DRIVER: | ||
| 292 | /* keep track of number of devices in use per hwblk */ | ||
| 293 | hwblk_cnt_inc(hwblk_info, hwblk, HWBLK_CNT_DEVICES); | ||
| 294 | break; | ||
| 295 | case BUS_NOTIFY_UNBOUND_DRIVER: | ||
| 296 | /* keep track of number of devices in use per hwblk */ | ||
| 297 | hwblk_cnt_dec(hwblk_info, hwblk, HWBLK_CNT_DEVICES); | ||
| 298 | /* make sure driver re-inits itself once */ | ||
| 299 | __set_bit(PDEV_ARCHDATA_FLAG_INIT, &pdev->archdata.flags); | ||
| 300 | break; | ||
| 301 | case BUS_NOTIFY_DEL_DEVICE: | ||
| 302 | dev->pm_domain = NULL; | ||
| 303 | break; | ||
| 304 | } | ||
| 305 | return 0; | ||
| 306 | } | ||
| 307 | |||
| 308 | static struct notifier_block platform_bus_notifier = { | ||
| 309 | .notifier_call = platform_bus_notify | ||
| 310 | }; | ||
| 311 | |||
| 312 | static int __init sh_pm_runtime_init(void) | ||
| 313 | { | ||
| 314 | INIT_WORK(&hwblk_work, platform_pm_runtime_work); | ||
| 315 | |||
| 316 | bus_register_notifier(&platform_bus_type, &platform_bus_notifier); | ||
| 317 | return 0; | ||
| 318 | } | ||
| 319 | core_initcall(sh_pm_runtime_init); | ||
diff --git a/arch/sh/kernel/init_task.c b/arch/sh/kernel/init_task.c new file mode 100644 index 00000000000..11f2ea556a6 --- /dev/null +++ b/arch/sh/kernel/init_task.c | |||
| @@ -0,0 +1,30 @@ | |||
| 1 | #include <linux/mm.h> | ||
| 2 | #include <linux/module.h> | ||
| 3 | #include <linux/sched.h> | ||
| 4 | #include <linux/init_task.h> | ||
| 5 | #include <linux/mqueue.h> | ||
| 6 | #include <linux/fs.h> | ||
| 7 | #include <asm/uaccess.h> | ||
| 8 | #include <asm/pgtable.h> | ||
| 9 | |||
| 10 | static struct signal_struct init_signals = INIT_SIGNALS(init_signals); | ||
| 11 | static struct sighand_struct init_sighand = INIT_SIGHAND(init_sighand); | ||
| 12 | struct pt_regs fake_swapper_regs; | ||
| 13 | /* | ||
| 14 | * Initial thread structure. | ||
| 15 | * | ||
| 16 | * We need to make sure that this is 8192-byte aligned due to the | ||
| 17 | * way process stacks are handled. This is done by having a special | ||
| 18 | * "init_task" linker map entry.. | ||
| 19 | */ | ||
| 20 | union thread_union init_thread_union __init_task_data = | ||
| 21 | { INIT_THREAD_INFO(init_task) }; | ||
| 22 | |||
| 23 | /* | ||
| 24 | * Initial task structure. | ||
| 25 | * | ||
| 26 | * All other task structs will be allocated on slabs in fork.c | ||
| 27 | */ | ||
| 28 | struct task_struct init_task = INIT_TASK(init_task); | ||
| 29 | |||
| 30 | EXPORT_SYMBOL(init_task); | ||
diff --git a/arch/sh/kernel/sys_sh64.c b/arch/sh/kernel/sys_sh64.c new file mode 100644 index 00000000000..c5a38c4bf41 --- /dev/null +++ b/arch/sh/kernel/sys_sh64.c | |||
| @@ -0,0 +1,50 @@ | |||
| 1 | /* | ||
| 2 | * arch/sh/kernel/sys_sh64.c | ||
| 3 | * | ||
| 4 | * Copyright (C) 2000, 2001 Paolo Alberelli | ||
| 5 | * | ||
| 6 | * This file contains various random system calls that | ||
| 7 | * have a non-standard calling sequence on the Linux/SH5 | ||
| 8 | * platform. | ||
| 9 | * | ||
| 10 | * This file is subject to the terms and conditions of the GNU General Public | ||
| 11 | * License. See the file "COPYING" in the main directory of this archive | ||
| 12 | * for more details. | ||
| 13 | */ | ||
| 14 | #include <linux/errno.h> | ||
| 15 | #include <linux/rwsem.h> | ||
| 16 | #include <linux/sched.h> | ||
| 17 | #include <linux/mm.h> | ||
| 18 | #include <linux/fs.h> | ||
| 19 | #include <linux/smp.h> | ||
| 20 | #include <linux/sem.h> | ||
| 21 | #include <linux/msg.h> | ||
| 22 | #include <linux/shm.h> | ||
| 23 | #include <linux/stat.h> | ||
| 24 | #include <linux/mman.h> | ||
| 25 | #include <linux/file.h> | ||
| 26 | #include <linux/syscalls.h> | ||
| 27 | #include <linux/ipc.h> | ||
| 28 | #include <asm/uaccess.h> | ||
| 29 | #include <asm/ptrace.h> | ||
| 30 | #include <asm/unistd.h> | ||
| 31 | |||
| 32 | /* | ||
| 33 | * Do a system call from kernel instead of calling sys_execve so we | ||
| 34 | * end up with proper pt_regs. | ||
| 35 | */ | ||
| 36 | int kernel_execve(const char *filename, | ||
| 37 | const char *const argv[], | ||
| 38 | const char *const envp[]) | ||
| 39 | { | ||
| 40 | register unsigned long __sc0 __asm__ ("r9") = ((0x13 << 16) | __NR_execve); | ||
| 41 | register unsigned long __sc2 __asm__ ("r2") = (unsigned long) filename; | ||
| 42 | register unsigned long __sc3 __asm__ ("r3") = (unsigned long) argv; | ||
| 43 | register unsigned long __sc4 __asm__ ("r4") = (unsigned long) envp; | ||
| 44 | __asm__ __volatile__ ("trapa %1 !\t\t\t execve(%2,%3,%4)" | ||
| 45 | : "=r" (__sc0) | ||
| 46 | : "r" (__sc0), "r" (__sc2), "r" (__sc3), "r" (__sc4) ); | ||
| 47 | __asm__ __volatile__ ("!dummy %0 %1 %2 %3" | ||
| 48 | : : "r" (__sc0), "r" (__sc2), "r" (__sc3), "r" (__sc4) : "memory"); | ||
| 49 | return __sc0; | ||
| 50 | } | ||
