[SCSI] mpt2sas: Added expander phy control support (b8d7d7bb) · Commits · e / devices / android_kernel_xiaomi_nabu

drivers/scsi/mpt2sas/mpt2sas_transport.c

+275 −30

Original line number	Original line	Diff line number	Diff line
	@@ -940,16 +940,6 @@ rphy_to_ioc(struct sas_rphy *rphy)
	return shost_priv(shost);		return shost_priv(shost);
	}		}

	static struct _sas_phy *
	_transport_find_local_phy(struct MPT2SAS_ADAPTER ioc, struct sas_phy phy)
	{
	int i;

	for (i = 0; i < ioc->sas_hba.num_phys; i++)
	if (ioc->sas_hba.phy[i].phy == phy)
	return(&ioc->sas_hba.phy[i]);
	return NULL;
	}

	/* report phy error log structure */		/* report phy error log structure */
	struct phy_error_log_request{		struct phy_error_log_request{
	@@ -1270,32 +1260,260 @@ _transport_get_bay_identifier(struct sas_rphy *rphy)
	return sas_device->slot;		return sas_device->slot;
	}		}

			/* phy control request structure */
			struct phy_control_request{
			u8 smp_frame_type; /* 0x40 */
			u8 function; /* 0x91 */
			u8 allocated_response_length;
			u8 request_length; /* 0x09 */
			u16 expander_change_count;
			u8 reserved_1[3];
			u8 phy_identifier;
			u8 phy_operation;
			u8 reserved_2[13];
			u64 attached_device_name;
			u8 programmed_min_physical_link_rate;
			u8 programmed_max_physical_link_rate;
			u8 reserved_3[6];
			};

			/* phy control reply structure */
			struct phy_control_reply{
			u8 smp_frame_type; /* 0x41 */
			u8 function; /* 0x11 */
			u8 function_result;
			u8 response_length;
			};

			#define SMP_PHY_CONTROL_LINK_RESET (0x01)
			#define SMP_PHY_CONTROL_HARD_RESET (0x02)
			#define SMP_PHY_CONTROL_DISABLE (0x03)

			/**
			* _transport_expander_phy_control - expander phy control
			* @ioc: per adapter object
			* @phy: The sas phy object
			*
			* Returns 0 for success, non-zero for failure.
			*
			*/
			static int
			_transport_expander_phy_control(struct MPT2SAS_ADAPTER *ioc,
			struct sas_phy *phy, u8 phy_operation)
			{
			Mpi2SmpPassthroughRequest_t *mpi_request;
			Mpi2SmpPassthroughReply_t *mpi_reply;
			struct phy_control_request *phy_control_request;
			struct phy_control_reply *phy_control_reply;
			int rc;
			u16 smid;
			u32 ioc_state;
			unsigned long timeleft;
			void *psge;
			u32 sgl_flags;
			u8 issue_reset = 0;
			void *data_out = NULL;
			dma_addr_t data_out_dma;
			u32 sz;
			u64 *sas_address_le;
			u16 wait_state_count;

			if (ioc->shost_recovery) {
			printk(MPT2SAS_INFO_FMT "%s: host reset in progress!\n",
			__func__, ioc->name);
			return -EFAULT;
			}

			mutex_lock(&ioc->transport_cmds.mutex);

			if (ioc->transport_cmds.status != MPT2_CMD_NOT_USED) {
			printk(MPT2SAS_ERR_FMT "%s: transport_cmds in use\n",
			ioc->name, __func__);
			rc = -EAGAIN;
			goto out;
			}
			ioc->transport_cmds.status = MPT2_CMD_PENDING;

			wait_state_count = 0;
			ioc_state = mpt2sas_base_get_iocstate(ioc, 1);
			while (ioc_state != MPI2_IOC_STATE_OPERATIONAL) {
			if (wait_state_count++ == 10) {
			printk(MPT2SAS_ERR_FMT
			"%s: failed due to ioc not operational\n",
			ioc->name, __func__);
			rc = -EFAULT;
			goto out;
			}
			ssleep(1);
			ioc_state = mpt2sas_base_get_iocstate(ioc, 1);
			printk(MPT2SAS_INFO_FMT "%s: waiting for "
			"operational state(count=%d)\n", ioc->name,
			__func__, wait_state_count);
			}
			if (wait_state_count)
			printk(MPT2SAS_INFO_FMT "%s: ioc is operational\n",
			ioc->name, __func__);

			smid = mpt2sas_base_get_smid(ioc, ioc->transport_cb_idx);
			if (!smid) {
			printk(MPT2SAS_ERR_FMT "%s: failed obtaining a smid\n",
			ioc->name, __func__);
			rc = -EAGAIN;
			goto out;
			}

			mpi_request = mpt2sas_base_get_msg_frame(ioc, smid);
			ioc->transport_cmds.smid = smid;

			sz = sizeof(struct phy_control_request) +
			sizeof(struct phy_control_reply);
			data_out = pci_alloc_consistent(ioc->pdev, sz, &data_out_dma);
			if (!data_out) {
			printk(KERN_ERR "failure at %s:%d/%s()!\n", __FILE__,
			__LINE__, __func__);
			rc = -ENOMEM;
			mpt2sas_base_free_smid(ioc, smid);
			goto out;
			}

			rc = -EINVAL;
			memset(data_out, 0, sz);
			phy_control_request = data_out;
			phy_control_request->smp_frame_type = 0x40;
			phy_control_request->function = 0x91;
			phy_control_request->request_length = 9;
			phy_control_request->allocated_response_length = 0;
			phy_control_request->phy_identifier = phy->number;
			phy_control_request->phy_operation = phy_operation;
			phy_control_request->programmed_min_physical_link_rate =
			phy->minimum_linkrate << 4;
			phy_control_request->programmed_max_physical_link_rate =
			phy->maximum_linkrate << 4;

			memset(mpi_request, 0, sizeof(Mpi2SmpPassthroughRequest_t));
			mpi_request->Function = MPI2_FUNCTION_SMP_PASSTHROUGH;
			mpi_request->PhysicalPort = 0xFF;
			mpi_request->VF_ID = 0; /* TODO */
			mpi_request->VP_ID = 0;
			sas_address_le = (u64 *)&mpi_request->SASAddress;
			*sas_address_le = cpu_to_le64(phy->identify.sas_address);
			mpi_request->RequestDataLength =
			cpu_to_le16(sizeof(struct phy_error_log_request));
			psge = &mpi_request->SGL;

			/* WRITE sgel first */
			sgl_flags = (MPI2_SGE_FLAGS_SIMPLE_ELEMENT \|
			MPI2_SGE_FLAGS_END_OF_BUFFER \| MPI2_SGE_FLAGS_HOST_TO_IOC);
			sgl_flags = sgl_flags << MPI2_SGE_FLAGS_SHIFT;
			ioc->base_add_sg_single(psge, sgl_flags \|
			sizeof(struct phy_control_request), data_out_dma);

			/* incr sgel */
			psge += ioc->sge_size;

			/* READ sgel last */
			sgl_flags = (MPI2_SGE_FLAGS_SIMPLE_ELEMENT \|
			MPI2_SGE_FLAGS_LAST_ELEMENT \| MPI2_SGE_FLAGS_END_OF_BUFFER \|
			MPI2_SGE_FLAGS_END_OF_LIST);
			sgl_flags = sgl_flags << MPI2_SGE_FLAGS_SHIFT;
			ioc->base_add_sg_single(psge, sgl_flags \|
			sizeof(struct phy_control_reply), data_out_dma +
			sizeof(struct phy_control_request));

			dtransportprintk(ioc, printk(MPT2SAS_INFO_FMT "phy_control - "
			"send to sas_addr(0x%016llx), phy(%d), opcode(%d)\n", ioc->name,
			(unsigned long long)phy->identify.sas_address, phy->number,
			phy_operation));
			mpt2sas_base_put_smid_default(ioc, smid);
			init_completion(&ioc->transport_cmds.done);
			timeleft = wait_for_completion_timeout(&ioc->transport_cmds.done,
			10*HZ);

			if (!(ioc->transport_cmds.status & MPT2_CMD_COMPLETE)) {
			printk(MPT2SAS_ERR_FMT "%s: timeout\n",
			ioc->name, __func__);
			_debug_dump_mf(mpi_request,
			sizeof(Mpi2SmpPassthroughRequest_t)/4);
			if (!(ioc->transport_cmds.status & MPT2_CMD_RESET))
			issue_reset = 1;
			goto issue_host_reset;
			}

			dtransportprintk(ioc, printk(MPT2SAS_INFO_FMT "phy_control - "
			"complete\n", ioc->name));

			if (ioc->transport_cmds.status & MPT2_CMD_REPLY_VALID) {

			mpi_reply = ioc->transport_cmds.reply;

			dtransportprintk(ioc, printk(MPT2SAS_INFO_FMT
			"phy_control - reply data transfer size(%d)\n",
			ioc->name, le16_to_cpu(mpi_reply->ResponseDataLength)));

			if (le16_to_cpu(mpi_reply->ResponseDataLength) !=
			sizeof(struct phy_control_reply))
			goto out;

			phy_control_reply = data_out +
			sizeof(struct phy_control_request);

			dtransportprintk(ioc, printk(MPT2SAS_INFO_FMT
			"phy_control - function_result(%d)\n",
			ioc->name, phy_control_reply->function_result));

			rc = 0;
			} else
			dtransportprintk(ioc, printk(MPT2SAS_INFO_FMT
			"phy_control - no reply\n", ioc->name));

			issue_host_reset:
			if (issue_reset)
			mpt2sas_base_hard_reset_handler(ioc, CAN_SLEEP,
			FORCE_BIG_HAMMER);
			out:
			ioc->transport_cmds.status = MPT2_CMD_NOT_USED;
			if (data_out)
			pci_free_consistent(ioc->pdev, sz, data_out, data_out_dma);

			mutex_unlock(&ioc->transport_cmds.mutex);
			return rc;
			}

	/**		/**
	* _transport_phy_reset -		* _transport_phy_reset -
	* @phy: The sas phy object		* @phy: The sas phy object
	* @hard_reset:		* @hard_reset:
	*		*
	* Only support sas_host direct attached phys.
	* Returns 0 for success, non-zero for failure.		* Returns 0 for success, non-zero for failure.
	*/		*/
	static int		static int
	_transport_phy_reset(struct sas_phy *phy, int hard_reset)		_transport_phy_reset(struct sas_phy *phy, int hard_reset)
	{		{
	struct MPT2SAS_ADAPTER *ioc = phy_to_ioc(phy);		struct MPT2SAS_ADAPTER *ioc = phy_to_ioc(phy);
	struct _sas_phy *mpt2sas_phy;
	Mpi2SasIoUnitControlReply_t mpi_reply;		Mpi2SasIoUnitControlReply_t mpi_reply;
	Mpi2SasIoUnitControlRequest_t mpi_request;		Mpi2SasIoUnitControlRequest_t mpi_request;
			unsigned long flags;

	mpt2sas_phy = _transport_find_local_phy(ioc, phy);		spin_lock_irqsave(&ioc->sas_node_lock, flags);
			if (_transport_sas_node_find_by_sas_address(ioc,
	if (!mpt2sas_phy) /* this phy not on sas_host */		phy->identify.sas_address) == NULL) {
			spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
	return -EINVAL;		return -EINVAL;
			}
			spin_unlock_irqrestore(&ioc->sas_node_lock, flags);

			/* handle expander phys */
			if (phy->identify.sas_address != ioc->sas_hba.sas_address)
			return _transport_expander_phy_control(ioc, phy,
			(hard_reset == 1) ? SMP_PHY_CONTROL_HARD_RESET :
			SMP_PHY_CONTROL_LINK_RESET);

			/* handle hba phys */
	memset(&mpi_request, 0, sizeof(Mpi2SasIoUnitControlReply_t));		memset(&mpi_request, 0, sizeof(Mpi2SasIoUnitControlReply_t));
	mpi_request.Function = MPI2_FUNCTION_SAS_IO_UNIT_CONTROL;		mpi_request.Function = MPI2_FUNCTION_SAS_IO_UNIT_CONTROL;
	mpi_request.Operation = hard_reset ?		mpi_request.Operation = hard_reset ?
	MPI2_SAS_OP_PHY_HARD_RESET : MPI2_SAS_OP_PHY_LINK_RESET;		MPI2_SAS_OP_PHY_HARD_RESET : MPI2_SAS_OP_PHY_LINK_RESET;
	mpi_request.PhyNum = mpt2sas_phy->phy_id;		mpi_request.PhyNum = phy->number;

	if ((mpt2sas_base_sas_iounit_control(ioc, &mpi_reply, &mpi_request))) {		if ((mpt2sas_base_sas_iounit_control(ioc, &mpi_reply, &mpi_request))) {
	printk(MPT2SAS_ERR_FMT "failure at %s:%d/%s()!\n",		printk(MPT2SAS_ERR_FMT "failure at %s:%d/%s()!\n",
	@@ -1306,8 +1524,7 @@ _transport_phy_reset(struct sas_phy *phy, int hard_reset)
	if (mpi_reply.IOCStatus \|\| mpi_reply.IOCLogInfo)		if (mpi_reply.IOCStatus \|\| mpi_reply.IOCLogInfo)
	printk(MPT2SAS_INFO_FMT "phy(%d), ioc_status"		printk(MPT2SAS_INFO_FMT "phy(%d), ioc_status"
	"(0x%04x), loginfo(0x%08x)\n", ioc->name,		"(0x%04x), loginfo(0x%08x)\n", ioc->name,
	mpt2sas_phy->phy_id,		phy->number, le16_to_cpu(mpi_reply.IOCStatus),
	le16_to_cpu(mpi_reply.IOCStatus),
	le32_to_cpu(mpi_reply.IOCLogInfo));		le32_to_cpu(mpi_reply.IOCLogInfo));

	return 0;		return 0;
	@@ -1325,17 +1542,28 @@ static int
	_transport_phy_enable(struct sas_phy *phy, int enable)		_transport_phy_enable(struct sas_phy *phy, int enable)
	{		{
	struct MPT2SAS_ADAPTER *ioc = phy_to_ioc(phy);		struct MPT2SAS_ADAPTER *ioc = phy_to_ioc(phy);
	struct _sas_phy *mpt2sas_phy;
	Mpi2SasIOUnitPage1_t *sas_iounit_pg1 = NULL;		Mpi2SasIOUnitPage1_t *sas_iounit_pg1 = NULL;
	Mpi2ConfigReply_t mpi_reply;		Mpi2ConfigReply_t mpi_reply;
	u16 ioc_status;		u16 ioc_status;
	u16 sz;		u16 sz;
	int rc = 0;		int rc = 0;
			unsigned long flags;

	mpt2sas_phy = _transport_find_local_phy(ioc, phy);		spin_lock_irqsave(&ioc->sas_node_lock, flags);
			if (_transport_sas_node_find_by_sas_address(ioc,
	if (!mpt2sas_phy) /* this phy not on sas_host */		phy->identify.sas_address) == NULL) {
			spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
	return -EINVAL;		return -EINVAL;
			}
			spin_unlock_irqrestore(&ioc->sas_node_lock, flags);

			/* handle expander phys */
			if (phy->identify.sas_address != ioc->sas_hba.sas_address)
			return _transport_expander_phy_control(ioc, phy,
			(enable == 1) ? SMP_PHY_CONTROL_LINK_RESET :
			SMP_PHY_CONTROL_DISABLE);

			/* handle hba phys */

	/* sas_iounit page 1 */		/* sas_iounit page 1 */
	sz = offsetof(Mpi2SasIOUnitPage1_t, PhyData) + (ioc->sas_hba.num_phys *		sz = offsetof(Mpi2SasIOUnitPage1_t, PhyData) + (ioc->sas_hba.num_phys *
	@@ -1364,14 +1592,18 @@ _transport_phy_enable(struct sas_phy *phy, int enable)
	}		}

	if (enable)		if (enable)
	sas_iounit_pg1->PhyData[mpt2sas_phy->phy_id].PhyFlags		sas_iounit_pg1->PhyData[phy->number].PhyFlags
	&= ~MPI2_SASIOUNIT1_PHYFLAGS_PHY_DISABLE;		&= ~MPI2_SASIOUNIT1_PHYFLAGS_PHY_DISABLE;
	else		else
	sas_iounit_pg1->PhyData[mpt2sas_phy->phy_id].PhyFlags		sas_iounit_pg1->PhyData[phy->number].PhyFlags
	\|= MPI2_SASIOUNIT1_PHYFLAGS_PHY_DISABLE;		\|= MPI2_SASIOUNIT1_PHYFLAGS_PHY_DISABLE;

	mpt2sas_config_set_sas_iounit_pg1(ioc, &mpi_reply, sas_iounit_pg1, sz);		mpt2sas_config_set_sas_iounit_pg1(ioc, &mpi_reply, sas_iounit_pg1, sz);

			/* link reset */
			if (enable)
			_transport_phy_reset(phy, 0);

	out:		out:
	kfree(sas_iounit_pg1);		kfree(sas_iounit_pg1);
	return rc;		return rc;
	@@ -1389,7 +1621,6 @@ static int
	_transport_phy_speed(struct sas_phy phy, struct sas_phy_linkrates rates)		_transport_phy_speed(struct sas_phy phy, struct sas_phy_linkrates rates)
	{		{
	struct MPT2SAS_ADAPTER *ioc = phy_to_ioc(phy);		struct MPT2SAS_ADAPTER *ioc = phy_to_ioc(phy);
	struct _sas_phy *mpt2sas_phy;
	Mpi2SasIOUnitPage1_t *sas_iounit_pg1 = NULL;		Mpi2SasIOUnitPage1_t *sas_iounit_pg1 = NULL;
	Mpi2SasPhyPage0_t phy_pg0;		Mpi2SasPhyPage0_t phy_pg0;
	Mpi2ConfigReply_t mpi_reply;		Mpi2ConfigReply_t mpi_reply;
	@@ -1397,11 +1628,15 @@ _transport_phy_speed(struct sas_phy phy, struct sas_phy_linkrates rates)
	u16 sz;		u16 sz;
	int i;		int i;
	int rc = 0;		int rc = 0;
			unsigned long flags;

	mpt2sas_phy = _transport_find_local_phy(ioc, phy);		spin_lock_irqsave(&ioc->sas_node_lock, flags);
			if (_transport_sas_node_find_by_sas_address(ioc,
	if (!mpt2sas_phy) /* this phy not on sas_host */		phy->identify.sas_address) == NULL) {
			spin_unlock_irqrestore(&ioc->sas_node_lock, flags);
	return -EINVAL;		return -EINVAL;
			}
			spin_unlock_irqrestore(&ioc->sas_node_lock, flags);

	if (!rates->minimum_linkrate)		if (!rates->minimum_linkrate)
	rates->minimum_linkrate = phy->minimum_linkrate;		rates->minimum_linkrate = phy->minimum_linkrate;
	@@ -1413,6 +1648,16 @@ _transport_phy_speed(struct sas_phy phy, struct sas_phy_linkrates rates)
	else if (rates->maximum_linkrate > phy->maximum_linkrate_hw)		else if (rates->maximum_linkrate > phy->maximum_linkrate_hw)
	rates->maximum_linkrate = phy->maximum_linkrate_hw;		rates->maximum_linkrate = phy->maximum_linkrate_hw;

			/* handle expander phys */
			if (phy->identify.sas_address != ioc->sas_hba.sas_address) {
			phy->minimum_linkrate = rates->minimum_linkrate;
			phy->maximum_linkrate = rates->maximum_linkrate;
			return _transport_expander_phy_control(ioc, phy,
			SMP_PHY_CONTROL_LINK_RESET);
			}

			/* handle hba phys */

	/* sas_iounit page 1 */		/* sas_iounit page 1 */
	sz = offsetof(Mpi2SasIOUnitPage1_t, PhyData) + (ioc->sas_hba.num_phys *		sz = offsetof(Mpi2SasIOUnitPage1_t, PhyData) + (ioc->sas_hba.num_phys *
	sizeof(Mpi2SasIOUnit1PhyData_t));		sizeof(Mpi2SasIOUnit1PhyData_t));
	@@ -1440,7 +1685,7 @@ _transport_phy_speed(struct sas_phy phy, struct sas_phy_linkrates rates)
	}		}

	for (i = 0; i < ioc->sas_hba.num_phys; i++) {		for (i = 0; i < ioc->sas_hba.num_phys; i++) {
	if (mpt2sas_phy->phy_id != i) {		if (phy->number != i) {
	sas_iounit_pg1->PhyData[i].MaxMinLinkRate =		sas_iounit_pg1->PhyData[i].MaxMinLinkRate =
	(ioc->sas_hba.phy[i].phy->minimum_linkrate +		(ioc->sas_hba.phy[i].phy->minimum_linkrate +
	(ioc->sas_hba.phy[i].phy->maximum_linkrate << 4));		(ioc->sas_hba.phy[i].phy->maximum_linkrate << 4));
	@@ -1464,7 +1709,7 @@ _transport_phy_speed(struct sas_phy phy, struct sas_phy_linkrates rates)

	/* read phy page 0, then update the rates in the sas transport phy */		/* read phy page 0, then update the rates in the sas transport phy */
	if (!mpt2sas_config_get_phy_pg0(ioc, &mpi_reply, &phy_pg0,		if (!mpt2sas_config_get_phy_pg0(ioc, &mpi_reply, &phy_pg0,
	mpt2sas_phy->phy_id)) {		phy->number)) {
	phy->minimum_linkrate = _transport_convert_phy_link_rate(		phy->minimum_linkrate = _transport_convert_phy_link_rate(
	phy_pg0.ProgrammedLinkRate & MPI2_SAS_PRATE_MIN_RATE_MASK);		phy_pg0.ProgrammedLinkRate & MPI2_SAS_PRATE_MIN_RATE_MASK);
	phy->maximum_linkrate = _transport_convert_phy_link_rate(		phy->maximum_linkrate = _transport_convert_phy_link_rate(