[deliverable/linux.git] / drivers / net / ethernet / qlogic / qed / qed_sp_commands.c

/* QLogic qed NIC Driver
 * Copyright (c) 2015 QLogic Corporation
 *
 * This software is available under the terms of the GNU General Public License
 * (GPL) Version 2, available from the file COPYING in the main directory of
 * this source tree.
 */

#include <linux/types.h>
#include <asm/byteorder.h>
#include <linux/bitops.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include "qed.h"
#include <linux/qed/qed_chain.h>
#include "qed_cxt.h"
#include "qed_hsi.h"
#include "qed_hw.h"
#include "qed_int.h"
#include "qed_reg_addr.h"
#include "qed_sp.h"

int qed_sp_init_request(struct qed_hwfn *p_hwfn,
			struct qed_spq_entry **pp_ent,
			u8 cmd,
			u8 protocol,
			struct qed_sp_init_data *p_data)
{
	u32 opaque_cid = p_data->opaque_fid << 16 | p_data->cid;
	struct qed_spq_entry *p_ent = NULL;
	int rc;

	if (!pp_ent)
		return -ENOMEM;

	rc = qed_spq_get_entry(p_hwfn, pp_ent);

	if (rc != 0)
		return rc;

	p_ent = *pp_ent;

	p_ent->elem.hdr.cid		= cpu_to_le32(opaque_cid);
	p_ent->elem.hdr.cmd_id		= cmd;
	p_ent->elem.hdr.protocol_id	= protocol;

	p_ent->priority		= QED_SPQ_PRIORITY_NORMAL;
	p_ent->comp_mode	= p_data->comp_mode;
	p_ent->comp_done.done	= 0;

	switch (p_ent->comp_mode) {
	case QED_SPQ_MODE_EBLOCK:
		p_ent->comp_cb.cookie = &p_ent->comp_done;
		break;

	case QED_SPQ_MODE_BLOCK:
		if (!p_data->p_comp_data)
			return -EINVAL;

		p_ent->comp_cb.cookie = p_data->p_comp_data->cookie;
		break;

	case QED_SPQ_MODE_CB:
		if (!p_data->p_comp_data)
			p_ent->comp_cb.function = NULL;
		else
			p_ent->comp_cb = *p_data->p_comp_data;
		break;

	default:
		DP_NOTICE(p_hwfn, "Unknown SPQE completion mode %d\n",
			  p_ent->comp_mode);
		return -EINVAL;
	}

	DP_VERBOSE(p_hwfn, QED_MSG_SPQ,
		   "Initialized: CID %08x cmd %02x protocol %02x data_addr %lu comp_mode [%s]\n",
		   opaque_cid, cmd, protocol,
		   (unsigned long)&p_ent->ramrod,
		   D_TRINE(p_ent->comp_mode, QED_SPQ_MODE_EBLOCK,
			   QED_SPQ_MODE_BLOCK, "MODE_EBLOCK", "MODE_BLOCK",
			   "MODE_CB"));

	memset(&p_ent->ramrod, 0, sizeof(p_ent->ramrod));

	return 0;
}

int qed_sp_pf_start(struct qed_hwfn *p_hwfn,
		    enum qed_mf_mode mode)
{
	struct pf_start_ramrod_data *p_ramrod = NULL;
	u16 sb = qed_int_get_sp_sb_id(p_hwfn);
	u8 sb_index = p_hwfn->p_eq->eq_sb_index;
	struct qed_spq_entry *p_ent = NULL;
	struct qed_sp_init_data init_data;
	int rc = -EINVAL;

	/* update initial eq producer */
	qed_eq_prod_update(p_hwfn,
			   qed_chain_get_prod_idx(&p_hwfn->p_eq->chain));

	memset(&init_data, 0, sizeof(init_data));
	init_data.cid = qed_spq_get_cid(p_hwfn);
	init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
	init_data.comp_mode = QED_SPQ_MODE_EBLOCK;

