s5p_mfc_pm.c revision 0c2272170d78f826f6e97f99fb8a67fc17feef07 
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
29static struct s5p_mfc_pm *pm;
30static struct s5p_mfc_dev *p_dev;
31
32#ifdef CLK_DEBUG
33static atomic_t clk_ref;
34#endif
35
36int 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
79err_s_clk:
80	clk_put(pm->clock);
81err_p_ip_clk:
82	clk_put(pm->clock_gate);
83err_g_ip_clk:
84	return ret;
85}
86
87void 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
101int 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
112void 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
121int 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
131int 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