1 files changed, 155 insertions, 6 deletions

diff --git a/drivers/ata/sata_highbank.c b/drivers/ata/sata_highbank.c
index c846fd3c5c09..d047d92a456f 100644
--- a/drivers/ata/sata_highbank.c
+++ b/drivers/ata/sata_highbank.c
@@ -33,6 +33,9 @@
 #include <linux/interrupt.h>
 #include <linux/delay.h>
 #include <linux/export.h>
+#include <linux/gpio.h>
+#include <linux/of_gpio.h>
+
 #include "ahci.h"
 
 #define CPHY_MAP(dev, addr) ((((dev) & 0x1f) << 7) | (((addr) >> 9) & 0x7f))
@@ -66,6 +69,146 @@ struct phy_lane_info {
 };
 static struct phy_lane_info port_data[CPHY_PORT_COUNT];
 
+static DEFINE_SPINLOCK(sgpio_lock);
+#define SCLOCK                          0
+#define SLOAD                           1
+#define SDATA                           2
+#define SGPIO_PINS                      3
+#define SGPIO_PORTS                     8
+
+/* can be cast as an ahci_host_priv for compatibility with most functions */
+struct ecx_plat_data {
+        u32             n_ports;
+        unsigned        sgpio_gpio[SGPIO_PINS];
+        u32             sgpio_pattern;
+        u32             port_to_sgpio[SGPIO_PORTS];
+};
+
+#define SGPIO_SIGNALS                   3
+#define ECX_ACTIVITY_BITS               0x300000
+#define ECX_ACTIVITY_SHIFT              2
+#define ECX_LOCATE_BITS                 0x80000
+#define ECX_LOCATE_SHIFT                1
+#define ECX_FAULT_BITS                  0x400000
+#define ECX_FAULT_SHIFT                 0
+static inline int sgpio_bit_shift(struct ecx_plat_data *pdata, u32 port,
+                                u32 shift)
+{
+        return 1 << (3 * pdata->port_to_sgpio[port] + shift);
+}
+
+static void ecx_parse_sgpio(struct ecx_plat_data *pdata, u32 port, u32 state)
+{
+        if (state & ECX_ACTIVITY_BITS)
+                pdata->sgpio_pattern |= sgpio_bit_shift(pdata, port,
+                                                ECX_ACTIVITY_SHIFT);
+        else
+                pdata->sgpio_pattern &= ~sgpio_bit_shift(pdata, port,
+                                                ECX_ACTIVITY_SHIFT);
+        if (state & ECX_LOCATE_BITS)
+                pdata->sgpio_pattern |= sgpio_bit_shift(pdata, port,
+                                                ECX_LOCATE_SHIFT);
+        else
+                pdata->sgpio_pattern &= ~sgpio_bit_shift(pdata, port,
+                                                ECX_LOCATE_SHIFT);
+        if (state & ECX_FAULT_BITS)
+                pdata->sgpio_pattern |= sgpio_bit_shift(pdata, port,
+                                                ECX_FAULT_SHIFT);
+        else
+                pdata->sgpio_pattern &= ~sgpio_bit_shift(pdata, port,
+                                                ECX_FAULT_SHIFT);
+}
+
+/*
+ * Tell the LED controller that the signal has changed by raising the clock
+ * line for 50 uS and then lowering it for 50 uS.
+ */
+static void ecx_led_cycle_clock(struct ecx_plat_data *pdata)
+{
+        gpio_set_value(pdata->sgpio_gpio[SCLOCK], 1);
+        udelay(50);
+        gpio_set_value(pdata->sgpio_gpio[SCLOCK], 0);
+        udelay(50);
+}
+
+static ssize_t ecx_transmit_led_message(struct ata_port *ap, u32 state,
+                                        ssize_t size)
+{
+        struct ahci_host_priv *hpriv =  ap->host->private_data;
+        struct ecx_plat_data *pdata = (struct ecx_plat_data *) hpriv->plat_data;
+        struct ahci_port_priv *pp = ap->private_data;
+        unsigned long flags;
+        int pmp, i;
+        struct ahci_em_priv *emp;
+        u32 sgpio_out;
+
+        /* get the slot number from the message */
+        pmp = (state & EM_MSG_LED_PMP_SLOT) >> 8;
+        if (pmp < EM_MAX_SLOTS)
+                emp = &pp->em_priv[pmp];
+        else
+                return -EINVAL;
+
+        if (!(hpriv->em_msg_type & EM_MSG_TYPE_LED))
+                return size;
+
+        spin_lock_irqsave(&sgpio_lock, flags);
+        ecx_parse_sgpio(pdata, ap->port_no, state);
+        sgpio_out = pdata->sgpio_pattern;
+        gpio_set_value(pdata->sgpio_gpio[SLOAD], 1);
+        ecx_led_cycle_clock(pdata);
+        gpio_set_value(pdata->sgpio_gpio[SLOAD], 0);
+        /*
+         * bit-bang out the SGPIO pattern, by consuming a bit and then
+         * clocking it out.
+         */
+        for (i = 0; i < (SGPIO_SIGNALS * pdata->n_ports); i++) {
+                gpio_set_value(pdata->sgpio_gpio[SDATA], sgpio_out & 1);
+                sgpio_out >>= 1;
+                ecx_led_cycle_clock(pdata);
+        }
+
+        /* save off new led state for port/slot */
+        emp->led_state = state;
+
+        spin_unlock_irqrestore(&sgpio_lock, flags);
+        return size;
+}
+
+static void highbank_set_em_messages(struct device *dev,
+                                        struct ahci_host_priv *hpriv,
+                                        struct ata_port_info *pi)
+{
+        struct device_node *np = dev->of_node;
+        struct ecx_plat_data *pdata = hpriv->plat_data;
+        int i;
+        int err;
+
+        for (i = 0; i < SGPIO_PINS; i++) {
+                err = of_get_named_gpio(np, "calxeda,sgpio-gpio", i);
+                if (IS_ERR_VALUE(err))
+                        return;
+
+                pdata->sgpio_gpio[i] = err;
+                err = gpio_request(pdata->sgpio_gpio[i], "CX SGPIO");
+                if (err) {
+                        pr_err("sata_highbank gpio_request %d failed: %d\n",
+                                        i, err);
+                        return;
+                }
+                gpio_direction_output(pdata->sgpio_gpio[i], 1);
+        }
+        of_property_read_u32_array(np, "calxeda,led-order",
+                                                pdata->port_to_sgpio,
+                                                pdata->n_ports);
+
+        /* store em_loc */
+        hpriv->em_loc = 0;
+        hpriv->em_buf_sz = 4;
+        hpriv->em_msg_type = EM_MSG_TYPE_LED;
+        pi->flags |= ATA_FLAG_EM | ATA_FLAG_SW_ACTIVITY;
+}
+
 static u32 __combo_phy_reg_read(u8 sata_port, u32 addr)
 {
         u32 data;
@@ -257,6 +400,7 @@ static int ahci_highbank_hardreset(struct ata_link *link, unsigned int *class,
 static struct ata_port_operations ahci_highbank_ops = {
         .inherits               = &ahci_ops,
         .hardreset              = ahci_highbank_hardreset,
+        .transmit_led_message   = ecx_transmit_led_message,
 };
 
 static const struct ata_port_info ahci_highbank_port_info = {
@@ -280,12 +424,13 @@ static int ahci_highbank_probe(struct platform_device *pdev)
 {
         struct device *dev = &pdev->dev;
         struct ahci_host_priv *hpriv;
+        struct ecx_plat_data *pdata;
         struct ata_host *host;
         struct resource *mem;
         int irq;
-        int n_ports;
         int i;
         int rc;
+        u32 n_ports;
         struct ata_port_info pi = ahci_highbank_port_info;
         const struct ata_port_info *ppi[] = { &pi, NULL };
 
@@ -306,6 +451,11 @@ static int ahci_highbank_probe(struct platform_device *pdev)
                 dev_err(dev, "can't alloc ahci_host_priv\n");
                 return -ENOMEM;
         }
+        pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
+        if (!pdata) {
+                dev_err(dev, "can't alloc ecx_plat_data\n");
+                return -ENOMEM;
+        }
 
         hpriv->flags |= (unsigned long)pi.private_data;
 
@@ -329,8 +479,6 @@ static int ahci_highbank_probe(struct platform_device *pdev)
         if (hpriv->cap & HOST_CAP_PMP)
                 pi.flags |= ATA_FLAG_PMP;
 
-        ahci_set_em_messages(hpriv, &pi);
-
         /* CAP.NP sometimes indicate the index of the last enabled
          * port, at other times, that of the last possible port, so
          * determining the maximum port number requires looking at
@@ -338,6 +486,10 @@ static int ahci_highbank_probe(struct platform_device *pdev)
          */
         n_ports = max(ahci_nr_ports(hpriv->cap), fls(hpriv->port_map));
 
+        pdata->n_ports = n_ports;
+        hpriv->plat_data = pdata;
+        highbank_set_em_messages(dev, hpriv, &pi);
+
         host = ata_host_alloc_pinfo(dev, ppi, n_ports);
         if (!host) {
                 rc = -ENOMEM;
@@ -349,9 +501,6 @@ static int ahci_highbank_probe(struct platform_device *pdev)
         if (!(hpriv->cap & HOST_CAP_SSS) || ahci_ignore_sss)
                 host->flags |= ATA_HOST_PARALLEL_SCAN;
 
-        if (pi.flags & ATA_FLAG_EM)
-                ahci_reset_em(host);
-
         for (i = 0; i < host->n_ports; i++) {
                 struct ata_port *ap = host->ports[i];