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