1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (C) 2012 STMicroelectronics Limited 4 * 5 * Authors: Francesco Virlinzi <francesco.virlinzi@st.com> 6 * Alexandre Torgue <alexandre.torgue@st.com> 7 */ 8 9 #include <linux/init.h> 10 #include <linux/module.h> 11 #include <linux/export.h> 12 #include <linux/platform_device.h> 13 #include <linux/clk.h> 14 #include <linux/of.h> 15 #include <linux/ahci_platform.h> 16 #include <linux/libata.h> 17 #include <linux/reset.h> 18 #include <linux/io.h> 19 #include <linux/dma-mapping.h> 20 21 #include "ahci.h" 22 23 #define DRV_NAME "st_ahci" 24 25 #define ST_AHCI_OOBR 0xbc 26 #define ST_AHCI_OOBR_WE BIT(31) 27 #define ST_AHCI_OOBR_CWMIN_SHIFT 24 28 #define ST_AHCI_OOBR_CWMAX_SHIFT 16 29 #define ST_AHCI_OOBR_CIMIN_SHIFT 8 30 #define ST_AHCI_OOBR_CIMAX_SHIFT 0 31 32 struct st_ahci_drv_data { 33 struct reset_control *pwr; 34 struct reset_control *sw_rst; 35 struct reset_control *pwr_rst; 36 }; 37 38 static void st_ahci_configure_oob(void __iomem *mmio) 39 { 40 unsigned long old_val, new_val; 41 42 new_val = (0x02 << ST_AHCI_OOBR_CWMIN_SHIFT) | 43 (0x04 << ST_AHCI_OOBR_CWMAX_SHIFT) | 44 (0x08 << ST_AHCI_OOBR_CIMIN_SHIFT) | 45 (0x0C << ST_AHCI_OOBR_CIMAX_SHIFT); 46 47 old_val = readl(mmio + ST_AHCI_OOBR); 48 writel(old_val | ST_AHCI_OOBR_WE, mmio + ST_AHCI_OOBR); 49 writel(new_val | ST_AHCI_OOBR_WE, mmio + ST_AHCI_OOBR); 50 writel(new_val, mmio + ST_AHCI_OOBR); 51 } 52 53 static int st_ahci_deassert_resets(struct ahci_host_priv *hpriv, 54 struct device *dev) 55 { 56 struct st_ahci_drv_data *drv_data = hpriv->plat_data; 57 int err; 58 59 if (drv_data->pwr) { 60 err = reset_control_deassert(drv_data->pwr); 61 if (err) { 62 dev_err(dev, "unable to bring out of pwrdwn\n"); 63 return err; 64 } 65 } 66 67 if (drv_data->sw_rst) { 68 err = reset_control_deassert(drv_data->sw_rst); 69 if (err) { 70 dev_err(dev, "unable to bring out of sw-rst\n"); 71 return err; 72 } 73 } 74 75 if (drv_data->pwr_rst) { 76 err = reset_control_deassert(drv_data->pwr_rst); 77 if (err) { 78 dev_err(dev, "unable to bring out of pwr-rst\n"); 79 return err; 80 } 81 } 82 83 return 0; 84 } 85 86 static void st_ahci_host_stop(struct ata_host *host) 87 { 88 struct ahci_host_priv *hpriv = host->private_data; 89 struct st_ahci_drv_data *drv_data = hpriv->plat_data; 90 struct device *dev = host->dev; 91 int err; 92 93 if (drv_data->pwr) { 94 err = reset_control_assert(drv_data->pwr); 95 if (err) 96 dev_err(dev, "unable to pwrdwn\n"); 97 } 98 99 ahci_platform_disable_resources(hpriv); 100 } 101 102 static int st_ahci_probe_resets(struct ahci_host_priv *hpriv, 103 struct device *dev) 104 { 105 struct st_ahci_drv_data *drv_data = hpriv->plat_data; 106 107 drv_data->pwr = devm_reset_control_get(dev, "pwr-dwn"); 108 if (IS_ERR(drv_data->pwr)) { 109 dev_info(dev, "power reset control not defined\n"); 110 drv_data->pwr = NULL; 111 } 112 113 drv_data->sw_rst = devm_reset_control_get(dev, "sw-rst"); 114 if (IS_ERR(drv_data->sw_rst)) { 115 dev_info(dev, "soft reset control not defined\n"); 116 drv_data->sw_rst = NULL; 117 } 118 119 drv_data->pwr_rst = devm_reset_control_get(dev, "pwr-rst"); 120 if (IS_ERR(drv_data->pwr_rst)) { 121 dev_dbg(dev, "power soft reset control not defined\n"); 122 drv_data->pwr_rst = NULL; 123 } 124 125 return st_ahci_deassert_resets(hpriv, dev); 126 } 127 128 static struct ata_port_operations st_ahci_port_ops = { 129 .inherits = &ahci_platform_ops, 130 .host_stop = st_ahci_host_stop, 131 }; 132 133 static const struct ata_port_info st_ahci_port_info = { 134 .flags = AHCI_FLAG_COMMON, 135 .pio_mask = ATA_PIO4, 136 .udma_mask = ATA_UDMA6, 137 .port_ops = &st_ahci_port_ops, 138 }; 139 140 static const struct scsi_host_template ahci_platform_sht = { 141 AHCI_SHT(DRV_NAME), 142 }; 143 144 static int st_ahci_probe(struct platform_device *pdev) 145 { 146 struct st_ahci_drv_data *drv_data; 147 struct ahci_host_priv *hpriv; 148 int err; 149 150 drv_data = devm_kzalloc(&pdev->dev, sizeof(*drv_data), GFP_KERNEL); 151 if (!drv_data) 152 return -ENOMEM; 153 154 hpriv = ahci_platform_get_resources(pdev, 0); 155 if (IS_ERR(hpriv)) 156 return PTR_ERR(hpriv); 157 hpriv->plat_data = drv_data; 158 159 err = st_ahci_probe_resets(hpriv, &pdev->dev); 160 if (err) 161 return err; 162 163 err = ahci_platform_enable_resources(hpriv); 164 if (err) 165 return err; 166 167 st_ahci_configure_oob(hpriv->mmio); 168 169 err = ahci_platform_init_host(pdev, hpriv, &st_ahci_port_info, 170 &ahci_platform_sht); 171 if (err) { 172 ahci_platform_disable_resources(hpriv); 173 return err; 174 } 175 176 return 0; 177 } 178 179 #ifdef CONFIG_PM_SLEEP 180 static int st_ahci_suspend(struct device *dev) 181 { 182 struct ata_host *host = dev_get_drvdata(dev); 183 struct ahci_host_priv *hpriv = host->private_data; 184 struct st_ahci_drv_data *drv_data = hpriv->plat_data; 185 int err; 186 187 err = ahci_platform_suspend_host(dev); 188 if (err) 189 return err; 190 191 if (drv_data->pwr) { 192 err = reset_control_assert(drv_data->pwr); 193 if (err) { 194 dev_err(dev, "unable to pwrdwn"); 195 return err; 196 } 197 } 198 199 ahci_platform_disable_resources(hpriv); 200 201 return 0; 202 } 203 204 static int st_ahci_resume(struct device *dev) 205 { 206 struct ata_host *host = dev_get_drvdata(dev); 207 struct ahci_host_priv *hpriv = host->private_data; 208 int err; 209 210 err = ahci_platform_enable_resources(hpriv); 211 if (err) 212 return err; 213 214 err = st_ahci_deassert_resets(hpriv, dev); 215 if (err) { 216 ahci_platform_disable_resources(hpriv); 217 return err; 218 } 219 220 st_ahci_configure_oob(hpriv->mmio); 221 222 return ahci_platform_resume_host(dev); 223 } 224 #endif 225 226 static SIMPLE_DEV_PM_OPS(st_ahci_pm_ops, st_ahci_suspend, st_ahci_resume); 227 228 static const struct of_device_id st_ahci_match[] = { 229 { .compatible = "st,ahci", }, 230 { /* sentinel */ } 231 }; 232 MODULE_DEVICE_TABLE(of, st_ahci_match); 233 234 static struct platform_driver st_ahci_driver = { 235 .driver = { 236 .name = DRV_NAME, 237 .pm = &st_ahci_pm_ops, 238 .of_match_table = st_ahci_match, 239 }, 240 .probe = st_ahci_probe, 241 .remove_new = ata_platform_remove_one, 242 }; 243 module_platform_driver(st_ahci_driver); 244 245 MODULE_AUTHOR("Alexandre Torgue <alexandre.torgue@st.com>"); 246 MODULE_AUTHOR("Francesco Virlinzi <francesco.virlinzi@st.com>"); 247 MODULE_DESCRIPTION("STMicroelectronics SATA AHCI Driver"); 248 MODULE_LICENSE("GPL v2"); 249