| // SPDX-License-Identifier: GPL-2.0 | |
| /* | |
| * Serial Attached SCSI (SAS) Event processing | |
| * | |
| * Copyright (C) 2005 Adaptec, Inc. All rights reserved. | |
| * Copyright (C) 2005 Luben Tuikov <luben_tuikov@adaptec.com> | |
| */ | |
| #include <linux/export.h> | |
| #include <scsi/scsi_host.h> | |
| #include "sas_internal.h" | |
| bool sas_queue_work(struct sas_ha_struct *ha, struct sas_work *sw) | |
| { | |
| if (!test_bit(SAS_HA_REGISTERED, &ha->state)) | |
| return false; | |
| if (test_bit(SAS_HA_DRAINING, &ha->state)) { | |
| /* add it to the defer list, if not already pending */ | |
| if (list_empty(&sw->drain_node)) | |
| list_add_tail(&sw->drain_node, &ha->defer_q); | |
| return true; | |
| } | |
| return queue_work(ha->event_q, &sw->work); | |
| } | |
| static bool sas_queue_event(int event, struct sas_work *work, | |
| struct sas_ha_struct *ha) | |
| { | |
| unsigned long flags; | |
| bool rc; | |
| spin_lock_irqsave(&ha->lock, flags); | |
| rc = sas_queue_work(ha, work); | |
| spin_unlock_irqrestore(&ha->lock, flags); | |
| return rc; | |
| } | |
| void sas_queue_deferred_work(struct sas_ha_struct *ha) | |
| { | |
| struct sas_work *sw, *_sw; | |
| spin_lock_irq(&ha->lock); | |
| list_for_each_entry_safe(sw, _sw, &ha->defer_q, drain_node) { | |
| list_del_init(&sw->drain_node); | |
| if (!sas_queue_work(ha, sw)) { | |
| pm_runtime_put(ha->dev); | |
| sas_free_event(to_asd_sas_event(&sw->work)); | |
| } | |
| } | |
| spin_unlock_irq(&ha->lock); | |
| } | |
| void __sas_drain_work(struct sas_ha_struct *ha) | |
| { | |
| set_bit(SAS_HA_DRAINING, &ha->state); | |
| /* flush submitters */ | |
| spin_lock_irq(&ha->lock); | |
| spin_unlock_irq(&ha->lock); | |
| drain_workqueue(ha->event_q); | |
| drain_workqueue(ha->disco_q); | |
| clear_bit(SAS_HA_DRAINING, &ha->state); | |
| sas_queue_deferred_work(ha); | |
| } | |
| int sas_drain_work(struct sas_ha_struct *ha) | |
| { | |
| int err; | |
| err = mutex_lock_interruptible(&ha->drain_mutex); | |
| if (err) | |
| return err; | |
| if (test_bit(SAS_HA_REGISTERED, &ha->state)) | |
| __sas_drain_work(ha); | |
| mutex_unlock(&ha->drain_mutex); | |
| return 0; | |
| } | |
| EXPORT_SYMBOL_GPL(sas_drain_work); | |
| void sas_disable_revalidation(struct sas_ha_struct *ha) | |
| { | |
| mutex_lock(&ha->disco_mutex); | |
| set_bit(SAS_HA_ATA_EH_ACTIVE, &ha->state); | |
| mutex_unlock(&ha->disco_mutex); | |
| } | |
| void sas_enable_revalidation(struct sas_ha_struct *ha) | |
| { | |
| int i; | |
| mutex_lock(&ha->disco_mutex); | |
| clear_bit(SAS_HA_ATA_EH_ACTIVE, &ha->state); | |
| for (i = 0; i < ha->num_phys; i++) { | |
| struct asd_sas_port *port = ha->sas_port[i]; | |
| const int ev = DISCE_REVALIDATE_DOMAIN; | |
| struct sas_discovery *d = &port->disc; | |
| struct asd_sas_phy *sas_phy; | |
| if (!test_and_clear_bit(ev, &d->pending)) | |
| continue; | |
| spin_lock(&port->phy_list_lock); | |
| if (list_empty(&port->phy_list)) { | |
| spin_unlock(&port->phy_list_lock); | |
| continue; | |
| } | |
| sas_phy = container_of(port->phy_list.next, struct asd_sas_phy, | |
| port_phy_el); | |
| spin_unlock(&port->phy_list_lock); | |
| sas_notify_port_event(sas_phy, | |
| PORTE_BROADCAST_RCVD, GFP_KERNEL); | |
| } | |
| mutex_unlock(&ha->disco_mutex); | |
| } | |
| static void sas_port_event_worker(struct work_struct *work) | |
| { | |
| struct asd_sas_event *ev = to_asd_sas_event(work); | |
| struct asd_sas_phy *phy = ev->phy; | |
| struct sas_ha_struct *ha = phy->ha; | |
| sas_port_event_fns[ev->event](work); | |
| pm_runtime_put(ha->dev); | |
| sas_free_event(ev); | |
| } | |
| static void sas_phy_event_worker(struct work_struct *work) | |
| { | |
| struct asd_sas_event *ev = to_asd_sas_event(work); | |
| struct asd_sas_phy *phy = ev->phy; | |
| struct sas_ha_struct *ha = phy->ha; | |
| sas_phy_event_fns[ev->event](work); | |
| pm_runtime_put(ha->dev); | |
| sas_free_event(ev); | |
| } | |
| /* defer works of new phys during suspend */ | |
| static bool sas_defer_event(struct asd_sas_phy *phy, struct asd_sas_event *ev) | |
| { | |
| struct sas_ha_struct *ha = phy->ha; | |
| unsigned long flags; | |
| bool deferred = false; | |
| spin_lock_irqsave(&ha->lock, flags); | |
| if (test_bit(SAS_HA_RESUMING, &ha->state) && !phy->suspended) { | |
| struct sas_work *sw = &ev->work; | |
| list_add_tail(&sw->drain_node, &ha->defer_q); | |
| deferred = true; | |
| } | |
| spin_unlock_irqrestore(&ha->lock, flags); | |
| return deferred; | |
| } | |
| void sas_notify_port_event(struct asd_sas_phy *phy, enum port_event event, | |
| gfp_t gfp_flags) | |
| { | |
| struct sas_ha_struct *ha = phy->ha; | |
| struct asd_sas_event *ev; | |
| BUG_ON(event >= PORT_NUM_EVENTS); | |
| ev = sas_alloc_event(phy, gfp_flags); | |
| if (!ev) | |
| return; | |
| /* Call pm_runtime_put() with pairs in sas_port_event_worker() */ | |
| pm_runtime_get_noresume(ha->dev); | |
| INIT_SAS_EVENT(ev, sas_port_event_worker, phy, event); | |
| if (sas_defer_event(phy, ev)) | |
| return; | |
| if (!sas_queue_event(event, &ev->work, ha)) { | |
| pm_runtime_put(ha->dev); | |
| sas_free_event(ev); | |
| } | |
| } | |
| EXPORT_SYMBOL_GPL(sas_notify_port_event); | |
| void sas_notify_phy_event(struct asd_sas_phy *phy, enum phy_event event, | |
| gfp_t gfp_flags) | |
| { | |
| struct sas_ha_struct *ha = phy->ha; | |
| struct asd_sas_event *ev; | |
| BUG_ON(event >= PHY_NUM_EVENTS); | |
| ev = sas_alloc_event(phy, gfp_flags); | |
| if (!ev) | |
| return; | |
| /* Call pm_runtime_put() with pairs in sas_phy_event_worker() */ | |
| pm_runtime_get_noresume(ha->dev); | |
| INIT_SAS_EVENT(ev, sas_phy_event_worker, phy, event); | |
| if (sas_defer_event(phy, ev)) | |
| return; | |
| if (!sas_queue_event(event, &ev->work, ha)) { | |
| pm_runtime_put(ha->dev); | |
| sas_free_event(ev); | |
| } | |
| } | |
| EXPORT_SYMBOL_GPL(sas_notify_phy_event); |