Commit 8b017a30 authored by James Smart's avatar James Smart Committed by James Bottomley
Browse files

lpfc: Add support for ELS LCB. 



Also has a little whitespace fixing.

Signed-off-by: default avatarDick Kennedy <dick.kennedy@avagotech.com>
Signed-off-by: default avatarJames Smart <james.smart@avagotech.com>
Reviewed-by: default avatarHannes Reinecke <hare@suse.de>
Signed-off-by: default avatarJames Bottomley <JBottomley@Odin.com>
parent 0290217a

drivers/scsi/lpfc/lpfc.h

+1 −0
Original line number Diff line number Diff line
@@ -230,6 +230,7 @@ struct lpfc_stats { 
	uint32_t elsRcvRRQ;

	uint32_t elsRcvRTV;

	uint32_t elsRcvECHO;

	uint32_t elsRcvLCB;

	uint32_t elsXmitFLOGI;

	uint32_t elsXmitFDISC;

	uint32_t elsXmitPLOGI;

drivers/scsi/lpfc/lpfc_els.c

+235 −4
Original line number Diff line number Diff line
@@ -4615,6 +4615,233 @@ lpfc_els_disc_plogi(struct lpfc_vport *vport) 
	return sentplogi;

}



static void

lpfc_els_lcb_rsp(struct lpfc_hba *phba, LPFC_MBOXQ_t *pmb)

{

	MAILBOX_t *mb;

	IOCB_t *icmd;

	uint8_t *pcmd;

	struct lpfc_iocbq *elsiocb;

	struct lpfc_nodelist *ndlp;

	struct ls_rjt *stat;

	struct lpfc_lcb_context *lcb_context;

	struct fc_lcb_res_frame *lcb_res;

	uint32_t cmdsize;

	int rc;



	mb = &pmb->u.mb;



	lcb_context = (struct lpfc_lcb_context *)pmb->context1;

	ndlp = lcb_context->ndlp;

	pmb->context1 = NULL;

	pmb->context2 = NULL;



	if (mb->mbxStatus) {

		mempool_free(pmb, phba->mbox_mem_pool);

		goto error;

	}



	mempool_free(pmb, phba->mbox_mem_pool);



	cmdsize = sizeof(struct fc_lcb_res_frame);

	elsiocb = lpfc_prep_els_iocb(phba->pport, 0, cmdsize,

			lpfc_max_els_tries, ndlp,

			ndlp->nlp_DID, ELS_CMD_ACC);



	/* Decrement the ndlp reference count from previous mbox command */

	lpfc_nlp_put(ndlp);



	if (!elsiocb)

		goto free_lcb_context;



	lcb_res = (struct fc_lcb_res_frame *)

		(((struct lpfc_dmabuf *)elsiocb->context2)->virt);



	icmd = &elsiocb->iocb;

	icmd->ulpContext = lcb_context->rx_id;

	icmd->unsli3.rcvsli3.ox_id = lcb_context->ox_id;



	pcmd = (uint8_t *)(((struct lpfc_dmabuf *)elsiocb->context2)->virt);

	*((uint32_t *)(pcmd)) = ELS_CMD_ACC;

	lcb_res->lcb_sub_command = lcb_context->sub_command;

	lcb_res->lcb_type = lcb_context->type;

	lcb_res->lcb_frequency = lcb_context->frequency;

	elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;

	phba->fc_stat.elsXmitACC++;

	rc = lpfc_sli_issue_iocb(phba, LPFC_ELS_RING, elsiocb, 0);

	if (rc == IOCB_ERROR)

		lpfc_els_free_iocb(phba, elsiocb);



	kfree(lcb_context);

	return;



error:

	cmdsize = sizeof(struct fc_lcb_res_frame);

	elsiocb = lpfc_prep_els_iocb(phba->pport, 0, cmdsize,

			lpfc_max_els_tries, ndlp,

			ndlp->nlp_DID, ELS_CMD_LS_RJT);

	lpfc_nlp_put(ndlp);

	if (!elsiocb)

		goto free_lcb_context;



	icmd = &elsiocb->iocb;

	icmd->ulpContext = lcb_context->rx_id;

	icmd->unsli3.rcvsli3.ox_id = lcb_context->ox_id;

	pcmd = (uint8_t *)(((struct lpfc_dmabuf *)elsiocb->context2)->virt);



	*((uint32_t *)(pcmd)) = ELS_CMD_LS_RJT;

	stat = (struct ls_rjt *)(pcmd + sizeof(uint32_t));

	stat->un.b.lsRjtRsnCode = LSRJT_UNABLE_TPC;



	elsiocb->iocb_cmpl = lpfc_cmpl_els_rsp;

	phba->fc_stat.elsXmitLSRJT++;

	rc = lpfc_sli_issue_iocb(phba, LPFC_ELS_RING, elsiocb, 0);

	if (rc == IOCB_ERROR)

		lpfc_els_free_iocb(phba, elsiocb);

free_lcb_context:

	kfree(lcb_context);

}