	rc = qed_sp_init_request(p_hwfn, &p_ent,
				 COMMON_RAMROD_PF_START,
				 PROTOCOLID_COMMON,
				 &init_data);
	if (rc)
		return rc;

	p_ramrod = &p_ent->ramrod.pf_start;

	p_ramrod->event_ring_sb_id	= cpu_to_le16(sb);
	p_ramrod->event_ring_sb_index	= sb_index;
	p_ramrod->path_id		= QED_PATH_ID(p_hwfn);
	p_ramrod->dont_log_ramrods	= 0;
	p_ramrod->log_type_mask		= cpu_to_le16(0xf);
	p_ramrod->mf_mode = mode;
	switch (mode) {
	case QED_MF_DEFAULT:
	case QED_MF_NPAR:
		p_ramrod->mf_mode = MF_NPAR;
		break;
	case QED_MF_OVLAN:
		p_ramrod->mf_mode = MF_OVLAN;
		break;
	default:
		DP_NOTICE(p_hwfn, "Unsupported MF mode, init as DEFAULT\n");
		p_ramrod->mf_mode = MF_NPAR;
	}
	p_ramrod->outer_tag = p_hwfn->hw_info.ovlan;

	/* Place EQ address in RAMROD */
	DMA_REGPAIR_LE(p_ramrod->event_ring_pbl_addr,
		       p_hwfn->p_eq->chain.pbl.p_phys_table);
	p_ramrod->event_ring_num_pages = (u8)p_hwfn->p_eq->chain.page_cnt;

	DMA_REGPAIR_LE(p_ramrod->consolid_q_pbl_addr,
		       p_hwfn->p_consq->chain.pbl.p_phys_table);

	p_hwfn->hw_info.personality = PERSONALITY_ETH;

	DP_VERBOSE(p_hwfn, QED_MSG_SPQ,
		   "Setting event_ring_sb [id %04x index %02x], outer_tag [%d]\n",
		   sb, sb_index,
		   p_ramrod->outer_tag);

	return qed_spq_post(p_hwfn, p_ent, NULL);
}

