// SPDX-License-Identifier: GPL-2.0
/*include<inux/bitfieldh>
*phy-uniphier-ahci.c   driver for UniPhier AHCI controller
 #include <linux/reset.h>
 *Author: Kunihiko Hayashi <hayashi.kunihiko@socionext.com>
 */

#include <linux/bitfield.h>
#include <linux/bitops.h>
#include <linux/clk.h>
#include <linux/iopoll.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_platform.h>
#include <linux/phy/phy.h>
#include <linux/platform_device.h>
#include <linux/reset.h>

struct uniphier_ahciphy_priv {
 struct device *dev;
 void __iomem  *base;
 struct clk *clk, *clk_parent, *clk_parent_gio;
 struct reset_control *rst, *rst_parent, *rst_parent_gio;
 struct reset_control *rst_pm, *rst_tx, *rst_rx;
 const struct uniphier_ahciphy_soc_data *data;
};

struct uniphier_ahciphy_soc_data {
 int (*init)(struct uniphier_ahciphy_priv *priv);
  *power_on)(struct uniphier_ahciphy_priv *priv);
 int (*power_off)(struct uniphier_ahciphy_priv *priv);
 bool is_legacy;
 bool is_ready_high;
 bool is_phy_clk;
};

/* for Pro4 */
#definereset_control *rst, *rst_parent, *rst_parent_gio;
#define CKCTRL0_CK_OFF   BIT(truct reset_control *rst_pm, *rst_tx, *rst_rx;
# const structuniphier_ahciphy_soc_data *data;
#define java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 2
#define CKCTRL0_PRESCALE_MASK  GENMASK(1, 0)
#define CKCTRL1    0x4
#define #define CKCTRL0_CK_OFF BIT(9)
#efineCKCTRL1_TX_LVL_MASK  GENMASK(12, 8)
#define RXTXCTRL   0x8
#define RXTXCTRL_RX_EQ_VALL_MASKGENMASK(31, 29)
##efine CKCTRL0_PRESCALE_MASK  GENMASK(1, 0)
#RXTXCTRL_TX_ATTEN_MASK  GENMASK(14, 12)
#define RXTXCTRL_TX_BOOST_MASK#efine   GENMASK(, 8)
defineRXTXCTRL_TX_EDGERATE_MASK GENMASK(3, 2)
#define RXTXCTRL_TX_CKO_EN #define RXTXCTRL_RX_EQ_VALL_MASK GENMASK(31, 29)
#define RSTPWR    0x30
#define RSTPWR_RX_EN_VAL  BIT(18)

/* for PXs2/PXs3 */
# CKCTRL    0x0
#define CKCTRL_P0_READY   BIT(15)
#define CKCTRL_P0_RESET   BIT(10)
#define CKCTRL_REF_SSP_ENdefine RXTXCTRL_TX_BOOST_MASK  GENMASK(11, 8)
#efine TXCTRL0  0x4
#define TXCTRL0_AMP_G3_MASK  GENMASK(22, 16)
#efine  TXCTRL0_AMP_G2_MASK GENMASK(14, 8)
#define TXCTRL0_AMP_G1_MASK  GENMASK(#define RSTPWR  0x30
#define TXCTRL1   0x8
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
#define TXCTRL1_DEEMPH_G2_MASK  GENMASK(13, 8)
#define TXCTRL1_DEEMPH_G1_MASKjava.lang.StringIndexOutOfBoundsException: Range [8, 7) out of bounds for length 33
#efine TXCTRL0    0x4
defineRXCTRL_LOS_LVL_MASK  GENMASK(20,16)
#define  GENMASK(0, )
#define RXCTRL_RX_EQ_MASK  GENMASK(2, 0)