static int

lpfc_sli4_set_beacon(struct lpfc_vport *vport,

		     struct lpfc_lcb_context *lcb_context,

		     uint32_t beacon_state)

{

	struct lpfc_hba *phba = vport->phba;

	LPFC_MBOXQ_t *mbox = NULL;

	uint32_t len;

	int rc;



	mbox = mempool_alloc(phba->mbox_mem_pool, GFP_KERNEL);

	if (!mbox)

		return 1;



	len = sizeof(struct lpfc_mbx_set_beacon_config) -

		sizeof(struct lpfc_sli4_cfg_mhdr);

	lpfc_sli4_config(phba, mbox, LPFC_MBOX_SUBSYSTEM_COMMON,

			 LPFC_MBOX_OPCODE_SET_BEACON_CONFIG, len,

			 LPFC_SLI4_MBX_EMBED);

	mbox->context1 = (void *)lcb_context;

	mbox->vport = phba->pport;

	mbox->mbox_cmpl = lpfc_els_lcb_rsp;

	bf_set(lpfc_mbx_set_beacon_port_num, &mbox->u.mqe.un.beacon_config,

	       phba->sli4_hba.physical_port);

	bf_set(lpfc_mbx_set_beacon_state, &mbox->u.mqe.un.beacon_config,

	       beacon_state);

	bf_set(lpfc_mbx_set_beacon_port_type, &mbox->u.mqe.un.beacon_config, 1);

	bf_set(lpfc_mbx_set_beacon_duration, &mbox->u.mqe.un.beacon_config, 0);

	rc = lpfc_sli_issue_mbox(phba, mbox, MBX_NOWAIT);

	if (rc == MBX_NOT_FINISHED) {

		mempool_free(mbox, phba->mbox_mem_pool);

		return 1;

	}



	return 0;

}





/**

 * lpfc_els_rcv_lcb - Process an unsolicited LCB

 * @vport: pointer to a host virtual N_Port data structure.

 * @cmdiocb: pointer to lpfc command iocb data structure.

 * @ndlp: pointer to a node-list data structure.

 *

 * This routine processes an unsolicited LCB(LINK CABLE BEACON) IOCB.

 * First, the payload of the unsolicited LCB is checked.

 * Then based on Subcommand beacon will either turn on or off.

 *

 * Return code

 * 0 - Sent the acc response

 * 1 - Sent the reject response.

 **/

static int

lpfc_els_rcv_lcb(struct lpfc_vport *vport, struct lpfc_iocbq *cmdiocb,

		 struct lpfc_nodelist *ndlp)

{

	struct lpfc_hba *phba = vport->phba;

	struct lpfc_dmabuf *pcmd;

	IOCB_t *icmd;

	uint8_t *lp;

	struct fc_lcb_request_frame *beacon;

	struct lpfc_lcb_context *lcb_context;

	uint8_t state, rjt_err;

	struct ls_rjt stat;



	icmd = &cmdiocb->iocb;

	pcmd = (struct lpfc_dmabuf *)cmdiocb->context2;

	lp = (uint8_t *)pcmd->virt;

	beacon = (struct fc_lcb_request_frame *)pcmd->virt;



	lpfc_printf_vlog(vport, KERN_INFO, LOG_ELS,

			"0192 ELS LCB Data x%x x%x x%x x%x sub x%x "

			"type x%x frequency %x duration x%x\n",

			lp[0], lp[1], lp[2],

			beacon->lcb_command,

			beacon->lcb_sub_command,

			beacon->lcb_type,

			beacon->lcb_frequency,

			be16_to_cpu(beacon->lcb_duration));



	if (phba->sli_rev < LPFC_SLI_REV4 ||

	    (bf_get(lpfc_sli_intf_if_type, &phba->sli4_hba.sli_intf) !=

	    LPFC_SLI_INTF_IF_TYPE_2)) {

		rjt_err = LSRJT_CMD_UNSUPPORTED;

		goto rjt;

	}

	lcb_context = kmalloc(sizeof(struct lpfc_lcb_context), GFP_KERNEL);



	if (phba->hba_flag & HBA_FCOE_MODE) {

		rjt_err = LSRJT_CMD_UNSUPPORTED;

		goto rjt;

	}

	if (beacon->lcb_frequency == 0) {

		rjt_err = LSRJT_CMD_UNSUPPORTED;

		goto rjt;

	}

