arch/arm/plat-samsung/setup-mipiphy.c

   1 /*
   2  * Copyright (C) 2011 Samsung Electronics Co., Ltd.
   3  *
   4  * S5P - Helper functions for MIPI-CSIS and MIPI-DSIM D-PHY control
   5  *
   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.
   9  */
  10
  11 #include <linux/export.h>
  12 #include <linux/kernel.h>
  13 #include <linux/platform_device.h>
  14 #include <linux/io.h>
  15 #include <linux/spinlock.h>
  16 #include <mach/regs-clock.h>
  17
  18 static int __s5p_mipi_phy_control(int id, bool on, u32 reset)
  19 {
  20         static DEFINE_SPINLOCK(lock);
  21         void __iomem *addr;
  22         unsigned long flags;
  23         u32 cfg;
  24
  25         id = max(0, id);
  26         if (id > 1)
  27                 return -EINVAL;
  28
  29         addr = S5P_MIPI_DPHY_CONTROL(id);
  30
  31         spin_lock_irqsave(&lock, flags);
  32
  33         cfg = __raw_readl(addr);
  34         cfg = on ? (cfg | reset) : (cfg & ~reset);
  35         __raw_writel(cfg, addr);
  36
  37         if (on) {
  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;
  42         }
  43
  44         __raw_writel(cfg, addr);
  45         spin_unlock_irqrestore(&lock, flags);
  46
  47         return 0;
  48 }
  49
  50 int s5p_csis_phy_enable(int id, bool on)
  51 {
  52         return __s5p_mipi_phy_control(id, on, S5P_MIPI_DPHY_SRESETN);
  53 }
  54 EXPORT_SYMBOL(s5p_csis_phy_enable);
  55
  56 int s5p_dsim_phy_enable(struct platform_device *pdev, bool on)
  57 {
  58         return __s5p_mipi_phy_control(pdev->id, on, S5P_MIPI_DPHY_MRESETN);
  59 }
  60 EXPORT_SYMBOL(s5p_dsim_phy_enable);