drivers/net/ethernet/hisilicon/hns3/hns3pf/hclge_mbx.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 // Copyright (c) 2016-2017 Hisilicon Limited.
   3
   4 #include "hclge_main.h"
   5 #include "hclge_mbx.h"
   6 #include "hnae3.h"
   7
   8 /* hclge_gen_resp_to_vf: used to generate a synchronous response to VF when PF
   9  * receives a mailbox message from VF.
  10  * @vport: pointer to struct hclge_vport
  11  * @vf_to_pf_req: pointer to hclge_mbx_vf_to_pf_cmd of the original mailbox
  12  *                message
  13  * @resp_status: indicate to VF whether its request success(0) or failed.
  14  */
  15 static int hclge_gen_resp_to_vf(struct hclge_vport *vport,
  16                                 struct hclge_mbx_vf_to_pf_cmd *vf_to_pf_req,
  17                                 int resp_status,
  18                                 u8 *resp_data, u16 resp_data_len)
  19 {
  20         struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf;
  21         struct hclge_dev *hdev = vport->back;
  22         enum hclge_cmd_status status;
  23         struct hclge_desc desc;
  24
  25         resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;
  26
  27         if (resp_data_len > HCLGE_MBX_MAX_RESP_DATA_SIZE) {
  28                 dev_err(&hdev->pdev->dev,
  29                         "PF fail to gen resp to VF len %d exceeds max len %d\n",
  30                         resp_data_len,
  31                         HCLGE_MBX_MAX_RESP_DATA_SIZE);
  32                 /* If resp_data_len is too long, set the value to max length
  33                  * and return the msg to VF
  34                  */
  35                 resp_data_len = HCLGE_MBX_MAX_RESP_DATA_SIZE;
  36         }
  37
  38         hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);
  39
  40         resp_pf_to_vf->dest_vfid = vf_to_pf_req->mbx_src_vfid;
  41         resp_pf_to_vf->msg_len = vf_to_pf_req->msg_len;
  42
  43         resp_pf_to_vf->msg[0] = HCLGE_MBX_PF_VF_RESP;
  44         resp_pf_to_vf->msg[1] = vf_to_pf_req->msg[0];
  45         resp_pf_to_vf->msg[2] = vf_to_pf_req->msg[1];
  46         resp_pf_to_vf->msg[3] = (resp_status == 0) ? 0 : 1;
  47
  48         if (resp_data && resp_data_len > 0)
  49                 memcpy(&resp_pf_to_vf->msg[4], resp_data, resp_data_len);
  50
  51         status = hclge_cmd_send(&hdev->hw, &desc, 1);
  52         if (status)
  53                 dev_err(&hdev->pdev->dev,
  54                         "PF failed(=%d) to send response to VF\n", status);
  55
  56         return status;
  57 }
  58
  59 static int hclge_send_mbx_msg(struct hclge_vport *vport, u8 *msg, u16 msg_len,
  60                               u16 mbx_opcode, u8 dest_vfid)
  61 {
  62         struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf;
  63         struct hclge_dev *hdev = vport->back;
  64         enum hclge_cmd_status status;
  65         struct hclge_desc desc;
  66
  67         resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data;
  68
  69         hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false);
  70
  71         resp_pf_to_vf->dest_vfid = dest_vfid;
  72         resp_pf_to_vf->msg_len = msg_len;
  73         resp_pf_to_vf->msg[0] = mbx_opcode;
  74
  75         memcpy(&resp_pf_to_vf->msg[1], msg, msg_len);
  76
  77         status = hclge_cmd_send(&hdev->hw, &desc, 1);
  78         if (status)
  79                 dev_err(&hdev->pdev->dev,
  80                         "PF failed(=%d) to send mailbox message to VF\n",
  81                         status);
  82
  83         return status;
  84 }
  85
  86 int hclge_inform_reset_assert_to_vf(struct hclge_vport *vport)
  87 {
  88         struct hclge_dev *hdev = vport->back;
  89         enum hnae3_reset_type reset_type;
  90         u8 msg_data[2];
  91         u8 dest_vfid;
  92
  93         dest_vfid = (u8)vport->vport_id;
  94
  95         if (hdev->reset_type == HNAE3_FUNC_RESET)
  96                 reset_type = HNAE3_VF_PF_FUNC_RESET;
  97         else if (hdev->reset_type == HNAE3_FLR_RESET)
  98                 reset_type = HNAE3_VF_FULL_RESET;
  99         else
 100                 reset_type = HNAE3_VF_FUNC_RESET;
 101
 102         memcpy(&msg_data[0], &reset_type, sizeof(u16));
 103
 104         /* send this requested info to VF */
 105         return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
 106                                   HCLGE_MBX_ASSERTING_RESET, dest_vfid);
 107 }
 108
 109 static void hclge_free_vector_ring_chain(struct hnae3_ring_chain_node *head)
 110 {
 111         struct hnae3_ring_chain_node *chain_tmp, *chain;
 112
 113         chain = head->next;
 114
 115         while (chain) {
 116                 chain_tmp = chain->next;
 117                 kzfree(chain);
 118                 chain = chain_tmp;
 119         }
 120 }
 121
 122 /* hclge_get_ring_chain_from_mbx: get ring type & tqp id & int_gl idx
 123  * from mailbox message
 124  * msg[0]: opcode
 125  * msg[1]: <not relevant to this function>
 126  * msg[2]: ring_num
 127  * msg[3]: first ring type (TX|RX)
 128  * msg[4]: first tqp id
 129  * msg[5]: first int_gl idx
 130  * msg[6] ~ msg[14]: other ring type, tqp id and int_gl idx
 131  */
 132 static int hclge_get_ring_chain_from_mbx(
 133                         struct hclge_mbx_vf_to_pf_cmd *req,
 134                         struct hnae3_ring_chain_node *ring_chain,
 135                         struct hclge_vport *vport)
 136 {
 137         struct hnae3_ring_chain_node *cur_chain, *new_chain;
 138         int ring_num;
 139         int i;
 140
 141         ring_num = req->msg[2];
 142
 143         if (ring_num > ((HCLGE_MBX_VF_MSG_DATA_NUM -
 144                 HCLGE_MBX_RING_MAP_BASIC_MSG_NUM) /
 145                 HCLGE_MBX_RING_NODE_VARIABLE_NUM))
 146                 return -ENOMEM;
 147
 148         hnae3_set_bit(ring_chain->flag, HNAE3_RING_TYPE_B, req->msg[3]);
 149         ring_chain->tqp_index =
 150                         hclge_get_queue_id(vport->nic.kinfo.tqp[req->msg[4]]);
 151         hnae3_set_field(ring_chain->int_gl_idx, HNAE3_RING_GL_IDX_M,
 152                         HNAE3_RING_GL_IDX_S,
 153                         req->msg[5]);
 154
 155         cur_chain = ring_chain;
 156
 157         for (i = 1; i < ring_num; i++) {
 158                 new_chain = kzalloc(sizeof(*new_chain), GFP_KERNEL);
 159                 if (!new_chain)
 160                         goto err;
 161
 162                 hnae3_set_bit(new_chain->flag, HNAE3_RING_TYPE_B,
 163                               req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
 164                               HCLGE_MBX_RING_MAP_BASIC_MSG_NUM]);
 165
 166                 new_chain->tqp_index =
 167                 hclge_get_queue_id(vport->nic.kinfo.tqp
 168                         [req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
 169                         HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 1]]);
 170
 171                 hnae3_set_field(new_chain->int_gl_idx, HNAE3_RING_GL_IDX_M,
 172                                 HNAE3_RING_GL_IDX_S,
 173                                 req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
 174                                 HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 2]);
 175
 176                 cur_chain->next = new_chain;
 177                 cur_chain = new_chain;
 178         }
 179
 180         return 0;
 181 err:
 182         hclge_free_vector_ring_chain(ring_chain);
 183         return -ENOMEM;
 184 }
 185
 186 static int hclge_map_unmap_ring_to_vf_vector(struct hclge_vport *vport, bool en,
 187                                              struct hclge_mbx_vf_to_pf_cmd *req)
 188 {
 189         struct hnae3_ring_chain_node ring_chain;
 190         int vector_id = req->msg[1];
 191         int ret;
 192
 193         memset(&ring_chain, 0, sizeof(ring_chain));
 194         ret = hclge_get_ring_chain_from_mbx(req, &ring_chain, vport);
 195         if (ret)
 196                 return ret;
 197
 198         ret = hclge_bind_ring_with_vector(vport, vector_id, en, &ring_chain);
 199
 200         hclge_free_vector_ring_chain(&ring_chain);
 201
 202         return ret;
 203 }
 204
 205 static int hclge_set_vf_promisc_mode(struct hclge_vport *vport,
 206                                      struct hclge_mbx_vf_to_pf_cmd *req)
 207 {
 208         bool en_bc = req->msg[1] ? true : false;
 209         struct hclge_promisc_param param;
 210
 211         /* vf is not allowed to enable unicast/multicast broadcast */
 212         hclge_promisc_param_init(&param, false, false, en_bc, vport->vport_id);
 213         return hclge_cmd_set_promisc_mode(vport->back, &param);
 214 }
 215
 216 static int hclge_set_vf_uc_mac_addr(struct hclge_vport *vport,
 217                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 218 {
 219         const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
 220         struct hclge_dev *hdev = vport->back;
 221         int status;
 222
 223         if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_MODIFY) {
 224                 const u8 *old_addr = (const u8 *)(&mbx_req->msg[8]);
 225
 226                 hclge_rm_uc_addr_common(vport, old_addr);
 227                 status = hclge_add_uc_addr_common(vport, mac_addr);
 228                 if (status) {
 229                         hclge_add_uc_addr_common(vport, old_addr);
 230                 } else {
 231                         hclge_rm_vport_mac_table(vport, mac_addr,
 232                                                  false, HCLGE_MAC_ADDR_UC);
 233                         hclge_add_vport_mac_table(vport, mac_addr,
 234                                                   HCLGE_MAC_ADDR_UC);
 235                 }
 236         } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_ADD) {
 237                 status = hclge_add_uc_addr_common(vport, mac_addr);
 238                 if (!status)
 239                         hclge_add_vport_mac_table(vport, mac_addr,
 240                                                   HCLGE_MAC_ADDR_UC);
 241         } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_REMOVE) {
 242                 status = hclge_rm_uc_addr_common(vport, mac_addr);
 243                 if (!status)
 244                         hclge_rm_vport_mac_table(vport, mac_addr,
 245                                                  false, HCLGE_MAC_ADDR_UC);
 246         } else {
 247                 dev_err(&hdev->pdev->dev,
 248                         "failed to set unicast mac addr, unknown subcode %d\n",
 249                         mbx_req->msg[1]);
 250                 return -EIO;
 251         }
 252
 253         if (mbx_req->mbx_need_resp & HCLGE_MBX_NEED_RESP_BIT)
 254                 hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);
 255
 256         return 0;
 257 }
 258
 259 static int hclge_set_vf_mc_mac_addr(struct hclge_vport *vport,
 260                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 261                                     bool gen_resp)
 262 {
 263         const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
 264         struct hclge_dev *hdev = vport->back;
 265         u8 resp_len = 0;
 266         u8 resp_data;
 267         int status;
 268
 269         if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_ADD) {
 270                 status = hclge_add_mc_addr_common(vport, mac_addr);
 271                 if (!status)
 272                         hclge_add_vport_mac_table(vport, mac_addr,
 273                                                   HCLGE_MAC_ADDR_MC);
 274         } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_REMOVE) {
 275                 status = hclge_rm_mc_addr_common(vport, mac_addr);
 276                 if (!status)
 277                         hclge_rm_vport_mac_table(vport, mac_addr,
 278                                                  false, HCLGE_MAC_ADDR_MC);
 279         } else {
 280                 dev_err(&hdev->pdev->dev,
 281                         "failed to set mcast mac addr, unknown subcode %d\n",
 282                         mbx_req->msg[1]);
 283                 return -EIO;
 284         }
 285
 286         if (gen_resp)
 287                 hclge_gen_resp_to_vf(vport, mbx_req, status,
 288                                      &resp_data, resp_len);
 289
 290         return 0;
 291 }
 292
 293 int hclge_push_vf_port_base_vlan_info(struct hclge_vport *vport, u8 vfid,
 294                                       u16 state, u16 vlan_tag, u16 qos,
 295                                       u16 vlan_proto)
 296 {
 297 #define MSG_DATA_SIZE   8
 298
 299         u8 msg_data[MSG_DATA_SIZE];
 300
 301         memcpy(&msg_data[0], &state, sizeof(u16));
 302         memcpy(&msg_data[2], &vlan_proto, sizeof(u16));
 303         memcpy(&msg_data[4], &qos, sizeof(u16));
 304         memcpy(&msg_data[6], &vlan_tag, sizeof(u16));
 305
 306         return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
 307                                   HLCGE_MBX_PUSH_VLAN_INFO, vfid);
 308 }
 309
 310 static int hclge_set_vf_vlan_cfg(struct hclge_vport *vport,
 311                                  struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 312 {
 313         struct hclge_vf_vlan_cfg *msg_cmd;
 314         int status = 0;
 315
 316         msg_cmd = (struct hclge_vf_vlan_cfg *)mbx_req->msg;
 317         if (msg_cmd->subcode == HCLGE_MBX_VLAN_FILTER) {
 318                 struct hnae3_handle *handle = &vport->nic;
 319                 u16 vlan, proto;
 320                 bool is_kill;
 321
 322                 is_kill = !!msg_cmd->is_kill;
 323                 vlan =  msg_cmd->vlan;
 324                 proto =  msg_cmd->proto;
 325                 status = hclge_set_vlan_filter(handle, cpu_to_be16(proto),
 326                                                vlan, is_kill);
 327         } else if (msg_cmd->subcode == HCLGE_MBX_VLAN_RX_OFF_CFG) {
 328                 struct hnae3_handle *handle = &vport->nic;
 329                 bool en = msg_cmd->is_kill ? true : false;
 330
 331                 status = hclge_en_hw_strip_rxvtag(handle, en);
 332         } else if (mbx_req->msg[1] == HCLGE_MBX_PORT_BASE_VLAN_CFG) {
 333                 struct hclge_vlan_info *vlan_info;
 334                 u16 *state;
 335
 336                 state = (u16 *)&mbx_req->msg[2];
 337                 vlan_info = (struct hclge_vlan_info *)&mbx_req->msg[4];
 338                 status = hclge_update_port_base_vlan_cfg(vport, *state,
 339                                                          vlan_info);
 340         } else if (mbx_req->msg[1] == HCLGE_MBX_GET_PORT_BASE_VLAN_STATE) {
 341                 u8 state;
 342
 343                 state = vport->port_base_vlan_cfg.state;
 344                 status = hclge_gen_resp_to_vf(vport, mbx_req, 0, &state,
 345                                               sizeof(u8));
 346         }
 347
 348         return status;
 349 }
 350
 351 static int hclge_set_vf_alive(struct hclge_vport *vport,
 352                               struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 353                               bool gen_resp)
 354 {
 355         bool alive = !!mbx_req->msg[2];
 356         int ret = 0;
 357
 358         if (alive)
 359                 ret = hclge_vport_start(vport);
 360         else
 361                 hclge_vport_stop(vport);
 362
 363         return ret;
 364 }
 365
 366 static int hclge_get_vf_tcinfo(struct hclge_vport *vport,
 367                                struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 368                                bool gen_resp)
 369 {
 370         struct hnae3_knic_private_info *kinfo = &vport->nic.kinfo;
 371         u8 vf_tc_map = 0;
 372         unsigned int i;
 373         int ret;
 374
 375         for (i = 0; i < kinfo->num_tc; i++)
 376                 vf_tc_map |= BIT(i);
 377
 378         ret = hclge_gen_resp_to_vf(vport, mbx_req, 0, &vf_tc_map,
 379                                    sizeof(vf_tc_map));
 380
 381         return ret;
 382 }
 383
 384 static int hclge_get_vf_queue_info(struct hclge_vport *vport,
 385                                    struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 386                                    bool gen_resp)
 387 {
 388 #define HCLGE_TQPS_RSS_INFO_LEN         6
 389         u8 resp_data[HCLGE_TQPS_RSS_INFO_LEN];
 390         struct hclge_dev *hdev = vport->back;
 391
 392         /* get the queue related info */
 393         memcpy(&resp_data[0], &vport->alloc_tqps, sizeof(u16));
 394         memcpy(&resp_data[2], &vport->nic.kinfo.rss_size, sizeof(u16));
 395         memcpy(&resp_data[4], &hdev->rx_buf_len, sizeof(u16));
 396
 397         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 398                                     HCLGE_TQPS_RSS_INFO_LEN);
 399 }
 400
 401 static int hclge_get_vf_queue_depth(struct hclge_vport *vport,
 402                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 403                                     bool gen_resp)
 404 {
 405 #define HCLGE_TQPS_DEPTH_INFO_LEN       4
 406         u8 resp_data[HCLGE_TQPS_DEPTH_INFO_LEN];
 407         struct hclge_dev *hdev = vport->back;
 408
 409         /* get the queue depth info */
 410         memcpy(&resp_data[0], &hdev->num_tx_desc, sizeof(u16));
 411         memcpy(&resp_data[2], &hdev->num_rx_desc, sizeof(u16));
 412         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 413                                     HCLGE_TQPS_DEPTH_INFO_LEN);
 414 }
 415
 416 static int hclge_get_vf_media_type(struct hclge_vport *vport,
 417                                    struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 418 {
 419         struct hclge_dev *hdev = vport->back;
 420         u8 resp_data[2];
 421
 422         resp_data[0] = hdev->hw.mac.media_type;
 423         resp_data[1] = hdev->hw.mac.module_type;
 424         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 425                                     sizeof(resp_data));
 426 }
 427
 428 static int hclge_get_link_info(struct hclge_vport *vport,
 429                                struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 430 {
 431         struct hclge_dev *hdev = vport->back;
 432         u16 link_status;
 433         u8 msg_data[8];
 434         u8 dest_vfid;
 435         u16 duplex;
 436
 437         /* mac.link can only be 0 or 1 */
 438         link_status = (u16)hdev->hw.mac.link;
 439         duplex = hdev->hw.mac.duplex;
 440         memcpy(&msg_data[0], &link_status, sizeof(u16));
 441         memcpy(&msg_data[2], &hdev->hw.mac.speed, sizeof(u32));
 442         memcpy(&msg_data[6], &duplex, sizeof(u16));
 443         dest_vfid = mbx_req->mbx_src_vfid;
 444
 445         /* send this requested info to VF */
 446         return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
 447                                   HCLGE_MBX_LINK_STAT_CHANGE, dest_vfid);
 448 }
 449
 450 static void hclge_get_link_mode(struct hclge_vport *vport,
 451                                 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 452 {
 453 #define HCLGE_SUPPORTED   1
 454         struct hclge_dev *hdev = vport->back;
 455         unsigned long advertising;
 456         unsigned long supported;
 457         unsigned long send_data;
 458         u8 msg_data[10];
 459         u8 dest_vfid;
 460
 461         advertising = hdev->hw.mac.advertising[0];
 462         supported = hdev->hw.mac.supported[0];
 463         dest_vfid = mbx_req->mbx_src_vfid;
 464         msg_data[0] = mbx_req->msg[2];
 465
 466         send_data = msg_data[0] == HCLGE_SUPPORTED ? supported : advertising;
 467
 468         memcpy(&msg_data[2], &send_data, sizeof(unsigned long));
 469         hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
 470                            HCLGE_MBX_LINK_STAT_MODE, dest_vfid);
 471 }
 472
 473 static void hclge_mbx_reset_vf_queue(struct hclge_vport *vport,
 474                                      struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 475 {
 476         u16 queue_id;
 477
 478         memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));
 479
 480         hclge_reset_vf_queue(vport, queue_id);
 481
 482         /* send response msg to VF after queue reset complete*/
 483         hclge_gen_resp_to_vf(vport, mbx_req, 0, NULL, 0);
 484 }
 485
 486 static void hclge_reset_vf(struct hclge_vport *vport,
 487                            struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 488 {
 489         struct hclge_dev *hdev = vport->back;
 490         int ret;
 491
 492         dev_warn(&hdev->pdev->dev, "PF received VF reset request from VF %d!",
 493                  vport->vport_id);
 494
 495         ret = hclge_func_reset_cmd(hdev, vport->vport_id);
 496         hclge_gen_resp_to_vf(vport, mbx_req, ret, NULL, 0);
 497 }
 498
 499 static void hclge_vf_keep_alive(struct hclge_vport *vport,
 500                                 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 501 {
 502         vport->last_active_jiffies = jiffies;
 503 }
 504
 505 static int hclge_set_vf_mtu(struct hclge_vport *vport,
 506                             struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 507 {
 508         int ret;
 509         u32 mtu;
 510
 511         memcpy(&mtu, &mbx_req->msg[2], sizeof(mtu));
 512         ret = hclge_set_vport_mtu(vport, mtu);
 513
 514         return hclge_gen_resp_to_vf(vport, mbx_req, ret, NULL, 0);
 515 }
 516
 517 static int hclge_get_queue_id_in_pf(struct hclge_vport *vport,
 518                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 519 {
 520         u16 queue_id, qid_in_pf;
 521         u8 resp_data[2];
 522
 523         memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));
 524         qid_in_pf = hclge_covert_handle_qid_global(&vport->nic, queue_id);
 525         memcpy(resp_data, &qid_in_pf, sizeof(qid_in_pf));
 526
 527         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data, 2);
 528 }
 529
 530 static int hclge_get_rss_key(struct hclge_vport *vport,
 531                              struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 532 {
 533 #define HCLGE_RSS_MBX_RESP_LEN  8
 534         u8 resp_data[HCLGE_RSS_MBX_RESP_LEN];
 535         struct hclge_dev *hdev = vport->back;
 536         u8 index;
 537
 538         index = mbx_req->msg[2];
 539
 540         memcpy(&resp_data[0],
 541                &hdev->vport[0].rss_hash_key[index * HCLGE_RSS_MBX_RESP_LEN],
 542                HCLGE_RSS_MBX_RESP_LEN);
 543
 544         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 545                                     HCLGE_RSS_MBX_RESP_LEN);
 546 }
 547
 548 static bool hclge_cmd_crq_empty(struct hclge_hw *hw)
 549 {
 550         u32 tail = hclge_read_dev(hw, HCLGE_NIC_CRQ_TAIL_REG);
 551
 552         return tail == hw->cmq.crq.next_to_use;
 553 }
 554
 555 void hclge_mbx_handler(struct hclge_dev *hdev)
 556 {
 557         struct hclge_cmq_ring *crq = &hdev->hw.cmq.crq;
 558         struct hclge_mbx_vf_to_pf_cmd *req;
 559         struct hclge_vport *vport;
 560         struct hclge_desc *desc;
 561         unsigned int flag;
 562         int ret;
 563
 564         /* handle all the mailbox requests in the queue */
 565         while (!hclge_cmd_crq_empty(&hdev->hw)) {
 566                 if (test_bit(HCLGE_STATE_CMD_DISABLE, &hdev->state)) {
 567                         dev_warn(&hdev->pdev->dev,
 568                                  "command queue needs re-initializing\n");
 569                         return;
 570                 }
 571
 572                 desc = &crq->desc[crq->next_to_use];
 573                 req = (struct hclge_mbx_vf_to_pf_cmd *)desc->data;
 574
 575                 flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
 576                 if (unlikely(!hnae3_get_bit(flag, HCLGE_CMDQ_RX_OUTVLD_B))) {
 577                         dev_warn(&hdev->pdev->dev,
 578                                  "dropped invalid mailbox message, code = %d\n",
 579                                  req->msg[0]);
 580
 581                         /* dropping/not processing this invalid message */
 582                         crq->desc[crq->next_to_use].flag = 0;
 583                         hclge_mbx_ring_ptr_move_crq(crq);
 584                         continue;
 585                 }
 586
 587                 vport = &hdev->vport[req->mbx_src_vfid];
 588
 589                 switch (req->msg[0]) {
 590                 case HCLGE_MBX_MAP_RING_TO_VECTOR:
 591                         ret = hclge_map_unmap_ring_to_vf_vector(vport, true,
 592                                                                 req);
 593                         break;
 594                 case HCLGE_MBX_UNMAP_RING_TO_VECTOR:
 595                         ret = hclge_map_unmap_ring_to_vf_vector(vport, false,
 596                                                                 req);
 597                         break;
 598                 case HCLGE_MBX_SET_PROMISC_MODE:
 599                         ret = hclge_set_vf_promisc_mode(vport, req);
 600                         if (ret)
 601                                 dev_err(&hdev->pdev->dev,
 602                                         "PF fail(%d) to set VF promisc mode\n",
 603                                         ret);
 604                         break;
 605                 case HCLGE_MBX_SET_UNICAST:
 606                         ret = hclge_set_vf_uc_mac_addr(vport, req);
 607                         if (ret)
 608                                 dev_err(&hdev->pdev->dev,
 609                                         "PF fail(%d) to set VF UC MAC Addr\n",
 610                                         ret);
 611                         break;
 612                 case HCLGE_MBX_SET_MULTICAST:
 613                         ret = hclge_set_vf_mc_mac_addr(vport, req, false);
 614                         if (ret)
 615                                 dev_err(&hdev->pdev->dev,
 616                                         "PF fail(%d) to set VF MC MAC Addr\n",
 617                                         ret);
 618                         break;
 619                 case HCLGE_MBX_SET_VLAN:
 620                         ret = hclge_set_vf_vlan_cfg(vport, req);
 621                         if (ret)
 622                                 dev_err(&hdev->pdev->dev,
 623                                         "PF failed(%d) to config VF's VLAN\n",
 624                                         ret);
 625                         break;
 626                 case HCLGE_MBX_SET_ALIVE:
 627                         ret = hclge_set_vf_alive(vport, req, false);
 628                         if (ret)
 629                                 dev_err(&hdev->pdev->dev,
 630                                         "PF failed(%d) to set VF's ALIVE\n",
 631                                         ret);
 632                         break;
 633                 case HCLGE_MBX_GET_QINFO:
 634                         ret = hclge_get_vf_queue_info(vport, req, true);
 635                         if (ret)
 636                                 dev_err(&hdev->pdev->dev,
 637                                         "PF failed(%d) to get Q info for VF\n",
 638                                         ret);
 639                         break;
 640                 case HCLGE_MBX_GET_QDEPTH:
 641                         ret = hclge_get_vf_queue_depth(vport, req, true);
 642                         if (ret)
 643                                 dev_err(&hdev->pdev->dev,
 644                                         "PF failed(%d) to get Q depth for VF\n",
 645                                         ret);
 646                         break;
 647
 648                 case HCLGE_MBX_GET_TCINFO:
 649                         ret = hclge_get_vf_tcinfo(vport, req, true);
 650                         if (ret)
 651                                 dev_err(&hdev->pdev->dev,
 652                                         "PF failed(%d) to get TC info for VF\n",
 653                                         ret);
 654                         break;
 655                 case HCLGE_MBX_GET_LINK_STATUS:
 656                         ret = hclge_get_link_info(vport, req);
 657                         if (ret)
 658                                 dev_err(&hdev->pdev->dev,
 659                                         "PF fail(%d) to get link stat for VF\n",
 660                                         ret);
 661                         break;
 662                 case HCLGE_MBX_QUEUE_RESET:
 663                         hclge_mbx_reset_vf_queue(vport, req);
 664                         break;
 665                 case HCLGE_MBX_RESET:
 666                         hclge_reset_vf(vport, req);
 667                         break;
 668                 case HCLGE_MBX_KEEP_ALIVE:
 669                         hclge_vf_keep_alive(vport, req);
 670                         break;
 671                 case HCLGE_MBX_SET_MTU:
 672                         ret = hclge_set_vf_mtu(vport, req);
 673                         if (ret)
 674                                 dev_err(&hdev->pdev->dev,
 675                                         "VF fail(%d) to set mtu\n", ret);
 676                         break;
 677                 case HCLGE_MBX_GET_QID_IN_PF:
 678                         ret = hclge_get_queue_id_in_pf(vport, req);
 679                         if (ret)
 680                                 dev_err(&hdev->pdev->dev,
 681                                         "PF failed(%d) to get qid for VF\n",
 682                                         ret);
 683                         break;
 684                 case HCLGE_MBX_GET_RSS_KEY:
 685                         ret = hclge_get_rss_key(vport, req);
 686                         if (ret)
 687                                 dev_err(&hdev->pdev->dev,
 688                                         "PF fail(%d) to get rss key for VF\n",
 689                                         ret);
 690                         break;
 691                 case HCLGE_MBX_GET_LINK_MODE:
 692                         hclge_get_link_mode(vport, req);
 693                         break;
 694                 case HCLGE_MBX_GET_VF_FLR_STATUS:
 695                         mutex_lock(&hdev->vport_cfg_mutex);
 696                         hclge_rm_vport_all_mac_table(vport, true,
 697                                                      HCLGE_MAC_ADDR_UC);
 698                         hclge_rm_vport_all_mac_table(vport, true,
 699                                                      HCLGE_MAC_ADDR_MC);
 700                         hclge_rm_vport_all_vlan_table(vport, true);
 701                         mutex_unlock(&hdev->vport_cfg_mutex);
 702                         break;
 703                 case HCLGE_MBX_GET_MEDIA_TYPE:
 704                         ret = hclge_get_vf_media_type(vport, req);
 705                         if (ret)
 706                                 dev_err(&hdev->pdev->dev,
 707                                         "PF fail(%d) to media type for VF\n",
 708                                         ret);
 709                         break;
 710                 default:
 711                         dev_err(&hdev->pdev->dev,
 712                                 "un-supported mailbox message, code = %d\n",
 713                                 req->msg[0]);
 714                         break;
 715                 }
 716                 crq->desc[crq->next_to_use].flag = 0;
 717                 hclge_mbx_ring_ptr_move_crq(crq);
 718         }
 719
 720         /* Write back CMDQ_RQ header pointer, M7 need this pointer */
 721         hclge_write_dev(&hdev->hw, HCLGE_NIC_CRQ_HEAD_REG, crq->next_to_use);
 722 }