Quelle  phy-berlin-usb.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2014 Marvell Technology Group Ltd.
 *
 * Antoine Tenart <antoine.tenart@free-electrons.com>
 * Jisheng Zhang <jszhang@marvell.com>
 */

#include <linux/io.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/phy/phy.h>
#include <linux/platform_device.h>
#include <linux/property.h>
#include <linux/reset.h>

#define USB_PHY_PLL  0x04
#define USB_PHY_PLL_CONTROL 0x08
#define USB_PHY_TX_CTRL0 0x10
#define USB_PHY_TX_CTRL1 0x14
#define USB_PHY_TX_CTRL2 0x18
#define USB_PHY_RX_CTRL  0x20
#define USB_PHY_ANALOG  0x34

/* USB_PHY_PLL */
#define CLK_REF_DIV(x)  ((x) << 4)
#define FEEDBACK_CLK_DIV(x) ((x) << 8)

/* USB_PHY_PLL_CONTROL */
#define CLK_STABLE  BIT(0)
#define PLL_CTRL_PIN  BIT(1)
#define PLL_CTRL_REG  BIT(2)
#define PLL_ON   BIT(3)
#define PHASE_OFF_TOL_125 (0x0 << 5)
#define PHASE_OFF_TOL_250 BIT(5)
#define KVC0_CALIB  (0x0 << 9)
#define KVC0_REG_CTRL  BIT(9)
#define KVC0_HIGH  (0x0 << 10)
#define KVC0_LOW  (0x3 << 10)
#define CLK_BLK_EN  BIT(13)

/* USB_PHY_TX_CTRL0 */
#define EXT_HS_RCAL_EN  BIT(3)
#define EXT_FS_RCAL_EN  BIT(4)
#define IMPCAL_VTH_DIV(x) ((x) << 5)
#define EXT_RS_RCAL_DIV(x) ((x) << 8)
#define EXT_FS_RCAL_DIV(x) ((x) << 12)

/* USB_PHY_TX_CTRL1 */
#define TX_VDD15_14  (0x0 << 4)
#define TX_VDD15_15  BIT(4)
#define TX_VDD15_16  (0x2 << 4)
#define TX_VDD15_17  (0x3 << 4)
#define TX_VDD12_VDD  (0x0 << 6)
#define TX_VDD12_11  BIT(6)
#define TX_VDD12_12  (0x2 << 6)
#define TX_VDD12_13  (0x3 << 6)
#define LOW_VDD_EN  BIT(8)
#define TX_OUT_AMP(x)  ((x) << 9)

/* USB_PHY_TX_CTRL2 */
#define TX_CHAN_CTRL_REG(x) ((x) << 0)
#define DRV_SLEWRATE(x)  ((x) << 4)
#define IMP_CAL_FS_HS_DLY_0 (0x0 << 6)
#define IMP_CAL_FS_HS_DLY_1 BIT(6)
#define IMP_CAL_FS_HS_DLY_2 (0x2 << 6)
#define IMP_CAL_FS_HS_DLY_3 (0x3 << 6)
#define FS_DRV_EN_MASK(x) ((x) << 8)
#define HS_DRV_EN_MASK(x) ((x) << 12)

/* USB_PHY_RX_CTRL */
#define PHASE_FREEZE_DLY_2_CL (0x0 << 0)
#define PHASE_FREEZE_DLY_4_CL BIT(0)
#define ACK_LENGTH_8_CL  (0x0 << 2)
#define ACK_LENGTH_12_CL BIT(2)
#define ACK_LENGTH_16_CL (0x2 << 2)
#define ACK_LENGTH_20_CL (0x3 << 2)
#define SQ_LENGTH_3  (0x0 << 4)
#define SQ_LENGTH_6  BIT(4)
#define SQ_LENGTH_9  (0x2 << 4)
#define SQ_LENGTH_12  (0x3 << 4)
#define DISCON_THRESHOLD_260 (0x0 << 6)
#define DISCON_THRESHOLD_270 BIT(6)
#define DISCON_THRESHOLD_280 (0x2 << 6)
#define DISCON_THRESHOLD_290 (0x3 << 6)
#define SQ_THRESHOLD(x)  ((x) << 8)
#define LPF_COEF(x)  ((x) << 12)
#define INTPL_CUR_10  (0x0 << 14)
#define INTPL_CUR_20  BIT(14)
#define INTPL_CUR_30  (0x2 << 14)
#define INTPL_CUR_40  (0x3 << 14)

/* USB_PHY_ANALOG */
#define ANA_PWR_UP  BIT(1)
#define ANA_PWR_DOWN  BIT(2)
#define V2I_VCO_RATIO(x) ((x) << 7)
#define R_ROTATE_90  (0x0 << 10)
#define R_ROTATE_0  BIT(10)
#define MODE_TEST_EN  BIT(11)
#define ANA_TEST_DC_CTRL(x) ((x) << 12)

