drivers/ata/ahci_seattle.c

   1 /*
   2  * AMD Seattle AHCI SATA driver
   3  *
   4  * Copyright (c) 2015, Advanced Micro Devices
   5  * Author: Brijesh Singh <brijesh.singh@amd.com>
   6  *
   7  * based on the AHCI SATA platform driver by Jeff Garzik and Anton Vorontsov
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  */
  18
  19 #include <linux/kernel.h>
  20 #include <linux/module.h>
  21 #include <linux/pm.h>
  22 #include <linux/device.h>
  23 #include <linux/of_device.h>
  24 #include <linux/platform_device.h>
  25 #include <linux/libata.h>
  26 #include <linux/ahci_platform.h>
  27 #include <linux/acpi.h>
  28 #include <linux/pci_ids.h>
  29 #include "ahci.h"
  30
  31 /* SGPIO Control Register definition
  32  *
  33  * Bit          Type            Description
  34  * 31           RW              OD7.2 (activity)
  35  * 30           RW              OD7.1 (locate)
  36  * 29           RW              OD7.0 (fault)
  37  * 28...8       RW              OD6.2...OD0.0 (3bits per port, 1 bit per LED)
  38  * 7            RO              SGPIO feature flag
  39  * 6:4          RO              Reserved
  40  * 3:0          RO              Number of ports (0 means no port supported)
  41  */
  42 #define ACTIVITY_BIT_POS(x)             (8 + (3 * x))
  43 #define LOCATE_BIT_POS(x)               (ACTIVITY_BIT_POS(x) + 1)
  44 #define FAULT_BIT_POS(x)                (LOCATE_BIT_POS(x) + 1)
  45
  46 #define ACTIVITY_MASK                   0x00010000
  47 #define LOCATE_MASK                     0x00080000
  48 #define FAULT_MASK                      0x00400000
  49
  50 #define DRV_NAME "ahci-seattle"
  51
  52 static ssize_t seattle_transmit_led_message(struct ata_port *ap, u32 state,
  53                                             ssize_t size);
  54
  55 struct seattle_plat_data {
  56         void __iomem *sgpio_ctrl;
  57 };
  58
  59 static struct ata_port_operations ahci_port_ops = {
  60         .inherits               = &ahci_ops,
  61 };
  62
  63 static const struct ata_port_info ahci_port_info = {
  64         .flags          = AHCI_FLAG_COMMON,
  65         .pio_mask       = ATA_PIO4,
  66         .udma_mask      = ATA_UDMA6,
  67         .port_ops       = &ahci_port_ops,
  68 };
  69
  70 static struct ata_port_operations ahci_seattle_ops = {
  71         .inherits               = &ahci_ops,
  72         .transmit_led_message   = seattle_transmit_led_message,
  73 };
  74
  75 static const struct ata_port_info ahci_port_seattle_info = {
  76         .flags          = AHCI_FLAG_COMMON | ATA_FLAG_EM | ATA_FLAG_SW_ACTIVITY,
  77         .link_flags     = ATA_LFLAG_SW_ACTIVITY,
  78         .pio_mask       = ATA_PIO4,
  79         .udma_mask      = ATA_UDMA6,
  80         .port_ops       = &ahci_seattle_ops,
  81 };
  82
  83 static struct scsi_host_template ahci_platform_sht = {
  84         AHCI_SHT(DRV_NAME),
  85 };
  86
  87 static ssize_t seattle_transmit_led_message(struct ata_port *ap, u32 state,
  88                                             ssize_t size)
  89 {
  90         struct ahci_host_priv *hpriv = ap->host->private_data;
  91         struct ahci_port_priv *pp = ap->private_data;
  92         struct seattle_plat_data *plat_data = hpriv->plat_data;
  93         unsigned long flags;
  94         int pmp;
  95         struct ahci_em_priv *emp;
  96         u32 val;
  97
  98         /* get the slot number from the message */
  99         pmp = (state & EM_MSG_LED_PMP_SLOT) >> 8;
 100         if (pmp >= EM_MAX_SLOTS)
 101                 return -EINVAL;
 102         emp = &pp->em_priv[pmp];
 103
 104         val = ioread32(plat_data->sgpio_ctrl);
 105         if (state & ACTIVITY_MASK)
 106                 val |= 1 << ACTIVITY_BIT_POS((ap->port_no));
 107         else
 108                 val &= ~(1 << ACTIVITY_BIT_POS((ap->port_no)));
 109
 110         if (state & LOCATE_MASK)
 111                 val |= 1 << LOCATE_BIT_POS((ap->port_no));
 112         else
 113                 val &= ~(1 << LOCATE_BIT_POS((ap->port_no)));
 114
 115         if (state & FAULT_MASK)
 116                 val |= 1 << FAULT_BIT_POS((ap->port_no));
 117         else
 118                 val &= ~(1 << FAULT_BIT_POS((ap->port_no)));
 119
 120         iowrite32(val, plat_data->sgpio_ctrl);
 121
 122         spin_lock_irqsave(ap->lock, flags);
 123
 124         /* save off new led state for port/slot */
 125         emp->led_state = state;
 126
 127         spin_unlock_irqrestore(ap->lock, flags);
 128
 129         return size;
 130 }
 131
 132 static const struct ata_port_info *ahci_seattle_get_port_info(
 133                 struct platform_device *pdev, struct ahci_host_priv *hpriv)
 134 {
 135         struct device *dev = &pdev->dev;
 136         struct seattle_plat_data *plat_data;
 137         u32 val;
 138
 139         plat_data = devm_kzalloc(dev, sizeof(*plat_data), GFP_KERNEL);
 140         if (!plat_data)
 141                 return &ahci_port_info;
 142
 143         plat_data->sgpio_ctrl = devm_ioremap_resource(dev,
 144                               platform_get_resource(pdev, IORESOURCE_MEM, 1));
 145         if (IS_ERR(plat_data->sgpio_ctrl))
 146                 return &ahci_port_info;
 147
 148         val = ioread32(plat_data->sgpio_ctrl);
 149
 150         if (!(val & 0xf))
 151                 return &ahci_port_info;
 152
 153         hpriv->em_loc = 0;
 154         hpriv->em_buf_sz = 4;
 155         hpriv->em_msg_type = EM_MSG_TYPE_LED;
 156         hpriv->plat_data = plat_data;
 157
 158         dev_info(dev, "SGPIO LED control is enabled.\n");
 159         return &ahci_port_seattle_info;
 160 }
 161
 162 static int ahci_seattle_probe(struct platform_device *pdev)
 163 {
 164         int rc;
 165         struct ahci_host_priv *hpriv;
 166
 167         hpriv = ahci_platform_get_resources(pdev, 0);
 168         if (IS_ERR(hpriv))
 169                 return PTR_ERR(hpriv);
 170
 171         rc = ahci_platform_enable_resources(hpriv);
 172         if (rc)
 173                 return rc;
 174
 175         rc = ahci_platform_init_host(pdev, hpriv,
 176                                      ahci_seattle_get_port_info(pdev, hpriv),
 177                                      &ahci_platform_sht);
 178         if (rc)
 179                 goto disable_resources;
 180
 181         return 0;
 182 disable_resources:
 183         ahci_platform_disable_resources(hpriv);
 184         return rc;
 185 }
 186
 187 static SIMPLE_DEV_PM_OPS(ahci_pm_ops, ahci_platform_suspend,
 188                          ahci_platform_resume);
 189
 190 static const struct acpi_device_id ahci_acpi_match[] = {
 191         { "AMDI0600", 0 },
 192         {}
 193 };
 194 MODULE_DEVICE_TABLE(acpi, ahci_acpi_match);
 195
 196 static struct platform_driver ahci_seattle_driver = {
 197         .probe = ahci_seattle_probe,
 198         .remove = ata_platform_remove_one,
 199         .driver = {
 200                 .name = DRV_NAME,
 201                 .acpi_match_table = ahci_acpi_match,
 202                 .pm = &ahci_pm_ops,
 203         },
 204 };
 205 module_platform_driver(ahci_seattle_driver);
 206
 207 MODULE_DESCRIPTION("Seattle AHCI SATA platform driver");
 208 MODULE_AUTHOR("Brijesh Singh <brijesh.singh@amd.com>");
 209 MODULE_LICENSE("GPL");
 210 MODULE_ALIAS("platform:" DRV_NAME);