|
@@ -37,7 +37,6 @@ struct st_ahci_drv_data {
|
|
|
struct reset_control *pwr;
|
|
|
struct reset_control *sw_rst;
|
|
|
struct reset_control *pwr_rst;
|
|
|
- struct ahci_host_priv *hpriv;
|
|
|
};
|
|
|
|
|
|
static void st_ahci_configure_oob(void __iomem *mmio)
|
|
@@ -55,9 +54,10 @@ static void st_ahci_configure_oob(void __iomem *mmio)
|
|
|
writel(new_val, mmio + ST_AHCI_OOBR);
|
|
|
}
|
|
|
|
|
|
-static int st_ahci_deassert_resets(struct device *dev)
|
|
|
+static int st_ahci_deassert_resets(struct ahci_host_priv *hpriv,
|
|
|
+ struct device *dev)
|
|
|
{
|
|
|
- struct st_ahci_drv_data *drv_data = dev_get_drvdata(dev);
|
|
|
+ struct st_ahci_drv_data *drv_data = hpriv->plat_data;
|
|
|
int err;
|
|
|
|
|
|
if (drv_data->pwr) {
|
|
@@ -90,8 +90,8 @@ static int st_ahci_deassert_resets(struct device *dev)
|
|
|
static void st_ahci_host_stop(struct ata_host *host)
|
|
|
{
|
|
|
struct ahci_host_priv *hpriv = host->private_data;
|
|
|
+ struct st_ahci_drv_data *drv_data = hpriv->plat_data;
|
|
|
struct device *dev = host->dev;
|
|
|
- struct st_ahci_drv_data *drv_data = dev_get_drvdata(dev);
|
|
|
int err;
|
|
|
|
|
|
if (drv_data->pwr) {
|
|
@@ -103,29 +103,30 @@ static void st_ahci_host_stop(struct ata_host *host)
|
|
|
ahci_platform_disable_resources(hpriv);
|
|
|
}
|
|
|
|
|
|
-static int st_ahci_probe_resets(struct platform_device *pdev)
|
|
|
+static int st_ahci_probe_resets(struct ahci_host_priv *hpriv,
|
|
|
+ struct device *dev)
|
|
|
{
|
|
|
- struct st_ahci_drv_data *drv_data = platform_get_drvdata(pdev);
|
|
|
+ struct st_ahci_drv_data *drv_data = hpriv->plat_data;
|
|
|
|
|
|
- drv_data->pwr = devm_reset_control_get(&pdev->dev, "pwr-dwn");
|
|
|
+ drv_data->pwr = devm_reset_control_get(dev, "pwr-dwn");
|
|
|
if (IS_ERR(drv_data->pwr)) {
|
|
|
- dev_info(&pdev->dev, "power reset control not defined\n");
|
|
|
+ dev_info(dev, "power reset control not defined\n");
|
|
|
drv_data->pwr = NULL;
|
|
|
}
|
|
|
|
|
|
- drv_data->sw_rst = devm_reset_control_get(&pdev->dev, "sw-rst");
|
|
|
+ drv_data->sw_rst = devm_reset_control_get(dev, "sw-rst");
|
|
|
if (IS_ERR(drv_data->sw_rst)) {
|
|
|
- dev_info(&pdev->dev, "soft reset control not defined\n");
|
|
|
+ dev_info(dev, "soft reset control not defined\n");
|
|
|
drv_data->sw_rst = NULL;
|
|
|
}
|
|
|
|
|
|
- drv_data->pwr_rst = devm_reset_control_get(&pdev->dev, "pwr-rst");
|
|
|
+ drv_data->pwr_rst = devm_reset_control_get(dev, "pwr-rst");
|
|
|
if (IS_ERR(drv_data->pwr_rst)) {
|
|
|
- dev_dbg(&pdev->dev, "power soft reset control not defined\n");
|
|
|
+ dev_dbg(dev, "power soft reset control not defined\n");
|
|
|
drv_data->pwr_rst = NULL;
|
|
|
}
|
|
|
|
|
|
- return st_ahci_deassert_resets(&pdev->dev);
|
|
|
+ return st_ahci_deassert_resets(hpriv, dev);
|
|
|
}
|
|
|
|
|
|
static struct ata_port_operations st_ahci_port_ops = {
|
|
@@ -154,15 +155,12 @@ static int st_ahci_probe(struct platform_device *pdev)
|
|
|
if (!drv_data)
|
|
|
return -ENOMEM;
|
|
|
|
|
|
- platform_set_drvdata(pdev, drv_data);
|
|
|
-
|
|
|
hpriv = ahci_platform_get_resources(pdev);
|
|
|
if (IS_ERR(hpriv))
|
|
|
return PTR_ERR(hpriv);
|
|
|
+ hpriv->plat_data = drv_data;
|
|
|
|
|
|
- drv_data->hpriv = hpriv;
|
|
|
-
|
|
|
- err = st_ahci_probe_resets(pdev);
|
|
|
+ err = st_ahci_probe_resets(hpriv, &pdev->dev);
|
|
|
if (err)
|
|
|
return err;
|
|
|
|
|
@@ -170,7 +168,7 @@ static int st_ahci_probe(struct platform_device *pdev)
|
|
|
if (err)
|
|
|
return err;
|
|
|
|
|
|
- st_ahci_configure_oob(drv_data->hpriv->mmio);
|
|
|
+ st_ahci_configure_oob(hpriv->mmio);
|
|
|
|
|
|
err = ahci_platform_init_host(pdev, hpriv, &st_ahci_port_info,
|
|
|
&ahci_platform_sht);
|
|
@@ -185,8 +183,9 @@ static int st_ahci_probe(struct platform_device *pdev)
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
|
static int st_ahci_suspend(struct device *dev)
|
|
|
{
|
|
|
- struct st_ahci_drv_data *drv_data = dev_get_drvdata(dev);
|
|
|
- struct ahci_host_priv *hpriv = drv_data->hpriv;
|
|
|
+ struct ata_host *host = dev_get_drvdata(dev);
|
|
|
+ struct ahci_host_priv *hpriv = host->private_data;
|
|
|
+ struct st_ahci_drv_data *drv_data = hpriv->plat_data;
|
|
|
int err;
|
|
|
|
|
|
err = ahci_platform_suspend_host(dev);
|
|
@@ -208,21 +207,21 @@ static int st_ahci_suspend(struct device *dev)
|
|
|
|
|
|
static int st_ahci_resume(struct device *dev)
|
|
|
{
|
|
|
- struct st_ahci_drv_data *drv_data = dev_get_drvdata(dev);
|
|
|
- struct ahci_host_priv *hpriv = drv_data->hpriv;
|
|
|
+ struct ata_host *host = dev_get_drvdata(dev);
|
|
|
+ struct ahci_host_priv *hpriv = host->private_data;
|
|
|
int err;
|
|
|
|
|
|
err = ahci_platform_enable_resources(hpriv);
|
|
|
if (err)
|
|
|
return err;
|
|
|
|
|
|
- err = st_ahci_deassert_resets(dev);
|
|
|
+ err = st_ahci_deassert_resets(hpriv, dev);
|
|
|
if (err) {
|
|
|
ahci_platform_disable_resources(hpriv);
|
|
|
return err;
|
|
|
}
|
|
|
|
|
|
- st_ahci_configure_oob(drv_data->hpriv->mmio);
|
|
|
+ st_ahci_configure_oob(hpriv->mmio);
|
|
|
|
|
|
return ahci_platform_resume_host(dev);
|
|
|
}
|