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 %u exceeds max len %u\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         u16 reset_type;
  90         u8 msg_data[2];
  91         u8 dest_vfid;
  92
  93         BUILD_BUG_ON(HNAE3_MAX_RESET > U16_MAX);
  94
  95         dest_vfid = (u8)vport->vport_id;
  96
  97         if (hdev->reset_type == HNAE3_FUNC_RESET)
  98                 reset_type = HNAE3_VF_PF_FUNC_RESET;
  99         else if (hdev->reset_type == HNAE3_FLR_RESET)
 100                 reset_type = HNAE3_VF_FULL_RESET;
 101         else
 102                 reset_type = HNAE3_VF_FUNC_RESET;
 103
 104         memcpy(&msg_data[0], &reset_type, sizeof(u16));
 105
 106         /* send this requested info to VF */
 107         return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
 108                                   HCLGE_MBX_ASSERTING_RESET, dest_vfid);
 109 }
 110
 111 static void hclge_free_vector_ring_chain(struct hnae3_ring_chain_node *head)
 112 {
 113         struct hnae3_ring_chain_node *chain_tmp, *chain;
 114
 115         chain = head->next;
 116
 117         while (chain) {
 118                 chain_tmp = chain->next;
 119                 kzfree(chain);
 120                 chain = chain_tmp;
 121         }
 122 }
 123
 124 /* hclge_get_ring_chain_from_mbx: get ring type & tqp id & int_gl idx
 125  * from mailbox message
 126  * msg[0]: opcode
 127  * msg[1]: <not relevant to this function>
 128  * msg[2]: ring_num
 129  * msg[3]: first ring type (TX|RX)
 130  * msg[4]: first tqp id
 131  * msg[5]: first int_gl idx
 132  * msg[6] ~ msg[14]: other ring type, tqp id and int_gl idx
 133  */
 134 static int hclge_get_ring_chain_from_mbx(
 135                         struct hclge_mbx_vf_to_pf_cmd *req,
 136                         struct hnae3_ring_chain_node *ring_chain,
 137                         struct hclge_vport *vport)
 138 {
 139         struct hnae3_ring_chain_node *cur_chain, *new_chain;
 140         int ring_num;
 141         int i;
 142
 143         ring_num = req->msg[2];
 144
 145         if (ring_num > ((HCLGE_MBX_VF_MSG_DATA_NUM -
 146                 HCLGE_MBX_RING_MAP_BASIC_MSG_NUM) /
 147                 HCLGE_MBX_RING_NODE_VARIABLE_NUM))
 148                 return -ENOMEM;
 149
 150         hnae3_set_bit(ring_chain->flag, HNAE3_RING_TYPE_B, req->msg[3]);
 151         ring_chain->tqp_index =
 152                         hclge_get_queue_id(vport->nic.kinfo.tqp[req->msg[4]]);
 153         hnae3_set_field(ring_chain->int_gl_idx, HNAE3_RING_GL_IDX_M,
 154                         HNAE3_RING_GL_IDX_S,
 155                         req->msg[5]);
 156
 157         cur_chain = ring_chain;
 158
 159         for (i = 1; i < ring_num; i++) {
 160                 new_chain = kzalloc(sizeof(*new_chain), GFP_KERNEL);
 161                 if (!new_chain)
 162                         goto err;
 163
 164                 hnae3_set_bit(new_chain->flag, HNAE3_RING_TYPE_B,
 165                               req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
 166                               HCLGE_MBX_RING_MAP_BASIC_MSG_NUM]);
 167
 168                 new_chain->tqp_index =
 169                 hclge_get_queue_id(vport->nic.kinfo.tqp
 170                         [req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
 171                         HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 1]]);
 172
 173                 hnae3_set_field(new_chain->int_gl_idx, HNAE3_RING_GL_IDX_M,
 174                                 HNAE3_RING_GL_IDX_S,
 175                                 req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i +
 176                                 HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 2]);
 177
 178                 cur_chain->next = new_chain;
 179                 cur_chain = new_chain;
 180         }
 181
 182         return 0;
 183 err:
 184         hclge_free_vector_ring_chain(ring_chain);
 185         return -ENOMEM;
 186 }
 187
 188 static int hclge_map_unmap_ring_to_vf_vector(struct hclge_vport *vport, bool en,
 189                                              struct hclge_mbx_vf_to_pf_cmd *req)
 190 {
 191         struct hnae3_ring_chain_node ring_chain;
 192         int vector_id = req->msg[1];
 193         int ret;
 194
 195         memset(&ring_chain, 0, sizeof(ring_chain));
 196         ret = hclge_get_ring_chain_from_mbx(req, &ring_chain, vport);
 197         if (ret)
 198                 return ret;
 199
 200         ret = hclge_bind_ring_with_vector(vport, vector_id, en, &ring_chain);
 201
 202         hclge_free_vector_ring_chain(&ring_chain);
 203
 204         return ret;
 205 }
 206
 207 static int hclge_set_vf_promisc_mode(struct hclge_vport *vport,
 208                                      struct hclge_mbx_vf_to_pf_cmd *req)
 209 {
 210 #define HCLGE_MBX_BC_INDEX      1
 211 #define HCLGE_MBX_UC_INDEX      2
 212 #define HCLGE_MBX_MC_INDEX      3
 213
 214         bool en_bc = req->msg[HCLGE_MBX_BC_INDEX] ? true : false;
 215         bool en_uc = req->msg[HCLGE_MBX_UC_INDEX] ? true : false;
 216         bool en_mc = req->msg[HCLGE_MBX_MC_INDEX] ? true : false;
 217         int ret;
 218
 219         if (!vport->vf_info.trusted) {
 220                 en_uc = false;
 221                 en_mc = false;
 222         }
 223
 224         ret = hclge_set_vport_promisc_mode(vport, en_uc, en_mc, en_bc);
 225         if (req->mbx_need_resp)
 226                 hclge_gen_resp_to_vf(vport, req, ret, NULL, 0);
 227
 228         vport->vf_info.promisc_enable = (en_uc || en_mc) ? 1 : 0;
 229
 230         return ret;
 231 }
 232
 233 void hclge_inform_vf_promisc_info(struct hclge_vport *vport)
 234 {
 235         u8 dest_vfid = (u8)vport->vport_id;
 236         u8 msg_data[2];
 237
 238         memcpy(&msg_data[0], &vport->vf_info.promisc_enable, sizeof(u16));
 239
 240         hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
 241                            HCLGE_MBX_PUSH_PROMISC_INFO, dest_vfid);
 242 }
 243
 244 static int hclge_set_vf_uc_mac_addr(struct hclge_vport *vport,
 245                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 246 {
 247         const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
 248         struct hclge_dev *hdev = vport->back;
 249         int status;
 250
 251         if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_MODIFY) {
 252                 const u8 *old_addr = (const u8 *)(&mbx_req->msg[8]);
 253
 254                 /* If VF MAC has been configured by the host then it
 255                  * cannot be overridden by the MAC specified by the VM.
 256                  */
 257                 if (!is_zero_ether_addr(vport->vf_info.mac) &&
 258                     !ether_addr_equal(mac_addr, vport->vf_info.mac)) {
 259                         status = -EPERM;
 260                         goto out;
 261                 }
 262
 263                 if (!is_valid_ether_addr(mac_addr)) {
 264                         status = -EINVAL;
 265                         goto out;
 266                 }
 267
 268                 hclge_rm_uc_addr_common(vport, old_addr);
 269                 status = hclge_add_uc_addr_common(vport, mac_addr);
 270                 if (status) {
 271                         hclge_add_uc_addr_common(vport, old_addr);
 272                 } else {
 273                         hclge_rm_vport_mac_table(vport, mac_addr,
 274                                                  false, HCLGE_MAC_ADDR_UC);
 275                         hclge_add_vport_mac_table(vport, mac_addr,
 276                                                   HCLGE_MAC_ADDR_UC);
 277                 }
 278         } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_ADD) {
 279                 status = hclge_add_uc_addr_common(vport, mac_addr);
 280                 if (!status)
 281                         hclge_add_vport_mac_table(vport, mac_addr,
 282                                                   HCLGE_MAC_ADDR_UC);
 283         } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_REMOVE) {
 284                 status = hclge_rm_uc_addr_common(vport, mac_addr);
 285                 if (!status)
 286                         hclge_rm_vport_mac_table(vport, mac_addr,
 287                                                  false, HCLGE_MAC_ADDR_UC);
 288         } else {
 289                 dev_err(&hdev->pdev->dev,
 290                         "failed to set unicast mac addr, unknown subcode %u\n",
 291                         mbx_req->msg[1]);
 292                 return -EIO;
 293         }
 294
 295 out:
 296         if (mbx_req->mbx_need_resp & HCLGE_MBX_NEED_RESP_BIT)
 297                 hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0);
 298
 299         return 0;
 300 }
 301
 302 static int hclge_set_vf_mc_mac_addr(struct hclge_vport *vport,
 303                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 304                                     bool gen_resp)
 305 {
 306         const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]);
 307         struct hclge_dev *hdev = vport->back;
 308         u8 resp_len = 0;
 309         u8 resp_data;
 310         int status;
 311
 312         if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_ADD) {
 313                 status = hclge_add_mc_addr_common(vport, mac_addr);
 314                 if (!status)
 315                         hclge_add_vport_mac_table(vport, mac_addr,
 316                                                   HCLGE_MAC_ADDR_MC);
 317         } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_REMOVE) {
 318                 status = hclge_rm_mc_addr_common(vport, mac_addr);
 319                 if (!status)
 320                         hclge_rm_vport_mac_table(vport, mac_addr,
 321                                                  false, HCLGE_MAC_ADDR_MC);
 322         } else {
 323                 dev_err(&hdev->pdev->dev,
 324                         "failed to set mcast mac addr, unknown subcode %u\n",
 325                         mbx_req->msg[1]);
 326                 return -EIO;
 327         }
 328
 329         if (gen_resp)
 330                 hclge_gen_resp_to_vf(vport, mbx_req, status,
 331                                      &resp_data, resp_len);
 332
 333         return 0;
 334 }
 335
 336 int hclge_push_vf_port_base_vlan_info(struct hclge_vport *vport, u8 vfid,
 337                                       u16 state, u16 vlan_tag, u16 qos,
 338                                       u16 vlan_proto)
 339 {
 340 #define MSG_DATA_SIZE   8
 341
 342         u8 msg_data[MSG_DATA_SIZE];
 343
 344         memcpy(&msg_data[0], &state, sizeof(u16));
 345         memcpy(&msg_data[2], &vlan_proto, sizeof(u16));
 346         memcpy(&msg_data[4], &qos, sizeof(u16));
 347         memcpy(&msg_data[6], &vlan_tag, sizeof(u16));
 348
 349         return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
 350                                   HCLGE_MBX_PUSH_VLAN_INFO, vfid);
 351 }
 352
 353 static int hclge_set_vf_vlan_cfg(struct hclge_vport *vport,
 354                                  struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 355 {
 356         struct hclge_vf_vlan_cfg *msg_cmd;
 357         int status = 0;
 358
 359         msg_cmd = (struct hclge_vf_vlan_cfg *)mbx_req->msg;
 360         if (msg_cmd->subcode == HCLGE_MBX_VLAN_FILTER) {
 361                 struct hnae3_handle *handle = &vport->nic;
 362                 u16 vlan, proto;
 363                 bool is_kill;
 364
 365                 is_kill = !!msg_cmd->is_kill;
 366                 vlan =  msg_cmd->vlan;
 367                 proto =  msg_cmd->proto;
 368                 status = hclge_set_vlan_filter(handle, cpu_to_be16(proto),
 369                                                vlan, is_kill);
 370                 if (mbx_req->mbx_need_resp)
 371                         return hclge_gen_resp_to_vf(vport, mbx_req, status,
 372                                                     NULL, 0);
 373         } else if (msg_cmd->subcode == HCLGE_MBX_VLAN_RX_OFF_CFG) {
 374                 struct hnae3_handle *handle = &vport->nic;
 375                 bool en = msg_cmd->is_kill ? true : false;
 376
 377                 status = hclge_en_hw_strip_rxvtag(handle, en);
 378         } else if (mbx_req->msg[1] == HCLGE_MBX_PORT_BASE_VLAN_CFG) {
 379                 struct hclge_vlan_info *vlan_info;
 380                 u16 *state;
 381
 382                 state = (u16 *)&mbx_req->msg[2];
 383                 vlan_info = (struct hclge_vlan_info *)&mbx_req->msg[4];
 384                 status = hclge_update_port_base_vlan_cfg(vport, *state,
 385                                                          vlan_info);
 386         } else if (mbx_req->msg[1] == HCLGE_MBX_GET_PORT_BASE_VLAN_STATE) {
 387                 u8 state;
 388
 389                 state = vport->port_base_vlan_cfg.state;
 390                 status = hclge_gen_resp_to_vf(vport, mbx_req, 0, &state,
 391                                               sizeof(u8));
 392         }
 393
 394         return status;
 395 }
 396
 397 static int hclge_set_vf_alive(struct hclge_vport *vport,
 398                               struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 399                               bool gen_resp)
 400 {
 401         bool alive = !!mbx_req->msg[2];
 402         int ret = 0;
 403
 404         if (alive)
 405                 ret = hclge_vport_start(vport);
 406         else
 407                 hclge_vport_stop(vport);
 408
 409         return ret;
 410 }
 411
 412 static int hclge_get_vf_tcinfo(struct hclge_vport *vport,
 413                                struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 414                                bool gen_resp)
 415 {
 416         struct hnae3_knic_private_info *kinfo = &vport->nic.kinfo;
 417         u8 vf_tc_map = 0;
 418         unsigned int i;
 419         int ret;
 420
 421         for (i = 0; i < kinfo->num_tc; i++)
 422                 vf_tc_map |= BIT(i);
 423
 424         ret = hclge_gen_resp_to_vf(vport, mbx_req, 0, &vf_tc_map,
 425                                    sizeof(vf_tc_map));
 426
 427         return ret;
 428 }
 429
 430 static int hclge_get_vf_queue_info(struct hclge_vport *vport,
 431                                    struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 432                                    bool gen_resp)
 433 {
 434 #define HCLGE_TQPS_RSS_INFO_LEN         6
 435         u8 resp_data[HCLGE_TQPS_RSS_INFO_LEN];
 436         struct hclge_dev *hdev = vport->back;
 437
 438         /* get the queue related info */
 439         memcpy(&resp_data[0], &vport->alloc_tqps, sizeof(u16));
 440         memcpy(&resp_data[2], &vport->nic.kinfo.rss_size, sizeof(u16));
 441         memcpy(&resp_data[4], &hdev->rx_buf_len, sizeof(u16));
 442
 443         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 444                                     HCLGE_TQPS_RSS_INFO_LEN);
 445 }
 446
 447 static int hclge_get_vf_mac_addr(struct hclge_vport *vport,
 448                                  struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 449 {
 450         return hclge_gen_resp_to_vf(vport, mbx_req, 0, vport->vf_info.mac,
 451                                     ETH_ALEN);
 452 }
 453
 454 static int hclge_get_vf_queue_depth(struct hclge_vport *vport,
 455                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req,
 456                                     bool gen_resp)
 457 {
 458 #define HCLGE_TQPS_DEPTH_INFO_LEN       4
 459         u8 resp_data[HCLGE_TQPS_DEPTH_INFO_LEN];
 460         struct hclge_dev *hdev = vport->back;
 461
 462         /* get the queue depth info */
 463         memcpy(&resp_data[0], &hdev->num_tx_desc, sizeof(u16));
 464         memcpy(&resp_data[2], &hdev->num_rx_desc, sizeof(u16));
 465         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 466                                     HCLGE_TQPS_DEPTH_INFO_LEN);
 467 }
 468
 469 static int hclge_get_vf_media_type(struct hclge_vport *vport,
 470                                    struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 471 {
 472         struct hclge_dev *hdev = vport->back;
 473         u8 resp_data[2];
 474
 475         resp_data[0] = hdev->hw.mac.media_type;
 476         resp_data[1] = hdev->hw.mac.module_type;
 477         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 478                                     sizeof(resp_data));
 479 }
 480
 481 static int hclge_get_link_info(struct hclge_vport *vport,
 482                                struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 483 {
 484 #define HCLGE_VF_LINK_STATE_UP          1U
 485 #define HCLGE_VF_LINK_STATE_DOWN        0U
 486
 487         struct hclge_dev *hdev = vport->back;
 488         u16 link_status;
 489         u8 msg_data[8];
 490         u8 dest_vfid;
 491         u16 duplex;
 492
 493         /* mac.link can only be 0 or 1 */
 494         switch (vport->vf_info.link_state) {
 495         case IFLA_VF_LINK_STATE_ENABLE:
 496                 link_status = HCLGE_VF_LINK_STATE_UP;
 497                 break;
 498         case IFLA_VF_LINK_STATE_DISABLE:
 499                 link_status = HCLGE_VF_LINK_STATE_DOWN;
 500                 break;
 501         case IFLA_VF_LINK_STATE_AUTO:
 502         default:
 503                 link_status = (u16)hdev->hw.mac.link;
 504                 break;
 505         }
 506
 507         duplex = hdev->hw.mac.duplex;
 508         memcpy(&msg_data[0], &link_status, sizeof(u16));
 509         memcpy(&msg_data[2], &hdev->hw.mac.speed, sizeof(u32));
 510         memcpy(&msg_data[6], &duplex, sizeof(u16));
 511         dest_vfid = mbx_req->mbx_src_vfid;
 512
 513         /* send this requested info to VF */
 514         return hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
 515                                   HCLGE_MBX_LINK_STAT_CHANGE, dest_vfid);
 516 }
 517
 518 static void hclge_get_link_mode(struct hclge_vport *vport,
 519                                 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 520 {
 521 #define HCLGE_SUPPORTED   1
 522         struct hclge_dev *hdev = vport->back;
 523         unsigned long advertising;
 524         unsigned long supported;
 525         unsigned long send_data;
 526         u8 msg_data[10];
 527         u8 dest_vfid;
 528
 529         advertising = hdev->hw.mac.advertising[0];
 530         supported = hdev->hw.mac.supported[0];
 531         dest_vfid = mbx_req->mbx_src_vfid;
 532         msg_data[0] = mbx_req->msg[2];
 533
 534         send_data = msg_data[0] == HCLGE_SUPPORTED ? supported : advertising;
 535
 536         memcpy(&msg_data[2], &send_data, sizeof(unsigned long));
 537         hclge_send_mbx_msg(vport, msg_data, sizeof(msg_data),
 538                            HCLGE_MBX_LINK_STAT_MODE, dest_vfid);
 539 }
 540
 541 static void hclge_mbx_reset_vf_queue(struct hclge_vport *vport,
 542                                      struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 543 {
 544         u16 queue_id;
 545
 546         memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));
 547
 548         hclge_reset_vf_queue(vport, queue_id);
 549
 550         /* send response msg to VF after queue reset complete */
 551         hclge_gen_resp_to_vf(vport, mbx_req, 0, NULL, 0);
 552 }
 553
 554 static void hclge_reset_vf(struct hclge_vport *vport,
 555                            struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 556 {
 557         struct hclge_dev *hdev = vport->back;
 558         int ret;
 559
 560         dev_warn(&hdev->pdev->dev, "PF received VF reset request from VF %u!",
 561                  vport->vport_id);
 562
 563         ret = hclge_func_reset_cmd(hdev, vport->vport_id);
 564         hclge_gen_resp_to_vf(vport, mbx_req, ret, NULL, 0);
 565 }
 566
 567 static void hclge_vf_keep_alive(struct hclge_vport *vport,
 568                                 struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 569 {
 570         vport->last_active_jiffies = jiffies;
 571 }
 572
 573 static int hclge_set_vf_mtu(struct hclge_vport *vport,
 574                             struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 575 {
 576         int ret;
 577         u32 mtu;
 578
 579         memcpy(&mtu, &mbx_req->msg[2], sizeof(mtu));
 580         ret = hclge_set_vport_mtu(vport, mtu);
 581
 582         return hclge_gen_resp_to_vf(vport, mbx_req, ret, NULL, 0);
 583 }
 584
 585 static int hclge_get_queue_id_in_pf(struct hclge_vport *vport,
 586                                     struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 587 {
 588         u16 queue_id, qid_in_pf;
 589         u8 resp_data[2];
 590
 591         memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id));
 592         qid_in_pf = hclge_covert_handle_qid_global(&vport->nic, queue_id);
 593         memcpy(resp_data, &qid_in_pf, sizeof(qid_in_pf));
 594
 595         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 596                                     sizeof(resp_data));
 597 }
 598
 599 static int hclge_get_rss_key(struct hclge_vport *vport,
 600                              struct hclge_mbx_vf_to_pf_cmd *mbx_req)
 601 {
 602 #define HCLGE_RSS_MBX_RESP_LEN  8
 603         u8 resp_data[HCLGE_RSS_MBX_RESP_LEN];
 604         struct hclge_dev *hdev = vport->back;
 605         u8 index;
 606
 607         index = mbx_req->msg[2];
 608
 609         memcpy(&resp_data[0],
 610                &hdev->vport[0].rss_hash_key[index * HCLGE_RSS_MBX_RESP_LEN],
 611                HCLGE_RSS_MBX_RESP_LEN);
 612
 613         return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data,
 614                                     HCLGE_RSS_MBX_RESP_LEN);
 615 }
 616
 617 static void hclge_link_fail_parse(struct hclge_dev *hdev, u8 link_fail_code)
 618 {
 619         switch (link_fail_code) {
 620         case HCLGE_LF_REF_CLOCK_LOST:
 621                 dev_warn(&hdev->pdev->dev, "Reference clock lost!\n");
 622                 break;
 623         case HCLGE_LF_XSFP_TX_DISABLE:
 624                 dev_warn(&hdev->pdev->dev, "SFP tx is disabled!\n");
 625                 break;
 626         case HCLGE_LF_XSFP_ABSENT:
 627                 dev_warn(&hdev->pdev->dev, "SFP is absent!\n");
 628                 break;
 629         default:
 630                 break;
 631         }
 632 }
 633
 634 static void hclge_handle_link_change_event(struct hclge_dev *hdev,
 635                                            struct hclge_mbx_vf_to_pf_cmd *req)
 636 {
 637 #define LINK_STATUS_OFFSET      1
 638 #define LINK_FAIL_CODE_OFFSET   2
 639
 640         hclge_task_schedule(hdev, 0);
 641
 642         if (!req->msg[LINK_STATUS_OFFSET])
 643                 hclge_link_fail_parse(hdev, req->msg[LINK_FAIL_CODE_OFFSET]);
 644 }
 645
 646 static bool hclge_cmd_crq_empty(struct hclge_hw *hw)
 647 {
 648         u32 tail = hclge_read_dev(hw, HCLGE_NIC_CRQ_TAIL_REG);
 649
 650         return tail == hw->cmq.crq.next_to_use;
 651 }
 652
 653 static void hclge_handle_ncsi_error(struct hclge_dev *hdev)
 654 {
 655         struct hnae3_ae_dev *ae_dev = hdev->ae_dev;
 656
 657         ae_dev->ops->set_default_reset_request(ae_dev, HNAE3_GLOBAL_RESET);
 658         dev_warn(&hdev->pdev->dev, "requesting reset due to NCSI error\n");
 659         ae_dev->ops->reset_event(hdev->pdev, NULL);
 660 }
 661
 662 void hclge_mbx_handler(struct hclge_dev *hdev)
 663 {
 664         struct hclge_cmq_ring *crq = &hdev->hw.cmq.crq;
 665         struct hclge_mbx_vf_to_pf_cmd *req;
 666         struct hclge_vport *vport;
 667         struct hclge_desc *desc;
 668         unsigned int flag;
 669         int ret;
 670
 671         /* handle all the mailbox requests in the queue */
 672         while (!hclge_cmd_crq_empty(&hdev->hw)) {
 673                 if (test_bit(HCLGE_STATE_CMD_DISABLE, &hdev->state)) {
 674                         dev_warn(&hdev->pdev->dev,
 675                                  "command queue needs re-initializing\n");
 676                         return;
 677                 }
 678
 679                 desc = &crq->desc[crq->next_to_use];
 680                 req = (struct hclge_mbx_vf_to_pf_cmd *)desc->data;
 681
 682                 flag = le16_to_cpu(crq->desc[crq->next_to_use].flag);
 683                 if (unlikely(!hnae3_get_bit(flag, HCLGE_CMDQ_RX_OUTVLD_B))) {
 684                         dev_warn(&hdev->pdev->dev,
 685                                  "dropped invalid mailbox message, code = %u\n",
 686                                  req->msg[0]);
 687
 688                         /* dropping/not processing this invalid message */
 689                         crq->desc[crq->next_to_use].flag = 0;
 690                         hclge_mbx_ring_ptr_move_crq(crq);
 691                         continue;
 692                 }
 693
 694                 vport = &hdev->vport[req->mbx_src_vfid];
 695
 696                 switch (req->msg[0]) {
 697                 case HCLGE_MBX_MAP_RING_TO_VECTOR:
 698                         ret = hclge_map_unmap_ring_to_vf_vector(vport, true,
 699                                                                 req);
 700                         break;
 701                 case HCLGE_MBX_UNMAP_RING_TO_VECTOR:
 702                         ret = hclge_map_unmap_ring_to_vf_vector(vport, false,
 703                                                                 req);
 704                         break;
 705                 case HCLGE_MBX_SET_PROMISC_MODE:
 706                         ret = hclge_set_vf_promisc_mode(vport, req);
 707                         if (ret)
 708                                 dev_err(&hdev->pdev->dev,
 709                                         "PF fail(%d) to set VF promisc mode\n",
 710                                         ret);
 711                         break;
 712                 case HCLGE_MBX_SET_UNICAST:
 713                         ret = hclge_set_vf_uc_mac_addr(vport, req);
 714                         if (ret)
 715                                 dev_err(&hdev->pdev->dev,
 716                                         "PF fail(%d) to set VF UC MAC Addr\n",
 717                                         ret);
 718                         break;
 719                 case HCLGE_MBX_SET_MULTICAST:
 720                         ret = hclge_set_vf_mc_mac_addr(vport, req, false);
 721                         if (ret)
 722                                 dev_err(&hdev->pdev->dev,
 723                                         "PF fail(%d) to set VF MC MAC Addr\n",
 724                                         ret);
 725                         break;
 726                 case HCLGE_MBX_SET_VLAN:
 727                         ret = hclge_set_vf_vlan_cfg(vport, req);
 728                         if (ret)
 729                                 dev_err(&hdev->pdev->dev,
 730                                         "PF failed(%d) to config VF's VLAN\n",
 731                                         ret);
 732                         break;
 733                 case HCLGE_MBX_SET_ALIVE:
 734                         ret = hclge_set_vf_alive(vport, req, false);
 735                         if (ret)
 736                                 dev_err(&hdev->pdev->dev,
 737                                         "PF failed(%d) to set VF's ALIVE\n",
 738                                         ret);
 739                         break;
 740                 case HCLGE_MBX_GET_QINFO:
 741                         ret = hclge_get_vf_queue_info(vport, req, true);
 742                         if (ret)
 743                                 dev_err(&hdev->pdev->dev,
 744                                         "PF failed(%d) to get Q info for VF\n",
 745                                         ret);
 746                         break;
 747                 case HCLGE_MBX_GET_QDEPTH:
 748                         ret = hclge_get_vf_queue_depth(vport, req, true);
 749                         if (ret)
 750                                 dev_err(&hdev->pdev->dev,
 751                                         "PF failed(%d) to get Q depth for VF\n",
 752                                         ret);
 753                         break;
 754
 755                 case HCLGE_MBX_GET_TCINFO:
 756                         ret = hclge_get_vf_tcinfo(vport, req, true);
 757                         if (ret)
 758                                 dev_err(&hdev->pdev->dev,
 759                                         "PF failed(%d) to get TC info for VF\n",
 760                                         ret);
 761                         break;
 762                 case HCLGE_MBX_GET_LINK_STATUS:
 763                         ret = hclge_get_link_info(vport, req);
 764                         if (ret)
 765                                 dev_err(&hdev->pdev->dev,
 766                                         "PF fail(%d) to get link stat for VF\n",
 767                                         ret);
 768                         break;
 769                 case HCLGE_MBX_QUEUE_RESET:
 770                         hclge_mbx_reset_vf_queue(vport, req);
 771                         break;
 772                 case HCLGE_MBX_RESET:
 773                         hclge_reset_vf(vport, req);
 774                         break;
 775                 case HCLGE_MBX_KEEP_ALIVE:
 776                         hclge_vf_keep_alive(vport, req);
 777                         break;
 778                 case HCLGE_MBX_SET_MTU:
 779                         ret = hclge_set_vf_mtu(vport, req);
 780                         if (ret)
 781                                 dev_err(&hdev->pdev->dev,
 782                                         "VF fail(%d) to set mtu\n", ret);
 783                         break;
 784                 case HCLGE_MBX_GET_QID_IN_PF:
 785                         ret = hclge_get_queue_id_in_pf(vport, req);
 786                         if (ret)
 787                                 dev_err(&hdev->pdev->dev,
 788                                         "PF failed(%d) to get qid for VF\n",
 789                                         ret);
 790                         break;
 791                 case HCLGE_MBX_GET_RSS_KEY:
 792                         ret = hclge_get_rss_key(vport, req);
 793                         if (ret)
 794                                 dev_err(&hdev->pdev->dev,
 795                                         "PF fail(%d) to get rss key for VF\n",
 796                                         ret);
 797                         break;
 798                 case HCLGE_MBX_GET_LINK_MODE:
 799                         hclge_get_link_mode(vport, req);
 800                         break;
 801                 case HCLGE_MBX_GET_VF_FLR_STATUS:
 802                 case HCLGE_MBX_VF_UNINIT:
 803                         hclge_rm_vport_all_mac_table(vport, true,
 804                                                      HCLGE_MAC_ADDR_UC);
 805                         hclge_rm_vport_all_mac_table(vport, true,
 806                                                      HCLGE_MAC_ADDR_MC);
 807                         hclge_rm_vport_all_vlan_table(vport, true);
 808                         break;
 809                 case HCLGE_MBX_GET_MEDIA_TYPE:
 810                         ret = hclge_get_vf_media_type(vport, req);
 811                         if (ret)
 812                                 dev_err(&hdev->pdev->dev,
 813                                         "PF fail(%d) to media type for VF\n",
 814                                         ret);
 815                         break;
 816                 case HCLGE_MBX_PUSH_LINK_STATUS:
 817                         hclge_handle_link_change_event(hdev, req);
 818                         break;
 819                 case HCLGE_MBX_GET_MAC_ADDR:
 820                         ret = hclge_get_vf_mac_addr(vport, req);
 821                         if (ret)
 822                                 dev_err(&hdev->pdev->dev,
 823                                         "PF failed(%d) to get MAC for VF\n",
 824                                         ret);
 825                         break;
 826                 case HCLGE_MBX_NCSI_ERROR:
 827                         hclge_handle_ncsi_error(hdev);
 828                         break;
 829                 default:
 830                         dev_err(&hdev->pdev->dev,
 831                                 "un-supported mailbox message, code = %u\n",
 832                                 req->msg[0]);
 833                         break;
 834                 }
 835                 crq->desc[crq->next_to_use].flag = 0;
 836                 hclge_mbx_ring_ptr_move_crq(crq);
 837         }
 838
 839         /* Write back CMDQ_RQ header pointer, M7 need this pointer */
 840         hclge_write_dev(&hdev->hw, HCLGE_NIC_CRQ_HEAD_REG, crq->next_to_use);
 841 }