forked from Minki/linux
64 lines
1.4 KiB
C
64 lines
1.4 KiB
C
/*
|
|
* Copyright (C) 2011 Samsung Electronics Co., Ltd.
|
|
*
|
|
* S5P - Helper functions for MIPI-CSIS and MIPI-DSIM D-PHY control
|
|
*
|
|
* 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/kernel.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/io.h>
|
|
#include <linux/spinlock.h>
|
|
#include <mach/regs-clock.h>
|
|
|
|
static int __s5p_mipi_phy_control(struct platform_device *pdev,
|
|
bool on, u32 reset)
|
|
{
|
|
static DEFINE_SPINLOCK(lock);
|
|
void __iomem *addr;
|
|
unsigned long flags;
|
|
int pid;
|
|
u32 cfg;
|
|
|
|
if (!pdev)
|
|
return -EINVAL;
|
|
|
|
pid = (pdev->id == -1) ? 0 : pdev->id;
|
|
|
|
if (pid != 0 && pid != 1)
|
|
return -EINVAL;
|
|
|
|
addr = S5P_MIPI_DPHY_CONTROL(pid);
|
|
|
|
spin_lock_irqsave(&lock, flags);
|
|
|
|
cfg = __raw_readl(addr);
|
|
cfg = on ? (cfg | reset) : (cfg & ~reset);
|
|
__raw_writel(cfg, addr);
|
|
|
|
if (on) {
|
|
cfg |= S5P_MIPI_DPHY_ENABLE;
|
|
} else if (!(cfg & (S5P_MIPI_DPHY_SRESETN |
|
|
S5P_MIPI_DPHY_MRESETN) & ~reset)) {
|
|
cfg &= ~S5P_MIPI_DPHY_ENABLE;
|
|
}
|
|
|
|
__raw_writel(cfg, addr);
|
|
spin_unlock_irqrestore(&lock, flags);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int s5p_csis_phy_enable(struct platform_device *pdev, bool on)
|
|
{
|
|
return __s5p_mipi_phy_control(pdev, on, S5P_MIPI_DPHY_SRESETN);
|
|
}
|
|
|
|
int s5p_dsim_phy_enable(struct platform_device *pdev, bool on)
|
|
{
|
|
return __s5p_mipi_phy_control(pdev, on, S5P_MIPI_DPHY_MRESETN);
|
|
}
|