	if ((beacon->lcb_type != LPFC_LCB_GREEN) &&

	    (beacon->lcb_type != LPFC_LCB_AMBER)) {

		rjt_err = LSRJT_CMD_UNSUPPORTED;

		goto rjt;

	}

	if ((beacon->lcb_sub_command != LPFC_LCB_ON) &&

	    (beacon->lcb_sub_command != LPFC_LCB_OFF)) {

		rjt_err = LSRJT_CMD_UNSUPPORTED;

		goto rjt;

	}

	if ((beacon->lcb_sub_command == LPFC_LCB_ON) &&

	    (beacon->lcb_type != LPFC_LCB_GREEN) &&

	    (beacon->lcb_type != LPFC_LCB_AMBER)) {

		rjt_err = LSRJT_CMD_UNSUPPORTED;

		goto rjt;

	}

	if (be16_to_cpu(beacon->lcb_duration) != 0) {

		rjt_err = LSRJT_CMD_UNSUPPORTED;

		goto rjt;

	}



	state = (beacon->lcb_sub_command == LPFC_LCB_ON) ? 1 : 0;

	lcb_context->sub_command = beacon->lcb_sub_command;

	lcb_context->type = beacon->lcb_type;

	lcb_context->frequency = beacon->lcb_frequency;

	lcb_context->ox_id = cmdiocb->iocb.unsli3.rcvsli3.ox_id;

	lcb_context->rx_id = cmdiocb->iocb.ulpContext;

	lcb_context->ndlp = lpfc_nlp_get(ndlp);

	if (lpfc_sli4_set_beacon(vport, lcb_context, state)) {

		lpfc_printf_vlog(ndlp->vport, KERN_ERR,

				 LOG_ELS, "0193 failed to send mail box");

		lpfc_nlp_put(ndlp);

		rjt_err = LSRJT_UNABLE_TPC;

		goto rjt;

	}

	return 0;

rjt:

	memset(&stat, 0, sizeof(stat));

	stat.un.b.lsRjtRsnCode = rjt_err;

	lpfc_els_rsp_reject(vport, stat.un.lsRjtError, cmdiocb, ndlp, NULL);

	return 1;

}





/**

 * lpfc_els_flush_rscn - Clean up any rscn activities with a vport

 * @vport: pointer to a host virtual N_Port data structure.
@@ -6821,6 +7048,10 @@ lpfc_els_unsol_buffer(struct lpfc_hba *phba, struct lpfc_sli_ring *pring, 
		}

		lpfc_disc_state_machine(vport, ndlp, elsiocb, NLP_EVT_RCV_PRLO);

		break;

	case ELS_CMD_LCB:

		phba->fc_stat.elsRcvLCB++;

		lpfc_els_rcv_lcb(vport, elsiocb, ndlp);

		break;

	case ELS_CMD_RSCN:

		phba->fc_stat.elsRcvRSCN++;

		lpfc_els_rcv_rscn(vport, elsiocb, ndlp);

drivers/scsi/lpfc/lpfc_hw.h

+32 −0
Original line number Diff line number Diff line
@@ -558,6 +558,7 @@ struct fc_vft_header { 
#define ELS_CMD_SCR       0x62000000

#define ELS_CMD_RNID      0x78000000

#define ELS_CMD_LIRR      0x7A000000

#define ELS_CMD_LCB	  0x81000000

#else	/*  __LITTLE_ENDIAN_BITFIELD */

#define ELS_CMD_MASK      0xffff

#define ELS_RSP_MASK      0xff
@@ -595,6 +596,7 @@ struct fc_vft_header { 
#define ELS_CMD_SCR       0x62

#define ELS_CMD_RNID      0x78

#define ELS_CMD_LIRR      0x7A

#define ELS_CMD_LCB	  0x81

#endif



/*
@@ -1010,6 +1012,36 @@ typedef struct _ELS_PKT { /* Structure is in Big Endian format */ 
	} un;

} ELS_PKT;



/*

 * Link Cable Beacon (LCB) ELS Frame

 */



struct fc_lcb_request_frame {

	uint32_t      lcb_command;      /* ELS command opcode (0x81)     */

	uint8_t       lcb_sub_command;/* LCB Payload Word 1, bit 24:31 */

#define LPFC_LCB_ON    0x1

#define LPFC_LCB_OFF   0x2

	uint8_t       reserved[3];



	uint8_t       lcb_type; /* LCB Payload Word 2, bit 24:31 */

#define LPFC_LCB_GREEN 0x1

#define LPFC_LCB_AMBER 0x2

	uint8_t       lcb_frequency;    /* LCB Payload Word 2, bit 16:23 */

