[SCSI] qla2xxx: Implement beacon support for ISP83xx.

Signed-off-by: Giridhar Malavali <giridhar.malavali@qlogic.com>
Signed-off-by: Chad Dupuis <chad.dupuis@qlogic.com>
Signed-off-by: James Bottomley <JBottomley@Parallels.com>

1 files changed, 35 insertions, 6 deletions

diff --git a/drivers/scsi/qla2xxx/qla_sup.c b/drivers/scsi/qla2xxx/qla_sup.c
index 41ed7af79f42..32fdc2a66dd1 100644
--- a/drivers/scsi/qla2xxx/qla_sup.c
+++ b/drivers/scsi/qla2xxx/qla_sup.c
@@ -1662,6 +1662,23 @@ qla24xx_beacon_blink(struct scsi_qla_host *vha)
         spin_unlock_irqrestore(&ha->hardware_lock, flags);
 }
 
+static uint32_t
+qla83xx_select_led_port(struct qla_hw_data *ha)
+{
+        uint32_t led_select_value = 0;
+
+        if (!IS_QLA83XX(ha))
+                goto out;
+
+        if (ha->flags.port0)
+                led_select_value = QLA83XX_LED_PORT0;
+        else
+                led_select_value = QLA83XX_LED_PORT1;
+
+out:
+        return led_select_value;
+}
+
 void
 qla83xx_beacon_blink(struct scsi_qla_host *vha)
 {
@@ -1669,22 +1686,34 @@ qla83xx_beacon_blink(struct scsi_qla_host *vha)
         struct qla_hw_data *ha = vha->hw;
         uint16_t led_cfg[6];
         uint16_t orig_led_cfg[6];
+        uint32_t led_10_value, led_43_value;
 
         if (!IS_QLA83XX(ha) && !IS_QLA81XX(ha))
                 return;
 
-        if (IS_QLA2031(ha) && ha->beacon_blink_led) {
-                if (ha->flags.port0)
-                        led_select_value = QLA83XX_LED_PORT0;
-                else
-                        led_select_value = QLA83XX_LED_PORT1;
+        if (!ha->beacon_blink_led)
+                return;
+
+        if (IS_QLA2031(ha)) {
+                led_select_value = qla83xx_select_led_port(ha);
 
                 qla83xx_wr_reg(vha, led_select_value, 0x40002000);
                 qla83xx_wr_reg(vha, led_select_value + 4, 0x40002000);
                 msleep(1000);
                 qla83xx_wr_reg(vha, led_select_value, 0x40004000);
                 qla83xx_wr_reg(vha, led_select_value + 4, 0x40004000);
-        } else if ((IS_QLA8031(ha) || IS_QLA81XX(ha)) && ha->beacon_blink_led) {
+        } else if (IS_QLA8031(ha)) {
+                led_select_value = qla83xx_select_led_port(ha);
+
+                qla83xx_rd_reg(vha, led_select_value, &led_10_value);
+                qla83xx_rd_reg(vha, led_select_value + 0x10, &led_43_value);
+                qla83xx_wr_reg(vha, led_select_value, 0x01f44000);
+                msleep(500);
+                qla83xx_wr_reg(vha, led_select_value, 0x400001f4);
+                msleep(1000);
+                qla83xx_wr_reg(vha, led_select_value, led_10_value);
+                qla83xx_wr_reg(vha, led_select_value + 0x10, led_43_value);
+        } else if (IS_QLA81XX(ha)) {
                 int rval;
 
                 /* Save Current */