static const u32 phy_berlin_pll_dividers[] = {
 /* Berlin 2 */
 CLK_REF_DIV(0x6) | FEEDBACK_CLK_DIV(0x55),
 /* Berlin 2CD/Q */
 CLK_REF_DIV(0xc) | FEEDBACK_CLK_DIV(0x54),
};

struct phy_berlin_usb_priv {
 void __iomem  *base;
 struct reset_control *rst_ctrl;
 u32   pll_divider;
};

static int phy_berlin_usb_power_on(struct phy *phy)
{
 struct phy_berlin_usb_priv *priv = phy_get_drvdata(phy);

 reset_control_reset(priv->rst_ctrl);

 writel(priv->pll_divider,
        priv->base + USB_PHY_PLL);
 writel(CLK_STABLE | PLL_CTRL_REG | PHASE_OFF_TOL_250 | KVC0_REG_CTRL |
        CLK_BLK_EN, priv->base + USB_PHY_PLL_CONTROL);
 writel(V2I_VCO_RATIO(0x5) | R_ROTATE_0 | ANA_TEST_DC_CTRL(0x5),
        priv->base + USB_PHY_ANALOG);
 writel(PHASE_FREEZE_DLY_4_CL | ACK_LENGTH_16_CL | SQ_LENGTH_12 |
        DISCON_THRESHOLD_270 | SQ_THRESHOLD(0xa) | LPF_COEF(0x2) |
        INTPL_CUR_30, priv->base + USB_PHY_RX_CTRL);

 writel(TX_VDD12_13 | TX_OUT_AMP(0x3), priv->base + USB_PHY_TX_CTRL1);
 writel(EXT_HS_RCAL_EN | IMPCAL_VTH_DIV(0x3) | EXT_RS_RCAL_DIV(0x4),
        priv->base + USB_PHY_TX_CTRL0);

 writel(EXT_HS_RCAL_EN | IMPCAL_VTH_DIV(0x3) | EXT_RS_RCAL_DIV(0x4) |
        EXT_FS_RCAL_DIV(0x2), priv->base + USB_PHY_TX_CTRL0);

 writel(EXT_HS_RCAL_EN | IMPCAL_VTH_DIV(0x3) | EXT_RS_RCAL_DIV(0x4),
        priv->base + USB_PHY_TX_CTRL0);
 writel(TX_CHAN_CTRL_REG(0xf) | DRV_SLEWRATE(0x3) | IMP_CAL_FS_HS_DLY_3 |
        FS_DRV_EN_MASK(0xd), priv->base + USB_PHY_TX_CTRL2);

 return 0;
}

static const struct phy_ops phy_berlin_usb_ops = {
 .power_on = phy_berlin_usb_power_on,
 .owner  = THIS_MODULE,
};

static const struct of_device_id phy_berlin_usb_of_match[] = {
 {
  .compatible = "marvell,berlin2-usb-phy",
  .data = &phy_berlin_pll_dividers[0],
 },
 {
  .compatible = "marvell,berlin2cd-usb-phy",
  .data = &phy_berlin_pll_dividers[1],
 },
 { },
};
MODULE_DEVICE_TABLE(of, phy_berlin_usb_of_match);

static int phy_berlin_usb_probe(struct platform_device *pdev)
{
 struct phy_berlin_usb_priv *priv;
 struct phy *phy;
 struct phy_provider *phy_provider;

 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
 if (!priv)
  return -ENOMEM;

 priv->base = devm_platform_ioremap_resource(pdev, 0);
 if (IS_ERR(priv->base))
  return PTR_ERR(priv->base);

 priv->rst_ctrl = devm_reset_control_get(&pdev->dev, NULL);
 if (IS_ERR(priv->rst_ctrl))
  return PTR_ERR(priv->rst_ctrl);

 priv->pll_divider = *((u32 *)device_get_match_data(&pdev->dev));

 phy = devm_phy_create(&pdev->dev, NULL, &phy_berlin_usb_ops);
 if (IS_ERR(phy)) {
  dev_err(&pdev->dev, "failed to create PHY\n");
  return PTR_ERR(phy);
 }

 phy_set_drvdata(phy, priv);

 phy_provider =
  devm_of_phy_provider_register(&pdev->dev, of_phy_simple_xlate);
 return PTR_ERR_OR_ZERO(phy_provider);
}

static struct platform_driver phy_berlin_usb_driver = {
 .probe = phy_berlin_usb_probe,
 .driver = {
  .name  = "phy-berlin-usb",
  .of_match_table = phy_berlin_usb_of_match,
 },
};
module_platform_driver(phy_berlin_usb_driver);

MODULE_AUTHOR("Antoine Tenart <antoine.tenart@free-electrons.com>");
MODULE_DESCRIPTION("Marvell Berlin PHY driver for USB");
MODULE_LICENSE("GPL");