1 /*
2 * linux/drivers/media/platform/s5p-mfc/s5p_mfc_pm.c
3 *
4 * Copyright (c) 2010 Samsung Electronics Co., Ltd.
5 * http://www.samsung.com/
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 */
12
13 #include <linux/clk.h>
14 #include <linux/err.h>
15 #include <linux/platform_device.h>
16 #ifdef CONFIG_PM_RUNTIME
17 #include <linux/pm_runtime.h>
18 #endif
19 #include "s5p_mfc_common.h"
20 #include "s5p_mfc_debug.h"
21 #include "s5p_mfc_pm.h"
22
23 #define MFC_GATE_CLK_NAME "mfc"
24 #define MFC_SCLK_NAME "sclk_mfc"
25 #define MFC_SCLK_RATE (200 * 1000000)
26
27 #define CLK_DEBUG
28
29 static struct s5p_mfc_pm *pm;
30 static struct s5p_mfc_dev *p_dev;
31
32 #ifdef CLK_DEBUG
33 static atomic_t clk_ref;
34 #endif
35
s5p_mfc_init_pm(struct s5p_mfc_dev * dev)36 int s5p_mfc_init_pm(struct s5p_mfc_dev *dev)
37 {
38 int ret = 0;
39
40 pm = &dev->pm;
41 p_dev = dev;
42 pm->clock_gate = clk_get(&dev->plat_dev->dev, MFC_GATE_CLK_NAME);
43 if (IS_ERR(pm->clock_gate)) {
44 mfc_err("Failed to get clock-gating control\n");
45 ret = PTR_ERR(pm->clock_gate);
46 goto err_g_ip_clk;
47 }
48
49 ret = clk_prepare(pm->clock_gate);
50 if (ret) {
51 mfc_err("Failed to prepare clock-gating control\n");
52 goto err_p_ip_clk;
53 }
54
55 if (dev->variant->version != MFC_VERSION_V6) {
56 pm->clock = clk_get(&dev->plat_dev->dev, MFC_SCLK_NAME);
57 if (IS_ERR(pm->clock)) {
58 mfc_info("Failed to get MFC special clock control\n");
59 } else {
60 clk_set_rate(pm->clock, MFC_SCLK_RATE);
61 ret = clk_prepare_enable(pm->clock);
62 if (ret) {
63 mfc_err("Failed to enable MFC special clock\n");
64 goto err_s_clk;
65 }
66 }
67 }
68
69 atomic_set(&pm->power, 0);
70 #ifdef CONFIG_PM_RUNTIME
71 pm->device = &dev->plat_dev->dev;
72 pm_runtime_enable(pm->device);
73 #endif
74 #ifdef CLK_DEBUG
75 atomic_set(&clk_ref, 0);
76 #endif
77 return 0;
78
79 err_s_clk:
80 clk_put(pm->clock);
81 err_p_ip_clk:
82 clk_put(pm->clock_gate);
83 err_g_ip_clk:
84 return ret;
85 }
86
s5p_mfc_final_pm(struct s5p_mfc_dev * dev)87 void s5p_mfc_final_pm(struct s5p_mfc_dev *dev)
88 {
89 if (dev->variant->version != MFC_VERSION_V6 &&
90 pm->clock) {
91 clk_disable_unprepare(pm->clock);
92 clk_put(pm->clock);
93 }
94 clk_unprepare(pm->clock_gate);
95 clk_put(pm->clock_gate);
96 #ifdef CONFIG_PM_RUNTIME
97 pm_runtime_disable(pm->device);
98 #endif
99 }
100
s5p_mfc_clock_on(void)101 int s5p_mfc_clock_on(void)
102 {
103 int ret;
104 #ifdef CLK_DEBUG
105 atomic_inc(&clk_ref);
106 mfc_debug(3, "+ %d\n", atomic_read(&clk_ref));
107 #endif
108 ret = clk_enable(pm->clock_gate);
109 return ret;
110 }
111
s5p_mfc_clock_off(void)112 void s5p_mfc_clock_off(void)
113 {
114 #ifdef CLK_DEBUG
115 atomic_dec(&clk_ref);
116 mfc_debug(3, "- %d\n", atomic_read(&clk_ref));
117 #endif
118 clk_disable(pm->clock_gate);
119 }
120
s5p_mfc_power_on(void)121 int s5p_mfc_power_on(void)
122 {
123 #ifdef CONFIG_PM_RUNTIME
124 return pm_runtime_get_sync(pm->device);
125 #else
126 atomic_set(&pm->power, 1);
127 return 0;
128 #endif
129 }
130
s5p_mfc_power_off(void)131 int s5p_mfc_power_off(void)
132 {
133 #ifdef CONFIG_PM_RUNTIME
134 return pm_runtime_put_sync(pm->device);
135 #else
136 atomic_set(&pm->power, 0);
137 return 0;
138 #endif
139 }
140
141
142