1 /* 2 * Allwinner sunxi AHCI SATA platform driver 3 * Copyright 2013 Olliver Schinagl <oliver@schinagl.nl> 4 * Copyright 2014 Hans de Goede <hdegoede@redhat.com> 5 * 6 * based on the AHCI SATA platform driver by Jeff Garzik and Anton Vorontsov 7 * Based on code from Allwinner Technology Co., Ltd. <www.allwinnertech.com>, 8 * Daniel Wang <danielwang@allwinnertech.com> 9 * 10 * This program is free software; you can redistribute it and/or modify it 11 * under the terms and conditions of the GNU General Public License, 12 * version 2, as published by the Free Software Foundation. 13 * 14 * This program is distributed in the hope it will be useful, but WITHOUT 15 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 16 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 17 * more details. 18 */ 19 20 #include <linux/ahci_platform.h> 21 #include <linux/clk.h> 22 #include <linux/errno.h> 23 #include <linux/kernel.h> 24 #include <linux/module.h> 25 #include <linux/of_device.h> 26 #include <linux/platform_device.h> 27 #include <linux/regulator/consumer.h> 28 #include "ahci.h" 29 30 #define AHCI_BISTAFR 0x00a0 31 #define AHCI_BISTCR 0x00a4 32 #define AHCI_BISTFCTR 0x00a8 33 #define AHCI_BISTSR 0x00ac 34 #define AHCI_BISTDECR 0x00b0 35 #define AHCI_DIAGNR0 0x00b4 36 #define AHCI_DIAGNR1 0x00b8 37 #define AHCI_OOBR 0x00bc 38 #define AHCI_PHYCS0R 0x00c0 39 #define AHCI_PHYCS1R 0x00c4 40 #define AHCI_PHYCS2R 0x00c8 41 #define AHCI_TIMER1MS 0x00e0 42 #define AHCI_GPARAM1R 0x00e8 43 #define AHCI_GPARAM2R 0x00ec 44 #define AHCI_PPARAMR 0x00f0 45 #define AHCI_TESTR 0x00f4 46 #define AHCI_VERSIONR 0x00f8 47 #define AHCI_IDR 0x00fc 48 #define AHCI_RWCR 0x00fc 49 #define AHCI_P0DMACR 0x0170 50 #define AHCI_P0PHYCR 0x0178 51 #define AHCI_P0PHYSR 0x017c 52 53 static void sunxi_clrbits(void __iomem *reg, u32 clr_val) 54 { 55 u32 reg_val; 56 57 reg_val = readl(reg); 58 reg_val &= ~(clr_val); 59 writel(reg_val, reg); 60 } 61 62 static void sunxi_setbits(void __iomem *reg, u32 set_val) 63 { 64 u32 reg_val; 65 66 reg_val = readl(reg); 67 reg_val |= set_val; 68 writel(reg_val, reg); 69 } 70 71 static void sunxi_clrsetbits(void __iomem *reg, u32 clr_val, u32 set_val) 72 { 73 u32 reg_val; 74 75 reg_val = readl(reg); 76 reg_val &= ~(clr_val); 77 reg_val |= set_val; 78 writel(reg_val, reg); 79 } 80 81 static u32 sunxi_getbits(void __iomem *reg, u8 mask, u8 shift) 82 { 83 return (readl(reg) >> shift) & mask; 84 } 85 86 static int ahci_sunxi_phy_init(struct device *dev, void __iomem *reg_base) 87 { 88 u32 reg_val; 89 int timeout; 90 91 /* This magic is from the original code */ 92 writel(0, reg_base + AHCI_RWCR); 93 msleep(5); 94 95 sunxi_setbits(reg_base + AHCI_PHYCS1R, BIT(19)); 96 sunxi_clrsetbits(reg_base + AHCI_PHYCS0R, 97 (0x7 << 24), 98 (0x5 << 24) | BIT(23) | BIT(18)); 99 sunxi_clrsetbits(reg_base + AHCI_PHYCS1R, 100 (0x3 << 16) | (0x1f << 8) | (0x3 << 6), 101 (0x2 << 16) | (0x6 << 8) | (0x2 << 6)); 102 sunxi_setbits(reg_base + AHCI_PHYCS1R, BIT(28) | BIT(15)); 103 sunxi_clrbits(reg_base + AHCI_PHYCS1R, BIT(19)); 104 sunxi_clrsetbits(reg_base + AHCI_PHYCS0R, 105 (0x7 << 20), (0x3 << 20)); 106 sunxi_clrsetbits(reg_base + AHCI_PHYCS2R, 107 (0x1f << 5), (0x19 << 5)); 108 msleep(5); 109 110 sunxi_setbits(reg_base + AHCI_PHYCS0R, (0x1 << 19)); 111 112 timeout = 250; /* Power up takes aprox 50 us */ 113 do { 114 reg_val = sunxi_getbits(reg_base + AHCI_PHYCS0R, 0x7, 28); 115 if (reg_val == 0x02) 116 break; 117 118 if (--timeout == 0) { 119 dev_err(dev, "PHY power up failed.\n"); 120 return -EIO; 121 } 122 udelay(1); 123 } while (1); 124 125 sunxi_setbits(reg_base + AHCI_PHYCS2R, (0x1 << 24)); 126 127 timeout = 100; /* Calibration takes aprox 10 us */ 128 do { 129 reg_val = sunxi_getbits(reg_base + AHCI_PHYCS2R, 0x1, 24); 130 if (reg_val == 0x00) 131 break; 132 133 if (--timeout == 0) { 134 dev_err(dev, "PHY calibration failed.\n"); 135 return -EIO; 136 } 137 udelay(1); 138 } while (1); 139 140 msleep(15); 141 142 writel(0x7, reg_base + AHCI_RWCR); 143 144 return 0; 145 } 146 147 static void ahci_sunxi_start_engine(struct ata_port *ap) 148 { 149 void __iomem *port_mmio = ahci_port_base(ap); 150 struct ahci_host_priv *hpriv = ap->host->private_data; 151 152 /* Setup DMA before DMA start */ 153 sunxi_clrsetbits(hpriv->mmio + AHCI_P0DMACR, 0x0000ff00, 0x00004400); 154 155 /* Start DMA */ 156 sunxi_setbits(port_mmio + PORT_CMD, PORT_CMD_START); 157 } 158 159 static const struct ata_port_info ahci_sunxi_port_info = { 160 .flags = AHCI_FLAG_COMMON | ATA_FLAG_NCQ, 161 .pio_mask = ATA_PIO4, 162 .udma_mask = ATA_UDMA6, 163 .port_ops = &ahci_platform_ops, 164 }; 165 166 static int ahci_sunxi_probe(struct platform_device *pdev) 167 { 168 struct device *dev = &pdev->dev; 169 struct ahci_host_priv *hpriv; 170 unsigned long hflags; 171 int rc; 172 173 hpriv = ahci_platform_get_resources(pdev); 174 if (IS_ERR(hpriv)) 175 return PTR_ERR(hpriv); 176 177 hpriv->start_engine = ahci_sunxi_start_engine; 178 179 rc = ahci_platform_enable_resources(hpriv); 180 if (rc) 181 return rc; 182 183 rc = ahci_sunxi_phy_init(dev, hpriv->mmio); 184 if (rc) 185 goto disable_resources; 186 187 hflags = AHCI_HFLAG_32BIT_ONLY | AHCI_HFLAG_NO_MSI | 188 AHCI_HFLAG_NO_PMP | AHCI_HFLAG_YES_NCQ; 189 190 rc = ahci_platform_init_host(pdev, hpriv, &ahci_sunxi_port_info, 191 hflags, 0, 0); 192 if (rc) 193 goto disable_resources; 194 195 return 0; 196 197 disable_resources: 198 ahci_platform_disable_resources(hpriv); 199 return rc; 200 } 201 202 #ifdef CONFIG_PM_SLEEP 203 static int ahci_sunxi_resume(struct device *dev) 204 { 205 struct ata_host *host = dev_get_drvdata(dev); 206 struct ahci_host_priv *hpriv = host->private_data; 207 int rc; 208 209 rc = ahci_platform_enable_resources(hpriv); 210 if (rc) 211 return rc; 212 213 rc = ahci_sunxi_phy_init(dev, hpriv->mmio); 214 if (rc) 215 goto disable_resources; 216 217 rc = ahci_platform_resume_host(dev); 218 if (rc) 219 goto disable_resources; 220 221 return 0; 222 223 disable_resources: 224 ahci_platform_disable_resources(hpriv); 225 return rc; 226 } 227 #endif 228 229 static SIMPLE_DEV_PM_OPS(ahci_sunxi_pm_ops, ahci_platform_suspend, 230 ahci_sunxi_resume); 231 232 static const struct of_device_id ahci_sunxi_of_match[] = { 233 { .compatible = "allwinner,sun4i-a10-ahci", }, 234 { }, 235 }; 236 MODULE_DEVICE_TABLE(of, ahci_sunxi_of_match); 237 238 static struct platform_driver ahci_sunxi_driver = { 239 .probe = ahci_sunxi_probe, 240 .remove = ata_platform_remove_one, 241 .driver = { 242 .name = "ahci-sunxi", 243 .owner = THIS_MODULE, 244 .of_match_table = ahci_sunxi_of_match, 245 .pm = &ahci_sunxi_pm_ops, 246 }, 247 }; 248 module_platform_driver(ahci_sunxi_driver); 249 250 MODULE_DESCRIPTION("Allwinner sunxi AHCI SATA driver"); 251 MODULE_AUTHOR("Olliver Schinagl <oliver@schinagl.nl>"); 252 MODULE_LICENSE("GPL"); 253