> On Jul 29, 2022, at 6:16 AM, Sreekanth Reddy <sreekanth.reddy@xxxxxxxxxxxx> wrote: > > Added framework to register and unregister the > host and expander phys with SCSI Transport Layer (STL). > > Signed-off-by: Sreekanth Reddy <sreekanth.reddy@xxxxxxxxxxxx> > --- > drivers/scsi/mpi3mr/Makefile | 1 + > drivers/scsi/mpi3mr/mpi3mr.h | 93 ++++++ > drivers/scsi/mpi3mr/mpi3mr_transport.c | 430 +++++++++++++++++++++++++ > 3 files changed, 524 insertions(+) > create mode 100644 drivers/scsi/mpi3mr/mpi3mr_transport.c > > diff --git a/drivers/scsi/mpi3mr/Makefile b/drivers/scsi/mpi3mr/Makefile > index f5cdbe4..ef86ca4 100644 > --- a/drivers/scsi/mpi3mr/Makefile > +++ b/drivers/scsi/mpi3mr/Makefile > @@ -3,3 +3,4 @@ obj-m += mpi3mr.o > mpi3mr-y += mpi3mr_os.o \ > mpi3mr_fw.o \ > mpi3mr_app.o \ > + mpi3mr_transport.o > diff --git a/drivers/scsi/mpi3mr/mpi3mr.h b/drivers/scsi/mpi3mr/mpi3mr.h > index 542b462..006bc5d 100644 > --- a/drivers/scsi/mpi3mr/mpi3mr.h > +++ b/drivers/scsi/mpi3mr/mpi3mr.h > @@ -39,6 +39,7 @@ > #include <scsi/scsi_host.h> > #include <scsi/scsi_tcq.h> > #include <uapi/scsi/scsi_bsg_mpi3mr.h> > +#include <scsi/scsi_transport_sas.h> > > #include "mpi/mpi30_transport.h" > #include "mpi/mpi30_cnfg.h" > @@ -461,6 +462,98 @@ struct mpi3mr_throttle_group_info { > atomic_t pend_large_data_sz; > }; > > +/* HBA port flags */ > +#define MPI3MR_HBA_PORT_FLAG_DIRTY 0x01 > + > +/** > + * struct mpi3mr_hba_port - HBA's port information > + * @port_id: Port number > + * @flags: HBA port flags > + */ > +struct mpi3mr_hba_port { > + struct list_head list; > + u8 port_id; > + u8 flags; > +}; > + > +/** > + * struct mpi3mr_sas_port - Internal SAS port information > + * @port_list: List of ports belonging to a SAS node > + * @num_phys: Number of phys associated with port > + * @hba_port: HBA port entry > + * @remote_identify: Attached device identification > + * @rphy: SAS transport layer rphy object > + * @port: SAS transport layer port object > + * @phy_list: mpi3mr_sas_phy objects belonging to this port > + */ > +struct mpi3mr_sas_port { > + struct list_head port_list; > + u8 num_phys; > + struct mpi3mr_hba_port *hba_port; > + struct sas_identify remote_identify; > + struct sas_rphy *rphy; > + struct sas_port *port; > + struct list_head phy_list; > +}; > + > +/** > + * struct mpi3mr_sas_phy - Internal SAS Phy information > + * @port_siblings: List of phys belonging to a port > + * @identify: Phy identification > + * @remote_identify: Attached device identification > + * @phy: SAS transport layer Phy object > + * @phy_id: Unique phy id within a port > + * @handle: Firmware device handle for this phy > + * @attached_handle: Firmware device handle for attached device > + * @phy_belongs_to_port: Flag to indicate phy belongs to port > + @hba_port: HBA port entry > + */ > +struct mpi3mr_sas_phy { > + struct list_head port_siblings; > + struct sas_identify identify; > + struct sas_identify remote_identify; > + struct sas_phy *phy; > + u8 phy_id; > + u16 handle; > + u16 attached_handle; > + u8 phy_belongs_to_port; > + struct mpi3mr_hba_port *hba_port; > +}; > + > +/** > + * struct mpi3mr_sas_node - SAS host/expander information > + * @list: List of sas nodes in a controller > + * @parent_dev: Parent device class > + * @num_phys: Number phys belonging to sas_node > + * @sas_address: SAS address of sas_node > + * @handle: Firmware device handle for this sas_host/expander > + * @sas_address_parent: SAS address of parent expander or host > + * @enclosure_handle: Firmware handle of enclosure of this node > + * @device_info: Capabilities of this sas_host/expander > + * @non_responding: used to refresh the expander devices during reset > + * @host_node: Flag to indicate this is a host_node > + * @hba_port: HBA port entry > + * @phy: A list of phys that make up this sas_host/expander > + * @sas_port_list: List of internal ports of this node > + * @rphy: sas_rphy object of this expander node > + */ > +struct mpi3mr_sas_node { > + struct list_head list; > + struct device *parent_dev; > + u8 num_phys; > + u64 sas_address; > + u16 handle; > + u64 sas_address_parent; > + u16 enclosure_handle; > + u64 enclosure_logical_id; > + u8 non_responding; > + u8 host_node; > + struct mpi3mr_hba_port *hba_port; > + struct mpi3mr_sas_phy *phy; > + struct list_head sas_port_list; > + struct sas_rphy *rphy; > +}; > + > /** > * struct mpi3mr_enclosure_node - enclosure information > * @list: List of enclosures > diff --git a/drivers/scsi/mpi3mr/mpi3mr_transport.c b/drivers/scsi/mpi3mr/mpi3mr_transport.c > new file mode 100644 > index 0000000..989bf63 > --- /dev/null > +++ b/drivers/scsi/mpi3mr/mpi3mr_transport.c > @@ -0,0 +1,430 @@ > +// SPDX-License-Identifier: GPL-2.0-or-later > +/* > + * Driver for Broadcom MPI3 Storage Controllers > + * > + * Copyright (C) 2017-2022 Broadcom Inc. > + * (mailto: mpi3mr-linuxdrv.pdl@xxxxxxxxxxxx) > + * > + */ > + > +#include "mpi3mr.h" > + > +/** > + * mpi3mr_convert_phy_link_rate - > + * @link_rate: link rate as defined in the MPI header > + * > + * Convert link_rate from mpi format into sas_transport layer > + * form. > + * > + * Return: A valid SAS transport layer defined link rate > + */ > +static enum sas_linkrate mpi3mr_convert_phy_link_rate(u8 link_rate) > +{ > + enum sas_linkrate rc; > + > + switch (link_rate) { > + case MPI3_SAS_NEG_LINK_RATE_1_5: > + rc = SAS_LINK_RATE_1_5_GBPS; > + break; > + case MPI3_SAS_NEG_LINK_RATE_3_0: > + rc = SAS_LINK_RATE_3_0_GBPS; > + break; > + case MPI3_SAS_NEG_LINK_RATE_6_0: > + rc = SAS_LINK_RATE_6_0_GBPS; > + break; > + case MPI3_SAS_NEG_LINK_RATE_12_0: > + rc = SAS_LINK_RATE_12_0_GBPS; > + break; > + case MPI3_SAS_NEG_LINK_RATE_22_5: > + rc = SAS_LINK_RATE_12_0_GBPS; This should be SAS_LINK_RATE_22_5_GBPS > + break; > + case MPI3_SAS_NEG_LINK_RATE_PHY_DISABLED: > + rc = SAS_PHY_DISABLED; > + break; > + case MPI3_SAS_NEG_LINK_RATE_NEGOTIATION_FAILED: > + rc = SAS_LINK_RATE_FAILED; > + break; > + case MPI3_SAS_NEG_LINK_RATE_PORT_SELECTOR: > + rc = SAS_SATA_PORT_SELECTOR; > + break; > + case MPI3_SAS_NEG_LINK_RATE_SMP_RESET_IN_PROGRESS: > + rc = SAS_PHY_RESET_IN_PROGRESS; > + break; > + case MPI3_SAS_NEG_LINK_RATE_SATA_OOB_COMPLETE: > + case MPI3_SAS_NEG_LINK_RATE_UNKNOWN_LINK_RATE: > + default: > + rc = SAS_LINK_RATE_UNKNOWN; > + break; > + } > + return rc; > +} > + > +/** > + * mpi3mr_delete_sas_phy - Remove a single phy from port > + * @mrioc: Adapter instance reference > + * @mr_sas_port: Internal Port object > + * @mr_sas_phy: Internal Phy object > + * > + * Return: None. > + */ > +static void mpi3mr_delete_sas_phy(struct mpi3mr_ioc *mrioc, > + struct mpi3mr_sas_port *mr_sas_port, > + struct mpi3mr_sas_phy *mr_sas_phy) > +{ > + u64 sas_address = mr_sas_port->remote_identify.sas_address; > + > + dev_info(&mr_sas_phy->phy->dev, > + "remove: sas_address(0x%016llx), phy(%d)\n", > + (unsigned long long) sas_address, mr_sas_phy->phy_id); > + > + list_del(&mr_sas_phy->port_siblings); > + mr_sas_port->num_phys--; > + sas_port_delete_phy(mr_sas_port->port, mr_sas_phy->phy); > + mr_sas_phy->phy_belongs_to_port = 0; > +} > + > +/** > + * mpi3mr_add_sas_phy - Adding a single phy to a port > + * @mrioc: Adapter instance reference > + * @mr_sas_port: Internal Port object > + * @mr_sas_phy: Internal Phy object > + * > + * Return: None. > + */ > +static void mpi3mr_add_sas_phy(struct mpi3mr_ioc *mrioc, > + struct mpi3mr_sas_port *mr_sas_port, > + struct mpi3mr_sas_phy *mr_sas_phy) > +{ > + u64 sas_address = mr_sas_port->remote_identify.sas_address; > + > + dev_info(&mr_sas_phy->phy->dev, > + "add: sas_address(0x%016llx), phy(%d)\n", (unsigned long long) > + sas_address, mr_sas_phy->phy_id); > + > + list_add_tail(&mr_sas_phy->port_siblings, &mr_sas_port->phy_list); > + mr_sas_port->num_phys++; > + sas_port_add_phy(mr_sas_port->port, mr_sas_phy->phy); > + mr_sas_phy->phy_belongs_to_port = 1; > +} > + > +/** > + * mpi3mr_add_phy_to_an_existing_port - add phy to existing port > + * @mrioc: Adapter instance reference > + * @mr_sas_node: Internal sas node object (expander or host) > + * @mr_sas_phy: Internal Phy object * > + * @sas_address: SAS address of device/expander were phy needs > + * to be added to > + * @hba_port: HBA port entry > + * > + * Return: None. > + */ > +static void mpi3mr_add_phy_to_an_existing_port(struct mpi3mr_ioc *mrioc, > + struct mpi3mr_sas_node *mr_sas_node, struct mpi3mr_sas_phy *mr_sas_phy, > + u64 sas_address, struct mpi3mr_hba_port *hba_port) > +{ > + struct mpi3mr_sas_port *mr_sas_port; > + struct mpi3mr_sas_phy *srch_phy; > + > + if (mr_sas_phy->phy_belongs_to_port == 1) > + return; > + > + if (!hba_port) > + return; > + > + list_for_each_entry(mr_sas_port, &mr_sas_node->sas_port_list, > + port_list) { > + if (mr_sas_port->remote_identify.sas_address != > + sas_address) > + continue; > + if (mr_sas_port->hba_port != hba_port) > + continue; > + list_for_each_entry(srch_phy, &mr_sas_port->phy_list, > + port_siblings) { > + if (srch_phy == mr_sas_phy) > + return; > + } > + mpi3mr_add_sas_phy(mrioc, mr_sas_port, mr_sas_phy); > + return; > + } > +} > + > +/** > + * mpi3mr_del_phy_from_an_existing_port - del phy from a port > + * @mrioc: Adapter instance reference > + * @mr_sas_node: Internal sas node object (expander or host) > + * @mr_sas_phy: Internal Phy object > + * > + * Return: None. > + */ > +static void mpi3mr_del_phy_from_an_existing_port(struct mpi3mr_ioc *mrioc, > + struct mpi3mr_sas_node *mr_sas_node, struct mpi3mr_sas_phy *mr_sas_phy) > +{ > + struct mpi3mr_sas_port *mr_sas_port, *next; > + struct mpi3mr_sas_phy *srch_phy; > + > + if (mr_sas_phy->phy_belongs_to_port == 0) > + return; > + > + list_for_each_entry_safe(mr_sas_port, next, &mr_sas_node->sas_port_list, > + port_list) { > + list_for_each_entry(srch_phy, &mr_sas_port->phy_list, > + port_siblings) { > + if (srch_phy != mr_sas_phy) > + continue; > + mpi3mr_delete_sas_phy(mrioc, mr_sas_port, > + mr_sas_phy); > + return; > + } > + } > +} > + > +/** > + * mpi3mr_sas_port_sanity_check - sanity check while adding port > + * @mrioc: Adapter instance reference > + * @mr_sas_node: Internal sas node object (expander or host) > + * @sas_address: SAS address of device/expander > + * @hba_port: HBA port entry > + * > + * Verifies whether the Phys attached to a device with the given > + * SAS address already belongs to an existing sas port if so > + * will remove those phys from the sas port > + * > + * Return: None. > + */ > +static void mpi3mr_sas_port_sanity_check(struct mpi3mr_ioc *mrioc, > + struct mpi3mr_sas_node *mr_sas_node, u64 sas_address, > + struct mpi3mr_hba_port *hba_port) > +{ > + int i; > + > + for (i = 0; i < mr_sas_node->num_phys; i++) { > + if ((mr_sas_node->phy[i].remote_identify.sas_address != > + sas_address) || (mr_sas_node->phy[i].hba_port != hba_port)) > + continue; > + if (mr_sas_node->phy[i].phy_belongs_to_port == 1) > + mpi3mr_del_phy_from_an_existing_port(mrioc, > + mr_sas_node, &mr_sas_node->phy[i]); > + } > +} > + > +/** > + * mpi3mr_set_identify - set identify for phys and end devices > + * @mrioc: Adapter instance reference > + * @handle: Firmware device handle > + * @identify: SAS transport layer's identify info > + * > + * Populates sas identify info for a specific device. > + * > + * Return: 0 for success, non-zero for failure. > + */ > +static int mpi3mr_set_identify(struct mpi3mr_ioc *mrioc, u16 handle, > + struct sas_identify *identify) > +{ > + > + struct mpi3_device_page0 device_pg0; > + struct mpi3_device0_sas_sata_format *sasinf; > + u16 device_info; > + u16 ioc_status; > + > + if (mrioc->reset_in_progress) { > + ioc_err(mrioc, "%s: host reset in progress!\n", __func__); > + return -EFAULT; > + } > + > + if ((mpi3mr_cfg_get_dev_pg0(mrioc, &ioc_status, &device_pg0, > + sizeof(device_pg0), MPI3_DEVICE_PGAD_FORM_HANDLE, handle))) { > + ioc_err(mrioc, "%s: device page0 read failed\n", __func__); > + return -ENXIO; > + } > + > + if (ioc_status != MPI3_IOCSTATUS_SUCCESS) { > + ioc_err(mrioc, "device page read failed for handle(0x%04x), with ioc_status(0x%04x) failure at %s:%d/%s()!\n", > + handle, ioc_status, __FILE__, __LINE__, __func__); > + return -EIO; > + } > + > + memset(identify, 0, sizeof(struct sas_identify)); > + sasinf = &device_pg0.device_specific.sas_sata_format; > + device_info = le16_to_cpu(sasinf->device_info); > + > + /* sas_address */ > + identify->sas_address = le64_to_cpu(sasinf->sas_address); > + > + /* phy number of the parent device this device is linked to */ > + identify->phy_identifier = sasinf->phy_num; > + > + /* device_type */ > + switch (device_info & MPI3_SAS_DEVICE_INFO_DEVICE_TYPE_MASK) { > + case MPI3_SAS_DEVICE_INFO_DEVICE_TYPE_NO_DEVICE: > + identify->device_type = SAS_PHY_UNUSED; > + break; > + case MPI3_SAS_DEVICE_INFO_DEVICE_TYPE_END_DEVICE: > + identify->device_type = SAS_END_DEVICE; > + break; > + case MPI3_SAS_DEVICE_INFO_DEVICE_TYPE_EXPANDER: > + identify->device_type = SAS_EDGE_EXPANDER_DEVICE; > + break; > + } > + > + /* initiator_port_protocols */ > + if (device_info & MPI3_SAS_DEVICE_INFO_SSP_INITIATOR) > + identify->initiator_port_protocols |= SAS_PROTOCOL_SSP; > + /* MPI3.0 doesn't have define for SATA INIT so setting both here*/ > + if (device_info & MPI3_SAS_DEVICE_INFO_STP_INITIATOR) > + identify->initiator_port_protocols |= (SAS_PROTOCOL_STP | > + SAS_PROTOCOL_SATA); > + if (device_info & MPI3_SAS_DEVICE_INFO_SMP_INITIATOR) > + identify->initiator_port_protocols |= SAS_PROTOCOL_SMP; > + > + /* target_port_protocols */ > + if (device_info & MPI3_SAS_DEVICE_INFO_SSP_TARGET) > + identify->target_port_protocols |= SAS_PROTOCOL_SSP; > + /* MPI3.0 doesn't have define for STP Target so setting both here*/ > + if (device_info & MPI3_SAS_DEVICE_INFO_STP_SATA_TARGET) > + identify->target_port_protocols |= (SAS_PROTOCOL_STP | > + SAS_PROTOCOL_SATA); > + if (device_info & MPI3_SAS_DEVICE_INFO_SMP_TARGET) > + identify->target_port_protocols |= SAS_PROTOCOL_SMP; > + return 0; > +} > + > +/** > + * mpi3mr_add_host_phy - report sas_host phy to SAS transport > + * @mrioc: Adapter instance reference > + * @mr_sas_phy: Internal Phy object > + * @phy_pg0: SAS phy page 0 > + * @parent_dev: Prent device class object > + * > + * Return: 0 for success, non-zero for failure. > + */ > +static int mpi3mr_add_host_phy(struct mpi3mr_ioc *mrioc, > + struct mpi3mr_sas_phy *mr_sas_phy, struct mpi3_sas_phy_page0 phy_pg0, > + struct device *parent_dev) > +{ > + struct sas_phy *phy; > + int phy_index = mr_sas_phy->phy_id; > + > + > + INIT_LIST_HEAD(&mr_sas_phy->port_siblings); > + phy = sas_phy_alloc(parent_dev, phy_index); > + if (!phy) { > + ioc_err(mrioc, "failure at %s:%d/%s()!\n", > + __FILE__, __LINE__, __func__); > + return -1; > + } > + if ((mpi3mr_set_identify(mrioc, mr_sas_phy->handle, > + &mr_sas_phy->identify))) { > + ioc_err(mrioc, "failure at %s:%d/%s()!\n", > + __FILE__, __LINE__, __func__); > + sas_phy_free(phy); > + return -1; > + } > + phy->identify = mr_sas_phy->identify; > + mr_sas_phy->attached_handle = le16_to_cpu(phy_pg0.attached_dev_handle); > + if (mr_sas_phy->attached_handle) > + mpi3mr_set_identify(mrioc, mr_sas_phy->attached_handle, > + &mr_sas_phy->remote_identify); > + phy->identify.phy_identifier = mr_sas_phy->phy_id; > + phy->negotiated_linkrate = mpi3mr_convert_phy_link_rate( > + (phy_pg0.negotiated_link_rate & > + MPI3_SAS_NEG_LINK_RATE_LOGICAL_MASK) >> > + MPI3_SAS_NEG_LINK_RATE_LOGICAL_SHIFT); > + phy->minimum_linkrate_hw = mpi3mr_convert_phy_link_rate( > + phy_pg0.hw_link_rate & MPI3_SAS_HWRATE_MIN_RATE_MASK); > + phy->maximum_linkrate_hw = mpi3mr_convert_phy_link_rate( > + phy_pg0.hw_link_rate >> 4); > + phy->minimum_linkrate = mpi3mr_convert_phy_link_rate( > + phy_pg0.programmed_link_rate & MPI3_SAS_PRATE_MIN_RATE_MASK); > + phy->maximum_linkrate = mpi3mr_convert_phy_link_rate( > + phy_pg0.programmed_link_rate >> 4); > + phy->hostdata = mr_sas_phy->hba_port; > + > + if ((sas_phy_add(phy))) { > + ioc_err(mrioc, "failure at %s:%d/%s()!\n", > + __FILE__, __LINE__, __func__); > + sas_phy_free(phy); > + return -1; > + } > + if ((mrioc->logging_level & MPI3_DEBUG_TRANSPORT_INFO)) > + dev_info(&phy->dev, > + "add: handle(0x%04x), sas_address(0x%016llx)\n" > + "\tattached_handle(0x%04x), sas_address(0x%016llx)\n", > + mr_sas_phy->handle, (unsigned long long) > + mr_sas_phy->identify.sas_address, > + mr_sas_phy->attached_handle, > + (unsigned long long) > + mr_sas_phy->remote_identify.sas_address); > + mr_sas_phy->phy = phy; > + return 0; > +} > + > +/** > + * mpi3mr_add_expander_phy - report expander phy to transport > + * @mrioc: Adapter instance reference > + * @mr_sas_phy: Internal Phy object > + * @expander_pg1: SAS Expander page 1 > + * @parent_dev: Parent device class object > + * > + * Return: 0 for success, non-zero for failure. > + */ > +static int mpi3mr_add_expander_phy(struct mpi3mr_ioc *mrioc, > + struct mpi3mr_sas_phy *mr_sas_phy, > + struct mpi3_sas_expander_page1 expander_pg1, > + struct device *parent_dev) > +{ > + struct sas_phy *phy; > + int phy_index = mr_sas_phy->phy_id; > + > + INIT_LIST_HEAD(&mr_sas_phy->port_siblings); > + phy = sas_phy_alloc(parent_dev, phy_index); > + if (!phy) { > + ioc_err(mrioc, "failure at %s:%d/%s()!\n", > + __FILE__, __LINE__, __func__); > + return -1; > + } > + if ((mpi3mr_set_identify(mrioc, mr_sas_phy->handle, > + &mr_sas_phy->identify))) { > + ioc_err(mrioc, "failure at %s:%d/%s()!\n", > + __FILE__, __LINE__, __func__); > + sas_phy_free(phy); > + return -1; > + } > + phy->identify = mr_sas_phy->identify; > + mr_sas_phy->attached_handle = > + le16_to_cpu(expander_pg1.attached_dev_handle); > + if (mr_sas_phy->attached_handle) > + mpi3mr_set_identify(mrioc, mr_sas_phy->attached_handle, > + &mr_sas_phy->remote_identify); > + phy->identify.phy_identifier = mr_sas_phy->phy_id; > + phy->negotiated_linkrate = mpi3mr_convert_phy_link_rate( > + (expander_pg1.negotiated_link_rate & > + MPI3_SAS_NEG_LINK_RATE_LOGICAL_MASK) >> > + MPI3_SAS_NEG_LINK_RATE_LOGICAL_SHIFT); > + phy->minimum_linkrate_hw = mpi3mr_convert_phy_link_rate( > + expander_pg1.hw_link_rate & MPI3_SAS_HWRATE_MIN_RATE_MASK); > + phy->maximum_linkrate_hw = mpi3mr_convert_phy_link_rate( > + expander_pg1.hw_link_rate >> 4); > + phy->minimum_linkrate = mpi3mr_convert_phy_link_rate( > + expander_pg1.programmed_link_rate & MPI3_SAS_PRATE_MIN_RATE_MASK); > + phy->maximum_linkrate = mpi3mr_convert_phy_link_rate( > + expander_pg1.programmed_link_rate >> 4); > + phy->hostdata = mr_sas_phy->hba_port; > + > + if ((sas_phy_add(phy))) { > + ioc_err(mrioc, "failure at %s:%d/%s()!\n", > + __FILE__, __LINE__, __func__); > + sas_phy_free(phy); > + return -1; > + } > + if ((mrioc->logging_level & MPI3_DEBUG_TRANSPORT_INFO)) > + dev_info(&phy->dev, > + "add: handle(0x%04x), sas_address(0x%016llx)\n" > + "\tattached_handle(0x%04x), sas_address(0x%016llx)\n", > + mr_sas_phy->handle, (unsigned long long) > + mr_sas_phy->identify.sas_address, > + mr_sas_phy->attached_handle, > + (unsigned long long) > + mr_sas_phy->remote_identify.sas_address); > + mr_sas_phy->phy = phy; > + return 0; > +} > -- > 2.27.0 > -- Himanshu Madhani Oracle Linux Engineering