2 * Copyright (C) 2011 Samsung Electronics Co., Ltd.
4 * S5P - Helper functions for MIPI-CSIS and MIPI-DSIM D-PHY control
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
11 #include <linux/export.h>
12 #include <linux/kernel.h>
13 #include <linux/platform_device.h>
15 #include <linux/spinlock.h>
16 #include <mach/regs-clock.h>
18 static int __s5p_mipi_phy_control(int id, bool on, u32 reset)
20 static DEFINE_SPINLOCK(lock);
29 addr = S5P_MIPI_DPHY_CONTROL(id);
31 spin_lock_irqsave(&lock, flags);
33 cfg = __raw_readl(addr);
34 cfg = on ? (cfg | reset) : (cfg & ~reset);
35 __raw_writel(cfg, addr);
38 cfg |= S5P_MIPI_DPHY_ENABLE;
39 } else if (!(cfg & (S5P_MIPI_DPHY_SRESETN |
40 S5P_MIPI_DPHY_MRESETN) & ~reset)) {
41 cfg &= ~S5P_MIPI_DPHY_ENABLE;
44 __raw_writel(cfg, addr);
45 spin_unlock_irqrestore(&lock, flags);
50 int s5p_csis_phy_enable(int id, bool on)
52 return __s5p_mipi_phy_control(id, on, S5P_MIPI_DPHY_SRESETN);
54 EXPORT_SYMBOL(s5p_csis_phy_enable);
56 int s5p_dsim_phy_enable(struct platform_device *pdev, bool on)
58 return __s5p_mipi_phy_control(pdev->id, on, S5P_MIPI_DPHY_MRESETN);
60 EXPORT_SYMBOL(s5p_dsim_phy_enable);