int qed_sp_pf_stop(struct qed_hwfn *p_hwfn)
{
	struct qed_spq_entry *p_ent = NULL;
	struct qed_sp_init_data init_data;
	int rc = -EINVAL;

	/* Get SPQ entry */
	memset(&init_data, 0, sizeof(init_data));
	init_data.cid = qed_spq_get_cid(p_hwfn);
	init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
	init_data.comp_mode = QED_SPQ_MODE_EBLOCK;

	rc = qed_sp_init_request(p_hwfn, &p_ent,
				 COMMON_RAMROD_PF_STOP, PROTOCOLID_COMMON,
				 &init_data);
	if (rc)
		return rc;

	return qed_spq_post(p_hwfn, p_ent, NULL);
}
Commit	Line	Data
fe56b9e6 YM	1	/* QLogic qed NIC Driver
	2	* Copyright (c) 2015 QLogic Corporation
	3	*
	4	* This software is available under the terms of the GNU General Public License
	5	* (GPL) Version 2, available from the file COPYING in the main directory of
	6	* this source tree.
	7	*/
	8
	9	#include <linux/types.h>
	10	#include <asm/byteorder.h>
	11	#include <linux/bitops.h>
	12	#include <linux/errno.h>
	13	#include <linux/kernel.h>
	14	#include <linux/string.h>
	15	#include "qed.h"
	16	#include <linux/qed/qed_chain.h>
	17	#include "qed_cxt.h"
	18	#include "qed_hsi.h"
	19	#include "qed_hw.h"
	20	#include "qed_int.h"
	21	#include "qed_reg_addr.h"
	22	#include "qed_sp.h"
	23
	24	int qed_sp_init_request(struct qed_hwfn *p_hwfn,
	25	struct qed_spq_entry **pp_ent,
fe56b9e6 YM	26	u8 cmd,
fe56b9e6 YM	27	u8 protocol,
06f56b81	28	struct qed_sp_init_data *p_data)
fe56b9e6	29	{
06f56b81	30	u32 opaque_cid = p_data->opaque_fid << 16 \| p_data->cid;
fe56b9e6	31	struct qed_spq_entry *p_ent = NULL;
06f56b81	32	int rc;
fe56b9e6 YM	33
	34	if (!pp_ent)
	35	return -ENOMEM;
	36
	37	rc = qed_spq_get_entry(p_hwfn, pp_ent);
	38
	39	if (rc != 0)
	40	return rc;
	41
	42	p_ent = *pp_ent;
	43
	44	p_ent->elem.hdr.cid = cpu_to_le32(opaque_cid);
	45	p_ent->elem.hdr.cmd_id = cmd;
	46	p_ent->elem.hdr.protocol_id = protocol;
	47
	48	p_ent->priority = QED_SPQ_PRIORITY_NORMAL;
06f56b81	49	p_ent->comp_mode = p_data->comp_mode;
fe56b9e6 YM	50	p_ent->comp_done.done = 0;
	51
	52	switch (p_ent->comp_mode) {
	53	case QED_SPQ_MODE_EBLOCK:
	54	p_ent->comp_cb.cookie = &p_ent->comp_done;
	55	break;
	56
	57	case QED_SPQ_MODE_BLOCK:
06f56b81	58	if (!p_data->p_comp_data)
fe56b9e6 YM	59	return -EINVAL;
fe56b9e6 YM	60
06f56b81	61	p_ent->comp_cb.cookie = p_data->p_comp_data->cookie;
fe56b9e6 YM	62	break;
	63
	64	case QED_SPQ_MODE_CB:
06f56b81	65	if (!p_data->p_comp_data)
fe56b9e6 YM	66	p_ent->comp_cb.function = NULL;
fe56b9e6 YM	67	else
06f56b81	68	p_ent->comp_cb = *p_data->p_comp_data;
fe56b9e6 YM	69	break;
	70
	71	default:
	72	DP_NOTICE(p_hwfn, "Unknown SPQE completion mode %d\n",
	73	p_ent->comp_mode);
	74	return -EINVAL;
	75	}
	76
	77	DP_VERBOSE(p_hwfn, QED_MSG_SPQ,
	78	"Initialized: CID %08x cmd %02x protocol %02x data_addr %lu comp_mode [%s]\n",
	79	opaque_cid, cmd, protocol,
	80	(unsigned long)&p_ent->ramrod,
	81	D_TRINE(p_ent->comp_mode, QED_SPQ_MODE_EBLOCK,
	82	QED_SPQ_MODE_BLOCK, "MODE_EBLOCK", "MODE_BLOCK",
	83	"MODE_CB"));
06f56b81 YM	84
06f56b81 YM	85	memset(&p_ent->ramrod, 0, sizeof(p_ent->ramrod));
fe56b9e6 YM	86
	87	return 0;
	88	}
	89
	90	int qed_sp_pf_start(struct qed_hwfn *p_hwfn,
fc48b7a6	91	enum qed_mf_mode mode)
fe56b9e6	92	{
fe56b9e6 YM	93	struct pf_start_ramrod_data *p_ramrod = NULL;
	94	u16 sb = qed_int_get_sp_sb_id(p_hwfn);
	95	u8 sb_index = p_hwfn->p_eq->eq_sb_index;
	96	struct qed_spq_entry *p_ent = NULL;
06f56b81	97	struct qed_sp_init_data init_data;
fe56b9e6 YM	98	int rc = -EINVAL;
	99
	100	/* update initial eq producer */
	101	qed_eq_prod_update(p_hwfn,
	102	qed_chain_get_prod_idx(&p_hwfn->p_eq->chain));
	103
06f56b81 YM	104	memset(&init_data, 0, sizeof(init_data));
	105	init_data.cid = qed_spq_get_cid(p_hwfn);
	106	init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
	107	init_data.comp_mode = QED_SPQ_MODE_EBLOCK;
fe56b9e6	108
06f56b81	109	rc = qed_sp_init_request(p_hwfn, &p_ent,
fe56b9e6 YM	110	COMMON_RAMROD_PF_START,
fe56b9e6 YM	111	PROTOCOLID_COMMON,
06f56b81	112	&init_data);
fe56b9e6 YM	113	if (rc)
	114	return rc;
	115
	116	p_ramrod = &p_ent->ramrod.pf_start;
	117
	118	p_ramrod->event_ring_sb_id = cpu_to_le16(sb);
	119	p_ramrod->event_ring_sb_index = sb_index;
	120	p_ramrod->path_id = QED_PATH_ID(p_hwfn);
	121	p_ramrod->dont_log_ramrods = 0;
	122	p_ramrod->log_type_mask = cpu_to_le16(0xf);
	123	p_ramrod->mf_mode = mode;
fc48b7a6 YM	124	switch (mode) {
	125	case QED_MF_DEFAULT:
	126	case QED_MF_NPAR:
	127	p_ramrod->mf_mode = MF_NPAR;
	128	break;
	129	case QED_MF_OVLAN:
	130	p_ramrod->mf_mode = MF_OVLAN;
	131	break;
	132	default:
	133	DP_NOTICE(p_hwfn, "Unsupported MF mode, init as DEFAULT\n");
	134	p_ramrod->mf_mode = MF_NPAR;
	135	}
fe56b9e6 YM	136	p_ramrod->outer_tag = p_hwfn->hw_info.ovlan;
	137
	138	/* Place EQ address in RAMROD */
94494598 YM	139	DMA_REGPAIR_LE(p_ramrod->event_ring_pbl_addr,
94494598 YM	140	p_hwfn->p_eq->chain.pbl.p_phys_table);
fe56b9e6 YM	141	p_ramrod->event_ring_num_pages = (u8)p_hwfn->p_eq->chain.page_cnt;
fe56b9e6 YM	142
94494598 YM	143	DMA_REGPAIR_LE(p_ramrod->consolid_q_pbl_addr,
94494598 YM	144	p_hwfn->p_consq->chain.pbl.p_phys_table);
fe56b9e6 YM	145
	146	p_hwfn->hw_info.personality = PERSONALITY_ETH;
	147
	148	DP_VERBOSE(p_hwfn, QED_MSG_SPQ,
fc48b7a6	149	"Setting event_ring_sb [id %04x index %02x], outer_tag [%d]\n",
fe56b9e6	150	sb, sb_index,
fe56b9e6 YM	151	p_ramrod->outer_tag);
	152
	153	return qed_spq_post(p_hwfn, p_ent, NULL);
	154	}
	155
	156	int qed_sp_pf_stop(struct qed_hwfn *p_hwfn)
	157	{
fe56b9e6	158	struct qed_spq_entry *p_ent = NULL;
06f56b81	159	struct qed_sp_init_data init_data;
fe56b9e6 YM	160	int rc = -EINVAL;
fe56b9e6 YM	161
06f56b81 YM	162	/* Get SPQ entry */
	163	memset(&init_data, 0, sizeof(init_data));
	164	init_data.cid = qed_spq_get_cid(p_hwfn);
	165	init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
	166	init_data.comp_mode = QED_SPQ_MODE_EBLOCK;
fe56b9e6	167
06f56b81	168	rc = qed_sp_init_request(p_hwfn, &p_ent,
fe56b9e6	169	COMMON_RAMROD_PF_STOP, PROTOCOLID_COMMON,
06f56b81	170	&init_data);
fe56b9e6 YM	171	if (rc)
	172	return rc;
	173
	174	return qed_spq_post(p_hwfn, p_ent, NULL);
	175	}