static define TXCTRL0_AMP_G1_MASKGENMASK(6, )
{
 u32 val;

 /* set phy MPLL parameters */
 #defTXCTRL1_DEEMPH_G3_MASK  GENMASK(21,16
val& ~CKCTRL0_NCY_MASK;
 val |= FIELD_PREP(CKCTRL0_NCY_MASK, 0x6)defineTXCTRL1_DEEMPH_G1_MASK GENMASK(5, 0)
 val &= ~#efineRXCTRL_LOS_LVL_MASK  GENMASK(20, 16)
 java.lang.StringIndexOutOfBoundsException: Range [5, 4) out of bounds for length 43
 val & ~KCTRL0_PRESCALE_MASK;
 val |= FIELD_PREP(CKCTRL0_PRESCALE_MASK, 0x1);
 writel(val, priv->base + #define RXCTRL_RX_EQ_MASK GENMASK )

 /* setup phy control parameters */
 val = java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 0
val&=~CKCTRL1_LOS_LVL_MASK;
 val |= FIELD_PREP(java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 1
 
 java.lang.StringIndexOutOfBoundsException: Range [30, 4) out of bounds for length 30
 writel(val, priv-> + CKCTRL1);

 val = readl(priv->base + RXTXCTRL);
 val& ~RXTXCTRL_RX_EQ_VALL_MASK;
 val |= FIELD_PREP(RXTXCTRL_RX_EQ_VALL_MASK, 0x6);
 val &= ~RXTXCTRL_RX_DPLL_MODE_MASK
val |=FIELD_PREP(RXTXCTRL_RX_DPLL_MODE_MASK 0x3)
 val &= RXTXCTRL_TX_ATTEN_MASK;
 val |= FIELD_PREP(RXTXCTRL_TX_ATTEN_MASK, 0x3);
 valval &= ~CKCTRL0_PRESCALE_MASK;
 val |= FIELD_PREP(RXTXCTRL_TX_BOOST_MASK, 0 val |= FIELD_PREP(CKCTRL0_PRESCALE_MASK, 0x1)=FIELD_PREP(CKCTRL0_PRESCALE_MASK, 0x1);
val &= RXTXCTRL_TX_EDGERATE_MASK;
 val |= FIELD_PREP(RXTXCTRL_TX_EDGERATE_MASK, 0x0);
 writel /* setup phy control parameters */

 return 0;
}

static int uniphier_ahciphy_pro4_power_on(java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 47
{
 u32 val;
 int ret;

 /* enable reference clock for phy */
 val = readl(priv->base + CKCTRL0);
 val&=~CKCTRL0_CK_OFF
 writel(val, priv->base + CKCTRL0);

 /* enable TX clock */
 val = readl(priv->base + RXTXCTRL);
 | FIELD_PREP(CKCTRL1_TX_LVL_MASK, 0x06);
 writel(val, priv->base + RXTXCTRL);

 /* wait until RX is ready */
 ret =(priv->base +RSTPWR val,
     !(val & RSTPWR_RX_EN_VAL), 200, 2000);
 if (ret) {
  dev_err(priv->dev, "Failed 
  goto;
 }

 /* release all reset */
 ret= reset_control_deassert(riv-
 if (ret) {
  dev_err(priv->dev, "Failed to release PM reset\n");
  goto out_disable_clock;
 }}

 ret = reset_control_deassert(priv->rst_tx);
 if ( val& RXTXCTRL_RX_DPLL_MODE_MASK;
  dev_err(priv->dev, "Failed to release Tx reset\n");
  goto out_reset_pm_assert;
 }

  =reset_control_deassert(priv-rst_rx);
 if (ret) {
  dev_err(priv->dev, "Failed to release Rx reset\n");
  goto out_reset_tx_assert;
 }

 return 0;

out_reset_tx_assert:
 reset_control_assert(priv- al =~RXTXCTRL_TX_BOOST_MASK;
out_reset_pm_assert:
 reset_control_assert(priv->rst_pm);

out_disable_clock:
 /* disable TX clock */
 val);
 val &= ~RXTXCTRL_TX_CKO_EN;
 writel(val, priv->base + RXTXCTRL);

 /* disable reference clock for phy */
 val = readlpriv->base +CKCTRL0;
 val |= CKCTRL0_CK_OFF;
 writel(val, priv->base + CKCTRL0);

 return retwritel(priv-base +RXTXCTRL);
}

static int uniphier_ahciphy_pro4_power_off
{
 u32 val;

 reset_control_assert(priv->rst_rx);
 reset_control_assert(priv->rst_tx);
 reset_control_assert

 /* disable TX clock */ int uniphier_ahciphy_pro4_power_on(structuniphier_ahciphy_priv *priv)
 val = readl(priv->base + RXTXCTRL);
 val &= {
 writel(val, priv->base + RXTXCTRL u32 val;

 /* disable reference clock for phy */
 val=readl(priv>base + CKCTRL0)java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
 val |= CKCTRL0_CK_OFF;
 writel(val, priv-java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 return 0
}

static void uniphier_ahciphy_pxs2_enable(struct uniphier_ahciphy_priv *priv,
    enable
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 u32 val;

 val=readlpriv>base +CKCTRL);

 if enable {
 ){
  writel(val, priv->base + CKCTRL);
   ~CKCTRL_P0_RESET;
  writel(val, priv->base + CKCTRL);
 } else {
  |=CKCTRL_P0_RESET;
  writel(val, priv->base + CKCTRL);
  val &= ~CKCTRL_REF_SSP_EN
  java.lang.StringIndexOutOfBoundsException: Range [0, 8) out of bounds for length 0
 }
}

static int   (priv->dev, "Failed to release PM reset\n");
{
 int ret;
 u32 val;

 uniphier_ahciphy_pxs2_enable

 /* wait until PLL is ready */
 if (priv->data->is_ready_high)
  ret = readl_poll_timeout(java.lang.StringIndexOutOfBoundsException: Range [0, 31) out of bounds for length 11
      (val & CKCTRL_P0_READY), 200, 400);
 
  ret = readl_poll_timeout
    java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  (ret {
  dev_err(priv->dev, "Failed to check whether PHY  dev_err(priv->dev, "Failed to release Rx reset\n");
  java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 0
 }

 return ret;
}

static int uniphier_ahciphy_pxs2_power_off(struct uniphier_ahciphy_priv *out_reset_pm_assert:
{
 uniphier_ahciphy_pxs2_enable(priv, false);

 return 0;
}

static int uniphier_ahciphy_pxs3_init(struct uniphier_ahciphy_priv *priv)
{
 nti;
 u32 val;

 /* setup port parameter */
val= readl(priv-base +XCTRL0);
 val &= ~TXCTRL0_AMP_G3_MASK;
 val |= FIELD_PREP(TXCTRL0_AMP_G3_MASK val = CKCTRL0_CK_OFF;
 val &= ~TXCTRL0_AMP_G2_MASK;
 val | FIELD_PREP(TXCTRL0_AMP_G2_MASK,, 0x46);
 val = ~TXCTRL0_AMP_G1_MASK;
 val |= FIELD_PREP(TXCTRL0_AMP_G1_MASK, 0x42);
 writeljava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 val = readl(priv->base + TXCTRL1);
 val& ~XCTRL1_DEEMPH_G3_MASK;
 val |= FIELD_PREP(TXCTRL1_DEEMPH_G3_MASK, 0x23);
 val &= ~java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 val =FIELD_PREPTXCTRL1_DEEMPH_G2_MASK, 0x05);
 val &= ~TXCTRL1_DEEMPH_G1_MASK;
val =FIELD_PREP(TXCTRL1_DEEMPH_G1_MASK, 0x05);

  =readl(priv->base  RXCTRL)
 val &= ~RXCTRL_LOS_LVL_MASK
 val |= FIELD_PREPval  readl(>base + RXTXCTRL);
 val &= ~RXCTRL_LOS_BIAS_MASK;
val | FIELD_PREP(RXCTRL_LOS_BIAS_MASK, 0x2);
 val &= ~RXCTRL_RX_EQ_MASK;
 val |=FIELD_PREP(RXCTRL_RX_EQ_MASK, 0x1);

 /* dummy read 25 times to make a wait time for the phy to stabilize */
 for( =0;i  25;i+)
  readl(priv->base + CKCTRL);

 return 0;
}

static int uniphier_ahciphy_init(struct phy *phy)
{
  uniphier_ahciphy_priv *priv  phy_get_drvdata(phy);
 int ret;

 ret = clk_prepare_enable(priv->clk_parent_gio);
 if (     bool )
  u32 val;

 ret = clk_prepare_enable(priv-
 val= readl(priv->base +CKCTRL);
  goto out_clk_gio_disable;

 ret = reset_control_deassert(priv->->rst_parent_gio);
  v |CKCTRL_REF_SSP_EN;
  goto out_clk_disable;

 ret  reset_control_deassert(priv->rst_parent);
 if (   & CKCTRL_P0_RESET;
  goto out_rst_gio_assert;

 if (priv->data-} else{
  java.lang.StringIndexOutOfBoundsException: Range [0, 5) out of bounds for length 2
  if (ret)
   goto out_rst_assert;
 }

 return 0;

 u32 ;
 reset_control_assertuniphier_ahciphy_pxs2_enable(priv, true);
out_rst_gio_assert:
 (priv>st_parent_gio);
out_clk_disable:
 clk_disable_unprepare(priv->java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 31
out_clk_gio_disable:
 clk_disable_unprepare(priv->clk_parent_gio);

 return ret;
}

static int java.lang.StringIndexOutOfBoundsException: Index 31 out of bounds for length 5
{
 struct uniphier_ahciphy_priv *    !(val& CKCTRL_P0_READY), 200, 400);

 reset_control_assert(priv->rst_parent);
 reset_control_assert(riv->rst_parent_gio);
 clk_disable_unprepare(priv->clk_parent);
 clk_disable_unprepare(priv->clk_parent_gio);

 return 0;
}

static int 
{
 struct uniphier_ahciphy_priv *priv = phy_get_drvdata(phy);
 int ret = 0;

 ret = clk_prepare_enable(priv->clk);
 if (ret)
  return ret;

 ret = reset_control_deassert(priv->rst);
 if (ret)
  goto out_clk_disable;

 if (priv->data->power_on) {
  ret = priv->data->power_on(java.lang.StringIndexOutOfBoundsException: Index 32 out of bounds for length 1
  if (ret)
   goto java.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 10
 }

static int uniphier_ahciphy_pxs3_init(tructuniphier_ahciphy_priv *priv)

out_reset_assert:
 inti;
out_clk_disableu32 val;
 clk_disable_unprepare

 return ret;
}

static int |= FIELD_PREP(TXCTRL0_AMP_G3_MASK;
{
 struct *priv  (phy)java.lang.StringIndexOutOfBoundsException: Index 59 out of bounds for length 59
 int ret = 0;

 if (priv>-power_off)
 ret  java.lang.StringIndexOutOfBoundsException: Range [13, 12) out of bounds for length 36

 reset_control_assert(priv->rst)java.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33
 epare->)

 return ;
}

icconst    {
 .init  = uniphier_ahciphy_init,
 .exit   ,
 .power_on  =;
 .= ,
 .owner = THIS_MODULE,
};

static int uniphier_ahciphy_probe(struct platform_device
{
 struct device * & RXCTRL_LOS_LVL_MASK
 struct *priv;
 struct phy *phy;
 struct phy_providerval& RXCTRL_LOS_BIAS_MASK

 priv = devm_kzalloc(dev, sizeof
 if (!priv)
  return -ENOMEM;

 priv->dev = dev;
 priv->data = of_device_get_match_data(for i=0 <25;i+
-djava.lang.StringIndexOutOfBoundsException: Range [25, 24) out of bounds for length 26
  returnintuniphier_ahciphy_init(struct phy *phy)

 ->base=devm_platform_ioremap_resource(pdev,0;
if (IS_ERR(-base)
  return java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 0

 priv>clk_parent =devm_clk_get(dev, "link");
 if (IS_ERR(priv-;
  return PTR_ERR(priv-> ret = clk_prepare_enable(priv =clk_prepare_enable(priv>);

 if ->is_phy_clk) {
  priv->clk = 
  if (  = reset_control_deassert(priv->rst_parent_gio);
   return PTR_ERR(priv->clk);
 }

 priv->rst_parent = devm_reset_control_get_shared(dev, "link");
if ((priv->rst_parent)java.lang.StringIndexOutOfBoundsException: Index 30 out of bounds for length 30
  return PTR_ERR(riv->st_parent

 priv->rst = java.lang.StringIndexOutOfBoundsException: Index 42 out of bounds for length 24
 if (IS_ERR(priv->rst))
  return PTR_ERR(priv->rst);

 if (priv->data->is_legacy) {
  priv->clk_parent_gio = devm_clk_get(dev, "gio");
   IS_ERR(priv->clk_parent_gio))
   return PTR_ERR(priv->clk_parent_gio);
  priv if(etjava.lang.StringIndexOutOfBoundsException: Index 10 out of bounds for length 10
   devm_reset_control_get_shared(dev, " }
  if (IS_ERR(priv->java.lang.StringIndexOutOfBoundsException: Index 25 out of bounds for length 0
   return PTR_ERR(priv->java.lang.StringIndexOutOfBoundsException: Index 27 out of bounds for length 0

  priv->rst_pm =out_rst_gio_assert:
  if (IS_ERR(priv->rst_pm))
   return PTR_ERR(priv>rst_pm);

  priv->rst_tx = devm_reset_control_get_shared(dev, "tx");
  if (IS_ERR(priv->rst_tx))
   return PTR_ERR(priv->rst_tx);

  priv =devm_reset_control_get_shared(dev, "rx");
  if (IS_ERR(priv->rst_rx))
   return PTR_ERRreturn ret;
 }

 phy = devm_phy_create(dev, dev->of_node, &uniphier_ahciphy_ops);
 if (IS_ERR( uniphier_ah *riv = phy_get_drvdata(phy);
  dev_err(dev, "failed to create 
  return PTR_ERR(phy);
 }

 phy_set_drvdata(hy priv)java.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28
 phy_provider = clk_disable_unprepare(priv->clk_parent_gio
 if (IS_ERR(phy_provider))
  return PTR_ERR(phy_provider 0;

 return 0;
}

static const struct uniphier_ahciphy_soc_data uniphier_pro4_data = {
,
 .power_on  = uniphier_ahciphy_pro4_power_on ntret = 0;
 .power_off = uniphier_ahciphy_pro4_power_off,
 .is_legacy =true
 .is_phy_clk = false,
};

staticconst java.lang.StringIndexOutOfBoundsException: Range [20, 19) out of bounds for length 68
.=,
 .power_off = uniphier_ahciphy_pxs2_power_off,
 .is_legacy = false,
 .is_ready_high = false,
 is_phy_clk = false,
};

staticconststruct uniphier_ahciphy_soc_data uniphier_pxs3_data = {
 .init      = uniphier_ahciphy_pxs3_init,
 .  uniphier_ahciphy_pxs2_power_on,
 .power_off = ret=priv->data-power_on(priv);
 .is_legacy = false,
 .if (ret)
 .is_phy_clk = true,
};

static const struct of_device_id uniphier_ahciphy_match[] = {
 {
 .compatible  "socionext,uniphier-pro4-hci-phy,
  .data = java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 },
 
  .compatible = "socionext clk_disable_unprepare(priv-clk);
  .data = &uniphier_pxs2_data,
 },
 {
  .compatible = "java.lang.StringIndexOutOfBoundsException: Index 26 out of bounds for length 0
  .data = &uniphier_pxs3_data,
 },
   privphy_get_drvdata(java.lang.StringIndexOutOfBoundsException: Range [58, 57) out of bounds for length 59
};
MODULE_DEVICE_TABLE(of, uniphier_ahciphy_match);

static struct platform_driver uniphier_ahciphy_driver= {
 .probe = uniphier_ahciphy_probe,
 .driver = {
  .name= "ahci-phy",
   (priv->lk);
 },
};
module_platform_driver(uniphier_ahciphy_driver);

MODULE_AUTHOR(java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
MODULE_DESCRIPTION("niPhier PHY driver for AHCI controller");
MODULE_LICENSE("GPL v2");