drivers/net/ethernet/broadcom/bnx2x/bnx2x

/* [<][>][^][v][top][bottom][index][help] */
This source file includes following definitions.
bnx2x_add_tlv
bnx2x_vfpf_prep
bnx2x_vfpf_finalize
bnx2x_search_tlv_list
bnx2x_dp_tlv_list
bnx2x_tlv_supported
bnx2x_pfvf_status_codes
bnx2x_send_msg2pf
bnx2x_get_vf_id
bnx2x_vfpf_acquire
bnx2x_vfpf_release
bnx2x_vfpf_init
bnx2x_vfpf_close_vf
bnx2x_leading_vfq_init
bnx2x_vfpf_setup_q
bnx2x_vfpf_teardown_queue
bnx2x_vfpf_config_mac
bnx2x_vfpf_config_rss
bnx2x_vfpf_set_mcast
bnx2x_vfpf_update_vlan
bnx2x_vfpf_storm_rx_mode
storm_memset_vf_mbx_ack
storm_memset_vf_mbx_valid
bnx2x_vf_enable_mbx
bnx2x_copy32_vf_dmae
bnx2x_vf_mbx_resp_single_tlv
bnx2x_vf_mbx_resp_send_msg
bnx2x_vf_mbx_resp
bnx2x_vf_mbx_resp_phys_port
bnx2x_vf_mbx_resp_fp_hsi_ver
bnx2x_vf_mbx_acquire_resp
bnx2x_vf_mbx_is_windows_vm
bnx2x_vf_mbx_acquire_chk_dorq
bnx2x_vf_mbx_acquire
bnx2x_vf_mbx_init_vf
bnx2x_vf_mbx_set_q_flags
bnx2x_vf_mbx_setup_q
bnx2x_vf_mbx_macvlan_list
bnx2x_vf_filters_contain
bnx2x_vf_mbx_dp_q_filter
bnx2x_vf_mbx_dp_q_filters
bnx2x_vf_mbx_qfilters
bnx2x_filters_validate_mac
bnx2x_filters_validate_vlan
bnx2x_vf_mbx_set_q_filters
bnx2x_vf_mbx_teardown_q
bnx2x_vf_mbx_close_vf
bnx2x_vf_mbx_release_vf
bnx2x_vf_mbx_update_rss
bnx2x_validate_tpa_params
bnx2x_vf_mbx_update_tpa
bnx2x_vf_mbx_request
bnx2x_vf_mbx_schedule
bnx2x_vf_mbx
bnx2x_vf_bulletin_finalize
bnx2x_post_vf_bulletin
   1 /* bnx2x_vfpf.c: QLogic Everest network driver.
   2  *
   3  * Copyright 2009-2013 Broadcom Corporation
   4  * Copyright 2014 QLogic Corporation
   5  * All rights reserved
   6  *
   7  * Unless you and QLogic execute a separate written software license
   8  * agreement governing use of this software, this software is licensed to you
   9  * under the terms of the GNU General Public License version 2, available
  10  * at http://www.gnu.org/licenses/old-licenses/gpl-2.0.html (the "GPL").
  11  *
  12  * Notwithstanding the above, under no circumstances may you combine this
  13  * software in any way with any other QLogic software provided under a
  14  * license other than the GPL, without QLogic's express prior written
  15  * consent.
  16  *
  17  * Maintained by: Ariel Elior <ariel.elior@qlogic.com>
  18  * Written by: Shmulik Ravid
  19  *             Ariel Elior <ariel.elior@qlogic.com>
  20  */
  21 
  22 #include "bnx2x.h"
  23 #include "bnx2x_cmn.h"
  24 #include <linux/crc32.h>
  25 
  26 static int bnx2x_vfpf_teardown_queue(struct bnx2x *bp, int qidx);
  27 
  28 /* place a given tlv on the tlv buffer at a given offset */
  29 static void bnx2x_add_tlv(struct bnx2x *bp, void *tlvs_list,
  30                           u16 offset, u16 type, u16 length)
  31 {
  32         struct channel_tlv *tl =
  33                 (struct channel_tlv *)(tlvs_list + offset);
  34 
  35         tl->type = type;
  36         tl->length = length;
  37 }
  38 
  39 /* Clear the mailbox and init the header of the first tlv */
  40 static void bnx2x_vfpf_prep(struct bnx2x *bp, struct vfpf_first_tlv *first_tlv,
  41                             u16 type, u16 length)
  42 {
  43         mutex_lock(&bp->vf2pf_mutex);
  44 
  45         DP(BNX2X_MSG_IOV, "preparing to send %d tlv over vf pf channel\n",
  46            type);
  47 
  48         /* Clear mailbox */
  49         memset(bp->vf2pf_mbox, 0, sizeof(struct bnx2x_vf_mbx_msg));
  50 
  51         /* init type and length */
  52         bnx2x_add_tlv(bp, &first_tlv->tl, 0, type, length);
  53 
  54         /* init first tlv header */
  55         first_tlv->resp_msg_offset = sizeof(bp->vf2pf_mbox->req);
  56 }
  57 
  58 /* releases the mailbox */
  59 static void bnx2x_vfpf_finalize(struct bnx2x *bp,
  60                                 struct vfpf_first_tlv *first_tlv)
  61 {
  62         DP(BNX2X_MSG_IOV, "done sending [%d] tlv over vf pf channel\n",
  63            first_tlv->tl.type);
  64 
  65         mutex_unlock(&bp->vf2pf_mutex);
  66 }
  67 
  68 /* Finds a TLV by type in a TLV buffer; If found, returns pointer to the TLV */
  69 static void *bnx2x_search_tlv_list(struct bnx2x *bp, void *tlvs_list,
  70                                    enum channel_tlvs req_tlv)
  71 {
  72         struct channel_tlv *tlv = (struct channel_tlv *)tlvs_list;
  73 
  74         do {
  75                 if (tlv->type == req_tlv)
  76                         return tlv;
  77 
  78                 if (!tlv->length) {
  79                         BNX2X_ERR("Found TLV with length 0\n");
  80                         return NULL;
  81                 }
  82 
  83                 tlvs_list += tlv->length;
  84                 tlv = (struct channel_tlv *)tlvs_list;
  85         } while (tlv->type != CHANNEL_TLV_LIST_END);
  86 
  87         DP(BNX2X_MSG_IOV, "TLV list does not contain %d TLV\n", req_tlv);
  88 
  89         return NULL;
  90 }
  91 
  92 /* list the types and lengths of the tlvs on the buffer */
  93 static void bnx2x_dp_tlv_list(struct bnx2x *bp, void *tlvs_list)
  94 {
  95         int i = 1;
  96         struct channel_tlv *tlv = (struct channel_tlv *)tlvs_list;
  97 
  98         while (tlv->type != CHANNEL_TLV_LIST_END) {
  99                 /* output tlv */
 100                 DP(BNX2X_MSG_IOV, "TLV number %d: type %d, length %d\n", i,
 101                    tlv->type, tlv->length);
 102 
 103                 /* advance to next tlv */
 104                 tlvs_list += tlv->length;
 105 
 106                 /* cast general tlv list pointer to channel tlv header*/
 107                 tlv = (struct channel_tlv *)tlvs_list;
 108 
 109                 i++;
 110 
 111                 /* break condition for this loop */
 112                 if (i > MAX_TLVS_IN_LIST) {
 113                         WARN(true, "corrupt tlvs");
 114                         return;
 115                 }
 116         }
 117 
 118         /* output last tlv */
 119         DP(BNX2X_MSG_IOV, "TLV number %d: type %d, length %d\n", i,
 120            tlv->type, tlv->length);
 121 }
 122 
 123 /* test whether we support a tlv type */
 124 bool bnx2x_tlv_supported(u16 tlvtype)
 125 {
 126         return CHANNEL_TLV_NONE < tlvtype && tlvtype < CHANNEL_TLV_MAX;
 127 }
 128 
 129 static inline int bnx2x_pfvf_status_codes(int rc)
 130 {
 131         switch (rc) {
 132         case 0:
 133                 return PFVF_STATUS_SUCCESS;
 134         case -ENOMEM:
 135                 return PFVF_STATUS_NO_RESOURCE;
 136         default:
 137                 return PFVF_STATUS_FAILURE;
 138         }
 139 }
 140 
 141 static int bnx2x_send_msg2pf(struct bnx2x *bp, u8 *done, dma_addr_t msg_mapping)
 142 {
 143         struct cstorm_vf_zone_data __iomem *zone_data =
 144                 REG_ADDR(bp, PXP_VF_ADDR_CSDM_GLOBAL_START);
 145         int tout = 100, interval = 100; /* wait for 10 seconds */
 146 
 147         if (*done) {
 148                 BNX2X_ERR("done was non zero before message to pf was sent\n");
 149                 WARN_ON(true);
 150                 return -EINVAL;
 151         }
 152 
 153         /* if PF indicated channel is down avoid sending message. Return success
 154          * so calling flow can continue
 155          */
 156         bnx2x_sample_bulletin(bp);
 157         if (bp->old_bulletin.valid_bitmap & 1 << CHANNEL_DOWN) {
 158                 DP(BNX2X_MSG_IOV, "detecting channel down. Aborting message\n");
 159                 *done = PFVF_STATUS_SUCCESS;
 160                 return -EINVAL;
 161         }
 162 
 163         /* Write message address */
 164         writel(U64_LO(msg_mapping),
 165                &zone_data->non_trigger.vf_pf_channel.msg_addr_lo);
 166         writel(U64_HI(msg_mapping),
 167                &zone_data->non_trigger.vf_pf_channel.msg_addr_hi);
 168 
 169         /* make sure the address is written before FW accesses it */
 170         wmb();
 171 
 172         /* Trigger the PF FW */
 173         writeb_relaxed(1, &zone_data->trigger.vf_pf_channel.addr_valid);
 174 
 175         /* Wait for PF to complete */
 176         while ((tout >= 0) && (!*done)) {
 177                 msleep(interval);
 178                 tout -= 1;
 179 
 180                 /* progress indicator - HV can take its own sweet time in
 181                  * answering VFs...
 182                  */
 183                 DP_CONT(BNX2X_MSG_IOV, ".");
 184         }
 185 
 186         if (!*done) {
 187                 BNX2X_ERR("PF response has timed out\n");
 188                 return -EAGAIN;
 189         }
 190         DP(BNX2X_MSG_SP, "Got a response from PF\n");
 191         return 0;
 192 }
 193 
 194 static int bnx2x_get_vf_id(struct bnx2x *bp, u32 *vf_id)
 195 {
 196         u32 me_reg;
 197         int tout = 10, interval = 100; /* Wait for 1 sec */
 198 
 199         do {
 200                 /* pxp traps vf read of doorbells and returns me reg value */
 201                 me_reg = readl(bp->doorbells);
 202                 if (GOOD_ME_REG(me_reg))
 203                         break;
 204 
 205                 msleep(interval);
 206 
 207                 BNX2X_ERR("Invalid ME register value: 0x%08x\n. Is pf driver up?",
 208                           me_reg);
 209         } while (tout-- > 0);
 210 
 211         if (!GOOD_ME_REG(me_reg)) {
 212                 BNX2X_ERR("Invalid ME register value: 0x%08x\n", me_reg);
 213                 return -EINVAL;
 214         }
 215 
 216         DP(BNX2X_MSG_IOV, "valid ME register value: 0x%08x\n", me_reg);
 217 
 218         *vf_id = (me_reg & ME_REG_VF_NUM_MASK) >> ME_REG_VF_NUM_SHIFT;
 219 
 220         return 0;
 221 }
 222 
 223 int bnx2x_vfpf_acquire(struct bnx2x *bp, u8 tx_count, u8 rx_count)
 224 {
 225         int rc = 0, attempts = 0;
 226         struct vfpf_acquire_tlv *req = &bp->vf2pf_mbox->req.acquire;
 227         struct pfvf_acquire_resp_tlv *resp = &bp->vf2pf_mbox->resp.acquire_resp;
 228         struct vfpf_port_phys_id_resp_tlv *phys_port_resp;
 229         struct vfpf_fp_hsi_resp_tlv *fp_hsi_resp;
 230         u32 vf_id;
 231         bool resources_acquired = false;
 232 
 233         /* clear mailbox and prep first tlv */
 234         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_ACQUIRE, sizeof(*req));
 235 
 236         if (bnx2x_get_vf_id(bp, &vf_id)) {
 237                 rc = -EAGAIN;
 238                 goto out;
 239         }
 240 
 241         req->vfdev_info.vf_id = vf_id;
 242         req->vfdev_info.vf_os = 0;
 243         req->vfdev_info.fp_hsi_ver = ETH_FP_HSI_VERSION;
 244 
 245         req->resc_request.num_rxqs = rx_count;
 246         req->resc_request.num_txqs = tx_count;
 247         req->resc_request.num_sbs = bp->igu_sb_cnt;
 248         req->resc_request.num_mac_filters = VF_ACQUIRE_MAC_FILTERS;
 249         req->resc_request.num_mc_filters = VF_ACQUIRE_MC_FILTERS;
 250         req->resc_request.num_vlan_filters = VF_ACQUIRE_VLAN_FILTERS;
 251 
 252         /* pf 2 vf bulletin board address */
 253         req->bulletin_addr = bp->pf2vf_bulletin_mapping;
 254 
 255         /* Request physical port identifier */
 256         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length,
 257                       CHANNEL_TLV_PHYS_PORT_ID, sizeof(struct channel_tlv));
 258 
 259         /* Bulletin support for bulletin board with length > legacy length */
 260         req->vfdev_info.caps |= VF_CAP_SUPPORT_EXT_BULLETIN;
 261         /* vlan filtering is supported */
 262         req->vfdev_info.caps |= VF_CAP_SUPPORT_VLAN_FILTER;
 263 
 264         /* add list termination tlv */
 265         bnx2x_add_tlv(bp, req,
 266                       req->first_tlv.tl.length + sizeof(struct channel_tlv),
 267                       CHANNEL_TLV_LIST_END,
 268                       sizeof(struct channel_list_end_tlv));
 269 
 270         /* output tlvs list */
 271         bnx2x_dp_tlv_list(bp, req);
 272 
 273         while (!resources_acquired) {
 274                 DP(BNX2X_MSG_SP, "attempting to acquire resources\n");
 275 
 276                 /* send acquire request */
 277                 rc = bnx2x_send_msg2pf(bp,
 278                                        &resp->hdr.status,
 279                                        bp->vf2pf_mbox_mapping);
 280 
 281                 /* PF timeout */
 282                 if (rc)
 283                         goto out;
 284 
 285                 /* copy acquire response from buffer to bp */
 286                 memcpy(&bp->acquire_resp, resp, sizeof(bp->acquire_resp));
 287 
 288                 attempts++;
 289 
 290                 /* test whether the PF accepted our request. If not, humble
 291                  * the request and try again.
 292                  */
 293                 if (bp->acquire_resp.hdr.status == PFVF_STATUS_SUCCESS) {
 294                         DP(BNX2X_MSG_SP, "resources acquired\n");
 295                         resources_acquired = true;
 296                 } else if (bp->acquire_resp.hdr.status ==
 297                            PFVF_STATUS_NO_RESOURCE &&
 298                            attempts < VF_ACQUIRE_THRESH) {
 299                         DP(BNX2X_MSG_SP,
 300                            "PF unwilling to fulfill resource request. Try PF recommended amount\n");
 301 
 302                         /* humble our request */
 303                         req->resc_request.num_txqs =
 304                                 min(req->resc_request.num_txqs,
 305                                     bp->acquire_resp.resc.num_txqs);
 306                         req->resc_request.num_rxqs =
 307                                 min(req->resc_request.num_rxqs,
 308                                     bp->acquire_resp.resc.num_rxqs);
 309                         req->resc_request.num_sbs =
 310                                 min(req->resc_request.num_sbs,
 311                                     bp->acquire_resp.resc.num_sbs);
 312                         req->resc_request.num_mac_filters =
 313                                 min(req->resc_request.num_mac_filters,
 314                                     bp->acquire_resp.resc.num_mac_filters);
 315                         req->resc_request.num_vlan_filters =
 316                                 min(req->resc_request.num_vlan_filters,
 317                                     bp->acquire_resp.resc.num_vlan_filters);
 318                         req->resc_request.num_mc_filters =
 319                                 min(req->resc_request.num_mc_filters,
 320                                     bp->acquire_resp.resc.num_mc_filters);
 321 
 322                         /* Clear response buffer */
 323                         memset(&bp->vf2pf_mbox->resp, 0,
 324                                sizeof(union pfvf_tlvs));
 325                 } else {
 326                         /* Determine reason of PF failure of acquire process */
 327                         fp_hsi_resp = bnx2x_search_tlv_list(bp, resp,
 328                                                             CHANNEL_TLV_FP_HSI_SUPPORT);
 329                         if (fp_hsi_resp && !fp_hsi_resp->is_supported)
 330                                 BNX2X_ERR("Old hypervisor - doesn't support current fastpath HSI version; Need to downgrade VF driver [or upgrade hypervisor]\n");
 331                         else
 332                                 BNX2X_ERR("Failed to get the requested amount of resources: %d. Breaking...\n",
 333                                           bp->acquire_resp.hdr.status);
 334                         rc = -EAGAIN;
 335                         goto out;
 336                 }
 337         }
 338 
 339         /* Retrieve physical port id (if possible) */
 340         phys_port_resp = (struct vfpf_port_phys_id_resp_tlv *)
 341                          bnx2x_search_tlv_list(bp, resp,
 342                                                CHANNEL_TLV_PHYS_PORT_ID);
 343         if (phys_port_resp) {
 344                 memcpy(bp->phys_port_id, phys_port_resp->id, ETH_ALEN);
 345                 bp->flags |= HAS_PHYS_PORT_ID;
 346         }
 347 
 348         /* Old Hypevisors might not even support the FP_HSI_SUPPORT TLV.
 349          * If that's the case, we need to make certain required FW was
 350          * supported by such a hypervisor [i.e., v0-v2].
 351          */
 352         fp_hsi_resp = bnx2x_search_tlv_list(bp, resp,
 353                                             CHANNEL_TLV_FP_HSI_SUPPORT);
 354         if (!fp_hsi_resp && (ETH_FP_HSI_VERSION > ETH_FP_HSI_VER_2)) {
 355                 BNX2X_ERR("Old hypervisor - need to downgrade VF's driver\n");
 356 
 357                 /* Since acquire succeeded on the PF side, we need to send a
 358                  * release message in order to allow future probes.
 359                  */
 360                 bnx2x_vfpf_finalize(bp, &req->first_tlv);
 361                 bnx2x_vfpf_release(bp);
 362 
 363                 rc = -EINVAL;
 364                 goto out;
 365         }
 366 
 367         /* get HW info */
 368         bp->common.chip_id |= (bp->acquire_resp.pfdev_info.chip_num & 0xffff);
 369         bp->link_params.chip_id = bp->common.chip_id;
 370         bp->db_size = bp->acquire_resp.pfdev_info.db_size;
 371         bp->common.int_block = INT_BLOCK_IGU;
 372         bp->common.chip_port_mode = CHIP_2_PORT_MODE;
 373         bp->igu_dsb_id = -1;
 374         bp->mf_ov = 0;
 375         bp->mf_mode = 0;
 376         bp->common.flash_size = 0;
 377         bp->flags |=
 378                 NO_WOL_FLAG | NO_ISCSI_OOO_FLAG | NO_ISCSI_FLAG | NO_FCOE_FLAG;
 379         bp->igu_sb_cnt = bp->acquire_resp.resc.num_sbs;
 380         bp->igu_base_sb = bp->acquire_resp.resc.hw_sbs[0].hw_sb_id;
 381         bp->vlan_credit = bp->acquire_resp.resc.num_vlan_filters;
 382 
 383         strlcpy(bp->fw_ver, bp->acquire_resp.pfdev_info.fw_ver,
 384                 sizeof(bp->fw_ver));
 385 
 386         if (is_valid_ether_addr(bp->acquire_resp.resc.current_mac_addr))
 387                 memcpy(bp->dev->dev_addr,
 388                        bp->acquire_resp.resc.current_mac_addr,
 389                        ETH_ALEN);
 390 
 391 out:
 392         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 393         return rc;
 394 }
 395 
 396 int bnx2x_vfpf_release(struct bnx2x *bp)
 397 {
 398         struct vfpf_release_tlv *req = &bp->vf2pf_mbox->req.release;
 399         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 400         u32 rc, vf_id;
 401 
 402         /* clear mailbox and prep first tlv */
 403         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_RELEASE, sizeof(*req));
 404 
 405         if (bnx2x_get_vf_id(bp, &vf_id)) {
 406                 rc = -EAGAIN;
 407                 goto out;
 408         }
 409 
 410         req->vf_id = vf_id;
 411 
 412         /* add list termination tlv */
 413         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
 414                       sizeof(struct channel_list_end_tlv));
 415 
 416         /* output tlvs list */
 417         bnx2x_dp_tlv_list(bp, req);
 418 
 419         /* send release request */
 420         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
 421 
 422         if (rc)
 423                 /* PF timeout */
 424                 goto out;
 425 
 426         if (resp->hdr.status == PFVF_STATUS_SUCCESS) {
 427                 /* PF released us */
 428                 DP(BNX2X_MSG_SP, "vf released\n");
 429         } else {
 430                 /* PF reports error */
 431                 BNX2X_ERR("PF failed our release request - are we out of sync? Response status: %d\n",
 432                           resp->hdr.status);
 433                 rc = -EAGAIN;
 434                 goto out;
 435         }
 436 out:
 437         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 438 
 439         return rc;
 440 }
 441 
 442 /* Tell PF about SB addresses */
 443 int bnx2x_vfpf_init(struct bnx2x *bp)
 444 {
 445         struct vfpf_init_tlv *req = &bp->vf2pf_mbox->req.init;
 446         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 447         int rc, i;
 448 
 449         /* clear mailbox and prep first tlv */
 450         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_INIT, sizeof(*req));
 451 
 452         /* status blocks */
 453         for_each_eth_queue(bp, i)
 454                 req->sb_addr[i] = (dma_addr_t)bnx2x_fp(bp, i,
 455                                                        status_blk_mapping);
 456 
 457         /* statistics - requests only supports single queue for now */
 458         req->stats_addr = bp->fw_stats_data_mapping +
 459                           offsetof(struct bnx2x_fw_stats_data, queue_stats);
 460 
 461         req->stats_stride = sizeof(struct per_queue_stats);
 462 
 463         /* add list termination tlv */
 464         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
 465                       sizeof(struct channel_list_end_tlv));
 466 
 467         /* output tlvs list */
 468         bnx2x_dp_tlv_list(bp, req);
 469 
 470         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
 471         if (rc)
 472                 goto out;
 473 
 474         if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
 475                 BNX2X_ERR("INIT VF failed: %d. Breaking...\n",
 476                           resp->hdr.status);
 477                 rc = -EAGAIN;
 478                 goto out;
 479         }
 480 
 481         DP(BNX2X_MSG_SP, "INIT VF Succeeded\n");
 482 out:
 483         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 484 
 485         return rc;
 486 }
 487 
 488 /* CLOSE VF - opposite to INIT_VF */
 489 void bnx2x_vfpf_close_vf(struct bnx2x *bp)
 490 {
 491         struct vfpf_close_tlv *req = &bp->vf2pf_mbox->req.close;
 492         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 493         int i, rc;
 494         u32 vf_id;
 495 
 496         /* If we haven't got a valid VF id, there is no sense to
 497          * continue with sending messages
 498          */
 499         if (bnx2x_get_vf_id(bp, &vf_id))
 500                 goto free_irq;
 501 
 502         /* Close the queues */
 503         for_each_queue(bp, i)
 504                 bnx2x_vfpf_teardown_queue(bp, i);
 505 
 506         /* remove mac */
 507         bnx2x_vfpf_config_mac(bp, bp->dev->dev_addr, bp->fp->index, false);
 508 
 509         /* clear mailbox and prep first tlv */
 510         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_CLOSE, sizeof(*req));
 511 
 512         req->vf_id = vf_id;
 513 
 514         /* add list termination tlv */
 515         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
 516                       sizeof(struct channel_list_end_tlv));
 517 
 518         /* output tlvs list */
 519         bnx2x_dp_tlv_list(bp, req);
 520 
 521         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
 522 
 523         if (rc)
 524                 BNX2X_ERR("Sending CLOSE failed. rc was: %d\n", rc);
 525 
 526         else if (resp->hdr.status != PFVF_STATUS_SUCCESS)
 527                 BNX2X_ERR("Sending CLOSE failed: pf response was %d\n",
 528                           resp->hdr.status);
 529 
 530         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 531 
 532 free_irq:
 533         /* Disable HW interrupts, NAPI */
 534         bnx2x_netif_stop(bp, 0);
 535         /* Delete all NAPI objects */
 536         bnx2x_del_all_napi(bp);
 537 
 538         /* Release IRQs */
 539         bnx2x_free_irq(bp);
 540 }
 541 
 542 static void bnx2x_leading_vfq_init(struct bnx2x *bp, struct bnx2x_virtf *vf,
 543                                    struct bnx2x_vf_queue *q)
 544 {
 545         u8 cl_id = vfq_cl_id(vf, q);
 546         u8 func_id = FW_VF_HANDLE(vf->abs_vfid);
 547 
 548         /* mac */
 549         bnx2x_init_mac_obj(bp, &q->mac_obj,
 550                            cl_id, q->cid, func_id,
 551                            bnx2x_vf_sp(bp, vf, mac_rdata),
 552                            bnx2x_vf_sp_map(bp, vf, mac_rdata),
 553                            BNX2X_FILTER_MAC_PENDING,
 554                            &vf->filter_state,
 555                            BNX2X_OBJ_TYPE_RX_TX,
 556                            &vf->vf_macs_pool);
 557         /* vlan */
 558         bnx2x_init_vlan_obj(bp, &q->vlan_obj,
 559                             cl_id, q->cid, func_id,
 560                             bnx2x_vf_sp(bp, vf, vlan_rdata),
 561                             bnx2x_vf_sp_map(bp, vf, vlan_rdata),
 562                             BNX2X_FILTER_VLAN_PENDING,
 563                             &vf->filter_state,
 564                             BNX2X_OBJ_TYPE_RX_TX,
 565                             &vf->vf_vlans_pool);
 566         /* vlan-mac */
 567         bnx2x_init_vlan_mac_obj(bp, &q->vlan_mac_obj,
 568                                 cl_id, q->cid, func_id,
 569                                 bnx2x_vf_sp(bp, vf, vlan_mac_rdata),
 570                                 bnx2x_vf_sp_map(bp, vf, vlan_mac_rdata),
 571                                 BNX2X_FILTER_VLAN_MAC_PENDING,
 572                                 &vf->filter_state,
 573                                 BNX2X_OBJ_TYPE_RX_TX,
 574                                 &vf->vf_macs_pool,
 575                                 &vf->vf_vlans_pool);
 576         /* mcast */
 577         bnx2x_init_mcast_obj(bp, &vf->mcast_obj, cl_id,
 578                              q->cid, func_id, func_id,
 579                              bnx2x_vf_sp(bp, vf, mcast_rdata),
 580                              bnx2x_vf_sp_map(bp, vf, mcast_rdata),
 581                              BNX2X_FILTER_MCAST_PENDING,
 582                              &vf->filter_state,
 583                              BNX2X_OBJ_TYPE_RX_TX);
 584 
 585         /* rss */
 586         bnx2x_init_rss_config_obj(bp, &vf->rss_conf_obj, cl_id, q->cid,
 587                                   func_id, func_id,
 588                                   bnx2x_vf_sp(bp, vf, rss_rdata),
 589                                   bnx2x_vf_sp_map(bp, vf, rss_rdata),
 590                                   BNX2X_FILTER_RSS_CONF_PENDING,
 591                                   &vf->filter_state,
 592                                   BNX2X_OBJ_TYPE_RX_TX);
 593 
 594         vf->leading_rss = cl_id;
 595         q->is_leading = true;
 596         q->sp_initialized = true;
 597 }
 598 
 599 /* ask the pf to open a queue for the vf */
 600 int bnx2x_vfpf_setup_q(struct bnx2x *bp, struct bnx2x_fastpath *fp,
 601                        bool is_leading)
 602 {
 603         struct vfpf_setup_q_tlv *req = &bp->vf2pf_mbox->req.setup_q;
 604         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 605         u8 fp_idx = fp->index;
 606         u16 tpa_agg_size = 0, flags = 0;
 607         int rc;
 608 
 609         /* clear mailbox and prep first tlv */
 610         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_SETUP_Q, sizeof(*req));
 611 
 612         /* select tpa mode to request */
 613         if (fp->mode != TPA_MODE_DISABLED) {
 614                 flags |= VFPF_QUEUE_FLG_TPA;
 615                 flags |= VFPF_QUEUE_FLG_TPA_IPV6;
 616                 if (fp->mode == TPA_MODE_GRO)
 617                         flags |= VFPF_QUEUE_FLG_TPA_GRO;
 618                 tpa_agg_size = TPA_AGG_SIZE;
 619         }
 620 
 621         if (is_leading)
 622                 flags |= VFPF_QUEUE_FLG_LEADING_RSS;
 623 
 624         /* calculate queue flags */
 625         flags |= VFPF_QUEUE_FLG_STATS;
 626         flags |= VFPF_QUEUE_FLG_CACHE_ALIGN;
 627         flags |= VFPF_QUEUE_FLG_VLAN;
 628 
 629         /* Common */
 630         req->vf_qid = fp_idx;
 631         req->param_valid = VFPF_RXQ_VALID | VFPF_TXQ_VALID;
 632 
 633         /* Rx */
 634         req->rxq.rcq_addr = fp->rx_comp_mapping;
 635         req->rxq.rcq_np_addr = fp->rx_comp_mapping + BCM_PAGE_SIZE;
 636         req->rxq.rxq_addr = fp->rx_desc_mapping;
 637         req->rxq.sge_addr = fp->rx_sge_mapping;
 638         req->rxq.vf_sb = fp_idx;
 639         req->rxq.sb_index = HC_INDEX_ETH_RX_CQ_CONS;
 640         req->rxq.hc_rate = bp->rx_ticks ? 1000000/bp->rx_ticks : 0;
 641         req->rxq.mtu = bp->dev->mtu;
 642         req->rxq.buf_sz = fp->rx_buf_size;
 643         req->rxq.sge_buf_sz = BCM_PAGE_SIZE * PAGES_PER_SGE;
 644         req->rxq.tpa_agg_sz = tpa_agg_size;
 645         req->rxq.max_sge_pkt = SGE_PAGE_ALIGN(bp->dev->mtu) >> SGE_PAGE_SHIFT;
 646         req->rxq.max_sge_pkt = ((req->rxq.max_sge_pkt + PAGES_PER_SGE - 1) &
 647                           (~(PAGES_PER_SGE-1))) >> PAGES_PER_SGE_SHIFT;
 648         req->rxq.flags = flags;
 649         req->rxq.drop_flags = 0;
 650         req->rxq.cache_line_log = BNX2X_RX_ALIGN_SHIFT;
 651         req->rxq.stat_id = -1; /* No stats at the moment */
 652 
 653         /* Tx */
 654         req->txq.txq_addr = fp->txdata_ptr[FIRST_TX_COS_INDEX]->tx_desc_mapping;
 655         req->txq.vf_sb = fp_idx;
 656         req->txq.sb_index = HC_INDEX_ETH_TX_CQ_CONS_COS0;
 657         req->txq.hc_rate = bp->tx_ticks ? 1000000/bp->tx_ticks : 0;
 658         req->txq.flags = flags;
 659         req->txq.traffic_type = LLFC_TRAFFIC_TYPE_NW;
 660 
 661         /* add list termination tlv */
 662         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
 663                       sizeof(struct channel_list_end_tlv));
 664 
 665         /* output tlvs list */
 666         bnx2x_dp_tlv_list(bp, req);
 667 
 668         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
 669         if (rc)
 670                 BNX2X_ERR("Sending SETUP_Q message for queue[%d] failed!\n",
 671                           fp_idx);
 672 
 673         if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
 674                 BNX2X_ERR("Status of SETUP_Q for queue[%d] is %d\n",
 675                           fp_idx, resp->hdr.status);
 676                 rc = -EINVAL;
 677         }
 678 
 679         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 680 
 681         return rc;
 682 }
 683 
 684 static int bnx2x_vfpf_teardown_queue(struct bnx2x *bp, int qidx)
 685 {
 686         struct vfpf_q_op_tlv *req = &bp->vf2pf_mbox->req.q_op;
 687         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 688         int rc;
 689 
 690         /* clear mailbox and prep first tlv */
 691         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_TEARDOWN_Q,
 692                         sizeof(*req));
 693 
 694         req->vf_qid = qidx;
 695 
 696         /* add list termination tlv */
 697         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
 698                       sizeof(struct channel_list_end_tlv));
 699 
 700         /* output tlvs list */
 701         bnx2x_dp_tlv_list(bp, req);
 702 
 703         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
 704 
 705         if (rc) {
 706                 BNX2X_ERR("Sending TEARDOWN for queue %d failed: %d\n", qidx,
 707                           rc);
 708                 goto out;
 709         }
 710 
 711         /* PF failed the transaction */
 712         if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
 713                 BNX2X_ERR("TEARDOWN for queue %d failed: %d\n", qidx,
 714                           resp->hdr.status);
 715                 rc = -EINVAL;
 716         }
 717 
 718 out:
 719         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 720 
 721         return rc;
 722 }
 723 
 724 /* request pf to add a mac for the vf */
 725 int bnx2x_vfpf_config_mac(struct bnx2x *bp, u8 *addr, u8 vf_qid, bool set)
 726 {
 727         struct vfpf_set_q_filters_tlv *req = &bp->vf2pf_mbox->req.set_q_filters;
 728         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 729         struct pf_vf_bulletin_content bulletin = bp->pf2vf_bulletin->content;
 730         int rc = 0;
 731 
 732         /* clear mailbox and prep first tlv */
 733         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_SET_Q_FILTERS,
 734                         sizeof(*req));
 735 
 736         req->flags = VFPF_SET_Q_FILTERS_MAC_VLAN_CHANGED;
 737         req->vf_qid = vf_qid;
 738         req->n_mac_vlan_filters = 1;
 739 
 740         req->filters[0].flags = VFPF_Q_FILTER_DEST_MAC_VALID;
 741         if (set)
 742                 req->filters[0].flags |= VFPF_Q_FILTER_SET;
 743 
 744         /* sample bulletin board for new mac */
 745         bnx2x_sample_bulletin(bp);
 746 
 747         /* copy mac from device to request */
 748         memcpy(req->filters[0].mac, addr, ETH_ALEN);
 749 
 750         /* add list termination tlv */
 751         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
 752                       sizeof(struct channel_list_end_tlv));
 753 
 754         /* output tlvs list */
 755         bnx2x_dp_tlv_list(bp, req);
 756 
 757         /* send message to pf */
 758         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
 759         if (rc) {
 760                 BNX2X_ERR("failed to send message to pf. rc was %d\n", rc);
 761                 goto out;
 762         }
 763 
 764         /* failure may mean PF was configured with a new mac for us */
 765         while (resp->hdr.status == PFVF_STATUS_FAILURE) {
 766                 DP(BNX2X_MSG_IOV,
 767                    "vfpf SET MAC failed. Check bulletin board for new posts\n");
 768 
 769                 /* copy mac from bulletin to device */
 770                 memcpy(bp->dev->dev_addr, bulletin.mac, ETH_ALEN);
 771 
 772                 /* check if bulletin board was updated */
 773                 if (bnx2x_sample_bulletin(bp) == PFVF_BULLETIN_UPDATED) {
 774                         /* copy mac from device to request */
 775                         memcpy(req->filters[0].mac, bp->dev->dev_addr,
 776                                ETH_ALEN);
 777 
 778                         /* send message to pf */
 779                         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status,
 780                                                bp->vf2pf_mbox_mapping);
 781                 } else {
 782                         /* no new info in bulletin */
 783                         break;
 784                 }
 785         }
 786 
 787         if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
 788                 BNX2X_ERR("vfpf SET MAC failed: %d\n", resp->hdr.status);
 789                 rc = -EINVAL;
 790         }
 791 out:
 792         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 793 
 794         return rc;
 795 }
 796 
 797 /* request pf to config rss table for vf queues*/
 798 int bnx2x_vfpf_config_rss(struct bnx2x *bp,
 799                           struct bnx2x_config_rss_params *params)
 800 {
 801         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 802         struct vfpf_rss_tlv *req = &bp->vf2pf_mbox->req.update_rss;
 803         int rc = 0;
 804 
 805         /* clear mailbox and prep first tlv */
 806         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_UPDATE_RSS,
 807                         sizeof(*req));
 808 
 809         /* add list termination tlv */
 810         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
 811                       sizeof(struct channel_list_end_tlv));
 812 
 813         memcpy(req->ind_table, params->ind_table, T_ETH_INDIRECTION_TABLE_SIZE);
 814         memcpy(req->rss_key, params->rss_key, sizeof(params->rss_key));
 815         req->ind_table_size = T_ETH_INDIRECTION_TABLE_SIZE;
 816         req->rss_key_size = T_ETH_RSS_KEY;
 817         req->rss_result_mask = params->rss_result_mask;
 818 
 819         /* flags handled individually for backward/forward compatibility */
 820         if (params->rss_flags & (1 << BNX2X_RSS_MODE_DISABLED))
 821                 req->rss_flags |= VFPF_RSS_MODE_DISABLED;
 822         if (params->rss_flags & (1 << BNX2X_RSS_MODE_REGULAR))
 823                 req->rss_flags |= VFPF_RSS_MODE_REGULAR;
 824         if (params->rss_flags & (1 << BNX2X_RSS_SET_SRCH))
 825                 req->rss_flags |= VFPF_RSS_SET_SRCH;
 826         if (params->rss_flags & (1 << BNX2X_RSS_IPV4))
 827                 req->rss_flags |= VFPF_RSS_IPV4;
 828         if (params->rss_flags & (1 << BNX2X_RSS_IPV4_TCP))
 829                 req->rss_flags |= VFPF_RSS_IPV4_TCP;
 830         if (params->rss_flags & (1 << BNX2X_RSS_IPV4_UDP))
 831                 req->rss_flags |= VFPF_RSS_IPV4_UDP;
 832         if (params->rss_flags & (1 << BNX2X_RSS_IPV6))
 833                 req->rss_flags |= VFPF_RSS_IPV6;
 834         if (params->rss_flags & (1 << BNX2X_RSS_IPV6_TCP))
 835                 req->rss_flags |= VFPF_RSS_IPV6_TCP;
 836         if (params->rss_flags & (1 << BNX2X_RSS_IPV6_UDP))
 837                 req->rss_flags |= VFPF_RSS_IPV6_UDP;
 838 
 839         DP(BNX2X_MSG_IOV, "rss flags %x\n", req->rss_flags);
 840 
 841         /* output tlvs list */
 842         bnx2x_dp_tlv_list(bp, req);
 843 
 844         /* send message to pf */
 845         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
 846         if (rc) {
 847                 BNX2X_ERR("failed to send message to pf. rc was %d\n", rc);
 848                 goto out;
 849         }
 850 
 851         if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
 852                 /* Since older drivers don't support this feature (and VF has
 853                  * no way of knowing other than failing this), don't propagate
 854                  * an error in this case.
 855                  */
 856                 DP(BNX2X_MSG_IOV,
 857                    "Failed to send rss message to PF over VF-PF channel [%d]\n",
 858                    resp->hdr.status);
 859         }
 860 out:
 861         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 862 
 863         return rc;
 864 }
 865 
 866 int bnx2x_vfpf_set_mcast(struct net_device *dev)
 867 {
 868         struct bnx2x *bp = netdev_priv(dev);
 869         struct vfpf_set_q_filters_tlv *req = &bp->vf2pf_mbox->req.set_q_filters;
 870         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 871         int rc = 0, i = 0;
 872         struct netdev_hw_addr *ha;
 873 
 874         if (bp->state != BNX2X_STATE_OPEN) {
 875                 DP(NETIF_MSG_IFUP, "state is %x, returning\n", bp->state);
 876                 return -EINVAL;
 877         }
 878 
 879         /* clear mailbox and prep first tlv */
 880         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_SET_Q_FILTERS,
 881                         sizeof(*req));
 882 
 883         /* Get Rx mode requested */
 884         DP(NETIF_MSG_IFUP, "dev->flags = %x\n", dev->flags);
 885 
 886         /* We support PFVF_MAX_MULTICAST_PER_VF mcast addresses tops */
 887         if (netdev_mc_count(dev) > PFVF_MAX_MULTICAST_PER_VF) {
 888                 DP(NETIF_MSG_IFUP,
 889                    "VF supports not more than %d multicast MAC addresses\n",
 890                    PFVF_MAX_MULTICAST_PER_VF);
 891                 rc = -EINVAL;
 892                 goto out;
 893         }
 894 
 895         netdev_for_each_mc_addr(ha, dev) {
 896                 DP(NETIF_MSG_IFUP, "Adding mcast MAC: %pM\n",
 897                    bnx2x_mc_addr(ha));
 898                 memcpy(req->multicast[i], bnx2x_mc_addr(ha), ETH_ALEN);
 899                 i++;
 900         }
 901 
 902         req->n_multicast = i;
 903         req->flags |= VFPF_SET_Q_FILTERS_MULTICAST_CHANGED;
 904         req->vf_qid = 0;
 905 
 906         /* add list termination tlv */
 907         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
 908                       sizeof(struct channel_list_end_tlv));
 909 
 910         /* output tlvs list */
 911         bnx2x_dp_tlv_list(bp, req);
 912         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
 913         if (rc) {
 914                 BNX2X_ERR("Sending a message failed: %d\n", rc);
 915                 goto out;
 916         }
 917 
 918         if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
 919                 BNX2X_ERR("Set Rx mode/multicast failed: %d\n",
 920                           resp->hdr.status);
 921                 rc = -EINVAL;
 922         }
 923 out:
 924         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 925 
 926         return rc;
 927 }
 928 
 929 /* request pf to add a vlan for the vf */
 930 int bnx2x_vfpf_update_vlan(struct bnx2x *bp, u16 vid, u8 vf_qid, bool add)
 931 {
 932         struct vfpf_set_q_filters_tlv *req = &bp->vf2pf_mbox->req.set_q_filters;
 933         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 934         int rc = 0;
 935 
 936         if (!(bp->acquire_resp.pfdev_info.pf_cap & PFVF_CAP_VLAN_FILTER)) {
 937                 DP(BNX2X_MSG_IOV, "HV does not support vlan filtering\n");
 938                 return 0;
 939         }
 940 
 941         /* clear mailbox and prep first tlv */
 942         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_SET_Q_FILTERS,
 943                         sizeof(*req));
 944 
 945         req->flags = VFPF_SET_Q_FILTERS_MAC_VLAN_CHANGED;
 946         req->vf_qid = vf_qid;
 947         req->n_mac_vlan_filters = 1;
 948 
 949         req->filters[0].flags = VFPF_Q_FILTER_VLAN_TAG_VALID;
 950 
 951         if (add)
 952                 req->filters[0].flags |= VFPF_Q_FILTER_SET;
 953 
 954         /* sample bulletin board for hypervisor vlan */
 955         bnx2x_sample_bulletin(bp);
 956 
 957         if (bp->shadow_bulletin.content.valid_bitmap & 1 << VLAN_VALID) {
 958                 BNX2X_ERR("Hypervisor will decline the request, avoiding\n");
 959                 rc = -EINVAL;
 960                 goto out;
 961         }
 962 
 963         req->filters[0].vlan_tag = vid;
 964 
 965         /* add list termination tlv */
 966         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
 967                       sizeof(struct channel_list_end_tlv));
 968 
 969         /* output tlvs list */
 970         bnx2x_dp_tlv_list(bp, req);
 971 
 972         /* send message to pf */
 973         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
 974         if (rc) {
 975                 BNX2X_ERR("failed to send message to pf. rc was %d\n", rc);
 976                 goto out;
 977         }
 978 
 979         if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
 980                 BNX2X_ERR("vfpf %s VLAN %d failed\n", add ? "add" : "del",
 981                           vid);
 982                 rc = -EINVAL;
 983         }
 984 out:
 985         bnx2x_vfpf_finalize(bp, &req->first_tlv);
 986 
 987         return rc;
 988 }
 989 
 990 int bnx2x_vfpf_storm_rx_mode(struct bnx2x *bp)
 991 {
 992         int mode = bp->rx_mode;
 993         struct vfpf_set_q_filters_tlv *req = &bp->vf2pf_mbox->req.set_q_filters;
 994         struct pfvf_general_resp_tlv *resp = &bp->vf2pf_mbox->resp.general_resp;
 995         int rc;
 996 
 997         /* clear mailbox and prep first tlv */
 998         bnx2x_vfpf_prep(bp, &req->first_tlv, CHANNEL_TLV_SET_Q_FILTERS,
 999                         sizeof(*req));
1000 
1001         DP(NETIF_MSG_IFUP, "Rx mode is %d\n", mode);
1002 
1003         /* Ignore everything accept MODE_NONE */
1004         if (mode  == BNX2X_RX_MODE_NONE) {
1005                 req->rx_mask = VFPF_RX_MASK_ACCEPT_NONE;
1006         } else {
1007                 /* Current PF driver will not look at the specific flags,
1008                  * but they are required when working with older drivers on hv.
1009                  */
1010                 req->rx_mask = VFPF_RX_MASK_ACCEPT_MATCHED_MULTICAST;
1011                 req->rx_mask |= VFPF_RX_MASK_ACCEPT_MATCHED_UNICAST;
1012                 req->rx_mask |= VFPF_RX_MASK_ACCEPT_BROADCAST;
1013                 if (mode == BNX2X_RX_MODE_PROMISC)
1014                         req->rx_mask |= VFPF_RX_MASK_ACCEPT_ANY_VLAN;
1015         }
1016 
1017         if (bp->accept_any_vlan)
1018                 req->rx_mask |= VFPF_RX_MASK_ACCEPT_ANY_VLAN;
1019 
1020         req->flags |= VFPF_SET_Q_FILTERS_RX_MASK_CHANGED;
1021         req->vf_qid = 0;
1022 
1023         /* add list termination tlv */
1024         bnx2x_add_tlv(bp, req, req->first_tlv.tl.length, CHANNEL_TLV_LIST_END,
1025                       sizeof(struct channel_list_end_tlv));
1026 
1027         /* output tlvs list */
1028         bnx2x_dp_tlv_list(bp, req);
1029 
1030         rc = bnx2x_send_msg2pf(bp, &resp->hdr.status, bp->vf2pf_mbox_mapping);
1031         if (rc)
1032                 BNX2X_ERR("Sending a message failed: %d\n", rc);
1033 
1034         if (resp->hdr.status != PFVF_STATUS_SUCCESS) {
1035                 BNX2X_ERR("Set Rx mode failed: %d\n", resp->hdr.status);
1036                 rc = -EINVAL;
1037         }
1038 
1039         bnx2x_vfpf_finalize(bp, &req->first_tlv);
1040 
1041         return rc;
1042 }
1043 
1044 /* General service functions */
1045 static void storm_memset_vf_mbx_ack(struct bnx2x *bp, u16 abs_fid)
1046 {
1047         u32 addr = BAR_CSTRORM_INTMEM +
1048                    CSTORM_VF_PF_CHANNEL_STATE_OFFSET(abs_fid);
1049 
1050         REG_WR8(bp, addr, VF_PF_CHANNEL_STATE_READY);
1051 }
1052 
1053 static void storm_memset_vf_mbx_valid(struct bnx2x *bp, u16 abs_fid)
1054 {
1055         u32 addr = BAR_CSTRORM_INTMEM +
1056                    CSTORM_VF_PF_CHANNEL_VALID_OFFSET(abs_fid);
1057 
1058         REG_WR8(bp, addr, 1);
1059 }
1060 
1061 /* enable vf_pf mailbox (aka vf-pf-channel) */
1062 void bnx2x_vf_enable_mbx(struct bnx2x *bp, u8 abs_vfid)
1063 {
1064         bnx2x_vf_flr_clnup_epilog(bp, abs_vfid);
1065 
1066         /* enable the mailbox in the FW */
1067         storm_memset_vf_mbx_ack(bp, abs_vfid);
1068         storm_memset_vf_mbx_valid(bp, abs_vfid);
1069 
1070         /* enable the VF access to the mailbox */
1071         bnx2x_vf_enable_access(bp, abs_vfid);
1072 }
1073 
1074 /* this works only on !E1h */
1075 static int bnx2x_copy32_vf_dmae(struct bnx2x *bp, u8 from_vf,
1076                                 dma_addr_t pf_addr, u8 vfid, u32 vf_addr_hi,
1077                                 u32 vf_addr_lo, u32 len32)
1078 {
1079         struct dmae_command dmae;
1080 
1081         if (CHIP_IS_E1x(bp)) {
1082                 BNX2X_ERR("Chip revision does not support VFs\n");
1083                 return DMAE_NOT_RDY;
1084         }
1085 
1086         if (!bp->dmae_ready) {
1087                 BNX2X_ERR("DMAE is not ready, can not copy\n");
1088                 return DMAE_NOT_RDY;
1089         }
1090 
1091         /* set opcode and fixed command fields */
1092         bnx2x_prep_dmae_with_comp(bp, &dmae, DMAE_SRC_PCI, DMAE_DST_PCI);
1093 
1094         if (from_vf) {
1095                 dmae.opcode_iov = (vfid << DMAE_COMMAND_SRC_VFID_SHIFT) |
1096                         (DMAE_SRC_VF << DMAE_COMMAND_SRC_VFPF_SHIFT) |
1097                         (DMAE_DST_PF << DMAE_COMMAND_DST_VFPF_SHIFT);
1098 
1099                 dmae.opcode |= (DMAE_C_DST << DMAE_COMMAND_C_FUNC_SHIFT);
1100 
1101                 dmae.src_addr_lo = vf_addr_lo;
1102                 dmae.src_addr_hi = vf_addr_hi;
1103                 dmae.dst_addr_lo = U64_LO(pf_addr);
1104                 dmae.dst_addr_hi = U64_HI(pf_addr);
1105         } else {
1106                 dmae.opcode_iov = (vfid << DMAE_COMMAND_DST_VFID_SHIFT) |
1107                         (DMAE_DST_VF << DMAE_COMMAND_DST_VFPF_SHIFT) |
1108                         (DMAE_SRC_PF << DMAE_COMMAND_SRC_VFPF_SHIFT);
1109 
1110                 dmae.opcode |= (DMAE_C_SRC << DMAE_COMMAND_C_FUNC_SHIFT);
1111 
1112                 dmae.src_addr_lo = U64_LO(pf_addr);
1113                 dmae.src_addr_hi = U64_HI(pf_addr);
1114                 dmae.dst_addr_lo = vf_addr_lo;
1115                 dmae.dst_addr_hi = vf_addr_hi;
1116         }
1117         dmae.len = len32;
1118 
1119         /* issue the command and wait for completion */
1120         return bnx2x_issue_dmae_with_comp(bp, &dmae, bnx2x_sp(bp, wb_comp));
1121 }
1122 
1123 static void bnx2x_vf_mbx_resp_single_tlv(struct bnx2x *bp,
1124                                          struct bnx2x_virtf *vf)
1125 {
1126         struct bnx2x_vf_mbx *mbx = BP_VF_MBX(bp, vf->index);
1127         u16 length, type;
1128 
1129         /* prepare response */
1130         type = mbx->first_tlv.tl.type;
1131         length = type == CHANNEL_TLV_ACQUIRE ?
1132                 sizeof(struct pfvf_acquire_resp_tlv) :
1133                 sizeof(struct pfvf_general_resp_tlv);
1134         bnx2x_add_tlv(bp, &mbx->msg->resp, 0, type, length);
1135         bnx2x_add_tlv(bp, &mbx->msg->resp, length, CHANNEL_TLV_LIST_END,
1136                       sizeof(struct channel_list_end_tlv));
1137 }
1138 
1139 static void bnx2x_vf_mbx_resp_send_msg(struct bnx2x *bp,
1140                                        struct bnx2x_virtf *vf,
1141                                        int vf_rc)
1142 {
1143         struct bnx2x_vf_mbx *mbx = BP_VF_MBX(bp, vf->index);
1144         struct pfvf_general_resp_tlv *resp = &mbx->msg->resp.general_resp;
1145         dma_addr_t pf_addr;
1146         u64 vf_addr;
1147         int rc;
1148 
1149         bnx2x_dp_tlv_list(bp, resp);
1150         DP(BNX2X_MSG_IOV, "mailbox vf address hi 0x%x, lo 0x%x, offset 0x%x\n",
1151            mbx->vf_addr_hi, mbx->vf_addr_lo, mbx->first_tlv.resp_msg_offset);
1152 
1153         resp->hdr.status = bnx2x_pfvf_status_codes(vf_rc);
1154 
1155         /* send response */
1156         vf_addr = HILO_U64(mbx->vf_addr_hi, mbx->vf_addr_lo) +
1157                   mbx->first_tlv.resp_msg_offset;
1158         pf_addr = mbx->msg_mapping +
1159                   offsetof(struct bnx2x_vf_mbx_msg, resp);
1160 
1161         /* Copy the response buffer. The first u64 is written afterwards, as
1162          * the vf is sensitive to the header being written
1163          */
1164         vf_addr += sizeof(u64);
1165         pf_addr += sizeof(u64);
1166         rc = bnx2x_copy32_vf_dmae(bp, false, pf_addr, vf->abs_vfid,
1167                                   U64_HI(vf_addr),
1168                                   U64_LO(vf_addr),
1169                                   (sizeof(union pfvf_tlvs) - sizeof(u64))/4);
1170         if (rc) {
1171                 BNX2X_ERR("Failed to copy response body to VF %d\n",
1172                           vf->abs_vfid);
1173                 goto mbx_error;
1174         }
1175         vf_addr -= sizeof(u64);
1176         pf_addr -= sizeof(u64);
1177 
1178         /* ack the FW */
1179         storm_memset_vf_mbx_ack(bp, vf->abs_vfid);
1180 
1181         /* copy the response header including status-done field,
1182          * must be last dmae, must be after FW is acked
1183          */
1184         rc = bnx2x_copy32_vf_dmae(bp, false, pf_addr, vf->abs_vfid,
1185                                   U64_HI(vf_addr),
1186                                   U64_LO(vf_addr),
1187                                   sizeof(u64)/4);
1188 
1189         /* unlock channel mutex */
1190         bnx2x_unlock_vf_pf_channel(bp, vf, mbx->first_tlv.tl.type);
1191 
1192         if (rc) {
1193                 BNX2X_ERR("Failed to copy response status to VF %d\n",
1194                           vf->abs_vfid);
1195                 goto mbx_error;
1196         }
1197         return;
1198 
1199 mbx_error:
1200         bnx2x_vf_release(bp, vf);
1201 }
1202 
1203 static void bnx2x_vf_mbx_resp(struct bnx2x *bp,
1204                               struct bnx2x_virtf *vf,
1205                               int rc)
1206 {
1207         bnx2x_vf_mbx_resp_single_tlv(bp, vf);
1208         bnx2x_vf_mbx_resp_send_msg(bp, vf, rc);
1209 }
1210 
1211 static void bnx2x_vf_mbx_resp_phys_port(struct bnx2x *bp,
1212                                         struct bnx2x_virtf *vf,
1213                                         void *buffer,
1214                                         u16 *offset)
1215 {
1216         struct vfpf_port_phys_id_resp_tlv *port_id;
1217 
1218         if (!(bp->flags & HAS_PHYS_PORT_ID))
1219                 return;
1220 
1221         bnx2x_add_tlv(bp, buffer, *offset, CHANNEL_TLV_PHYS_PORT_ID,
1222                       sizeof(struct vfpf_port_phys_id_resp_tlv));
1223 
1224         port_id = (struct vfpf_port_phys_id_resp_tlv *)
1225                   (((u8 *)buffer) + *offset);
1226         memcpy(port_id->id, bp->phys_port_id, ETH_ALEN);
1227 
1228         /* Offset should continue representing the offset to the tail
1229          * of TLV data (outside this function scope)
1230          */
1231         *offset += sizeof(struct vfpf_port_phys_id_resp_tlv);
1232 }
1233 
1234 static void bnx2x_vf_mbx_resp_fp_hsi_ver(struct bnx2x *bp,
1235                                          struct bnx2x_virtf *vf,
1236                                          void *buffer,
1237                                          u16 *offset)
1238 {
1239         struct vfpf_fp_hsi_resp_tlv *fp_hsi;
1240 
1241         bnx2x_add_tlv(bp, buffer, *offset, CHANNEL_TLV_FP_HSI_SUPPORT,
1242                       sizeof(struct vfpf_fp_hsi_resp_tlv));
1243 
1244         fp_hsi = (struct vfpf_fp_hsi_resp_tlv *)
1245                  (((u8 *)buffer) + *offset);
1246         fp_hsi->is_supported = (vf->fp_hsi > ETH_FP_HSI_VERSION) ? 0 : 1;
1247 
1248         /* Offset should continue representing the offset to the tail
1249          * of TLV data (outside this function scope)
1250          */
1251         *offset += sizeof(struct vfpf_fp_hsi_resp_tlv);
1252 }
1253 
1254 static void bnx2x_vf_mbx_acquire_resp(struct bnx2x *bp, struct bnx2x_virtf *vf,
1255                                       struct bnx2x_vf_mbx *mbx, int vfop_status)
1256 {
1257         int i;
1258         struct pfvf_acquire_resp_tlv *resp = &mbx->msg->resp.acquire_resp;
1259         struct pf_vf_resc *resc = &resp->resc;
1260         u8 status = bnx2x_pfvf_status_codes(vfop_status);
1261         u16 length;
1262 
1263         memset(resp, 0, sizeof(*resp));
1264 
1265         /* fill in pfdev info */
1266         resp->pfdev_info.chip_num = bp->common.chip_id;
1267         resp->pfdev_info.db_size = bp->db_size;
1268         resp->pfdev_info.indices_per_sb = HC_SB_MAX_INDICES_E2;
1269         resp->pfdev_info.pf_cap = (PFVF_CAP_RSS |
1270                                    PFVF_CAP_TPA |
1271                                    PFVF_CAP_TPA_UPDATE |
1272                                    PFVF_CAP_VLAN_FILTER);
1273         bnx2x_fill_fw_str(bp, resp->pfdev_info.fw_ver,
1274                           sizeof(resp->pfdev_info.fw_ver));
1275 
1276         if (status == PFVF_STATUS_NO_RESOURCE ||
1277             status == PFVF_STATUS_SUCCESS) {
1278                 /* set resources numbers, if status equals NO_RESOURCE these
1279                  * are max possible numbers
1280                  */
1281                 resc->num_rxqs = vf_rxq_count(vf) ? :
1282                         bnx2x_vf_max_queue_cnt(bp, vf);
1283                 resc->num_txqs = vf_txq_count(vf) ? :
1284                         bnx2x_vf_max_queue_cnt(bp, vf);
1285                 resc->num_sbs = vf_sb_count(vf);
1286                 resc->num_mac_filters = vf_mac_rules_cnt(vf);
1287                 resc->num_vlan_filters = vf_vlan_rules_cnt(vf);
1288                 resc->num_mc_filters = 0;
1289 
1290                 if (status == PFVF_STATUS_SUCCESS) {
1291                         /* fill in the allocated resources */
1292                         struct pf_vf_bulletin_content *bulletin =
1293                                 BP_VF_BULLETIN(bp, vf->index);
1294 
1295                         for_each_vfq(vf, i)
1296                                 resc->hw_qid[i] =
1297                                         vfq_qzone_id(vf, vfq_get(vf, i));
1298 
1299                         for_each_vf_sb(vf, i) {
1300                                 resc->hw_sbs[i].hw_sb_id = vf_igu_sb(vf, i);
1301                                 resc->hw_sbs[i].sb_qid = vf_hc_qzone(vf, i);
1302                         }
1303 
1304                         /* if a mac has been set for this vf, supply it */
1305                         if (bulletin->valid_bitmap & 1 << MAC_ADDR_VALID) {
1306                                 memcpy(resc->current_mac_addr, bulletin->mac,
1307                                        ETH_ALEN);
1308                         }
1309                 }
1310         }
1311 
1312         DP(BNX2X_MSG_IOV, "VF[%d] ACQUIRE_RESPONSE: pfdev_info- chip_num=0x%x, db_size=%d, idx_per_sb=%d, pf_cap=0x%x\n"
1313            "resources- n_rxq-%d, n_txq-%d, n_sbs-%d, n_macs-%d, n_vlans-%d, n_mcs-%d, fw_ver: '%s'\n",
1314            vf->abs_vfid,
1315            resp->pfdev_info.chip_num,
1316            resp->pfdev_info.db_size,
1317            resp->pfdev_info.indices_per_sb,
1318            resp->pfdev_info.pf_cap,
1319            resc->num_rxqs,
1320            resc->num_txqs,
1321            resc->num_sbs,
1322            resc->num_mac_filters,
1323            resc->num_vlan_filters,
1324            resc->num_mc_filters,
1325            resp->pfdev_info.fw_ver);
1326 
1327         DP_CONT(BNX2X_MSG_IOV, "hw_qids- [ ");
1328         for (i = 0; i < vf_rxq_count(vf); i++)
1329                 DP_CONT(BNX2X_MSG_IOV, "%d ", resc->hw_qid[i]);
1330         DP_CONT(BNX2X_MSG_IOV, "], sb_info- [ ");
1331         for (i = 0; i < vf_sb_count(vf); i++)
1332                 DP_CONT(BNX2X_MSG_IOV, "%d:%d ",
1333                         resc->hw_sbs[i].hw_sb_id,
1334                         resc->hw_sbs[i].sb_qid);
1335         DP_CONT(BNX2X_MSG_IOV, "]\n");
1336 
1337         /* prepare response */
1338         length = sizeof(struct pfvf_acquire_resp_tlv);
1339         bnx2x_add_tlv(bp, &mbx->msg->resp, 0, CHANNEL_TLV_ACQUIRE, length);
1340 
1341         /* Handle possible VF requests for physical port identifiers.
1342          * 'length' should continue to indicate the offset of the first empty
1343          * place in the buffer (i.e., where next TLV should be inserted)
1344          */
1345         if (bnx2x_search_tlv_list(bp, &mbx->msg->req,
1346                                   CHANNEL_TLV_PHYS_PORT_ID))
1347                 bnx2x_vf_mbx_resp_phys_port(bp, vf, &mbx->msg->resp, &length);
1348 
1349         /* `New' vfs will want to know if fastpath HSI is supported, since
1350          * if that's not the case they could print into system log the fact
1351          * the driver version must be updated.
1352          */
1353         bnx2x_vf_mbx_resp_fp_hsi_ver(bp, vf, &mbx->msg->resp, &length);
1354 
1355         bnx2x_add_tlv(bp, &mbx->msg->resp, length, CHANNEL_TLV_LIST_END,
1356                       sizeof(struct channel_list_end_tlv));
1357 
1358         /* send the response */
1359         bnx2x_vf_mbx_resp_send_msg(bp, vf, vfop_status);
1360 }
1361 
1362 static bool bnx2x_vf_mbx_is_windows_vm(struct bnx2x *bp,
1363                                        struct vfpf_acquire_tlv *acquire)
1364 {
1365         /* Windows driver does one of three things:
1366          * 1. Old driver doesn't have bulletin board address set.
1367          * 2. 'Middle' driver sends mc_num == 32.
1368          * 3. New driver sets the OS field.
1369          */
1370         if (!acquire->bulletin_addr ||
1371             acquire->resc_request.num_mc_filters == 32 ||
1372             ((acquire->vfdev_info.vf_os & VF_OS_MASK) ==
1373              VF_OS_WINDOWS))
1374                 return true;
1375 
1376         return false;
1377 }
1378 
1379 static int bnx2x_vf_mbx_acquire_chk_dorq(struct bnx2x *bp,
1380                                          struct bnx2x_virtf *vf,
1381                                          struct bnx2x_vf_mbx *mbx)
1382 {
1383         /* Linux drivers which correctly set the doorbell size also
1384          * send a physical port request
1385          */
1386         if (bnx2x_search_tlv_list(bp, &mbx->msg->req,
1387                                   CHANNEL_TLV_PHYS_PORT_ID))
1388                 return 0;
1389 
1390         /* Issue does not exist in windows VMs */
1391         if (bnx2x_vf_mbx_is_windows_vm(bp, &mbx->msg->req.acquire))
1392                 return 0;
1393 
1394         return -EOPNOTSUPP;
1395 }
1396 
1397 static void bnx2x_vf_mbx_acquire(struct bnx2x *bp, struct bnx2x_virtf *vf,
1398                                  struct bnx2x_vf_mbx *mbx)
1399 {
1400         int rc;
1401         struct vfpf_acquire_tlv *acquire = &mbx->msg->req.acquire;
1402 
1403         /* log vfdef info */
1404         DP(BNX2X_MSG_IOV,
1405            "VF[%d] ACQUIRE: vfdev_info- vf_id %d, vf_os %d resources- n_rxq-%d, n_txq-%d, n_sbs-%d, n_macs-%d, n_vlans-%d, n_mcs-%d\n",
1406            vf->abs_vfid, acquire->vfdev_info.vf_id, acquire->vfdev_info.vf_os,
1407            acquire->resc_request.num_rxqs, acquire->resc_request.num_txqs,
1408            acquire->resc_request.num_sbs, acquire->resc_request.num_mac_filters,
1409            acquire->resc_request.num_vlan_filters,
1410            acquire->resc_request.num_mc_filters);
1411 
1412         /* Prevent VFs with old drivers from loading, since they calculate
1413          * CIDs incorrectly requiring a VF-flr [VM reboot] in order to recover
1414          * while being upgraded.
1415          */
1416         rc = bnx2x_vf_mbx_acquire_chk_dorq(bp, vf, mbx);
1417         if (rc) {
1418                 DP(BNX2X_MSG_IOV,
1419                    "VF [%d] - Can't support acquire request due to doorbell mismatch. Please update VM driver\n",
1420                    vf->abs_vfid);
1421                 goto out;
1422         }
1423 
1424         /* Verify the VF fastpath HSI can be supported by the loaded FW.
1425          * Linux vfs should be oblivious to changes between v0 and v2.
1426          */
1427         if (bnx2x_vf_mbx_is_windows_vm(bp, &mbx->msg->req.acquire))
1428                 vf->fp_hsi = acquire->vfdev_info.fp_hsi_ver;
1429         else
1430                 vf->fp_hsi = max_t(u8, acquire->vfdev_info.fp_hsi_ver,
1431                                    ETH_FP_HSI_VER_2);
1432         if (vf->fp_hsi > ETH_FP_HSI_VERSION) {
1433                 DP(BNX2X_MSG_IOV,
1434                    "VF [%d] - Can't support acquire request since VF requests a FW version which is too new [%02x > %02x]\n",
1435                    vf->abs_vfid, acquire->vfdev_info.fp_hsi_ver,
1436                    ETH_FP_HSI_VERSION);
1437                 rc = -EINVAL;
1438                 goto out;
1439         }
1440 
1441         /* acquire the resources */
1442         rc = bnx2x_vf_acquire(bp, vf, &acquire->resc_request);
1443 
1444         /* store address of vf's bulletin board */
1445         vf->bulletin_map = acquire->bulletin_addr;
1446         if (acquire->vfdev_info.caps & VF_CAP_SUPPORT_EXT_BULLETIN) {
1447                 DP(BNX2X_MSG_IOV, "VF[%d] supports long bulletin boards\n",
1448                    vf->abs_vfid);
1449                 vf->cfg_flags |= VF_CFG_EXT_BULLETIN;
1450         } else {
1451                 vf->cfg_flags &= ~VF_CFG_EXT_BULLETIN;
1452         }
1453 
1454         if (acquire->vfdev_info.caps & VF_CAP_SUPPORT_VLAN_FILTER) {
1455                 DP(BNX2X_MSG_IOV, "VF[%d] supports vlan filtering\n",
1456                    vf->abs_vfid);
1457                 vf->cfg_flags |= VF_CFG_VLAN_FILTER;
1458         } else {
1459                 vf->cfg_flags &= ~VF_CFG_VLAN_FILTER;
1460         }
1461 
1462 out:
1463         /* response */
1464         bnx2x_vf_mbx_acquire_resp(bp, vf, mbx, rc);
1465 }
1466 
1467 static void bnx2x_vf_mbx_init_vf(struct bnx2x *bp, struct bnx2x_virtf *vf,
1468                               struct bnx2x_vf_mbx *mbx)
1469 {
1470         struct vfpf_init_tlv *init = &mbx->msg->req.init;
1471         int rc;
1472 
1473         /* record ghost addresses from vf message */
1474         vf->fw_stat_map = init->stats_addr;
1475         vf->stats_stride = init->stats_stride;
1476         rc = bnx2x_vf_init(bp, vf, (dma_addr_t *)init->sb_addr);
1477 
1478         /* set VF multiqueue statistics collection mode */
1479         if (init->flags & VFPF_INIT_FLG_STATS_COALESCE)
1480                 vf->cfg_flags |= VF_CFG_STATS_COALESCE;
1481 
1482         /* Update VF's view of link state */
1483         if (vf->cfg_flags & VF_CFG_EXT_BULLETIN)
1484                 bnx2x_iov_link_update_vf(bp, vf->index);
1485 
1486         /* response */
1487         bnx2x_vf_mbx_resp(bp, vf, rc);
1488 }
1489 
1490 /* convert MBX queue-flags to standard SP queue-flags */
1491 static void bnx2x_vf_mbx_set_q_flags(struct bnx2x *bp, u32 mbx_q_flags,
1492                                      unsigned long *sp_q_flags)
1493 {
1494         if (mbx_q_flags & VFPF_QUEUE_FLG_TPA)
1495                 __set_bit(BNX2X_Q_FLG_TPA, sp_q_flags);
1496         if (mbx_q_flags & VFPF_QUEUE_FLG_TPA_IPV6)
1497                 __set_bit(BNX2X_Q_FLG_TPA_IPV6, sp_q_flags);
1498         if (mbx_q_flags & VFPF_QUEUE_FLG_TPA_GRO)
1499                 __set_bit(BNX2X_Q_FLG_TPA_GRO, sp_q_flags);
1500         if (mbx_q_flags & VFPF_QUEUE_FLG_STATS)
1501                 __set_bit(BNX2X_Q_FLG_STATS, sp_q_flags);
1502         if (mbx_q_flags & VFPF_QUEUE_FLG_VLAN)
1503                 __set_bit(BNX2X_Q_FLG_VLAN, sp_q_flags);
1504         if (mbx_q_flags & VFPF_QUEUE_FLG_COS)
1505                 __set_bit(BNX2X_Q_FLG_COS, sp_q_flags);
1506         if (mbx_q_flags & VFPF_QUEUE_FLG_HC)
1507                 __set_bit(BNX2X_Q_FLG_HC, sp_q_flags);
1508         if (mbx_q_flags & VFPF_QUEUE_FLG_DHC)
1509                 __set_bit(BNX2X_Q_FLG_DHC, sp_q_flags);
1510         if (mbx_q_flags & VFPF_QUEUE_FLG_LEADING_RSS)
1511                 __set_bit(BNX2X_Q_FLG_LEADING_RSS, sp_q_flags);
1512 
1513         /* outer vlan removal is set according to PF's multi function mode */
1514         if (IS_MF_SD(bp))
1515                 __set_bit(BNX2X_Q_FLG_OV, sp_q_flags);
1516 }
1517 
1518 static void bnx2x_vf_mbx_setup_q(struct bnx2x *bp, struct bnx2x_virtf *vf,
1519                                  struct bnx2x_vf_mbx *mbx)
1520 {
1521         struct vfpf_setup_q_tlv *setup_q = &mbx->msg->req.setup_q;
1522         struct bnx2x_vf_queue_construct_params qctor;
1523         int rc = 0;
1524 
1525         /* verify vf_qid */
1526         if (setup_q->vf_qid >= vf_rxq_count(vf)) {
1527                 BNX2X_ERR("vf_qid %d invalid, max queue count is %d\n",
1528                           setup_q->vf_qid, vf_rxq_count(vf));
1529                 rc = -EINVAL;
1530                 goto response;
1531         }
1532 
1533         /* tx queues must be setup alongside rx queues thus if the rx queue
1534          * is not marked as valid there's nothing to do.
1535          */
1536         if (setup_q->param_valid & (VFPF_RXQ_VALID|VFPF_TXQ_VALID)) {
1537                 struct bnx2x_vf_queue *q = vfq_get(vf, setup_q->vf_qid);
1538                 unsigned long q_type = 0;
1539 
1540                 struct bnx2x_queue_init_params *init_p;
1541                 struct bnx2x_queue_setup_params *setup_p;
1542 
1543                 if (bnx2x_vfq_is_leading(q))
1544                         bnx2x_leading_vfq_init(bp, vf, q);
1545 
1546                 /* re-init the VF operation context */
1547                 memset(&qctor, 0 ,
1548                        sizeof(struct bnx2x_vf_queue_construct_params));
1549                 setup_p = &qctor.prep_qsetup;
1550                 init_p =  &qctor.qstate.params.init;
1551 
1552                 /* activate immediately */
1553                 __set_bit(BNX2X_Q_FLG_ACTIVE, &setup_p->flags);
1554 
1555                 if (setup_q->param_valid & VFPF_TXQ_VALID) {
1556                         struct bnx2x_txq_setup_params *txq_params =
1557                                 &setup_p->txq_params;
1558 
1559                         __set_bit(BNX2X_Q_TYPE_HAS_TX, &q_type);
1560 
1561                         /* save sb resource index */
1562                         q->sb_idx = setup_q->txq.vf_sb;
1563 
1564                         /* tx init */
1565                         init_p->tx.hc_rate = setup_q->txq.hc_rate;
1566                         init_p->tx.sb_cq_index = setup_q->txq.sb_index;
1567 
1568                         bnx2x_vf_mbx_set_q_flags(bp, setup_q->txq.flags,
1569                                                  &init_p->tx.flags);
1570 
1571                         /* tx setup - flags */
1572                         bnx2x_vf_mbx_set_q_flags(bp, setup_q->txq.flags,
1573                                                  &setup_p->flags);
1574 
1575                         /* tx setup - general, nothing */
1576 
1577                         /* tx setup - tx */
1578                         txq_params->dscr_map = setup_q->txq.txq_addr;
1579                         txq_params->sb_cq_index = setup_q->txq.sb_index;
1580                         txq_params->traffic_type = setup_q->txq.traffic_type;
1581 
1582                         bnx2x_vfop_qctor_dump_tx(bp, vf, init_p, setup_p,
1583                                                  q->index, q->sb_idx);
1584                 }
1585 
1586                 if (setup_q->param_valid & VFPF_RXQ_VALID) {
1587                         struct bnx2x_rxq_setup_params *rxq_params =
1588                                                         &setup_p->rxq_params;
1589 
1590                         __set_bit(BNX2X_Q_TYPE_HAS_RX, &q_type);
1591 
1592                         /* Note: there is no support for different SBs
1593                          * for TX and RX
1594                          */
1595                         q->sb_idx = setup_q->rxq.vf_sb;
1596 
1597                         /* rx init */
1598                         init_p->rx.hc_rate = setup_q->rxq.hc_rate;
1599                         init_p->rx.sb_cq_index = setup_q->rxq.sb_index;
1600                         bnx2x_vf_mbx_set_q_flags(bp, setup_q->rxq.flags,
1601                                                  &init_p->rx.flags);
1602 
1603                         /* rx setup - flags */
1604                         bnx2x_vf_mbx_set_q_flags(bp, setup_q->rxq.flags,
1605                                                  &setup_p->flags);
1606 
1607                         /* rx setup - general */
1608                         setup_p->gen_params.mtu = setup_q->rxq.mtu;
1609 
1610                         /* rx setup - rx */
1611                         rxq_params->drop_flags = setup_q->rxq.drop_flags;
1612                         rxq_params->dscr_map = setup_q->rxq.rxq_addr;
1613                         rxq_params->sge_map = setup_q->rxq.sge_addr;
1614                         rxq_params->rcq_map = setup_q->rxq.rcq_addr;
1615                         rxq_params->rcq_np_map = setup_q->rxq.rcq_np_addr;
1616                         rxq_params->buf_sz = setup_q->rxq.buf_sz;
1617                         rxq_params->tpa_agg_sz = setup_q->rxq.tpa_agg_sz;
1618                         rxq_params->max_sges_pkt = setup_q->rxq.max_sge_pkt;
1619                         rxq_params->sge_buf_sz = setup_q->rxq.sge_buf_sz;
1620                         rxq_params->cache_line_log =
1621                                 setup_q->rxq.cache_line_log;
1622                         rxq_params->sb_cq_index = setup_q->rxq.sb_index;
1623 
1624                         /* rx setup - multicast engine */
1625                         if (bnx2x_vfq_is_leading(q)) {
1626                                 u8 mcast_id = FW_VF_HANDLE(vf->abs_vfid);
1627 
1628                                 rxq_params->mcast_engine_id = mcast_id;
1629                                 __set_bit(BNX2X_Q_FLG_MCAST, &setup_p->flags);
1630                         }
1631 
1632                         bnx2x_vfop_qctor_dump_rx(bp, vf, init_p, setup_p,
1633                                                  q->index, q->sb_idx);
1634                 }
1635                 /* complete the preparations */
1636                 bnx2x_vfop_qctor_prep(bp, vf, q, &qctor, q_type);
1637 
1638                 rc = bnx2x_vf_queue_setup(bp, vf, q->index, &qctor);
1639                 if (rc)
1640                         goto response;
1641         }
1642 response:
1643         bnx2x_vf_mbx_resp(bp, vf, rc);
1644 }
1645 
1646 static int bnx2x_vf_mbx_macvlan_list(struct bnx2x *bp,
1647                                      struct bnx2x_virtf *vf,
1648                                      struct vfpf_set_q_filters_tlv *tlv,
1649                                      struct bnx2x_vf_mac_vlan_filters **pfl,
1650                                      u32 type_flag)
1651 {
1652         int i, j;
1653         struct bnx2x_vf_mac_vlan_filters *fl = NULL;
1654 
1655         fl = kzalloc(struct_size(fl, filters, tlv->n_mac_vlan_filters),
1656                      GFP_KERNEL);
1657         if (!fl)
1658                 return -ENOMEM;
1659 
1660         for (i = 0, j = 0; i < tlv->n_mac_vlan_filters; i++) {
1661                 struct vfpf_q_mac_vlan_filter *msg_filter = &tlv->filters[i];
1662 
1663                 if ((msg_filter->flags & type_flag) != type_flag)
1664                         continue;
1665                 memset(&fl->filters[j], 0, sizeof(fl->filters[j]));
1666                 if (type_flag & VFPF_Q_FILTER_DEST_MAC_VALID) {
1667                         fl->filters[j].mac = msg_filter->mac;
1668                         fl->filters[j].type |= BNX2X_VF_FILTER_MAC;
1669                 }
1670                 if (type_flag & VFPF_Q_FILTER_VLAN_TAG_VALID) {
1671                         fl->filters[j].vid = msg_filter->vlan_tag;
1672                         fl->filters[j].type |= BNX2X_VF_FILTER_VLAN;
1673                 }
1674                 fl->filters[j].add = !!(msg_filter->flags & VFPF_Q_FILTER_SET);
1675                 fl->count++;
1676                 j++;
1677         }
1678         if (!fl->count)
1679                 kfree(fl);
1680         else
1681                 *pfl = fl;
1682 
1683         return 0;
1684 }
1685 
1686 static int bnx2x_vf_filters_contain(struct vfpf_set_q_filters_tlv *filters,
1687                                     u32 flags)
1688 {
1689         int i, cnt = 0;
1690 
1691         for (i = 0; i < filters->n_mac_vlan_filters; i++)
1692                 if  ((filters->filters[i].flags & flags) == flags)
1693                         cnt++;
1694 
1695         return cnt;
1696 }
1697 
1698 static void bnx2x_vf_mbx_dp_q_filter(struct bnx2x *bp, int msglvl, int idx,
1699                                        struct vfpf_q_mac_vlan_filter *filter)
1700 {
1701         DP(msglvl, "MAC-VLAN[%d] -- flags=0x%x\n", idx, filter->flags);
1702         if (filter->flags & VFPF_Q_FILTER_VLAN_TAG_VALID)
1703                 DP_CONT(msglvl, ", vlan=%d", filter->vlan_tag);
1704         if (filter->flags & VFPF_Q_FILTER_DEST_MAC_VALID)
1705                 DP_CONT(msglvl, ", MAC=%pM", filter->mac);
1706         DP_CONT(msglvl, "\n");
1707 }
1708 
1709 static void bnx2x_vf_mbx_dp_q_filters(struct bnx2x *bp, int msglvl,
1710                                        struct vfpf_set_q_filters_tlv *filters)
1711 {
1712         int i;
1713 
1714         if (filters->flags & VFPF_SET_Q_FILTERS_MAC_VLAN_CHANGED)
1715                 for (i = 0; i < filters->n_mac_vlan_filters; i++)
1716                         bnx2x_vf_mbx_dp_q_filter(bp, msglvl, i,
1717                                                  &filters->filters[i]);
1718 
1719         if (filters->flags & VFPF_SET_Q_FILTERS_RX_MASK_CHANGED)
1720                 DP(msglvl, "RX-MASK=0x%x\n", filters->rx_mask);
1721 
1722         if (filters->flags & VFPF_SET_Q_FILTERS_MULTICAST_CHANGED)
1723                 for (i = 0; i < filters->n_multicast; i++)
1724                         DP(msglvl, "MULTICAST=%pM\n", filters->multicast[i]);
1725 }
1726 
1727 #define VFPF_MAC_FILTER         VFPF_Q_FILTER_DEST_MAC_VALID
1728 #define VFPF_VLAN_FILTER        VFPF_Q_FILTER_VLAN_TAG_VALID
1729 #define VFPF_VLAN_MAC_FILTER    (VFPF_VLAN_FILTER | VFPF_MAC_FILTER)
1730 
1731 static int bnx2x_vf_mbx_qfilters(struct bnx2x *bp, struct bnx2x_virtf *vf)
1732 {
1733         int rc = 0;
1734 
1735         struct vfpf_set_q_filters_tlv *msg =
1736                 &BP_VF_MBX(bp, vf->index)->msg->req.set_q_filters;
1737 
1738         /* check for any mac/vlan changes */
1739         if (msg->flags & VFPF_SET_Q_FILTERS_MAC_VLAN_CHANGED) {
1740                 struct bnx2x_vf_mac_vlan_filters *fl = NULL;
1741 
1742                 /* build vlan-mac list */
1743                 rc = bnx2x_vf_mbx_macvlan_list(bp, vf, msg, &fl,
1744                                                VFPF_VLAN_MAC_FILTER);
1745                 if (rc)
1746                         goto op_err;
1747 
1748                 if (fl) {
1749 
1750                         /* set vlan-mac list */
1751                         rc = bnx2x_vf_mac_vlan_config_list(bp, vf, fl,
1752                                                            msg->vf_qid,
1753                                                            false);
1754                         if (rc)
1755                                 goto op_err;
1756                 }
1757 
1758                 /* build mac list */
1759                 fl = NULL;
1760 
1761                 rc = bnx2x_vf_mbx_macvlan_list(bp, vf, msg, &fl,
1762                                                VFPF_MAC_FILTER);
1763                 if (rc)
1764                         goto op_err;
1765 
1766                 if (fl) {
1767                         /* set mac list */
1768                         rc = bnx2x_vf_mac_vlan_config_list(bp, vf, fl,
1769                                                            msg->vf_qid,
1770                                                            false);
1771                         if (rc)
1772                                 goto op_err;
1773                 }
1774 
1775                 /* build vlan list */
1776                 fl = NULL;
1777 
1778                 rc = bnx2x_vf_mbx_macvlan_list(bp, vf, msg, &fl,
1779                                                VFPF_VLAN_FILTER);
1780                 if (rc)
1781                         goto op_err;
1782 
1783                 if (fl) {
1784                         /* set vlan list */
1785                         rc = bnx2x_vf_mac_vlan_config_list(bp, vf, fl,
1786                                                            msg->vf_qid,
1787                                                            false);
1788                         if (rc)
1789                                 goto op_err;
1790                 }
1791 
1792         }
1793 
1794         if (msg->flags & VFPF_SET_Q_FILTERS_RX_MASK_CHANGED) {
1795                 unsigned long accept = 0;
1796                 struct pf_vf_bulletin_content *bulletin =
1797                                         BP_VF_BULLETIN(bp, vf->index);
1798 
1799                 /* Ignore VF requested mode; instead set a regular mode */
1800                 if (msg->rx_mask !=  VFPF_RX_MASK_ACCEPT_NONE) {
1801                         __set_bit(BNX2X_ACCEPT_UNICAST, &accept);
1802                         __set_bit(BNX2X_ACCEPT_MULTICAST, &accept);
1803                         __set_bit(BNX2X_ACCEPT_BROADCAST, &accept);
1804                 }
1805 
1806                 /* any_vlan is not configured if HV is forcing VLAN
1807                  * any_vlan is configured if
1808                  *   1. VF does not support vlan filtering
1809                  *   OR
1810                  *   2. VF supports vlan filtering and explicitly requested it
1811                  */
1812                 if (!(bulletin->valid_bitmap & (1 << VLAN_VALID)) &&
1813                     (!(vf->cfg_flags & VF_CFG_VLAN_FILTER) ||
1814                      msg->rx_mask & VFPF_RX_MASK_ACCEPT_ANY_VLAN))
1815                         __set_bit(BNX2X_ACCEPT_ANY_VLAN, &accept);
1816 
1817                 /* set rx-mode */
1818                 rc = bnx2x_vf_rxmode(bp, vf, msg->vf_qid, accept);
1819                 if (rc)
1820                         goto op_err;
1821         }
1822 
1823         if (msg->flags & VFPF_SET_Q_FILTERS_MULTICAST_CHANGED) {
1824                 /* set mcasts */
1825                 rc = bnx2x_vf_mcast(bp, vf, msg->multicast,
1826                                     msg->n_multicast, false);
1827                 if (rc)
1828                         goto op_err;
1829         }
1830 op_err:
1831         if (rc)
1832                 BNX2X_ERR("QFILTERS[%d:%d] error: rc %d\n",
1833                           vf->abs_vfid, msg->vf_qid, rc);
1834         return rc;
1835 }
1836 
1837 static int bnx2x_filters_validate_mac(struct bnx2x *bp,
1838                                       struct bnx2x_virtf *vf,
1839                                       struct vfpf_set_q_filters_tlv *filters)
1840 {
1841         struct pf_vf_bulletin_content *bulletin = BP_VF_BULLETIN(bp, vf->index);
1842         int rc = 0;
1843 
1844         /* if a mac was already set for this VF via the set vf mac ndo, we only
1845          * accept mac configurations of that mac. Why accept them at all?
1846          * because PF may have been unable to configure the mac at the time
1847          * since queue was not set up.
1848          */
1849         if (bulletin->valid_bitmap & 1 << MAC_ADDR_VALID) {
1850                 struct vfpf_q_mac_vlan_filter *filter = NULL;
1851                 int i;
1852 
1853                 for (i = 0; i < filters->n_mac_vlan_filters; i++) {
1854                         if (!(filters->filters[i].flags &
1855                               VFPF_Q_FILTER_DEST_MAC_VALID))
1856                                 continue;
1857 
1858                         /* once a mac was set by ndo can only accept
1859                          * a single mac...
1860                          */
1861                         if (filter) {
1862                                 BNX2X_ERR("VF[%d] requested the addition of multiple macs after set_vf_mac ndo was called [%d filters]\n",
1863                                           vf->abs_vfid,
1864                                           filters->n_mac_vlan_filters);
1865                                 rc = -EPERM;
1866                                 goto response;
1867                         }
1868 
1869                         filter = &filters->filters[i];
1870                 }
1871 
1872                 /* ...and only the mac set by the ndo */
1873                 if (filter &&
1874                     !ether_addr_equal(filter->mac, bulletin->mac)) {
1875                         BNX2X_ERR("VF[%d] requested the addition of a mac address not matching the one configured by set_vf_mac ndo\n",
1876                                   vf->abs_vfid);
1877 
1878                         rc = -EPERM;
1879                         goto response;
1880                 }
1881         }
1882 
1883 response:
1884         return rc;
1885 }
1886 
1887 static int bnx2x_filters_validate_vlan(struct bnx2x *bp,
1888                                        struct bnx2x_virtf *vf,
1889                                        struct vfpf_set_q_filters_tlv *filters)
1890 {
1891         struct pf_vf_bulletin_content *bulletin = BP_VF_BULLETIN(bp, vf->index);
1892         int rc = 0;
1893 
1894         /* if vlan was set by hypervisor we don't allow guest to config vlan */
1895         if (bulletin->valid_bitmap & 1 << VLAN_VALID) {
1896                 /* search for vlan filters */
1897 
1898                 if (bnx2x_vf_filters_contain(filters,
1899                                              VFPF_Q_FILTER_VLAN_TAG_VALID)) {
1900                         BNX2X_ERR("VF[%d] attempted to configure vlan but one was already set by Hypervisor. Aborting request\n",
1901                                   vf->abs_vfid);
1902                         rc = -EPERM;
1903                         goto response;
1904                 }
1905         }
1906 
1907         /* verify vf_qid */
1908         if (filters->vf_qid > vf_rxq_count(vf)) {
1909                 rc = -EPERM;
1910                 goto response;
1911         }
1912 
1913 response:
1914         return rc;
1915 }
1916 
1917 static void bnx2x_vf_mbx_set_q_filters(struct bnx2x *bp,
1918                                        struct bnx2x_virtf *vf,
1919                                        struct bnx2x_vf_mbx *mbx)
1920 {
1921         struct vfpf_set_q_filters_tlv *filters = &mbx->msg->req.set_q_filters;
1922         int rc;
1923 
1924         rc = bnx2x_filters_validate_mac(bp, vf, filters);
1925         if (rc)
1926                 goto response;
1927 
1928         rc = bnx2x_filters_validate_vlan(bp, vf, filters);
1929         if (rc)
1930                 goto response;
1931 
1932         DP(BNX2X_MSG_IOV, "VF[%d] Q_FILTERS: queue[%d]\n",
1933            vf->abs_vfid,
1934            filters->vf_qid);
1935 
1936         /* print q_filter message */
1937         bnx2x_vf_mbx_dp_q_filters(bp, BNX2X_MSG_IOV, filters);
1938 
1939         rc = bnx2x_vf_mbx_qfilters(bp, vf);
1940 response:
1941         bnx2x_vf_mbx_resp(bp, vf, rc);
1942 }
1943 
1944 static void bnx2x_vf_mbx_teardown_q(struct bnx2x *bp, struct bnx2x_virtf *vf,
1945                                     struct bnx2x_vf_mbx *mbx)
1946 {
1947         int qid = mbx->msg->req.q_op.vf_qid;
1948         int rc;
1949 
1950         DP(BNX2X_MSG_IOV, "VF[%d] Q_TEARDOWN: vf_qid=%d\n",
1951            vf->abs_vfid, qid);
1952 
1953         rc = bnx2x_vf_queue_teardown(bp, vf, qid);
1954         bnx2x_vf_mbx_resp(bp, vf, rc);
1955 }
1956 
1957 static void bnx2x_vf_mbx_close_vf(struct bnx2x *bp, struct bnx2x_virtf *vf,
1958                                   struct bnx2x_vf_mbx *mbx)
1959 {
1960         int rc;
1961 
1962         DP(BNX2X_MSG_IOV, "VF[%d] VF_CLOSE\n", vf->abs_vfid);
1963 
1964         rc = bnx2x_vf_close(bp, vf);
1965         bnx2x_vf_mbx_resp(bp, vf, rc);
1966 }
1967 
1968 static void bnx2x_vf_mbx_release_vf(struct bnx2x *bp, struct bnx2x_virtf *vf,
1969                                     struct bnx2x_vf_mbx *mbx)
1970 {
1971         int rc;
1972 
1973         DP(BNX2X_MSG_IOV, "VF[%d] VF_RELEASE\n", vf->abs_vfid);
1974 
1975         rc = bnx2x_vf_free(bp, vf);
1976         bnx2x_vf_mbx_resp(bp, vf, rc);
1977 }
1978 
1979 static void bnx2x_vf_mbx_update_rss(struct bnx2x *bp, struct bnx2x_virtf *vf,
1980                                     struct bnx2x_vf_mbx *mbx)
1981 {
1982         struct bnx2x_config_rss_params rss;
1983         struct vfpf_rss_tlv *rss_tlv = &mbx->msg->req.update_rss;
1984         int rc = 0;
1985 
1986         if (rss_tlv->ind_table_size != T_ETH_INDIRECTION_TABLE_SIZE ||
1987             rss_tlv->rss_key_size != T_ETH_RSS_KEY) {
1988                 BNX2X_ERR("failing rss configuration of vf %d due to size mismatch\n",
1989                           vf->index);
1990                 rc = -EINVAL;
1991                 goto mbx_resp;
1992         }
1993 
1994         memset(&rss, 0, sizeof(struct bnx2x_config_rss_params));
1995 
1996         /* set vfop params according to rss tlv */
1997         memcpy(rss.ind_table, rss_tlv->ind_table,
1998                T_ETH_INDIRECTION_TABLE_SIZE);
1999         memcpy(rss.rss_key, rss_tlv->rss_key, sizeof(rss_tlv->rss_key));
2000         rss.rss_obj = &vf->rss_conf_obj;
2001         rss.rss_result_mask = rss_tlv->rss_result_mask;
2002 
2003         /* flags handled individually for backward/forward compatibility */
2004         rss.rss_flags = 0;
2005         rss.ramrod_flags = 0;
2006 
2007         if (rss_tlv->rss_flags & VFPF_RSS_MODE_DISABLED)
2008                 __set_bit(BNX2X_RSS_MODE_DISABLED, &rss.rss_flags);
2009         if (rss_tlv->rss_flags & VFPF_RSS_MODE_REGULAR)
2010                 __set_bit(BNX2X_RSS_MODE_REGULAR, &rss.rss_flags);
2011         if (rss_tlv->rss_flags & VFPF_RSS_SET_SRCH)
2012                 __set_bit(BNX2X_RSS_SET_SRCH, &rss.rss_flags);
2013         if (rss_tlv->rss_flags & VFPF_RSS_IPV4)
2014                 __set_bit(BNX2X_RSS_IPV4, &rss.rss_flags);
2015         if (rss_tlv->rss_flags & VFPF_RSS_IPV4_TCP)
2016                 __set_bit(BNX2X_RSS_IPV4_TCP, &rss.rss_flags);
2017         if (rss_tlv->rss_flags & VFPF_RSS_IPV4_UDP)
2018                 __set_bit(BNX2X_RSS_IPV4_UDP, &rss.rss_flags);
2019         if (rss_tlv->rss_flags & VFPF_RSS_IPV6)
2020                 __set_bit(BNX2X_RSS_IPV6, &rss.rss_flags);
2021         if (rss_tlv->rss_flags & VFPF_RSS_IPV6_TCP)
2022                 __set_bit(BNX2X_RSS_IPV6_TCP, &rss.rss_flags);
2023         if (rss_tlv->rss_flags & VFPF_RSS_IPV6_UDP)
2024                 __set_bit(BNX2X_RSS_IPV6_UDP, &rss.rss_flags);
2025 
2026         if ((!(rss_tlv->rss_flags & VFPF_RSS_IPV4_TCP) &&
2027              rss_tlv->rss_flags & VFPF_RSS_IPV4_UDP) ||
2028             (!(rss_tlv->rss_flags & VFPF_RSS_IPV6_TCP) &&
2029              rss_tlv->rss_flags & VFPF_RSS_IPV6_UDP)) {
2030                 BNX2X_ERR("about to hit a FW assert. aborting...\n");
2031                 rc = -EINVAL;
2032                 goto mbx_resp;
2033         }
2034 
2035         rc = bnx2x_vf_rss_update(bp, vf, &rss);
2036 mbx_resp:
2037         bnx2x_vf_mbx_resp(bp, vf, rc);
2038 }
2039 
2040 static int bnx2x_validate_tpa_params(struct bnx2x *bp,
2041                                        struct vfpf_tpa_tlv *tpa_tlv)
2042 {
2043         int rc = 0;
2044 
2045         if (tpa_tlv->tpa_client_info.max_sges_for_packet >
2046             U_ETH_MAX_SGES_FOR_PACKET) {
2047                 rc = -EINVAL;
2048                 BNX2X_ERR("TPA update: max_sges received %d, max is %d\n",
2049                           tpa_tlv->tpa_client_info.max_sges_for_packet,
2050                           U_ETH_MAX_SGES_FOR_PACKET);
2051         }
2052 
2053         if (tpa_tlv->tpa_client_info.max_tpa_queues > MAX_AGG_QS(bp)) {
2054                 rc = -EINVAL;
2055                 BNX2X_ERR("TPA update: max_tpa_queues received %d, max is %d\n",
2056                           tpa_tlv->tpa_client_info.max_tpa_queues,
2057                           MAX_AGG_QS(bp));
2058         }
2059 
2060         return rc;
2061 }
2062 
2063 static void bnx2x_vf_mbx_update_tpa(struct bnx2x *bp, struct bnx2x_virtf *vf,
2064                                     struct bnx2x_vf_mbx *mbx)
2065 {
2066         struct bnx2x_queue_update_tpa_params vf_op_params;
2067         struct vfpf_tpa_tlv *tpa_tlv = &mbx->msg->req.update_tpa;
2068         int rc = 0;
2069 
2070         memset(&vf_op_params, 0, sizeof(vf_op_params));
2071 
2072         if (bnx2x_validate_tpa_params(bp, tpa_tlv))
2073                 goto mbx_resp;
2074 
2075         vf_op_params.complete_on_both_clients =
2076                 tpa_tlv->tpa_client_info.complete_on_both_clients;
2077         vf_op_params.dont_verify_thr =
2078                 tpa_tlv->tpa_client_info.dont_verify_thr;
2079         vf_op_params.max_agg_sz =
2080                 tpa_tlv->tpa_client_info.max_agg_size;
2081         vf_op_params.max_sges_pkt =
2082                 tpa_tlv->tpa_client_info.max_sges_for_packet;
2083         vf_op_params.max_tpa_queues =
2084                 tpa_tlv->tpa_client_info.max_tpa_queues;
2085         vf_op_params.sge_buff_sz =
2086                 tpa_tlv->tpa_client_info.sge_buff_size;
2087         vf_op_params.sge_pause_thr_high =
2088                 tpa_tlv->tpa_client_info.sge_pause_thr_high;
2089         vf_op_params.sge_pause_thr_low =
2090                 tpa_tlv->tpa_client_info.sge_pause_thr_low;
2091         vf_op_params.tpa_mode =
2092                 tpa_tlv->tpa_client_info.tpa_mode;
2093         vf_op_params.update_ipv4 =
2094                 tpa_tlv->tpa_client_info.update_ipv4;
2095         vf_op_params.update_ipv6 =
2096                 tpa_tlv->tpa_client_info.update_ipv6;
2097 
2098         rc = bnx2x_vf_tpa_update(bp, vf, tpa_tlv, &vf_op_params);
2099 
2100 mbx_resp:
2101         bnx2x_vf_mbx_resp(bp, vf, rc);
2102 }
2103 
2104 /* dispatch request */
2105 static void bnx2x_vf_mbx_request(struct bnx2x *bp, struct bnx2x_virtf *vf,
2106                                   struct bnx2x_vf_mbx *mbx)
2107 {
2108         int i;
2109 
2110         if (vf->state == VF_LOST) {
2111                 /* Just ack the FW and return if VFs are lost
2112                  * in case of parity error. VFs are supposed to be timedout
2113                  * on waiting for PF response.
2114                  */
2115                 DP(BNX2X_MSG_IOV,
2116                    "VF 0x%x lost, not handling the request\n", vf->abs_vfid);
2117 
2118                 storm_memset_vf_mbx_ack(bp, vf->abs_vfid);
2119                 return;
2120         }
2121 
2122         /* check if tlv type is known */
2123         if (bnx2x_tlv_supported(mbx->first_tlv.tl.type)) {
2124                 /* Lock the per vf op mutex and note the locker's identity.
2125                  * The unlock will take place in mbx response.
2126                  */
2127                 bnx2x_lock_vf_pf_channel(bp, vf, mbx->first_tlv.tl.type);
2128 
2129                 /* switch on the opcode */
2130                 switch (mbx->first_tlv.tl.type) {
2131                 case CHANNEL_TLV_ACQUIRE:
2132                         bnx2x_vf_mbx_acquire(bp, vf, mbx);
2133                         return;
2134                 case CHANNEL_TLV_INIT:
2135                         bnx2x_vf_mbx_init_vf(bp, vf, mbx);
2136                         return;
2137                 case CHANNEL_TLV_SETUP_Q:
2138                         bnx2x_vf_mbx_setup_q(bp, vf, mbx);
2139                         return;
2140                 case CHANNEL_TLV_SET_Q_FILTERS:
2141                         bnx2x_vf_mbx_set_q_filters(bp, vf, mbx);
2142                         return;
2143                 case CHANNEL_TLV_TEARDOWN_Q:
2144                         bnx2x_vf_mbx_teardown_q(bp, vf, mbx);
2145                         return;
2146                 case CHANNEL_TLV_CLOSE:
2147                         bnx2x_vf_mbx_close_vf(bp, vf, mbx);
2148                         return;
2149                 case CHANNEL_TLV_RELEASE:
2150                         bnx2x_vf_mbx_release_vf(bp, vf, mbx);
2151                         return;
2152                 case CHANNEL_TLV_UPDATE_RSS:
2153                         bnx2x_vf_mbx_update_rss(bp, vf, mbx);
2154                         return;
2155                 case CHANNEL_TLV_UPDATE_TPA:
2156                         bnx2x_vf_mbx_update_tpa(bp, vf, mbx);
2157                         return;
2158                 }
2159 
2160         } else {
2161                 /* unknown TLV - this may belong to a VF driver from the future
2162                  * - a version written after this PF driver was written, which
2163                  * supports features unknown as of yet. Too bad since we don't
2164                  * support them. Or this may be because someone wrote a crappy
2165                  * VF driver and is sending garbage over the channel.
2166                  */
2167                 BNX2X_ERR("unknown TLV. type %d length %d vf->state was %d. first 20 bytes of mailbox buffer:\n",
2168                           mbx->first_tlv.tl.type, mbx->first_tlv.tl.length,
2169                           vf->state);
2170                 for (i = 0; i < 20; i++)
2171                         DP_CONT(BNX2X_MSG_IOV, "%x ",
2172                                 mbx->msg->req.tlv_buf_size.tlv_buffer[i]);
2173         }
2174 
2175         /* can we respond to VF (do we have an address for it?) */
2176         if (vf->state == VF_ACQUIRED || vf->state == VF_ENABLED) {
2177                 /* notify the VF that we do not support this request */
2178                 bnx2x_vf_mbx_resp(bp, vf, PFVF_STATUS_NOT_SUPPORTED);
2179         } else {
2180                 /* can't send a response since this VF is unknown to us
2181                  * just ack the FW to release the mailbox and unlock
2182                  * the channel.
2183                  */
2184                 storm_memset_vf_mbx_ack(bp, vf->abs_vfid);
2185                 /* Firmware ack should be written before unlocking channel */
2186                 bnx2x_unlock_vf_pf_channel(bp, vf, mbx->first_tlv.tl.type);
2187         }
2188 }
2189 
2190 void bnx2x_vf_mbx_schedule(struct bnx2x *bp,
2191                            struct vf_pf_event_data *vfpf_event)
2192 {
2193         u8 vf_idx;
2194 
2195         DP(BNX2X_MSG_IOV,
2196            "vf pf event received: vfid %d, address_hi %x, address lo %x",
2197            vfpf_event->vf_id, vfpf_event->msg_addr_hi, vfpf_event->msg_addr_lo);
2198         /* Sanity checks consider removing later */
2199 
2200         /* check if the vf_id is valid */
2201         if (vfpf_event->vf_id - BP_VFDB(bp)->sriov.first_vf_in_pf >
2202             BNX2X_NR_VIRTFN(bp)) {
2203                 BNX2X_ERR("Illegal vf_id %d max allowed: %d\n",
2204                           vfpf_event->vf_id, BNX2X_NR_VIRTFN(bp));
2205                 return;
2206         }
2207 
2208         vf_idx = bnx2x_vf_idx_by_abs_fid(bp, vfpf_event->vf_id);
2209 
2210         /* Update VFDB with current message and schedule its handling */
2211         mutex_lock(&BP_VFDB(bp)->event_mutex);
2212         BP_VF_MBX(bp, vf_idx)->vf_addr_hi =
2213                 le32_to_cpu(vfpf_event->msg_addr_hi);
2214         BP_VF_MBX(bp, vf_idx)->vf_addr_lo =
2215                 le32_to_cpu(vfpf_event->msg_addr_lo);
2216         BP_VFDB(bp)->event_occur |= (1ULL << vf_idx);
2217         mutex_unlock(&BP_VFDB(bp)->event_mutex);
2218 
2219         bnx2x_schedule_iov_task(bp, BNX2X_IOV_HANDLE_VF_MSG);
2220 }
2221 
2222 /* handle new vf-pf messages */
2223 void bnx2x_vf_mbx(struct bnx2x *bp)
2224 {
2225         struct bnx2x_vfdb *vfdb = BP_VFDB(bp);
2226         u64 events;
2227         u8 vf_idx;
2228         int rc;
2229 
2230         if (!vfdb)
2231                 return;
2232 
2233         mutex_lock(&vfdb->event_mutex);
2234         events = vfdb->event_occur;
2235         vfdb->event_occur = 0;
2236         mutex_unlock(&vfdb->event_mutex);
2237 
2238         for_each_vf(bp, vf_idx) {
2239                 struct bnx2x_vf_mbx *mbx = BP_VF_MBX(bp, vf_idx);
2240                 struct bnx2x_virtf *vf = BP_VF(bp, vf_idx);
2241 
2242                 /* Handle VFs which have pending events */
2243                 if (!(events & (1ULL << vf_idx)))
2244                         continue;
2245 
2246                 DP(BNX2X_MSG_IOV,
2247                    "Handling vf pf event vfid %d, address: [%x:%x], resp_offset 0x%x\n",
2248                    vf_idx, mbx->vf_addr_hi, mbx->vf_addr_lo,
2249                    mbx->first_tlv.resp_msg_offset);
2250 
2251                 /* dmae to get the VF request */
2252                 rc = bnx2x_copy32_vf_dmae(bp, true, mbx->msg_mapping,
2253                                           vf->abs_vfid, mbx->vf_addr_hi,
2254                                           mbx->vf_addr_lo,
2255                                           sizeof(union vfpf_tlvs)/4);
2256                 if (rc) {
2257                         BNX2X_ERR("Failed to copy request VF %d\n",
2258                                   vf->abs_vfid);
2259                         bnx2x_vf_release(bp, vf);
2260                         return;
2261                 }
2262 
2263                 /* process the VF message header */
2264                 mbx->first_tlv = mbx->msg->req.first_tlv;
2265 
2266                 /* Clean response buffer to refrain from falsely
2267                  * seeing chains.
2268                  */
2269                 memset(&mbx->msg->resp, 0, sizeof(union pfvf_tlvs));
2270 
2271                 /* dispatch the request (will prepare the response) */
2272                 bnx2x_vf_mbx_request(bp, vf, mbx);
2273         }
2274 }
2275 
2276 void bnx2x_vf_bulletin_finalize(struct pf_vf_bulletin_content *bulletin,
2277                                 bool support_long)
2278 {
2279         /* Older VFs contain a bug where they can't check CRC for bulletin
2280          * boards of length greater than legacy size.
2281          */
2282         bulletin->length = support_long ? BULLETIN_CONTENT_SIZE :
2283                                           BULLETIN_CONTENT_LEGACY_SIZE;
2284         bulletin->crc = bnx2x_crc_vf_bulletin(bulletin);
2285 }
2286 
2287 /* propagate local bulletin board to vf */
2288 int bnx2x_post_vf_bulletin(struct bnx2x *bp, int vf)
2289 {
2290         struct pf_vf_bulletin_content *bulletin = BP_VF_BULLETIN(bp, vf);
2291         dma_addr_t pf_addr = BP_VF_BULLETIN_DMA(bp)->mapping +
2292                 vf * BULLETIN_CONTENT_SIZE;
2293         dma_addr_t vf_addr = bnx2x_vf(bp, vf, bulletin_map);
2294         int rc;
2295 
2296         /* can only update vf after init took place */
2297         if (bnx2x_vf(bp, vf, state) != VF_ENABLED &&
2298             bnx2x_vf(bp, vf, state) != VF_ACQUIRED)
2299                 return 0;
2300 
2301         /* increment bulletin board version and compute crc */
2302         bulletin->version++;
2303         bnx2x_vf_bulletin_finalize(bulletin,
2304                                    (bnx2x_vf(bp, vf, cfg_flags) &
2305                                     VF_CFG_EXT_BULLETIN) ? true : false);
2306 
2307         /* propagate bulletin board via dmae to vm memory */
2308         rc = bnx2x_copy32_vf_dmae(bp, false, pf_addr,
2309                                   bnx2x_vf(bp, vf, abs_vfid), U64_HI(vf_addr),
2310                                   U64_LO(vf_addr), bulletin->length / 4);
2311         return rc;
2312 }
/* [<][>][^][v][top][bottom][index][help] */
root/drivers/net/ethernet/broadcom/bnx2x/bnx2x_vfpf.c

DEFINITIONS