	uint16_t      lcb_duration;     /* LCB Payload Word 2, bit 15:0  */

};



/*

 * Link Cable Beacon (LCB) ELS Response Frame

 */

struct fc_lcb_res_frame {

	uint32_t      lcb_ls_acc;       /* Acceptance of LCB request (0x02) */

	uint8_t       lcb_sub_command;/* LCB Payload Word 1, bit 24:31 */

	uint8_t       reserved[3];

	uint8_t       lcb_type; /* LCB Payload Word 2, bit 24:31 */

	uint8_t       lcb_frequency;    /* LCB Payload Word 2, bit 16:23 */

	uint16_t      lcb_duration;     /* LCB Payload Word 2, bit 15:0  */

};



/******** FDMI ********/



/* lpfc_sli_ct_request defines the CT_IU preamble for FDMI commands */

drivers/scsi/lpfc/lpfc_hw4.h

+25 −2
Original line number Diff line number Diff line
@@ -914,6 +914,8 @@ struct mbox_header { 
#define LPFC_MBOX_OPCODE_FUNCTION_RESET			0x3D

#define LPFC_MBOX_OPCODE_SET_PHYSICAL_LINK_CONFIG	0x3E

#define LPFC_MBOX_OPCODE_SET_BOOT_CONFIG		0x43

#define LPFC_MBOX_OPCODE_SET_BEACON_CONFIG              0x45

#define LPFC_MBOX_OPCODE_GET_BEACON_CONFIG              0x46

#define LPFC_MBOX_OPCODE_GET_PORT_NAME			0x4D

#define LPFC_MBOX_OPCODE_MQ_CREATE_EXT			0x5A

#define LPFC_MBOX_OPCODE_GET_VPD_DATA			0x5B
@@ -1479,6 +1481,26 @@ struct lpfc_mbx_query_fw_config { 
	} rsp;

};



struct lpfc_mbx_set_beacon_config {

	struct mbox_header header;

	uint32_t word4;

#define lpfc_mbx_set_beacon_port_num_SHIFT		0

#define lpfc_mbx_set_beacon_port_num_MASK		0x0000003F

#define lpfc_mbx_set_beacon_port_num_WORD		word4

#define lpfc_mbx_set_beacon_port_type_SHIFT		6

#define lpfc_mbx_set_beacon_port_type_MASK		0x00000003

#define lpfc_mbx_set_beacon_port_type_WORD		word4

#define lpfc_mbx_set_beacon_state_SHIFT			8

#define lpfc_mbx_set_beacon_state_MASK			0x000000FF

#define lpfc_mbx_set_beacon_state_WORD			word4

#define lpfc_mbx_set_beacon_duration_SHIFT		16

#define lpfc_mbx_set_beacon_duration_MASK		0x000000FF

#define lpfc_mbx_set_beacon_duration_WORD		word4

#define lpfc_mbx_set_beacon_status_duration_SHIFT	24

#define lpfc_mbx_set_beacon_status_duration_MASK	0x000000FF

#define lpfc_mbx_set_beacon_status_duration_WORD	word4

};



struct lpfc_id_range {

	uint32_t word5;

#define lpfc_mbx_rsrc_id_word4_0_SHIFT	0
@@ -3021,6 +3043,7 @@ struct lpfc_mqe { 
		struct lpfc_mbx_request_features req_ftrs;

		struct lpfc_mbx_post_hdr_tmpl hdr_tmpl;

		struct lpfc_mbx_query_fw_config query_fw_cfg;

		struct lpfc_mbx_set_beacon_config beacon_config;

		struct lpfc_mbx_supp_pages supp_pages;

		struct lpfc_mbx_pc_sli4_params sli4_params;

		struct lpfc_mbx_get_sli4_parameters get_sli4_parameters;

drivers/scsi/lpfc/lpfc_init.c

+2 −0
Original line number Diff line number Diff line
@@ -7500,6 +7500,8 @@ lpfc_sli4_queue_setup(struct lpfc_hba *phba) 
			mboxq->u.mqe.un.query_fw_cfg.rsp.function_mode;

	phba->sli4_hba.ulp0_mode = mboxq->u.mqe.un.query_fw_cfg.rsp.ulp0_mode;

	phba->sli4_hba.ulp1_mode = mboxq->u.mqe.un.query_fw_cfg.rsp.ulp1_mode;

	phba->sli4_hba.physical_port =

			mboxq->u.mqe.un.query_fw_cfg.rsp.physical_port;

	lpfc_printf_log(phba, KERN_INFO, LOG_INIT,

			"3251 QUERY_FW_CFG: func_mode:x%x, ulp0_mode:x%x, "

			"ulp1_mode:x%x\n", phba->sli4_hba.fw_func_mode,