1fe56b9e6SYuval Mintz /* QLogic qed NIC Driver 2e8f1cb50SMintz, Yuval * Copyright (c) 2015-2017 QLogic Corporation 3fe56b9e6SYuval Mintz * 4e8f1cb50SMintz, Yuval * This software is available to you under a choice of one of two 5e8f1cb50SMintz, Yuval * licenses. You may choose to be licensed under the terms of the GNU 6e8f1cb50SMintz, Yuval * General Public License (GPL) Version 2, available from the file 7e8f1cb50SMintz, Yuval * COPYING in the main directory of this source tree, or the 8e8f1cb50SMintz, Yuval * OpenIB.org BSD license below: 9e8f1cb50SMintz, Yuval * 10e8f1cb50SMintz, Yuval * Redistribution and use in source and binary forms, with or 11e8f1cb50SMintz, Yuval * without modification, are permitted provided that the following 12e8f1cb50SMintz, Yuval * conditions are met: 13e8f1cb50SMintz, Yuval * 14e8f1cb50SMintz, Yuval * - Redistributions of source code must retain the above 15e8f1cb50SMintz, Yuval * copyright notice, this list of conditions and the following 16e8f1cb50SMintz, Yuval * disclaimer. 17e8f1cb50SMintz, Yuval * 18e8f1cb50SMintz, Yuval * - Redistributions in binary form must reproduce the above 19e8f1cb50SMintz, Yuval * copyright notice, this list of conditions and the following 20e8f1cb50SMintz, Yuval * disclaimer in the documentation and /or other materials 21e8f1cb50SMintz, Yuval * provided with the distribution. 22e8f1cb50SMintz, Yuval * 23e8f1cb50SMintz, Yuval * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, 24e8f1cb50SMintz, Yuval * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 25e8f1cb50SMintz, Yuval * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 26e8f1cb50SMintz, Yuval * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS 27e8f1cb50SMintz, Yuval * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN 28e8f1cb50SMintz, Yuval * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN 29e8f1cb50SMintz, Yuval * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE 30e8f1cb50SMintz, Yuval * SOFTWARE. 31fe56b9e6SYuval Mintz */ 32fe56b9e6SYuval Mintz 33fe56b9e6SYuval Mintz #include <linux/types.h> 34fe56b9e6SYuval Mintz #include <asm/byteorder.h> 35fe56b9e6SYuval Mintz #include <linux/io.h> 36fe56b9e6SYuval Mintz #include <linux/delay.h> 37fe56b9e6SYuval Mintz #include <linux/dma-mapping.h> 38fe56b9e6SYuval Mintz #include <linux/errno.h> 39fe56b9e6SYuval Mintz #include <linux/kernel.h> 40fe56b9e6SYuval Mintz #include <linux/list.h> 41fe56b9e6SYuval Mintz #include <linux/pci.h> 42fe56b9e6SYuval Mintz #include <linux/slab.h> 43fe56b9e6SYuval Mintz #include <linux/spinlock.h> 44fe56b9e6SYuval Mintz #include <linux/string.h> 45fe56b9e6SYuval Mintz #include "qed.h" 46fe56b9e6SYuval Mintz #include "qed_cxt.h" 47fe56b9e6SYuval Mintz #include "qed_dev_api.h" 48fe56b9e6SYuval Mintz #include "qed_hsi.h" 49fe56b9e6SYuval Mintz #include "qed_hw.h" 50fe56b9e6SYuval Mintz #include "qed_int.h" 51fc831825SYuval Mintz #include "qed_iscsi.h" 52fe56b9e6SYuval Mintz #include "qed_mcp.h" 531d6cff4fSYuval Mintz #include "qed_ooo.h" 54fe56b9e6SYuval Mintz #include "qed_reg_addr.h" 55fe56b9e6SYuval Mintz #include "qed_sp.h" 5637bff2b9SYuval Mintz #include "qed_sriov.h" 57b71b9afdSKalderon, Michal #include "qed_rdma.h" 58fe56b9e6SYuval Mintz 59fe56b9e6SYuval Mintz /*************************************************************************** 60fe56b9e6SYuval Mintz * Structures & Definitions 61fe56b9e6SYuval Mintz ***************************************************************************/ 62fe56b9e6SYuval Mintz 63fe56b9e6SYuval Mintz #define SPQ_HIGH_PRI_RESERVE_DEFAULT (1) 64c59f5291SYuval Mintz 65c59f5291SYuval Mintz #define SPQ_BLOCK_DELAY_MAX_ITER (10) 66c59f5291SYuval Mintz #define SPQ_BLOCK_DELAY_US (10) 67c59f5291SYuval Mintz #define SPQ_BLOCK_SLEEP_MAX_ITER (1000) 68c59f5291SYuval Mintz #define SPQ_BLOCK_SLEEP_MS (5) 69fe56b9e6SYuval Mintz 70fe56b9e6SYuval Mintz /*************************************************************************** 71fe56b9e6SYuval Mintz * Blocking Imp. (BLOCK/EBLOCK mode) 72fe56b9e6SYuval Mintz ***************************************************************************/ 73fe56b9e6SYuval Mintz static void qed_spq_blocking_cb(struct qed_hwfn *p_hwfn, 74fe56b9e6SYuval Mintz void *cookie, 751a635e48SYuval Mintz union event_ring_data *data, u8 fw_return_code) 76fe56b9e6SYuval Mintz { 77fe56b9e6SYuval Mintz struct qed_spq_comp_done *comp_done; 78fe56b9e6SYuval Mintz 79fe56b9e6SYuval Mintz comp_done = (struct qed_spq_comp_done *)cookie; 80fe56b9e6SYuval Mintz 81fe56b9e6SYuval Mintz comp_done->fw_return_code = fw_return_code; 82fe56b9e6SYuval Mintz 83d5df7688SManish Chopra /* Make sure completion done is visible on waiting thread */ 84d5df7688SManish Chopra smp_store_release(&comp_done->done, 0x1); 85fe56b9e6SYuval Mintz } 86fe56b9e6SYuval Mintz 87c59f5291SYuval Mintz static int __qed_spq_block(struct qed_hwfn *p_hwfn, 88c59f5291SYuval Mintz struct qed_spq_entry *p_ent, 89c59f5291SYuval Mintz u8 *p_fw_ret, bool sleep_between_iter) 90c59f5291SYuval Mintz { 91c59f5291SYuval Mintz struct qed_spq_comp_done *comp_done; 92c59f5291SYuval Mintz u32 iter_cnt; 93c59f5291SYuval Mintz 94c59f5291SYuval Mintz comp_done = (struct qed_spq_comp_done *)p_ent->comp_cb.cookie; 95c59f5291SYuval Mintz iter_cnt = sleep_between_iter ? SPQ_BLOCK_SLEEP_MAX_ITER 96c59f5291SYuval Mintz : SPQ_BLOCK_DELAY_MAX_ITER; 97c59f5291SYuval Mintz 98c59f5291SYuval Mintz while (iter_cnt--) { 99c59f5291SYuval Mintz /* Validate we receive completion update */ 100d5df7688SManish Chopra if (READ_ONCE(comp_done->done) == 1) { 101d5df7688SManish Chopra /* Read updated FW return value */ 102d5df7688SManish Chopra smp_read_barrier_depends(); 103c59f5291SYuval Mintz if (p_fw_ret) 104c59f5291SYuval Mintz *p_fw_ret = comp_done->fw_return_code; 105c59f5291SYuval Mintz return 0; 106c59f5291SYuval Mintz } 107c59f5291SYuval Mintz 108c59f5291SYuval Mintz if (sleep_between_iter) 109c59f5291SYuval Mintz msleep(SPQ_BLOCK_SLEEP_MS); 110c59f5291SYuval Mintz else 111c59f5291SYuval Mintz udelay(SPQ_BLOCK_DELAY_US); 112c59f5291SYuval Mintz } 113c59f5291SYuval Mintz 114c59f5291SYuval Mintz return -EBUSY; 115c59f5291SYuval Mintz } 116c59f5291SYuval Mintz 117fe56b9e6SYuval Mintz static int qed_spq_block(struct qed_hwfn *p_hwfn, 118fe56b9e6SYuval Mintz struct qed_spq_entry *p_ent, 119c59f5291SYuval Mintz u8 *p_fw_ret, bool skip_quick_poll) 120fe56b9e6SYuval Mintz { 121fe56b9e6SYuval Mintz struct qed_spq_comp_done *comp_done; 12215582962SRahul Verma struct qed_ptt *p_ptt; 123fe56b9e6SYuval Mintz int rc; 124fe56b9e6SYuval Mintz 125c59f5291SYuval Mintz /* A relatively short polling period w/o sleeping, to allow the FW to 126c59f5291SYuval Mintz * complete the ramrod and thus possibly to avoid the following sleeps. 127c59f5291SYuval Mintz */ 128c59f5291SYuval Mintz if (!skip_quick_poll) { 129c59f5291SYuval Mintz rc = __qed_spq_block(p_hwfn, p_ent, p_fw_ret, false); 130c59f5291SYuval Mintz if (!rc) 131fe56b9e6SYuval Mintz return 0; 132fe56b9e6SYuval Mintz } 133c59f5291SYuval Mintz 134c59f5291SYuval Mintz /* Move to polling with a sleeping period between iterations */ 135c59f5291SYuval Mintz rc = __qed_spq_block(p_hwfn, p_ent, p_fw_ret, true); 136c59f5291SYuval Mintz if (!rc) 137c59f5291SYuval Mintz return 0; 138fe56b9e6SYuval Mintz 13915582962SRahul Verma p_ptt = qed_ptt_acquire(p_hwfn); 14015582962SRahul Verma if (!p_ptt) { 14115582962SRahul Verma DP_NOTICE(p_hwfn, "ptt, failed to acquire\n"); 14215582962SRahul Verma return -EAGAIN; 14315582962SRahul Verma } 14415582962SRahul Verma 145fe56b9e6SYuval Mintz DP_INFO(p_hwfn, "Ramrod is stuck, requesting MCP drain\n"); 14615582962SRahul Verma rc = qed_mcp_drain(p_hwfn, p_ptt); 147c59f5291SYuval Mintz if (rc) { 148fe56b9e6SYuval Mintz DP_NOTICE(p_hwfn, "MCP drain failed\n"); 149c59f5291SYuval Mintz goto err; 150c59f5291SYuval Mintz } 151fe56b9e6SYuval Mintz 152fe56b9e6SYuval Mintz /* Retry after drain */ 153c59f5291SYuval Mintz rc = __qed_spq_block(p_hwfn, p_ent, p_fw_ret, true); 154c59f5291SYuval Mintz if (!rc) 15515582962SRahul Verma goto out; 156c59f5291SYuval Mintz 157c59f5291SYuval Mintz comp_done = (struct qed_spq_comp_done *)p_ent->comp_cb.cookie; 15815582962SRahul Verma if (comp_done->done == 1) 159fe56b9e6SYuval Mintz if (p_fw_ret) 160fe56b9e6SYuval Mintz *p_fw_ret = comp_done->fw_return_code; 16115582962SRahul Verma out: 16215582962SRahul Verma qed_ptt_release(p_hwfn, p_ptt); 163fe56b9e6SYuval Mintz return 0; 16415582962SRahul Verma 165c59f5291SYuval Mintz err: 16615582962SRahul Verma qed_ptt_release(p_hwfn, p_ptt); 167c59f5291SYuval Mintz DP_NOTICE(p_hwfn, 168c59f5291SYuval Mintz "Ramrod is stuck [CID %08x cmd %02x protocol %02x echo %04x]\n", 169c59f5291SYuval Mintz le32_to_cpu(p_ent->elem.hdr.cid), 170c59f5291SYuval Mintz p_ent->elem.hdr.cmd_id, 171c59f5291SYuval Mintz p_ent->elem.hdr.protocol_id, 172c59f5291SYuval Mintz le16_to_cpu(p_ent->elem.hdr.echo)); 173fe56b9e6SYuval Mintz 174fe56b9e6SYuval Mintz return -EBUSY; 175fe56b9e6SYuval Mintz } 176fe56b9e6SYuval Mintz 177fe56b9e6SYuval Mintz /*************************************************************************** 178fe56b9e6SYuval Mintz * SPQ entries inner API 179fe56b9e6SYuval Mintz ***************************************************************************/ 1801a635e48SYuval Mintz static int qed_spq_fill_entry(struct qed_hwfn *p_hwfn, 181fe56b9e6SYuval Mintz struct qed_spq_entry *p_ent) 182fe56b9e6SYuval Mintz { 183fe56b9e6SYuval Mintz p_ent->flags = 0; 184fe56b9e6SYuval Mintz 185fe56b9e6SYuval Mintz switch (p_ent->comp_mode) { 186fe56b9e6SYuval Mintz case QED_SPQ_MODE_EBLOCK: 187fe56b9e6SYuval Mintz case QED_SPQ_MODE_BLOCK: 188fe56b9e6SYuval Mintz p_ent->comp_cb.function = qed_spq_blocking_cb; 189fe56b9e6SYuval Mintz break; 190fe56b9e6SYuval Mintz case QED_SPQ_MODE_CB: 191fe56b9e6SYuval Mintz break; 192fe56b9e6SYuval Mintz default: 193fe56b9e6SYuval Mintz DP_NOTICE(p_hwfn, "Unknown SPQE completion mode %d\n", 194fe56b9e6SYuval Mintz p_ent->comp_mode); 195fe56b9e6SYuval Mintz return -EINVAL; 196fe56b9e6SYuval Mintz } 197fe56b9e6SYuval Mintz 198fe56b9e6SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_SPQ, 199fe56b9e6SYuval Mintz "Ramrod header: [CID 0x%08x CMD 0x%02x protocol 0x%02x] Data pointer: [%08x:%08x] Completion Mode: %s\n", 200fe56b9e6SYuval Mintz p_ent->elem.hdr.cid, 201fe56b9e6SYuval Mintz p_ent->elem.hdr.cmd_id, 202fe56b9e6SYuval Mintz p_ent->elem.hdr.protocol_id, 203fe56b9e6SYuval Mintz p_ent->elem.data_ptr.hi, 204fe56b9e6SYuval Mintz p_ent->elem.data_ptr.lo, 205fe56b9e6SYuval Mintz D_TRINE(p_ent->comp_mode, QED_SPQ_MODE_EBLOCK, 206fe56b9e6SYuval Mintz QED_SPQ_MODE_BLOCK, "MODE_EBLOCK", "MODE_BLOCK", 207fe56b9e6SYuval Mintz "MODE_CB")); 208fe56b9e6SYuval Mintz 209fe56b9e6SYuval Mintz return 0; 210fe56b9e6SYuval Mintz } 211fe56b9e6SYuval Mintz 212fe56b9e6SYuval Mintz /*************************************************************************** 213fe56b9e6SYuval Mintz * HSI access 214fe56b9e6SYuval Mintz ***************************************************************************/ 215fe56b9e6SYuval Mintz static void qed_spq_hw_initialize(struct qed_hwfn *p_hwfn, 216fe56b9e6SYuval Mintz struct qed_spq *p_spq) 217fe56b9e6SYuval Mintz { 218fe56b9e6SYuval Mintz struct core_conn_context *p_cxt; 219b5a9ee7cSAriel Elior struct qed_cxt_info cxt_info; 220b5a9ee7cSAriel Elior u16 physical_q; 221fe56b9e6SYuval Mintz int rc; 222fe56b9e6SYuval Mintz 223fe56b9e6SYuval Mintz cxt_info.iid = p_spq->cid; 224fe56b9e6SYuval Mintz 225fe56b9e6SYuval Mintz rc = qed_cxt_get_cid_info(p_hwfn, &cxt_info); 226fe56b9e6SYuval Mintz 227fe56b9e6SYuval Mintz if (rc < 0) { 228fe56b9e6SYuval Mintz DP_NOTICE(p_hwfn, "Cannot find context info for cid=%d\n", 229fe56b9e6SYuval Mintz p_spq->cid); 230fe56b9e6SYuval Mintz return; 231fe56b9e6SYuval Mintz } 232fe56b9e6SYuval Mintz 233fe56b9e6SYuval Mintz p_cxt = cxt_info.p_cxt; 234fe56b9e6SYuval Mintz 235fe56b9e6SYuval Mintz SET_FIELD(p_cxt->xstorm_ag_context.flags10, 236fe56b9e6SYuval Mintz XSTORM_CORE_CONN_AG_CTX_DQ_CF_EN, 1); 237fe56b9e6SYuval Mintz SET_FIELD(p_cxt->xstorm_ag_context.flags1, 238fe56b9e6SYuval Mintz XSTORM_CORE_CONN_AG_CTX_DQ_CF_ACTIVE, 1); 239fe56b9e6SYuval Mintz SET_FIELD(p_cxt->xstorm_ag_context.flags9, 240fe56b9e6SYuval Mintz XSTORM_CORE_CONN_AG_CTX_CONSOLID_PROD_CF_EN, 1); 241fe56b9e6SYuval Mintz 242fe56b9e6SYuval Mintz /* QM physical queue */ 243b5a9ee7cSAriel Elior physical_q = qed_get_cm_pq_idx(p_hwfn, PQ_FLAGS_LB); 244b5a9ee7cSAriel Elior p_cxt->xstorm_ag_context.physical_q0 = cpu_to_le16(physical_q); 245fe56b9e6SYuval Mintz 246fe56b9e6SYuval Mintz p_cxt->xstorm_st_context.spq_base_lo = 247fe56b9e6SYuval Mintz DMA_LO_LE(p_spq->chain.p_phys_addr); 248fe56b9e6SYuval Mintz p_cxt->xstorm_st_context.spq_base_hi = 249fe56b9e6SYuval Mintz DMA_HI_LE(p_spq->chain.p_phys_addr); 250fe56b9e6SYuval Mintz 25194494598SYuval Mintz DMA_REGPAIR_LE(p_cxt->xstorm_st_context.consolid_base_addr, 25294494598SYuval Mintz p_hwfn->p_consq->chain.p_phys_addr); 253fe56b9e6SYuval Mintz } 254fe56b9e6SYuval Mintz 255fe56b9e6SYuval Mintz static int qed_spq_hw_post(struct qed_hwfn *p_hwfn, 2561a635e48SYuval Mintz struct qed_spq *p_spq, struct qed_spq_entry *p_ent) 257fe56b9e6SYuval Mintz { 258fe56b9e6SYuval Mintz struct qed_chain *p_chain = &p_hwfn->p_spq->chain; 25976a9a364STomer Tayar u16 echo = qed_chain_get_prod_idx(p_chain); 260fe56b9e6SYuval Mintz struct slow_path_element *elem; 261fe56b9e6SYuval Mintz struct core_db_data db; 262fe56b9e6SYuval Mintz 26376a9a364STomer Tayar p_ent->elem.hdr.echo = cpu_to_le16(echo); 264fe56b9e6SYuval Mintz elem = qed_chain_produce(p_chain); 265fe56b9e6SYuval Mintz if (!elem) { 266fe56b9e6SYuval Mintz DP_NOTICE(p_hwfn, "Failed to produce from SPQ chain\n"); 267fe56b9e6SYuval Mintz return -EINVAL; 268fe56b9e6SYuval Mintz } 269fe56b9e6SYuval Mintz 270fe56b9e6SYuval Mintz *elem = p_ent->elem; /* struct assignment */ 271fe56b9e6SYuval Mintz 272fe56b9e6SYuval Mintz /* send a doorbell on the slow hwfn session */ 273fe56b9e6SYuval Mintz memset(&db, 0, sizeof(db)); 274fe56b9e6SYuval Mintz SET_FIELD(db.params, CORE_DB_DATA_DEST, DB_DEST_XCM); 275fe56b9e6SYuval Mintz SET_FIELD(db.params, CORE_DB_DATA_AGG_CMD, DB_AGG_CMD_SET); 276fe56b9e6SYuval Mintz SET_FIELD(db.params, CORE_DB_DATA_AGG_VAL_SEL, 277fe56b9e6SYuval Mintz DQ_XCM_CORE_SPQ_PROD_CMD); 278fe56b9e6SYuval Mintz db.agg_flags = DQ_XCM_CORE_DQ_CF_CMD; 279fe56b9e6SYuval Mintz db.spq_prod = cpu_to_le16(qed_chain_get_prod_idx(p_chain)); 280fe56b9e6SYuval Mintz 28134c7bb47SSudarsana Reddy Kalluru /* make sure the SPQE is updated before the doorbell */ 28234c7bb47SSudarsana Reddy Kalluru wmb(); 283fe56b9e6SYuval Mintz 284fe56b9e6SYuval Mintz DOORBELL(p_hwfn, qed_db_addr(p_spq->cid, DQ_DEMS_LEGACY), *(u32 *)&db); 285fe56b9e6SYuval Mintz 286fe56b9e6SYuval Mintz /* make sure doorbell is rang */ 28734c7bb47SSudarsana Reddy Kalluru wmb(); 288fe56b9e6SYuval Mintz 289fe56b9e6SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_SPQ, 290fe56b9e6SYuval Mintz "Doorbelled [0x%08x, CID 0x%08x] with Flags: %02x agg_params: %02x, prod: %04x\n", 291fe56b9e6SYuval Mintz qed_db_addr(p_spq->cid, DQ_DEMS_LEGACY), 292fe56b9e6SYuval Mintz p_spq->cid, db.params, db.agg_flags, 293fe56b9e6SYuval Mintz qed_chain_get_prod_idx(p_chain)); 294fe56b9e6SYuval Mintz 295fe56b9e6SYuval Mintz return 0; 296fe56b9e6SYuval Mintz } 297fe56b9e6SYuval Mintz 298fe56b9e6SYuval Mintz /*************************************************************************** 299fe56b9e6SYuval Mintz * Asynchronous events 300fe56b9e6SYuval Mintz ***************************************************************************/ 301fe56b9e6SYuval Mintz static int 302fe56b9e6SYuval Mintz qed_async_event_completion(struct qed_hwfn *p_hwfn, 303fe56b9e6SYuval Mintz struct event_ring_entry *p_eqe) 304fe56b9e6SYuval Mintz { 3056c9e80eaSMichal Kalderon qed_spq_async_comp_cb cb; 3066c9e80eaSMichal Kalderon 3076c9e80eaSMichal Kalderon if (!p_hwfn->p_spq || (p_eqe->protocol_id >= MAX_PROTOCOL_TYPE)) 308fc831825SYuval Mintz return -EINVAL; 309fc831825SYuval Mintz 3106c9e80eaSMichal Kalderon cb = p_hwfn->p_spq->async_comp_cb[p_eqe->protocol_id]; 3116c9e80eaSMichal Kalderon if (cb) { 3126c9e80eaSMichal Kalderon return cb(p_hwfn, p_eqe->opcode, p_eqe->echo, 3136c9e80eaSMichal Kalderon &p_eqe->data, p_eqe->fw_return_code); 314fc831825SYuval Mintz } else { 315fc831825SYuval Mintz DP_NOTICE(p_hwfn, 316fe56b9e6SYuval Mintz "Unknown Async completion for protocol: %d\n", 317fe56b9e6SYuval Mintz p_eqe->protocol_id); 318fe56b9e6SYuval Mintz return -EINVAL; 319fe56b9e6SYuval Mintz } 32037bff2b9SYuval Mintz } 321fe56b9e6SYuval Mintz 3226c9e80eaSMichal Kalderon int 3236c9e80eaSMichal Kalderon qed_spq_register_async_cb(struct qed_hwfn *p_hwfn, 3246c9e80eaSMichal Kalderon enum protocol_type protocol_id, 3256c9e80eaSMichal Kalderon qed_spq_async_comp_cb cb) 3266c9e80eaSMichal Kalderon { 3276c9e80eaSMichal Kalderon if (!p_hwfn->p_spq || (protocol_id >= MAX_PROTOCOL_TYPE)) 3286c9e80eaSMichal Kalderon return -EINVAL; 3296c9e80eaSMichal Kalderon 3306c9e80eaSMichal Kalderon p_hwfn->p_spq->async_comp_cb[protocol_id] = cb; 3316c9e80eaSMichal Kalderon return 0; 3326c9e80eaSMichal Kalderon } 3336c9e80eaSMichal Kalderon 3346c9e80eaSMichal Kalderon void 3356c9e80eaSMichal Kalderon qed_spq_unregister_async_cb(struct qed_hwfn *p_hwfn, 3366c9e80eaSMichal Kalderon enum protocol_type protocol_id) 3376c9e80eaSMichal Kalderon { 3386c9e80eaSMichal Kalderon if (!p_hwfn->p_spq || (protocol_id >= MAX_PROTOCOL_TYPE)) 3396c9e80eaSMichal Kalderon return; 3406c9e80eaSMichal Kalderon 3416c9e80eaSMichal Kalderon p_hwfn->p_spq->async_comp_cb[protocol_id] = NULL; 3426c9e80eaSMichal Kalderon } 3436c9e80eaSMichal Kalderon 344fe56b9e6SYuval Mintz /*************************************************************************** 345fe56b9e6SYuval Mintz * EQ API 346fe56b9e6SYuval Mintz ***************************************************************************/ 3471a635e48SYuval Mintz void qed_eq_prod_update(struct qed_hwfn *p_hwfn, u16 prod) 348fe56b9e6SYuval Mintz { 349fe56b9e6SYuval Mintz u32 addr = GTT_BAR0_MAP_REG_USDM_RAM + 350fe56b9e6SYuval Mintz USTORM_EQE_CONS_OFFSET(p_hwfn->rel_pf_id); 351fe56b9e6SYuval Mintz 352fe56b9e6SYuval Mintz REG_WR16(p_hwfn, addr, prod); 353fe56b9e6SYuval Mintz 354fe56b9e6SYuval Mintz /* keep prod updates ordered */ 355fe56b9e6SYuval Mintz mmiowb(); 356fe56b9e6SYuval Mintz } 357fe56b9e6SYuval Mintz 3581a635e48SYuval Mintz int qed_eq_completion(struct qed_hwfn *p_hwfn, void *cookie) 359fe56b9e6SYuval Mintz { 360fe56b9e6SYuval Mintz struct qed_eq *p_eq = cookie; 361fe56b9e6SYuval Mintz struct qed_chain *p_chain = &p_eq->chain; 362fe56b9e6SYuval Mintz int rc = 0; 363fe56b9e6SYuval Mintz 364fe56b9e6SYuval Mintz /* take a snapshot of the FW consumer */ 365fe56b9e6SYuval Mintz u16 fw_cons_idx = le16_to_cpu(*p_eq->p_fw_cons); 366fe56b9e6SYuval Mintz 367fe56b9e6SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_SPQ, "fw_cons_idx %x\n", fw_cons_idx); 368fe56b9e6SYuval Mintz 369fe56b9e6SYuval Mintz /* Need to guarantee the fw_cons index we use points to a usuable 370fe56b9e6SYuval Mintz * element (to comply with our chain), so our macros would comply 371fe56b9e6SYuval Mintz */ 372fe56b9e6SYuval Mintz if ((fw_cons_idx & qed_chain_get_usable_per_page(p_chain)) == 373fe56b9e6SYuval Mintz qed_chain_get_usable_per_page(p_chain)) 374fe56b9e6SYuval Mintz fw_cons_idx += qed_chain_get_unusable_per_page(p_chain); 375fe56b9e6SYuval Mintz 376fe56b9e6SYuval Mintz /* Complete current segment of eq entries */ 377fe56b9e6SYuval Mintz while (fw_cons_idx != qed_chain_get_cons_idx(p_chain)) { 378fe56b9e6SYuval Mintz struct event_ring_entry *p_eqe = qed_chain_consume(p_chain); 379fe56b9e6SYuval Mintz 380fe56b9e6SYuval Mintz if (!p_eqe) { 381fe56b9e6SYuval Mintz rc = -EINVAL; 382fe56b9e6SYuval Mintz break; 383fe56b9e6SYuval Mintz } 384fe56b9e6SYuval Mintz 385fe56b9e6SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_SPQ, 386fe56b9e6SYuval Mintz "op %x prot %x res0 %x echo %x fwret %x flags %x\n", 387fe56b9e6SYuval Mintz p_eqe->opcode, 388fe56b9e6SYuval Mintz p_eqe->protocol_id, 389fe56b9e6SYuval Mintz p_eqe->reserved0, 390fe56b9e6SYuval Mintz le16_to_cpu(p_eqe->echo), 391fe56b9e6SYuval Mintz p_eqe->fw_return_code, 392fe56b9e6SYuval Mintz p_eqe->flags); 393fe56b9e6SYuval Mintz 394fe56b9e6SYuval Mintz if (GET_FIELD(p_eqe->flags, EVENT_RING_ENTRY_ASYNC)) { 395fe56b9e6SYuval Mintz if (qed_async_event_completion(p_hwfn, p_eqe)) 396fe56b9e6SYuval Mintz rc = -EINVAL; 397fe56b9e6SYuval Mintz } else if (qed_spq_completion(p_hwfn, 398fe56b9e6SYuval Mintz p_eqe->echo, 399fe56b9e6SYuval Mintz p_eqe->fw_return_code, 400fe56b9e6SYuval Mintz &p_eqe->data)) { 401fe56b9e6SYuval Mintz rc = -EINVAL; 402fe56b9e6SYuval Mintz } 403fe56b9e6SYuval Mintz 404fe56b9e6SYuval Mintz qed_chain_recycle_consumed(p_chain); 405fe56b9e6SYuval Mintz } 406fe56b9e6SYuval Mintz 407fe56b9e6SYuval Mintz qed_eq_prod_update(p_hwfn, qed_chain_get_prod_idx(p_chain)); 408fe56b9e6SYuval Mintz 409fe56b9e6SYuval Mintz return rc; 410fe56b9e6SYuval Mintz } 411fe56b9e6SYuval Mintz 4123587cb87STomer Tayar int qed_eq_alloc(struct qed_hwfn *p_hwfn, u16 num_elem) 413fe56b9e6SYuval Mintz { 414fe56b9e6SYuval Mintz struct qed_eq *p_eq; 415fe56b9e6SYuval Mintz 416fe56b9e6SYuval Mintz /* Allocate EQ struct */ 41760fffb3bSYuval Mintz p_eq = kzalloc(sizeof(*p_eq), GFP_KERNEL); 4182591c280SJoe Perches if (!p_eq) 4193587cb87STomer Tayar return -ENOMEM; 420fe56b9e6SYuval Mintz 421fe56b9e6SYuval Mintz /* Allocate and initialize EQ chain*/ 422fe56b9e6SYuval Mintz if (qed_chain_alloc(p_hwfn->cdev, 423fe56b9e6SYuval Mintz QED_CHAIN_USE_TO_PRODUCE, 424fe56b9e6SYuval Mintz QED_CHAIN_MODE_PBL, 425a91eb52aSYuval Mintz QED_CHAIN_CNT_TYPE_U16, 426fe56b9e6SYuval Mintz num_elem, 427fe56b9e6SYuval Mintz sizeof(union event_ring_element), 4281a4a6975SMintz, Yuval &p_eq->chain, NULL)) 429fe56b9e6SYuval Mintz goto eq_allocate_fail; 430fe56b9e6SYuval Mintz 431fe56b9e6SYuval Mintz /* register EQ completion on the SP SB */ 4321a635e48SYuval Mintz qed_int_register_cb(p_hwfn, qed_eq_completion, 4331a635e48SYuval Mintz p_eq, &p_eq->eq_sb_index, &p_eq->p_fw_cons); 434fe56b9e6SYuval Mintz 4353587cb87STomer Tayar p_hwfn->p_eq = p_eq; 4363587cb87STomer Tayar return 0; 437fe56b9e6SYuval Mintz 438fe56b9e6SYuval Mintz eq_allocate_fail: 439fe56b9e6SYuval Mintz kfree(p_eq); 4403587cb87STomer Tayar return -ENOMEM; 4413587cb87STomer Tayar } 4423587cb87STomer Tayar 4433587cb87STomer Tayar void qed_eq_setup(struct qed_hwfn *p_hwfn) 4443587cb87STomer Tayar { 4453587cb87STomer Tayar qed_chain_reset(&p_hwfn->p_eq->chain); 4463587cb87STomer Tayar } 4473587cb87STomer Tayar 4483587cb87STomer Tayar void qed_eq_free(struct qed_hwfn *p_hwfn) 4493587cb87STomer Tayar { 4503587cb87STomer Tayar if (!p_hwfn->p_eq) 4513587cb87STomer Tayar return; 4523587cb87STomer Tayar 4533587cb87STomer Tayar qed_chain_free(p_hwfn->cdev, &p_hwfn->p_eq->chain); 4543587cb87STomer Tayar 4553587cb87STomer Tayar kfree(p_hwfn->p_eq); 4563587cb87STomer Tayar p_hwfn->p_eq = NULL; 457fe56b9e6SYuval Mintz } 458fe56b9e6SYuval Mintz 459fe56b9e6SYuval Mintz /*************************************************************************** 460cee4d264SManish Chopra * CQE API - manipulate EQ functionality 461cee4d264SManish Chopra ***************************************************************************/ 4621a635e48SYuval Mintz static int qed_cqe_completion(struct qed_hwfn *p_hwfn, 463cee4d264SManish Chopra struct eth_slow_path_rx_cqe *cqe, 464cee4d264SManish Chopra enum protocol_type protocol) 465cee4d264SManish Chopra { 4661408cc1fSYuval Mintz if (IS_VF(p_hwfn->cdev)) 4671408cc1fSYuval Mintz return 0; 4681408cc1fSYuval Mintz 469cee4d264SManish Chopra /* @@@tmp - it's possible we'll eventually want to handle some 470cee4d264SManish Chopra * actual commands that can arrive here, but for now this is only 471cee4d264SManish Chopra * used to complete the ramrod using the echo value on the cqe 472cee4d264SManish Chopra */ 473cee4d264SManish Chopra return qed_spq_completion(p_hwfn, cqe->echo, 0, NULL); 474cee4d264SManish Chopra } 475cee4d264SManish Chopra 476cee4d264SManish Chopra int qed_eth_cqe_completion(struct qed_hwfn *p_hwfn, 477cee4d264SManish Chopra struct eth_slow_path_rx_cqe *cqe) 478cee4d264SManish Chopra { 479cee4d264SManish Chopra int rc; 480cee4d264SManish Chopra 481cee4d264SManish Chopra rc = qed_cqe_completion(p_hwfn, cqe, PROTOCOLID_ETH); 482cee4d264SManish Chopra if (rc) 483cee4d264SManish Chopra DP_NOTICE(p_hwfn, 484cee4d264SManish Chopra "Failed to handle RXQ CQE [cmd 0x%02x]\n", 485cee4d264SManish Chopra cqe->ramrod_cmd_id); 486cee4d264SManish Chopra 487cee4d264SManish Chopra return rc; 488cee4d264SManish Chopra } 489cee4d264SManish Chopra 490cee4d264SManish Chopra /*************************************************************************** 491fe56b9e6SYuval Mintz * Slow hwfn Queue (spq) 492fe56b9e6SYuval Mintz ***************************************************************************/ 493fe56b9e6SYuval Mintz void qed_spq_setup(struct qed_hwfn *p_hwfn) 494fe56b9e6SYuval Mintz { 495fe56b9e6SYuval Mintz struct qed_spq *p_spq = p_hwfn->p_spq; 496fe56b9e6SYuval Mintz struct qed_spq_entry *p_virt = NULL; 497fe56b9e6SYuval Mintz dma_addr_t p_phys = 0; 498a91eb52aSYuval Mintz u32 i, capacity; 499fe56b9e6SYuval Mintz 500fe56b9e6SYuval Mintz INIT_LIST_HEAD(&p_spq->pending); 501fe56b9e6SYuval Mintz INIT_LIST_HEAD(&p_spq->completion_pending); 502fe56b9e6SYuval Mintz INIT_LIST_HEAD(&p_spq->free_pool); 503fe56b9e6SYuval Mintz INIT_LIST_HEAD(&p_spq->unlimited_pending); 504fe56b9e6SYuval Mintz spin_lock_init(&p_spq->lock); 505fe56b9e6SYuval Mintz 506fe56b9e6SYuval Mintz /* SPQ empty pool */ 507fe56b9e6SYuval Mintz p_phys = p_spq->p_phys + offsetof(struct qed_spq_entry, ramrod); 508fe56b9e6SYuval Mintz p_virt = p_spq->p_virt; 509fe56b9e6SYuval Mintz 510a91eb52aSYuval Mintz capacity = qed_chain_get_capacity(&p_spq->chain); 511a91eb52aSYuval Mintz for (i = 0; i < capacity; i++) { 51294494598SYuval Mintz DMA_REGPAIR_LE(p_virt->elem.data_ptr, p_phys); 513fe56b9e6SYuval Mintz 514fe56b9e6SYuval Mintz list_add_tail(&p_virt->list, &p_spq->free_pool); 515fe56b9e6SYuval Mintz 516fe56b9e6SYuval Mintz p_virt++; 517fe56b9e6SYuval Mintz p_phys += sizeof(struct qed_spq_entry); 518fe56b9e6SYuval Mintz } 519fe56b9e6SYuval Mintz 520fe56b9e6SYuval Mintz /* Statistics */ 521fe56b9e6SYuval Mintz p_spq->normal_count = 0; 522fe56b9e6SYuval Mintz p_spq->comp_count = 0; 523fe56b9e6SYuval Mintz p_spq->comp_sent_count = 0; 524fe56b9e6SYuval Mintz p_spq->unlimited_pending_count = 0; 52576a9a364STomer Tayar 52676a9a364STomer Tayar bitmap_zero(p_spq->p_comp_bitmap, SPQ_RING_SIZE); 52776a9a364STomer Tayar p_spq->comp_bitmap_idx = 0; 528fe56b9e6SYuval Mintz 529fe56b9e6SYuval Mintz /* SPQ cid, cannot fail */ 530fe56b9e6SYuval Mintz qed_cxt_acquire_cid(p_hwfn, PROTOCOLID_CORE, &p_spq->cid); 531fe56b9e6SYuval Mintz qed_spq_hw_initialize(p_hwfn, p_spq); 532fe56b9e6SYuval Mintz 533fe56b9e6SYuval Mintz /* reset the chain itself */ 534fe56b9e6SYuval Mintz qed_chain_reset(&p_spq->chain); 535fe56b9e6SYuval Mintz } 536fe56b9e6SYuval Mintz 537fe56b9e6SYuval Mintz int qed_spq_alloc(struct qed_hwfn *p_hwfn) 538fe56b9e6SYuval Mintz { 539a91eb52aSYuval Mintz struct qed_spq_entry *p_virt = NULL; 540fe56b9e6SYuval Mintz struct qed_spq *p_spq = NULL; 541fe56b9e6SYuval Mintz dma_addr_t p_phys = 0; 542a91eb52aSYuval Mintz u32 capacity; 543fe56b9e6SYuval Mintz 544fe56b9e6SYuval Mintz /* SPQ struct */ 5451a635e48SYuval Mintz p_spq = kzalloc(sizeof(struct qed_spq), GFP_KERNEL); 5462591c280SJoe Perches if (!p_spq) 547fe56b9e6SYuval Mintz return -ENOMEM; 548fe56b9e6SYuval Mintz 549fe56b9e6SYuval Mintz /* SPQ ring */ 550fe56b9e6SYuval Mintz if (qed_chain_alloc(p_hwfn->cdev, 551fe56b9e6SYuval Mintz QED_CHAIN_USE_TO_PRODUCE, 552fe56b9e6SYuval Mintz QED_CHAIN_MODE_SINGLE, 553a91eb52aSYuval Mintz QED_CHAIN_CNT_TYPE_U16, 554fe56b9e6SYuval Mintz 0, /* N/A when the mode is SINGLE */ 555fe56b9e6SYuval Mintz sizeof(struct slow_path_element), 5561a4a6975SMintz, Yuval &p_spq->chain, NULL)) 557fe56b9e6SYuval Mintz goto spq_allocate_fail; 558fe56b9e6SYuval Mintz 559fe56b9e6SYuval Mintz /* allocate and fill the SPQ elements (incl. ramrod data list) */ 560a91eb52aSYuval Mintz capacity = qed_chain_get_capacity(&p_spq->chain); 561fe56b9e6SYuval Mintz p_virt = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev, 5622591c280SJoe Perches capacity * sizeof(struct qed_spq_entry), 563a91eb52aSYuval Mintz &p_phys, GFP_KERNEL); 564fe56b9e6SYuval Mintz if (!p_virt) 565fe56b9e6SYuval Mintz goto spq_allocate_fail; 566fe56b9e6SYuval Mintz 567fe56b9e6SYuval Mintz p_spq->p_virt = p_virt; 568fe56b9e6SYuval Mintz p_spq->p_phys = p_phys; 569fe56b9e6SYuval Mintz p_hwfn->p_spq = p_spq; 570fe56b9e6SYuval Mintz 571fe56b9e6SYuval Mintz return 0; 572fe56b9e6SYuval Mintz 573fe56b9e6SYuval Mintz spq_allocate_fail: 574fe56b9e6SYuval Mintz qed_chain_free(p_hwfn->cdev, &p_spq->chain); 575fe56b9e6SYuval Mintz kfree(p_spq); 576fe56b9e6SYuval Mintz return -ENOMEM; 577fe56b9e6SYuval Mintz } 578fe56b9e6SYuval Mintz 579fe56b9e6SYuval Mintz void qed_spq_free(struct qed_hwfn *p_hwfn) 580fe56b9e6SYuval Mintz { 581fe56b9e6SYuval Mintz struct qed_spq *p_spq = p_hwfn->p_spq; 582a91eb52aSYuval Mintz u32 capacity; 583fe56b9e6SYuval Mintz 584fe56b9e6SYuval Mintz if (!p_spq) 585fe56b9e6SYuval Mintz return; 586fe56b9e6SYuval Mintz 587a91eb52aSYuval Mintz if (p_spq->p_virt) { 588a91eb52aSYuval Mintz capacity = qed_chain_get_capacity(&p_spq->chain); 589fe56b9e6SYuval Mintz dma_free_coherent(&p_hwfn->cdev->pdev->dev, 590a91eb52aSYuval Mintz capacity * 591fe56b9e6SYuval Mintz sizeof(struct qed_spq_entry), 592a91eb52aSYuval Mintz p_spq->p_virt, p_spq->p_phys); 593a91eb52aSYuval Mintz } 594fe56b9e6SYuval Mintz 595fe56b9e6SYuval Mintz qed_chain_free(p_hwfn->cdev, &p_spq->chain); 596fe56b9e6SYuval Mintz kfree(p_spq); 5973587cb87STomer Tayar p_hwfn->p_spq = NULL; 598fe56b9e6SYuval Mintz } 599fe56b9e6SYuval Mintz 6001a635e48SYuval Mintz int qed_spq_get_entry(struct qed_hwfn *p_hwfn, struct qed_spq_entry **pp_ent) 601fe56b9e6SYuval Mintz { 602fe56b9e6SYuval Mintz struct qed_spq *p_spq = p_hwfn->p_spq; 603fe56b9e6SYuval Mintz struct qed_spq_entry *p_ent = NULL; 604fe56b9e6SYuval Mintz int rc = 0; 605fe56b9e6SYuval Mintz 606fe56b9e6SYuval Mintz spin_lock_bh(&p_spq->lock); 607fe56b9e6SYuval Mintz 608fe56b9e6SYuval Mintz if (list_empty(&p_spq->free_pool)) { 609fe56b9e6SYuval Mintz p_ent = kzalloc(sizeof(*p_ent), GFP_ATOMIC); 610fe56b9e6SYuval Mintz if (!p_ent) { 6111a635e48SYuval Mintz DP_NOTICE(p_hwfn, 6121a635e48SYuval Mintz "Failed to allocate an SPQ entry for a pending ramrod\n"); 613fe56b9e6SYuval Mintz rc = -ENOMEM; 614fe56b9e6SYuval Mintz goto out_unlock; 615fe56b9e6SYuval Mintz } 616fe56b9e6SYuval Mintz p_ent->queue = &p_spq->unlimited_pending; 617fe56b9e6SYuval Mintz } else { 618fe56b9e6SYuval Mintz p_ent = list_first_entry(&p_spq->free_pool, 6191a635e48SYuval Mintz struct qed_spq_entry, list); 620fe56b9e6SYuval Mintz list_del(&p_ent->list); 621fe56b9e6SYuval Mintz p_ent->queue = &p_spq->pending; 622fe56b9e6SYuval Mintz } 623fe56b9e6SYuval Mintz 624fe56b9e6SYuval Mintz *pp_ent = p_ent; 625fe56b9e6SYuval Mintz 626fe56b9e6SYuval Mintz out_unlock: 627fe56b9e6SYuval Mintz spin_unlock_bh(&p_spq->lock); 628fe56b9e6SYuval Mintz return rc; 629fe56b9e6SYuval Mintz } 630fe56b9e6SYuval Mintz 631fe56b9e6SYuval Mintz /* Locked variant; Should be called while the SPQ lock is taken */ 632fe56b9e6SYuval Mintz static void __qed_spq_return_entry(struct qed_hwfn *p_hwfn, 633fe56b9e6SYuval Mintz struct qed_spq_entry *p_ent) 634fe56b9e6SYuval Mintz { 635fe56b9e6SYuval Mintz list_add_tail(&p_ent->list, &p_hwfn->p_spq->free_pool); 636fe56b9e6SYuval Mintz } 637fe56b9e6SYuval Mintz 6381a635e48SYuval Mintz void qed_spq_return_entry(struct qed_hwfn *p_hwfn, struct qed_spq_entry *p_ent) 639fe56b9e6SYuval Mintz { 640fe56b9e6SYuval Mintz spin_lock_bh(&p_hwfn->p_spq->lock); 641fe56b9e6SYuval Mintz __qed_spq_return_entry(p_hwfn, p_ent); 642fe56b9e6SYuval Mintz spin_unlock_bh(&p_hwfn->p_spq->lock); 643fe56b9e6SYuval Mintz } 644fe56b9e6SYuval Mintz 645fe56b9e6SYuval Mintz /** 646fe56b9e6SYuval Mintz * @brief qed_spq_add_entry - adds a new entry to the pending 647fe56b9e6SYuval Mintz * list. Should be used while lock is being held. 648fe56b9e6SYuval Mintz * 649fe56b9e6SYuval Mintz * Addes an entry to the pending list is there is room (en empty 650fe56b9e6SYuval Mintz * element is available in the free_pool), or else places the 651fe56b9e6SYuval Mintz * entry in the unlimited_pending pool. 652fe56b9e6SYuval Mintz * 653fe56b9e6SYuval Mintz * @param p_hwfn 654fe56b9e6SYuval Mintz * @param p_ent 655fe56b9e6SYuval Mintz * @param priority 656fe56b9e6SYuval Mintz * 657fe56b9e6SYuval Mintz * @return int 658fe56b9e6SYuval Mintz */ 6591a635e48SYuval Mintz static int qed_spq_add_entry(struct qed_hwfn *p_hwfn, 660fe56b9e6SYuval Mintz struct qed_spq_entry *p_ent, 661fe56b9e6SYuval Mintz enum spq_priority priority) 662fe56b9e6SYuval Mintz { 663fe56b9e6SYuval Mintz struct qed_spq *p_spq = p_hwfn->p_spq; 664fe56b9e6SYuval Mintz 665fe56b9e6SYuval Mintz if (p_ent->queue == &p_spq->unlimited_pending) { 666fe56b9e6SYuval Mintz 667fe56b9e6SYuval Mintz if (list_empty(&p_spq->free_pool)) { 668fe56b9e6SYuval Mintz list_add_tail(&p_ent->list, &p_spq->unlimited_pending); 669fe56b9e6SYuval Mintz p_spq->unlimited_pending_count++; 670fe56b9e6SYuval Mintz 671fe56b9e6SYuval Mintz return 0; 67276a9a364STomer Tayar } else { 67376a9a364STomer Tayar struct qed_spq_entry *p_en2; 674fe56b9e6SYuval Mintz 675fe56b9e6SYuval Mintz p_en2 = list_first_entry(&p_spq->free_pool, 6761a635e48SYuval Mintz struct qed_spq_entry, list); 677fe56b9e6SYuval Mintz list_del(&p_en2->list); 678fe56b9e6SYuval Mintz 67976a9a364STomer Tayar /* Copy the ring element physical pointer to the new 68076a9a364STomer Tayar * entry, since we are about to override the entire ring 68176a9a364STomer Tayar * entry and don't want to lose the pointer. 68276a9a364STomer Tayar */ 68376a9a364STomer Tayar p_ent->elem.data_ptr = p_en2->elem.data_ptr; 68476a9a364STomer Tayar 685fe56b9e6SYuval Mintz *p_en2 = *p_ent; 686fe56b9e6SYuval Mintz 687db511c37SYuval Mintz /* EBLOCK responsible to free the allocated p_ent */ 688db511c37SYuval Mintz if (p_ent->comp_mode != QED_SPQ_MODE_EBLOCK) 689fe56b9e6SYuval Mintz kfree(p_ent); 690fe56b9e6SYuval Mintz 691fe56b9e6SYuval Mintz p_ent = p_en2; 692fe56b9e6SYuval Mintz } 69376a9a364STomer Tayar } 694fe56b9e6SYuval Mintz 695fe56b9e6SYuval Mintz /* entry is to be placed in 'pending' queue */ 696fe56b9e6SYuval Mintz switch (priority) { 697fe56b9e6SYuval Mintz case QED_SPQ_PRIORITY_NORMAL: 698fe56b9e6SYuval Mintz list_add_tail(&p_ent->list, &p_spq->pending); 699fe56b9e6SYuval Mintz p_spq->normal_count++; 700fe56b9e6SYuval Mintz break; 701fe56b9e6SYuval Mintz case QED_SPQ_PRIORITY_HIGH: 702fe56b9e6SYuval Mintz list_add(&p_ent->list, &p_spq->pending); 703fe56b9e6SYuval Mintz p_spq->high_count++; 704fe56b9e6SYuval Mintz break; 705fe56b9e6SYuval Mintz default: 706fe56b9e6SYuval Mintz return -EINVAL; 707fe56b9e6SYuval Mintz } 708fe56b9e6SYuval Mintz 709fe56b9e6SYuval Mintz return 0; 710fe56b9e6SYuval Mintz } 711fe56b9e6SYuval Mintz 712fe56b9e6SYuval Mintz /*************************************************************************** 713fe56b9e6SYuval Mintz * Accessor 714fe56b9e6SYuval Mintz ***************************************************************************/ 715fe56b9e6SYuval Mintz u32 qed_spq_get_cid(struct qed_hwfn *p_hwfn) 716fe56b9e6SYuval Mintz { 717fe56b9e6SYuval Mintz if (!p_hwfn->p_spq) 718fe56b9e6SYuval Mintz return 0xffffffff; /* illegal */ 719fe56b9e6SYuval Mintz return p_hwfn->p_spq->cid; 720fe56b9e6SYuval Mintz } 721fe56b9e6SYuval Mintz 722fe56b9e6SYuval Mintz /*************************************************************************** 723fe56b9e6SYuval Mintz * Posting new Ramrods 724fe56b9e6SYuval Mintz ***************************************************************************/ 725fe56b9e6SYuval Mintz static int qed_spq_post_list(struct qed_hwfn *p_hwfn, 7261a635e48SYuval Mintz struct list_head *head, u32 keep_reserve) 727fe56b9e6SYuval Mintz { 728fe56b9e6SYuval Mintz struct qed_spq *p_spq = p_hwfn->p_spq; 729fe56b9e6SYuval Mintz int rc; 730fe56b9e6SYuval Mintz 731fe56b9e6SYuval Mintz while (qed_chain_get_elem_left(&p_spq->chain) > keep_reserve && 732fe56b9e6SYuval Mintz !list_empty(head)) { 733fe56b9e6SYuval Mintz struct qed_spq_entry *p_ent = 734fe56b9e6SYuval Mintz list_first_entry(head, struct qed_spq_entry, list); 735fe56b9e6SYuval Mintz list_del(&p_ent->list); 736fe56b9e6SYuval Mintz list_add_tail(&p_ent->list, &p_spq->completion_pending); 737fe56b9e6SYuval Mintz p_spq->comp_sent_count++; 738fe56b9e6SYuval Mintz 739fe56b9e6SYuval Mintz rc = qed_spq_hw_post(p_hwfn, p_spq, p_ent); 740fe56b9e6SYuval Mintz if (rc) { 741fe56b9e6SYuval Mintz list_del(&p_ent->list); 742fe56b9e6SYuval Mintz __qed_spq_return_entry(p_hwfn, p_ent); 743fe56b9e6SYuval Mintz return rc; 744fe56b9e6SYuval Mintz } 745fe56b9e6SYuval Mintz } 746fe56b9e6SYuval Mintz 747fe56b9e6SYuval Mintz return 0; 748fe56b9e6SYuval Mintz } 749fe56b9e6SYuval Mintz 750fe56b9e6SYuval Mintz static int qed_spq_pend_post(struct qed_hwfn *p_hwfn) 751fe56b9e6SYuval Mintz { 752fe56b9e6SYuval Mintz struct qed_spq *p_spq = p_hwfn->p_spq; 753fe56b9e6SYuval Mintz struct qed_spq_entry *p_ent = NULL; 754fe56b9e6SYuval Mintz 755fe56b9e6SYuval Mintz while (!list_empty(&p_spq->free_pool)) { 756fe56b9e6SYuval Mintz if (list_empty(&p_spq->unlimited_pending)) 757fe56b9e6SYuval Mintz break; 758fe56b9e6SYuval Mintz 759fe56b9e6SYuval Mintz p_ent = list_first_entry(&p_spq->unlimited_pending, 7601a635e48SYuval Mintz struct qed_spq_entry, list); 761fe56b9e6SYuval Mintz if (!p_ent) 762fe56b9e6SYuval Mintz return -EINVAL; 763fe56b9e6SYuval Mintz 764fe56b9e6SYuval Mintz list_del(&p_ent->list); 765fe56b9e6SYuval Mintz 766fe56b9e6SYuval Mintz qed_spq_add_entry(p_hwfn, p_ent, p_ent->priority); 767fe56b9e6SYuval Mintz } 768fe56b9e6SYuval Mintz 769fe56b9e6SYuval Mintz return qed_spq_post_list(p_hwfn, &p_spq->pending, 770fe56b9e6SYuval Mintz SPQ_HIGH_PRI_RESERVE_DEFAULT); 771fe56b9e6SYuval Mintz } 772fe56b9e6SYuval Mintz 773fe56b9e6SYuval Mintz int qed_spq_post(struct qed_hwfn *p_hwfn, 7741a635e48SYuval Mintz struct qed_spq_entry *p_ent, u8 *fw_return_code) 775fe56b9e6SYuval Mintz { 776fe56b9e6SYuval Mintz int rc = 0; 777fe56b9e6SYuval Mintz struct qed_spq *p_spq = p_hwfn ? p_hwfn->p_spq : NULL; 778fe56b9e6SYuval Mintz bool b_ret_ent = true; 779fe56b9e6SYuval Mintz 780fe56b9e6SYuval Mintz if (!p_hwfn) 781fe56b9e6SYuval Mintz return -EINVAL; 782fe56b9e6SYuval Mintz 783fe56b9e6SYuval Mintz if (!p_ent) { 784fe56b9e6SYuval Mintz DP_NOTICE(p_hwfn, "Got a NULL pointer\n"); 785fe56b9e6SYuval Mintz return -EINVAL; 786fe56b9e6SYuval Mintz } 787fe56b9e6SYuval Mintz 788fe56b9e6SYuval Mintz /* Complete the entry */ 789fe56b9e6SYuval Mintz rc = qed_spq_fill_entry(p_hwfn, p_ent); 790fe56b9e6SYuval Mintz 791fe56b9e6SYuval Mintz spin_lock_bh(&p_spq->lock); 792fe56b9e6SYuval Mintz 793fe56b9e6SYuval Mintz /* Check return value after LOCK is taken for cleaner error flow */ 794fe56b9e6SYuval Mintz if (rc) 795fe56b9e6SYuval Mintz goto spq_post_fail; 796fe56b9e6SYuval Mintz 797fe56b9e6SYuval Mintz /* Add the request to the pending queue */ 798fe56b9e6SYuval Mintz rc = qed_spq_add_entry(p_hwfn, p_ent, p_ent->priority); 799fe56b9e6SYuval Mintz if (rc) 800fe56b9e6SYuval Mintz goto spq_post_fail; 801fe56b9e6SYuval Mintz 802fe56b9e6SYuval Mintz rc = qed_spq_pend_post(p_hwfn); 803fe56b9e6SYuval Mintz if (rc) { 804fe56b9e6SYuval Mintz /* Since it's possible that pending failed for a different 805fe56b9e6SYuval Mintz * entry [although unlikely], the failed entry was already 806fe56b9e6SYuval Mintz * dealt with; No need to return it here. 807fe56b9e6SYuval Mintz */ 808fe56b9e6SYuval Mintz b_ret_ent = false; 809fe56b9e6SYuval Mintz goto spq_post_fail; 810fe56b9e6SYuval Mintz } 811fe56b9e6SYuval Mintz 812fe56b9e6SYuval Mintz spin_unlock_bh(&p_spq->lock); 813fe56b9e6SYuval Mintz 814fe56b9e6SYuval Mintz if (p_ent->comp_mode == QED_SPQ_MODE_EBLOCK) { 815fe56b9e6SYuval Mintz /* For entries in QED BLOCK mode, the completion code cannot 816fe56b9e6SYuval Mintz * perform the necessary cleanup - if it did, we couldn't 817fe56b9e6SYuval Mintz * access p_ent here to see whether it's successful or not. 818fe56b9e6SYuval Mintz * Thus, after gaining the answer perform the cleanup here. 819fe56b9e6SYuval Mintz */ 820c59f5291SYuval Mintz rc = qed_spq_block(p_hwfn, p_ent, fw_return_code, 821c59f5291SYuval Mintz p_ent->queue == &p_spq->unlimited_pending); 822db511c37SYuval Mintz 823db511c37SYuval Mintz if (p_ent->queue == &p_spq->unlimited_pending) { 824db511c37SYuval Mintz /* This is an allocated p_ent which does not need to 825db511c37SYuval Mintz * return to pool. 826db511c37SYuval Mintz */ 827db511c37SYuval Mintz kfree(p_ent); 828db511c37SYuval Mintz return rc; 829db511c37SYuval Mintz } 830db511c37SYuval Mintz 831fe56b9e6SYuval Mintz if (rc) 832fe56b9e6SYuval Mintz goto spq_post_fail2; 833fe56b9e6SYuval Mintz 834fe56b9e6SYuval Mintz /* return to pool */ 835fe56b9e6SYuval Mintz qed_spq_return_entry(p_hwfn, p_ent); 836fe56b9e6SYuval Mintz } 837fe56b9e6SYuval Mintz return rc; 838fe56b9e6SYuval Mintz 839fe56b9e6SYuval Mintz spq_post_fail2: 840fe56b9e6SYuval Mintz spin_lock_bh(&p_spq->lock); 841fe56b9e6SYuval Mintz list_del(&p_ent->list); 842fe56b9e6SYuval Mintz qed_chain_return_produced(&p_spq->chain); 843fe56b9e6SYuval Mintz 844fe56b9e6SYuval Mintz spq_post_fail: 845fe56b9e6SYuval Mintz /* return to the free pool */ 846fe56b9e6SYuval Mintz if (b_ret_ent) 847fe56b9e6SYuval Mintz __qed_spq_return_entry(p_hwfn, p_ent); 848fe56b9e6SYuval Mintz spin_unlock_bh(&p_spq->lock); 849fe56b9e6SYuval Mintz 850fe56b9e6SYuval Mintz return rc; 851fe56b9e6SYuval Mintz } 852fe56b9e6SYuval Mintz 853fe56b9e6SYuval Mintz int qed_spq_completion(struct qed_hwfn *p_hwfn, 854fe56b9e6SYuval Mintz __le16 echo, 855fe56b9e6SYuval Mintz u8 fw_return_code, 856fe56b9e6SYuval Mintz union event_ring_data *p_data) 857fe56b9e6SYuval Mintz { 858fe56b9e6SYuval Mintz struct qed_spq *p_spq; 859fe56b9e6SYuval Mintz struct qed_spq_entry *p_ent = NULL; 860fe56b9e6SYuval Mintz struct qed_spq_entry *tmp; 861fe56b9e6SYuval Mintz struct qed_spq_entry *found = NULL; 862fe56b9e6SYuval Mintz int rc; 863fe56b9e6SYuval Mintz 864fe56b9e6SYuval Mintz if (!p_hwfn) 865fe56b9e6SYuval Mintz return -EINVAL; 866fe56b9e6SYuval Mintz 867fe56b9e6SYuval Mintz p_spq = p_hwfn->p_spq; 868fe56b9e6SYuval Mintz if (!p_spq) 869fe56b9e6SYuval Mintz return -EINVAL; 870fe56b9e6SYuval Mintz 871fe56b9e6SYuval Mintz spin_lock_bh(&p_spq->lock); 8721a635e48SYuval Mintz list_for_each_entry_safe(p_ent, tmp, &p_spq->completion_pending, list) { 873fe56b9e6SYuval Mintz if (p_ent->elem.hdr.echo == echo) { 87476a9a364STomer Tayar u16 pos = le16_to_cpu(echo) % SPQ_RING_SIZE; 87576a9a364STomer Tayar 876fe56b9e6SYuval Mintz list_del(&p_ent->list); 877fe56b9e6SYuval Mintz 87876a9a364STomer Tayar /* Avoid overriding of SPQ entries when getting 87976a9a364STomer Tayar * out-of-order completions, by marking the completions 88076a9a364STomer Tayar * in a bitmap and increasing the chain consumer only 88176a9a364STomer Tayar * for the first successive completed entries. 88276a9a364STomer Tayar */ 88359d3f1ceSManish Chopra __set_bit(pos, p_spq->p_comp_bitmap); 88476a9a364STomer Tayar 88576a9a364STomer Tayar while (test_bit(p_spq->comp_bitmap_idx, 88676a9a364STomer Tayar p_spq->p_comp_bitmap)) { 88759d3f1ceSManish Chopra __clear_bit(p_spq->comp_bitmap_idx, 88859d3f1ceSManish Chopra p_spq->p_comp_bitmap); 88976a9a364STomer Tayar p_spq->comp_bitmap_idx++; 890fe56b9e6SYuval Mintz qed_chain_return_produced(&p_spq->chain); 89176a9a364STomer Tayar } 89276a9a364STomer Tayar 893fe56b9e6SYuval Mintz p_spq->comp_count++; 894fe56b9e6SYuval Mintz found = p_ent; 895fe56b9e6SYuval Mintz break; 896fe56b9e6SYuval Mintz } 89776a9a364STomer Tayar 89876a9a364STomer Tayar /* This is relatively uncommon - depends on scenarios 89976a9a364STomer Tayar * which have mutliple per-PF sent ramrods. 90076a9a364STomer Tayar */ 90176a9a364STomer Tayar DP_VERBOSE(p_hwfn, QED_MSG_SPQ, 90276a9a364STomer Tayar "Got completion for echo %04x - doesn't match echo %04x in completion pending list\n", 90376a9a364STomer Tayar le16_to_cpu(echo), 90476a9a364STomer Tayar le16_to_cpu(p_ent->elem.hdr.echo)); 905fe56b9e6SYuval Mintz } 906fe56b9e6SYuval Mintz 907fe56b9e6SYuval Mintz /* Release lock before callback, as callback may post 908fe56b9e6SYuval Mintz * an additional ramrod. 909fe56b9e6SYuval Mintz */ 910fe56b9e6SYuval Mintz spin_unlock_bh(&p_spq->lock); 911fe56b9e6SYuval Mintz 912fe56b9e6SYuval Mintz if (!found) { 913fe56b9e6SYuval Mintz DP_NOTICE(p_hwfn, 914525ef5c0SYuval Mintz "Failed to find an entry this EQE [echo %04x] completes\n", 915525ef5c0SYuval Mintz le16_to_cpu(echo)); 916fe56b9e6SYuval Mintz return -EEXIST; 917fe56b9e6SYuval Mintz } 918fe56b9e6SYuval Mintz 919525ef5c0SYuval Mintz DP_VERBOSE(p_hwfn, QED_MSG_SPQ, 920525ef5c0SYuval Mintz "Complete EQE [echo %04x]: func %p cookie %p)\n", 921525ef5c0SYuval Mintz le16_to_cpu(echo), 922fe56b9e6SYuval Mintz p_ent->comp_cb.function, p_ent->comp_cb.cookie); 923fe56b9e6SYuval Mintz if (found->comp_cb.function) 924fe56b9e6SYuval Mintz found->comp_cb.function(p_hwfn, found->comp_cb.cookie, p_data, 925fe56b9e6SYuval Mintz fw_return_code); 926525ef5c0SYuval Mintz else 927525ef5c0SYuval Mintz DP_VERBOSE(p_hwfn, 928525ef5c0SYuval Mintz QED_MSG_SPQ, 929525ef5c0SYuval Mintz "Got a completion without a callback function\n"); 930fe56b9e6SYuval Mintz 931db511c37SYuval Mintz if ((found->comp_mode != QED_SPQ_MODE_EBLOCK) || 932db511c37SYuval Mintz (found->queue == &p_spq->unlimited_pending)) 933db511c37SYuval Mintz /* EBLOCK is responsible for returning its own entry into the 934db511c37SYuval Mintz * free list, unless it originally added the entry into the 935db511c37SYuval Mintz * unlimited pending list. 936db511c37SYuval Mintz */ 937fe56b9e6SYuval Mintz qed_spq_return_entry(p_hwfn, found); 938fe56b9e6SYuval Mintz 939fe56b9e6SYuval Mintz /* Attempt to post pending requests */ 940fe56b9e6SYuval Mintz spin_lock_bh(&p_spq->lock); 941fe56b9e6SYuval Mintz rc = qed_spq_pend_post(p_hwfn); 942fe56b9e6SYuval Mintz spin_unlock_bh(&p_spq->lock); 943fe56b9e6SYuval Mintz 944fe56b9e6SYuval Mintz return rc; 945fe56b9e6SYuval Mintz } 946fe56b9e6SYuval Mintz 9473587cb87STomer Tayar int qed_consq_alloc(struct qed_hwfn *p_hwfn) 948fe56b9e6SYuval Mintz { 949fe56b9e6SYuval Mintz struct qed_consq *p_consq; 950fe56b9e6SYuval Mintz 951fe56b9e6SYuval Mintz /* Allocate ConsQ struct */ 95260fffb3bSYuval Mintz p_consq = kzalloc(sizeof(*p_consq), GFP_KERNEL); 9532591c280SJoe Perches if (!p_consq) 9543587cb87STomer Tayar return -ENOMEM; 955fe56b9e6SYuval Mintz 956fe56b9e6SYuval Mintz /* Allocate and initialize EQ chain*/ 957fe56b9e6SYuval Mintz if (qed_chain_alloc(p_hwfn->cdev, 958fe56b9e6SYuval Mintz QED_CHAIN_USE_TO_PRODUCE, 959fe56b9e6SYuval Mintz QED_CHAIN_MODE_PBL, 960a91eb52aSYuval Mintz QED_CHAIN_CNT_TYPE_U16, 961fe56b9e6SYuval Mintz QED_CHAIN_PAGE_SIZE / 0x80, 9621a4a6975SMintz, Yuval 0x80, &p_consq->chain, NULL)) 963fe56b9e6SYuval Mintz goto consq_allocate_fail; 964fe56b9e6SYuval Mintz 9653587cb87STomer Tayar p_hwfn->p_consq = p_consq; 9663587cb87STomer Tayar return 0; 967fe56b9e6SYuval Mintz 968fe56b9e6SYuval Mintz consq_allocate_fail: 969fe56b9e6SYuval Mintz kfree(p_consq); 9703587cb87STomer Tayar return -ENOMEM; 9713587cb87STomer Tayar } 9723587cb87STomer Tayar 9733587cb87STomer Tayar void qed_consq_setup(struct qed_hwfn *p_hwfn) 9743587cb87STomer Tayar { 9753587cb87STomer Tayar qed_chain_reset(&p_hwfn->p_consq->chain); 9763587cb87STomer Tayar } 9773587cb87STomer Tayar 9783587cb87STomer Tayar void qed_consq_free(struct qed_hwfn *p_hwfn) 9793587cb87STomer Tayar { 9803587cb87STomer Tayar if (!p_hwfn->p_consq) 9813587cb87STomer Tayar return; 9823587cb87STomer Tayar 9833587cb87STomer Tayar qed_chain_free(p_hwfn->cdev, &p_hwfn->p_consq->chain); 9843587cb87STomer Tayar 9853587cb87STomer Tayar kfree(p_hwfn->p_consq); 9863587cb87STomer Tayar p_hwfn->p_consq = NULL; 987fe56b9e6SYuval Mintz } 988