V4L/DVB : Add S5PV210 TV out driver support

drivers/media/video/samsung/tv20/tv_power_s5pv210.c

Index: drivers/media/video/samsung/tv20/tv_power_s5pv210.c
diff --git a/drivers/media/video/samsung/tv20/tv_power_s5pv210.c b/drivers/media/video/samsung/tv20/tv_power_s5pv210.c
new file mode 100644
index 0000000000000000000000000000000000000000..4f39d7fbb5f3b5f06e4ed228fb2a28146ce62eef
--- /dev/null
+++ b/drivers/media/video/samsung/tv20/tv_power_s5pv210.c
@@ -0,0 +1,133 @@
+/* linux/drivers/media/video/samsung/tv20/tv_power_s5pv210.c
+*
+* Copyright (c) 2010 Samsung Electronics Co., Ltd.
+*		http://www.samsung.com/
+*
+* S5PV210 - power raw ftn  file for Samsung TVOut driver
+*
+* This program is free software; you can redistribute it and/or modify
+* it under the terms of the GNU General Public License version 2 as
+* published by the Free Software Foundation.
+*/
+
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/delay.h>
+#include <linux/platform_device.h>
+
+#include <linux/uaccess.h>
+#include <linux/io.h>
+
+#include <mach/map.h>
+#include <mach/regs-clock.h>
+
+#include "tv_out_s5pv210.h"
+
+#if defined USE_POWERCON_FUNCTION
+#undef USE_POWERCON_FUNCTION
+#endif
+
+#ifdef CONFIG_TVOUT_RAW_DBG
+#define S5P_TVOUT_PM_DEBUG 1
+#endif
+
+#ifdef S5P_TVOUT_PM_DEBUG
+#define TVPMPRINTK(fmt, args...) \
+	printk(KERN_INFO "\t\t[TVPM] %s: " fmt, __func__ , ## args)
+#else
+#define TVPMPRINTK(fmt, args...)
+#endif
+
+/* NORMAL_CFG */
+#define TVPWR_SUBSYSTEM_ACTIVE			(1<<4)
+#define TVPWR_SUBSYSTEM_LP			(0<<4)
+
+/* MTC_STABLE */
+#define TVPWR_MTC_COUNTER_CLEAR(a)		(((~0xf)<<16)&a)
+#define TVPWR_MTC_COUNTER_SET(a)		((0xf&a)<<16)
+
+/* BLK_PWR_STAT */
+#define TVPWR_TV_BLOCK_STATUS(a)		((0x1<<4)&a)
+
+/* DAC Power */
+static unsigned short g_dacPwrOn;
+
+void tv_power_init_mtc_stable_counter(unsigned int value)
+{
+	TVPMPRINTK("(%d)\n\r", value);
+
+	writel(TVPWR_MTC_COUNTER_CLEAR((readl(S5P_MTC_STABLE) |
+			TVPWR_MTC_COUNTER_SET(value))), S5P_MTC_STABLE);
+
+	TVPMPRINTK("(0x%08x)\n\r", readl(S5P_MTC_STABLE));
+}
+
+void tv_powerinitialize_dac_onoff(unsigned short on)
+{
+	TVPMPRINTK("(%d)\n\r", on);
+
+	g_dacPwrOn = on;
+
+	TVPMPRINTK("(0x%08x)\n\r", g_dacPwrOn);
+}
+
+void tv_powerset_dac_onoff(unsigned short on)
+{
+	TVPMPRINTK("(%d)\n\r", on);
+
+	if (on)
+		writel(S5P_DAC_ENABLE, S5P_DAC_CONTROL);
+	else
+		writel(S5P_DAC_DISABLE, S5P_DAC_CONTROL);
+
+	TVPMPRINTK("(0x%08x)\n\r", readl(S5P_DAC_CONTROL));
+}
+
+
+unsigned short tv_power_get_power_status(void)
+{
+	TVPMPRINTK("(0x%08x)\n\r", readl(S5P_BLK_PWR_STAT));
+
+
+	return TVPWR_TV_BLOCK_STATUS(readl(S5P_BLK_PWR_STAT)) ? 1 : 0;
+}
+
+unsigned short tv_power_get_dac_power_status(void)
+{
+	TVPMPRINTK("()\n\r");
+
+	TVPMPRINTK("(0x%08x)\n\r", readl(S5P_DAC_CONTROL));
+
+	return (readl(S5P_DAC_CONTROL) & S5P_DAC_ENABLE) ? 1 : 0;
+}
+
+void tv_poweron(void)
+{
+	TVPMPRINTK("0x%08x\n\r", readl(S3C_VA_SYS + 0xE804));
+
+	writel(readl(S3C_VA_SYS + 0xE804) | 0x1, S3C_VA_SYS + 0xE804);
+
+	writel(readl(S5P_NORMAL_CFG) | TVPWR_SUBSYSTEM_ACTIVE, S5P_NORMAL_CFG);
+
+	while (!TVPWR_TV_BLOCK_STATUS(readl(S5P_BLK_PWR_STAT)))
+		msleep(1);
+
+	TVPMPRINTK("0x%08x,0x%08x)\n\r",
+				readl(S5P_NORMAL_CFG), readl(S5P_BLK_PWR_STAT));
+}
+
+
+void tv_poweroff(void)
+{
+	TVPMPRINTK("()\n\r");
+
+	tv_powerset_dac_onoff(0);
+
+	writel(readl(S5P_NORMAL_CFG) & ~TVPWR_SUBSYSTEM_ACTIVE, S5P_NORMAL_CFG);
+
+	while (TVPWR_TV_BLOCK_STATUS(readl(S5P_BLK_PWR_STAT)))
+		msleep(1);
+
+	TVPMPRINTK("0x%08x,0x%08x)\n\r",
+				readl(S5P_NORMAL_CFG), readl(S5P_BLK_PWR_STAT));
+}