1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Serial Attached SCSI (SAS) Event processing 4 * 5 * Copyright (C) 2005 Adaptec, Inc. All rights reserved. 6 * Copyright (C) 2005 Luben Tuikov <luben_tuikov@adaptec.com> 7 */ 8 9 #include <linux/export.h> 10 #include <scsi/scsi_host.h> 11 #include "sas_internal.h" 12 13 int sas_queue_work(struct sas_ha_struct *ha, struct sas_work *sw) 14 { 15 /* it's added to the defer_q when draining so return succeed */ 16 int rc = 1; 17 18 if (!test_bit(SAS_HA_REGISTERED, &ha->state)) 19 return 0; 20 21 if (test_bit(SAS_HA_DRAINING, &ha->state)) { 22 /* add it to the defer list, if not already pending */ 23 if (list_empty(&sw->drain_node)) 24 list_add_tail(&sw->drain_node, &ha->defer_q); 25 } else 26 rc = queue_work(ha->event_q, &sw->work); 27 28 return rc; 29 } 30 31 static int sas_queue_event(int event, struct sas_work *work, 32 struct sas_ha_struct *ha) 33 { 34 unsigned long flags; 35 int rc; 36 37 spin_lock_irqsave(&ha->lock, flags); 38 rc = sas_queue_work(ha, work); 39 spin_unlock_irqrestore(&ha->lock, flags); 40 41 return rc; 42 } 43 44 45 void __sas_drain_work(struct sas_ha_struct *ha) 46 { 47 struct sas_work *sw, *_sw; 48 int ret; 49 50 set_bit(SAS_HA_DRAINING, &ha->state); 51 /* flush submitters */ 52 spin_lock_irq(&ha->lock); 53 spin_unlock_irq(&ha->lock); 54 55 drain_workqueue(ha->event_q); 56 drain_workqueue(ha->disco_q); 57 58 spin_lock_irq(&ha->lock); 59 clear_bit(SAS_HA_DRAINING, &ha->state); 60 list_for_each_entry_safe(sw, _sw, &ha->defer_q, drain_node) { 61 list_del_init(&sw->drain_node); 62 ret = sas_queue_work(ha, sw); 63 if (ret != 1) 64 sas_free_event(to_asd_sas_event(&sw->work)); 65 66 } 67 spin_unlock_irq(&ha->lock); 68 } 69 70 int sas_drain_work(struct sas_ha_struct *ha) 71 { 72 int err; 73 74 err = mutex_lock_interruptible(&ha->drain_mutex); 75 if (err) 76 return err; 77 if (test_bit(SAS_HA_REGISTERED, &ha->state)) 78 __sas_drain_work(ha); 79 mutex_unlock(&ha->drain_mutex); 80 81 return 0; 82 } 83 EXPORT_SYMBOL_GPL(sas_drain_work); 84 85 void sas_disable_revalidation(struct sas_ha_struct *ha) 86 { 87 mutex_lock(&ha->disco_mutex); 88 set_bit(SAS_HA_ATA_EH_ACTIVE, &ha->state); 89 mutex_unlock(&ha->disco_mutex); 90 } 91 92 void sas_enable_revalidation(struct sas_ha_struct *ha) 93 { 94 int i; 95 96 mutex_lock(&ha->disco_mutex); 97 clear_bit(SAS_HA_ATA_EH_ACTIVE, &ha->state); 98 for (i = 0; i < ha->num_phys; i++) { 99 struct asd_sas_port *port = ha->sas_port[i]; 100 const int ev = DISCE_REVALIDATE_DOMAIN; 101 struct sas_discovery *d = &port->disc; 102 struct asd_sas_phy *sas_phy; 103 104 if (!test_and_clear_bit(ev, &d->pending)) 105 continue; 106 107 if (list_empty(&port->phy_list)) 108 continue; 109 110 sas_phy = container_of(port->phy_list.next, struct asd_sas_phy, 111 port_phy_el); 112 ha->notify_port_event(sas_phy, PORTE_BROADCAST_RCVD); 113 } 114 mutex_unlock(&ha->disco_mutex); 115 } 116 117 118 static void sas_port_event_worker(struct work_struct *work) 119 { 120 struct asd_sas_event *ev = to_asd_sas_event(work); 121 122 sas_port_event_fns[ev->event](work); 123 sas_free_event(ev); 124 } 125 126 static void sas_phy_event_worker(struct work_struct *work) 127 { 128 struct asd_sas_event *ev = to_asd_sas_event(work); 129 130 sas_phy_event_fns[ev->event](work); 131 sas_free_event(ev); 132 } 133 134 static int sas_notify_port_event(struct asd_sas_phy *phy, enum port_event event) 135 { 136 struct asd_sas_event *ev; 137 struct sas_ha_struct *ha = phy->ha; 138 int ret; 139 140 BUG_ON(event >= PORT_NUM_EVENTS); 141 142 ev = sas_alloc_event(phy); 143 if (!ev) 144 return -ENOMEM; 145 146 INIT_SAS_EVENT(ev, sas_port_event_worker, phy, event); 147 148 ret = sas_queue_event(event, &ev->work, ha); 149 if (ret != 1) 150 sas_free_event(ev); 151 152 return ret; 153 } 154 155 int sas_notify_phy_event(struct asd_sas_phy *phy, enum phy_event event) 156 { 157 struct asd_sas_event *ev; 158 struct sas_ha_struct *ha = phy->ha; 159 int ret; 160 161 BUG_ON(event >= PHY_NUM_EVENTS); 162 163 ev = sas_alloc_event(phy); 164 if (!ev) 165 return -ENOMEM; 166 167 INIT_SAS_EVENT(ev, sas_phy_event_worker, phy, event); 168 169 ret = sas_queue_event(event, &ev->work, ha); 170 if (ret != 1) 171 sas_free_event(ev); 172 173 return ret; 174 } 175 176 int sas_init_events(struct sas_ha_struct *sas_ha) 177 { 178 sas_ha->notify_port_event = sas_notify_port_event; 179 sas_ha->notify_phy_event = sas_notify_phy_event; 180 181 return 0; 182 } 183