|
@@ -13,44 +13,55 @@
|
|
#include <linux/io.h>
|
|
#include <linux/io.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/module.h>
|
|
|
|
+#include <linux/mfd/syscon.h>
|
|
|
|
+#include <linux/mfd/syscon/exynos5-pmu.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/phy/phy.h>
|
|
#include <linux/phy/phy.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/platform_device.h>
|
|
|
|
+#include <linux/regmap.h>
|
|
|
|
|
|
-/* DPTX_PHY_CONTROL register */
|
|
|
|
-#define EXYNOS_DPTX_PHY_ENABLE (1 << 0)
|
|
|
|
|
|
+struct exynos_dp_video_phy_drvdata {
|
|
|
|
+ u32 phy_ctrl_offset;
|
|
|
|
+};
|
|
|
|
|
|
struct exynos_dp_video_phy {
|
|
struct exynos_dp_video_phy {
|
|
- void __iomem *regs;
|
|
|
|
|
|
+ struct regmap *regs;
|
|
|
|
+ const struct exynos_dp_video_phy_drvdata *drvdata;
|
|
};
|
|
};
|
|
|
|
|
|
-static int __set_phy_state(struct exynos_dp_video_phy *state, unsigned int on)
|
|
|
|
|
|
+static void exynos_dp_video_phy_pwr_isol(struct exynos_dp_video_phy *state,
|
|
|
|
+ unsigned int on)
|
|
{
|
|
{
|
|
- u32 reg;
|
|
|
|
|
|
+ unsigned int val;
|
|
|
|
+
|
|
|
|
+ if (IS_ERR(state->regs))
|
|
|
|
+ return;
|
|
|
|
|
|
- reg = readl(state->regs);
|
|
|
|
- if (on)
|
|
|
|
- reg |= EXYNOS_DPTX_PHY_ENABLE;
|
|
|
|
- else
|
|
|
|
- reg &= ~EXYNOS_DPTX_PHY_ENABLE;
|
|
|
|
- writel(reg, state->regs);
|
|
|
|
|
|
+ val = on ? 0 : EXYNOS5_PHY_ENABLE;
|
|
|
|
|
|
- return 0;
|
|
|
|
|
|
+ regmap_update_bits(state->regs, state->drvdata->phy_ctrl_offset,
|
|
|
|
+ EXYNOS5_PHY_ENABLE, val);
|
|
}
|
|
}
|
|
|
|
|
|
static int exynos_dp_video_phy_power_on(struct phy *phy)
|
|
static int exynos_dp_video_phy_power_on(struct phy *phy)
|
|
{
|
|
{
|
|
struct exynos_dp_video_phy *state = phy_get_drvdata(phy);
|
|
struct exynos_dp_video_phy *state = phy_get_drvdata(phy);
|
|
|
|
|
|
- return __set_phy_state(state, 1);
|
|
|
|
|
|
+ /* Disable power isolation on DP-PHY */
|
|
|
|
+ exynos_dp_video_phy_pwr_isol(state, 0);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
}
|
|
}
|
|
|
|
|
|
static int exynos_dp_video_phy_power_off(struct phy *phy)
|
|
static int exynos_dp_video_phy_power_off(struct phy *phy)
|
|
{
|
|
{
|
|
struct exynos_dp_video_phy *state = phy_get_drvdata(phy);
|
|
struct exynos_dp_video_phy *state = phy_get_drvdata(phy);
|
|
|
|
|
|
- return __set_phy_state(state, 0);
|
|
|
|
|
|
+ /* Enable power isolation on DP-PHY */
|
|
|
|
+ exynos_dp_video_phy_pwr_isol(state, 1);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
}
|
|
}
|
|
|
|
|
|
static struct phy_ops exynos_dp_video_phy_ops = {
|
|
static struct phy_ops exynos_dp_video_phy_ops = {
|
|
@@ -59,11 +70,31 @@ static struct phy_ops exynos_dp_video_phy_ops = {
|
|
.owner = THIS_MODULE,
|
|
.owner = THIS_MODULE,
|
|
};
|
|
};
|
|
|
|
|
|
|
|
+static const struct exynos_dp_video_phy_drvdata exynos5250_dp_video_phy = {
|
|
|
|
+ .phy_ctrl_offset = EXYNOS5_DPTX_PHY_CONTROL,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static const struct exynos_dp_video_phy_drvdata exynos5420_dp_video_phy = {
|
|
|
|
+ .phy_ctrl_offset = EXYNOS5420_DPTX_PHY_CONTROL,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static const struct of_device_id exynos_dp_video_phy_of_match[] = {
|
|
|
|
+ {
|
|
|
|
+ .compatible = "samsung,exynos5250-dp-video-phy",
|
|
|
|
+ .data = &exynos5250_dp_video_phy,
|
|
|
|
+ }, {
|
|
|
|
+ .compatible = "samsung,exynos5420-dp-video-phy",
|
|
|
|
+ .data = &exynos5420_dp_video_phy,
|
|
|
|
+ },
|
|
|
|
+ { },
|
|
|
|
+};
|
|
|
|
+MODULE_DEVICE_TABLE(of, exynos_dp_video_phy_of_match);
|
|
|
|
+
|
|
static int exynos_dp_video_phy_probe(struct platform_device *pdev)
|
|
static int exynos_dp_video_phy_probe(struct platform_device *pdev)
|
|
{
|
|
{
|
|
struct exynos_dp_video_phy *state;
|
|
struct exynos_dp_video_phy *state;
|
|
struct device *dev = &pdev->dev;
|
|
struct device *dev = &pdev->dev;
|
|
- struct resource *res;
|
|
|
|
|
|
+ const struct of_device_id *match;
|
|
struct phy_provider *phy_provider;
|
|
struct phy_provider *phy_provider;
|
|
struct phy *phy;
|
|
struct phy *phy;
|
|
|
|
|
|
@@ -71,11 +102,15 @@ static int exynos_dp_video_phy_probe(struct platform_device *pdev)
|
|
if (!state)
|
|
if (!state)
|
|
return -ENOMEM;
|
|
return -ENOMEM;
|
|
|
|
|
|
- res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
|
-
|
|
|
|
- state->regs = devm_ioremap_resource(dev, res);
|
|
|
|
- if (IS_ERR(state->regs))
|
|
|
|
|
|
+ state->regs = syscon_regmap_lookup_by_phandle(dev->of_node,
|
|
|
|
+ "samsung,pmu-syscon");
|
|
|
|
+ if (IS_ERR(state->regs)) {
|
|
|
|
+ dev_err(dev, "Failed to lookup PMU regmap\n");
|
|
return PTR_ERR(state->regs);
|
|
return PTR_ERR(state->regs);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ match = of_match_node(exynos_dp_video_phy_of_match, dev->of_node);
|
|
|
|
+ state->drvdata = match->data;
|
|
|
|
|
|
phy = devm_phy_create(dev, NULL, &exynos_dp_video_phy_ops, NULL);
|
|
phy = devm_phy_create(dev, NULL, &exynos_dp_video_phy_ops, NULL);
|
|
if (IS_ERR(phy)) {
|
|
if (IS_ERR(phy)) {
|
|
@@ -89,12 +124,6 @@ static int exynos_dp_video_phy_probe(struct platform_device *pdev)
|
|
return PTR_ERR_OR_ZERO(phy_provider);
|
|
return PTR_ERR_OR_ZERO(phy_provider);
|
|
}
|
|
}
|
|
|
|
|
|
-static const struct of_device_id exynos_dp_video_phy_of_match[] = {
|
|
|
|
- { .compatible = "samsung,exynos5250-dp-video-phy" },
|
|
|
|
- { },
|
|
|
|
-};
|
|
|
|
-MODULE_DEVICE_TABLE(of, exynos_dp_video_phy_of_match);
|
|
|
|
-
|
|
|
|
static struct platform_driver exynos_dp_video_phy_driver = {
|
|
static struct platform_driver exynos_dp_video_phy_driver = {
|
|
.probe = exynos_dp_video_phy_probe,
|
|
.probe = exynos_dp_video_phy_probe,
|
|
.driver = {
|
|
.driver = {
|