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