drivers/net/hinic/base/hinic_pmd_mgmt.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2017 Huawei Technologies Co., Ltd
   3  */
   4
   5 #include "hinic_compat.h"
   6 #include "hinic_csr.h"
   7 #include "hinic_pmd_hwdev.h"
   8 #include "hinic_pmd_hwif.h"
   9 #include "hinic_pmd_mgmt.h"
  10 #include "hinic_pmd_mbox.h"
  11
  12 #define BUF_OUT_DEFAULT_SIZE            1
  13
  14 #define MAX_PF_MGMT_BUF_SIZE            2048UL
  15
  16 #define MGMT_MSG_SIZE_MIN               20
  17 #define MGMT_MSG_SIZE_STEP              16
  18 #define MGMT_MSG_RSVD_FOR_DEV           8
  19
  20 #define MGMT_MSG_TIMEOUT                5000    /* millisecond */
  21
  22 #define SYNC_MSG_ID_MASK                0x1FF
  23 #define ASYNC_MSG_ID_MASK               0x1FF
  24 #define ASYNC_MSG_FLAG                  0x200
  25
  26 #define MSG_NO_RESP                     0xFFFF
  27
  28 #define MAX_MSG_SZ                      2016
  29
  30 #define MSG_SZ_IS_VALID(in_size)        ((in_size) <= MAX_MSG_SZ)
  31
  32 #define SYNC_MSG_ID(pf_to_mgmt)         ((pf_to_mgmt)->sync_msg_id)
  33
  34 #define SYNC_MSG_ID_INC(pf_to_mgmt)     (SYNC_MSG_ID(pf_to_mgmt) = \
  35                         (SYNC_MSG_ID(pf_to_mgmt) + 1) & SYNC_MSG_ID_MASK)
  36
  37 #define ASYNC_MSG_ID(pf_to_mgmt)        ((pf_to_mgmt)->async_msg_id)
  38
  39 #define ASYNC_MSG_ID_INC(pf_to_mgmt)    (ASYNC_MSG_ID(pf_to_mgmt) = \
  40                         ((ASYNC_MSG_ID(pf_to_mgmt) + 1) & ASYNC_MSG_ID_MASK) \
  41                         | ASYNC_MSG_FLAG)
  42
  43 #define HINIC_SEQ_ID_MAX_VAL            42
  44 #define HINIC_MSG_SEG_LEN               48
  45
  46 #define GET_CURR_AEQ_ELEM(eq)           GET_AEQ_ELEM((eq), (eq)->cons_idx)
  47
  48 #define EQ_ELEM_DESC_TYPE_SHIFT                 0
  49 #define EQ_ELEM_DESC_SRC_SHIFT                  7
  50 #define EQ_ELEM_DESC_SIZE_SHIFT                 8
  51 #define EQ_ELEM_DESC_WRAPPED_SHIFT              31
  52
  53 #define EQ_ELEM_DESC_TYPE_MASK                  0x7FU
  54 #define EQ_ELEM_DESC_SRC_MASK                   0x1U
  55 #define EQ_ELEM_DESC_SIZE_MASK                  0xFFU
  56 #define EQ_ELEM_DESC_WRAPPED_MASK               0x1U
  57
  58 #define EQ_MSIX_RESEND_TIMER_CLEAR              1
  59
  60 #define EQ_ELEM_DESC_GET(val, member)           \
  61                                 (((val) >> EQ_ELEM_DESC_##member##_SHIFT) & \
  62                                 EQ_ELEM_DESC_##member##_MASK)
  63
  64 #define HINIC_MGMT_CHANNEL_STATUS_SHIFT         0x0
  65 #define HINIC_MGMT_CHANNEL_STATUS_MASK          0x1
  66
  67 #define HINIC_GET_MGMT_CHANNEL_STATUS(val, member)      \
  68         (((val) >> HINIC_##member##_SHIFT) & HINIC_##member##_MASK)
  69
  70 #define HINIC_MSG_TO_MGMT_MAX_LEN               2016
  71
  72 /**
  73  * mgmt_msg_len - calculate the total message length
  74  * @msg_data_len: the length of the message data
  75  * Return: the total message length
  76  */
  77 static u16 mgmt_msg_len(u16 msg_data_len)
  78 {
  79         /* u64 - the size of the header */
  80         u16 msg_size = (u16)(MGMT_MSG_RSVD_FOR_DEV + sizeof(u64) +
  81                              msg_data_len);
  82
  83         if (msg_size > MGMT_MSG_SIZE_MIN)
  84                 msg_size = MGMT_MSG_SIZE_MIN +
  85                         ALIGN((msg_size - MGMT_MSG_SIZE_MIN),
  86                               MGMT_MSG_SIZE_STEP);
  87         else
  88                 msg_size = MGMT_MSG_SIZE_MIN;
  89
  90         return msg_size;
  91 }
  92
  93 /**
  94  * prepare_header - prepare the header of the message
  95  * @pf_to_mgmt: PF to MGMT channel
  96  * @header: pointer of the header to prepare
  97  * @msg_len: the length of the message
  98  * @mod: module in the chip that will get the message
  99  * @ack_type: the type to response
 100  * @direction: the direction of the original message
 101  * @cmd: the command to do
 102  * @msg_id: message id
 103  */
 104 static void prepare_header(struct hinic_msg_pf_to_mgmt *pf_to_mgmt,
 105                            u64 *header, int msg_len, enum hinic_mod_type mod,
 106                            enum hinic_msg_ack_type ack_type,
 107                            enum hinic_msg_direction_type direction,
 108                            u8 cmd, u32 msg_id)
 109 {
 110         struct hinic_hwif *hwif = pf_to_mgmt->hwdev->hwif;
 111
 112         *header = HINIC_MSG_HEADER_SET(msg_len, MSG_LEN) |
 113                 HINIC_MSG_HEADER_SET(mod, MODULE) |
 114                 HINIC_MSG_HEADER_SET(msg_len, SEG_LEN) |
 115                 HINIC_MSG_HEADER_SET(ack_type, NO_ACK) |
 116                 HINIC_MSG_HEADER_SET(0, ASYNC_MGMT_TO_PF) |
 117                 HINIC_MSG_HEADER_SET(0, SEQID) |
 118                 HINIC_MSG_HEADER_SET(LAST_SEGMENT, LAST) |
 119                 HINIC_MSG_HEADER_SET(direction, DIRECTION) |
 120                 HINIC_MSG_HEADER_SET(cmd, CMD) |
 121                 HINIC_MSG_HEADER_SET(HINIC_PCI_INTF_IDX(hwif), PCI_INTF_IDX) |
 122                 HINIC_MSG_HEADER_SET(hwif->attr.port_to_port_idx, P2P_IDX) |
 123                 HINIC_MSG_HEADER_SET(msg_id, MSG_ID);
 124 }
 125
 126 /**
 127  * prepare_mgmt_cmd - prepare the mgmt command
 128  * @mgmt_cmd: pointer to the command to prepare
 129  * @header: pointer of the header to prepare
 130  * @msg: the data of the message
 131  * @msg_len: the length of the message
 132  */
 133 static void prepare_mgmt_cmd(u8 *mgmt_cmd, u64 *header, void *msg,
 134                              int msg_len)
 135 {
 136         u32 cmd_buf_max = MAX_PF_MGMT_BUF_SIZE;
 137
 138         memset(mgmt_cmd, 0, MGMT_MSG_RSVD_FOR_DEV);
 139
 140         mgmt_cmd += MGMT_MSG_RSVD_FOR_DEV;
 141         cmd_buf_max -= MGMT_MSG_RSVD_FOR_DEV;
 142         memcpy(mgmt_cmd, header, sizeof(*header));
 143
 144         mgmt_cmd += sizeof(*header);
 145         cmd_buf_max -= sizeof(*header);
 146         memcpy(mgmt_cmd, msg, msg_len);
 147 }
 148
 149 /**
 150  * alloc_recv_msg - allocate received message memory
 151  * @recv_msg: pointer that will hold the allocated data
 152  * Return: 0 - success, negative - failure
 153  */
 154 static int alloc_recv_msg(struct hinic_recv_msg *recv_msg)
 155 {
 156         int err;
 157
 158         recv_msg->msg = kzalloc(MAX_PF_MGMT_BUF_SIZE, GFP_KERNEL);
 159         if (!recv_msg->msg) {
 160                 PMD_DRV_LOG(ERR, "Allocate recv msg buf failed");
 161                 return -ENOMEM;
 162         }
 163
 164         recv_msg->buf_out = kzalloc(MAX_PF_MGMT_BUF_SIZE, GFP_KERNEL);
 165         if (!recv_msg->buf_out) {
 166                 PMD_DRV_LOG(ERR, "Allocate recv msg output buf failed");
 167                 err = -ENOMEM;
 168                 goto alloc_buf_out_err;
 169         }
 170
 171         return 0;
 172
 173 alloc_buf_out_err:
 174         kfree(recv_msg->msg);
 175         return err;
 176 }
 177
 178 /**
 179  * free_recv_msg - free received message memory
 180  * @recv_msg: pointer that holds the allocated data
 181  */
 182 static void free_recv_msg(struct hinic_recv_msg *recv_msg)
 183 {
 184         kfree(recv_msg->buf_out);
 185         kfree(recv_msg->msg);
 186 }
 187
 188 /**
 189  * alloc_msg_buf - allocate all the message buffers of PF to MGMT channel
 190  * @pf_to_mgmt: PF to MGMT channel
 191  * Return: 0 - success, negative - failure
 192  */
 193 static int alloc_msg_buf(struct hinic_msg_pf_to_mgmt *pf_to_mgmt)
 194 {
 195         int err;
 196
 197         err = alloc_recv_msg(&pf_to_mgmt->recv_msg_from_mgmt);
 198         if (err) {
 199                 PMD_DRV_LOG(ERR, "Allocate recv msg failed");
 200                 return err;
 201         }
 202
 203         err = alloc_recv_msg(&pf_to_mgmt->recv_resp_msg_from_mgmt);
 204         if (err) {
 205                 PMD_DRV_LOG(ERR, "Allocate resp recv msg failed");
 206                 goto alloc_msg_for_resp_err;
 207         }
 208
 209         pf_to_mgmt->async_msg_buf = kzalloc(MAX_PF_MGMT_BUF_SIZE, GFP_KERNEL);
 210         if (!pf_to_mgmt->async_msg_buf) {
 211                 PMD_DRV_LOG(ERR, "Allocate async msg buf failed");
 212                 err = -ENOMEM;
 213                 goto async_msg_buf_err;
 214         }
 215
 216         pf_to_mgmt->sync_msg_buf = kzalloc(MAX_PF_MGMT_BUF_SIZE, GFP_KERNEL);
 217         if (!pf_to_mgmt->sync_msg_buf)  {
 218                 PMD_DRV_LOG(ERR, "Allocate sync msg buf failed");
 219                 err = -ENOMEM;
 220                 goto sync_msg_buf_err;
 221         }
 222
 223         return 0;
 224
 225 sync_msg_buf_err:
 226         kfree(pf_to_mgmt->async_msg_buf);
 227
 228 async_msg_buf_err:
 229         free_recv_msg(&pf_to_mgmt->recv_resp_msg_from_mgmt);
 230
 231 alloc_msg_for_resp_err:
 232         free_recv_msg(&pf_to_mgmt->recv_msg_from_mgmt);
 233
 234         return err;
 235 }
 236
 237 /**
 238  * free_msg_buf - free all the message buffers of PF to MGMT channel
 239  * @pf_to_mgmt: PF to MGMT channel
 240  * Return: 0 - success, negative - failure
 241  */
 242 static void free_msg_buf(struct hinic_msg_pf_to_mgmt *pf_to_mgmt)
 243 {
 244         kfree(pf_to_mgmt->sync_msg_buf);
 245         kfree(pf_to_mgmt->async_msg_buf);
 246
 247         free_recv_msg(&pf_to_mgmt->recv_resp_msg_from_mgmt);
 248         free_recv_msg(&pf_to_mgmt->recv_msg_from_mgmt);
 249 }
 250
 251 /**
 252  * send_msg_to_mgmt_async - send async message
 253  * @pf_to_mgmt: PF to MGMT channel
 254  * @mod: module in the chip that will get the message
 255  * @cmd: command of the message
 256  * @msg: the data of the message
 257  * @msg_len: the length of the message
 258  * @direction: the direction of the original message
 259  * @resp_msg_id: message id of response
 260  * Return: 0 - success, negative - failure
 261  */
 262 static int send_msg_to_mgmt_async(struct hinic_msg_pf_to_mgmt *pf_to_mgmt,
 263                                   enum hinic_mod_type mod, u8 cmd,
 264                                   void *msg, u16 msg_len,
 265                                   enum hinic_msg_direction_type direction,
 266                                   u16 resp_msg_id)
 267 {
 268         void *mgmt_cmd = pf_to_mgmt->async_msg_buf;
 269         struct hinic_api_cmd_chain *chain;
 270         u64 header;
 271         u16 cmd_size = mgmt_msg_len(msg_len);
 272
 273         if (direction == HINIC_MSG_RESPONSE)
 274                 prepare_header(pf_to_mgmt, &header, msg_len, mod, HINIC_MSG_ACK,
 275                                direction, cmd, resp_msg_id);
 276         else
 277                 prepare_header(pf_to_mgmt, &header, msg_len, mod, HINIC_MSG_ACK,
 278                                direction, cmd, ASYNC_MSG_ID(pf_to_mgmt));
 279
 280         prepare_mgmt_cmd((u8 *)mgmt_cmd, &header, msg, msg_len);
 281
 282         chain = pf_to_mgmt->cmd_chain[HINIC_API_CMD_WRITE_ASYNC_TO_MGMT_CPU];
 283
 284         return hinic_api_cmd_write(chain, HINIC_NODE_ID_MGMT_HOST, mgmt_cmd,
 285                                    cmd_size);
 286 }
 287
 288 /**
 289  * send_msg_to_mgmt_sync - send async message
 290  * @pf_to_mgmt: PF to MGMT channel
 291  * @mod: module in the chip that will get the message
 292  * @cmd: command of the message
 293  * @msg: the msg data
 294  * @msg_len: the msg data length
 295  * @ack_type: indicate mgmt command whether need ack or not
 296  * @direction: the direction of the original message
 297  * @resp_msg_id: msg id to response for
 298  * Return: 0 - success, negative - failure
 299  */
 300 static int send_msg_to_mgmt_sync(struct hinic_msg_pf_to_mgmt *pf_to_mgmt,
 301                                  enum hinic_mod_type mod, u8 cmd,
 302                                  void *msg, u16 msg_len,
 303                                  enum hinic_msg_ack_type ack_type,
 304                                  enum hinic_msg_direction_type direction,
 305                                  __rte_unused u16 resp_msg_id)
 306 {
 307         void *mgmt_cmd = pf_to_mgmt->sync_msg_buf;
 308         struct hinic_api_cmd_chain *chain;
 309         u64 header;
 310         u16 cmd_size = mgmt_msg_len(msg_len);
 311
 312         if (direction == HINIC_MSG_RESPONSE)
 313                 prepare_header(pf_to_mgmt, &header, msg_len, mod, ack_type,
 314                                direction, cmd, resp_msg_id);
 315         else
 316                 prepare_header(pf_to_mgmt, &header, msg_len, mod, ack_type,
 317                                direction, cmd, SYNC_MSG_ID(pf_to_mgmt));
 318
 319         prepare_mgmt_cmd((u8 *)mgmt_cmd, &header, msg, msg_len);
 320
 321         chain = pf_to_mgmt->cmd_chain[HINIC_API_CMD_PMD_WRITE_TO_MGMT];
 322
 323         return hinic_api_cmd_write(chain, HINIC_NODE_ID_MGMT_HOST,
 324                                    mgmt_cmd, cmd_size);
 325 }
 326
 327 /**
 328  * hinic_pf_to_mgmt_init - initialize PF to MGMT channel
 329  * @hwdev: the pointer to the private hardware device object
 330  * Return: 0 - success, negative - failure
 331  */
 332 static int hinic_pf_to_mgmt_init(struct hinic_hwdev *hwdev)
 333 {
 334         struct hinic_msg_pf_to_mgmt *pf_to_mgmt;
 335         int err;
 336
 337         pf_to_mgmt = kzalloc(sizeof(*pf_to_mgmt), GFP_KERNEL);
 338         if (!pf_to_mgmt) {
 339                 PMD_DRV_LOG(ERR, "Allocate pf to mgmt mem failed");
 340                 return -ENOMEM;
 341         }
 342
 343         hwdev->pf_to_mgmt = pf_to_mgmt;
 344         pf_to_mgmt->hwdev = hwdev;
 345
 346         err = hinic_mutex_init(&pf_to_mgmt->sync_msg_mutex, NULL);
 347         if (err)
 348                 goto mutex_init_err;
 349
 350         err = alloc_msg_buf(pf_to_mgmt);
 351         if (err) {
 352                 PMD_DRV_LOG(ERR, "Allocate msg buffers failed");
 353                 goto alloc_msg_buf_err;
 354         }
 355
 356         err = hinic_api_cmd_init(hwdev, pf_to_mgmt->cmd_chain);
 357         if (err) {
 358                 PMD_DRV_LOG(ERR, "Init the api cmd chains failed");
 359                 goto api_cmd_init_err;
 360         }
 361
 362         return 0;
 363
 364 api_cmd_init_err:
 365         free_msg_buf(pf_to_mgmt);
 366
 367 alloc_msg_buf_err:
 368         hinic_mutex_destroy(&pf_to_mgmt->sync_msg_mutex);
 369
 370 mutex_init_err:
 371         kfree(pf_to_mgmt);
 372
 373         return err;
 374 }
 375
 376 /**
 377  * hinic_pf_to_mgmt_free - free PF to MGMT channel
 378  * @hwdev: the pointer to the private hardware device object
 379  */
 380 static void hinic_pf_to_mgmt_free(struct hinic_hwdev *hwdev)
 381 {
 382         struct hinic_msg_pf_to_mgmt *pf_to_mgmt = hwdev->pf_to_mgmt;
 383
 384         hinic_api_cmd_free(pf_to_mgmt->cmd_chain);
 385         free_msg_buf(pf_to_mgmt);
 386         hinic_mutex_destroy(&pf_to_mgmt->sync_msg_mutex);
 387         kfree(pf_to_mgmt);
 388 }
 389
 390 static int
 391 hinic_pf_to_mgmt_sync(struct hinic_hwdev *hwdev,
 392                 enum hinic_mod_type mod, u8 cmd, void *buf_in, u16 in_size,
 393                 void *buf_out, u16 *out_size, u32 timeout)
 394 {
 395         struct hinic_msg_pf_to_mgmt *pf_to_mgmt = hwdev->pf_to_mgmt;
 396         struct hinic_recv_msg *recv_msg;
 397         u32 timeo;
 398         int err, i;
 399
 400         err = hinic_mutex_lock(&pf_to_mgmt->sync_msg_mutex);
 401         if (err)
 402                 return err;
 403
 404         SYNC_MSG_ID_INC(pf_to_mgmt);
 405         recv_msg = &pf_to_mgmt->recv_resp_msg_from_mgmt;
 406
 407         err = send_msg_to_mgmt_sync(pf_to_mgmt, mod, cmd, buf_in, in_size,
 408                                     HINIC_MSG_ACK, HINIC_MSG_DIRECT_SEND,
 409                                     MSG_NO_RESP);
 410         if (err) {
 411                 PMD_DRV_LOG(ERR, "Send msg to mgmt failed");
 412                 goto unlock_sync_msg;
 413         }
 414
 415         timeo = msecs_to_jiffies(timeout ? timeout : MGMT_MSG_TIMEOUT);
 416         for (i = 0; i < pf_to_mgmt->rx_aeq->poll_retry_nr; i++) {
 417                 err = hinic_aeq_poll_msg(pf_to_mgmt->rx_aeq, timeo, NULL);
 418                 if (err) {
 419                         PMD_DRV_LOG(ERR, "Poll mgmt rsp timeout, mod=%d cmd=%d msg_id=%u rc=%d",
 420                                 mod, cmd, pf_to_mgmt->sync_msg_id, err);
 421                         err = -ETIMEDOUT;
 422                         hinic_dump_aeq_info(hwdev);
 423                         goto unlock_sync_msg;
 424                 } else {
 425                         if (mod == recv_msg->mod && cmd == recv_msg->cmd &&
 426                             recv_msg->msg_id == pf_to_mgmt->sync_msg_id) {
 427                                 /* the expected response polled */
 428                                 break;
 429                         }
 430                         PMD_DRV_LOG(ERR, "AEQ[%d] poll(mod=%d, cmd=%d, msg_id=%u) an "
 431                                 "unexpected(mod=%d, cmd=%d, msg_id=%u) response",
 432                                 pf_to_mgmt->rx_aeq->q_id, mod, cmd,
 433                                 pf_to_mgmt->sync_msg_id, recv_msg->mod,
 434                                 recv_msg->cmd, recv_msg->msg_id);
 435                 }
 436         }
 437
 438         if (i == pf_to_mgmt->rx_aeq->poll_retry_nr) {
 439                 PMD_DRV_LOG(ERR, "Get %d unexpected mgmt rsp from AEQ[%d], poll mgmt rsp failed",
 440                         i, pf_to_mgmt->rx_aeq->q_id);
 441                 err = -EBADMSG;
 442                 goto unlock_sync_msg;
 443         }
 444
 445         rte_smp_rmb();
 446         if (recv_msg->msg_len && buf_out && out_size) {
 447                 if (recv_msg->msg_len <= *out_size) {
 448                         memcpy(buf_out, recv_msg->msg,
 449                                recv_msg->msg_len);
 450                         *out_size = recv_msg->msg_len;
 451                 } else {
 452                         PMD_DRV_LOG(ERR, "Mgmt rsp's msg len:%u overflow.",
 453                                 recv_msg->msg_len);
 454                         err = -ERANGE;
 455                 }
 456         }
 457
 458 unlock_sync_msg:
 459         if (err && out_size)
 460                 *out_size = 0;
 461         (void)hinic_mutex_unlock(&pf_to_mgmt->sync_msg_mutex);
 462         return err;
 463 }
 464
 465 static int hinic_get_mgmt_channel_status(void *hwdev)
 466 {
 467         struct hinic_hwif *hwif = ((struct hinic_hwdev *)hwdev)->hwif;
 468         u32 val;
 469
 470         if (hinic_func_type((struct hinic_hwdev *)hwdev) == TYPE_VF)
 471                 return false;
 472
 473         val = hinic_hwif_read_reg(hwif, HINIC_ICPL_RESERVD_ADDR);
 474
 475         return HINIC_GET_MGMT_CHANNEL_STATUS(val, MGMT_CHANNEL_STATUS);
 476 }
 477
 478 int hinic_msg_to_mgmt_sync(void *hwdev, enum hinic_mod_type mod, u8 cmd,
 479                            void *buf_in, u16 in_size,
 480                            void *buf_out, u16 *out_size, u32 timeout)
 481 {
 482         int rc = HINIC_ERROR;
 483
 484         if (!hwdev || in_size > HINIC_MSG_TO_MGMT_MAX_LEN)
 485                 return -EINVAL;
 486
 487         /* If status is hot upgrading, don't send message to mgmt */
 488         if (hinic_get_mgmt_channel_status(hwdev))
 489                 return -EPERM;
 490
 491         if (hinic_func_type(hwdev) == TYPE_VF) {
 492                 rc = hinic_mbox_to_pf(hwdev, mod, cmd, buf_in, in_size,
 493                                         buf_out, out_size, timeout);
 494         } else {
 495                 rc = hinic_pf_to_mgmt_sync(hwdev, mod, cmd, buf_in, in_size,
 496                                                 buf_out, out_size, timeout);
 497         }
 498
 499         return rc;
 500 }
 501
 502 int hinic_msg_to_mgmt_no_ack(void *hwdev, enum hinic_mod_type mod, u8 cmd,
 503                      void *buf_in, u16 in_size, __rte_unused void *buf_out,
 504                      __rte_unused u16 *out_size)
 505 {
 506         struct hinic_msg_pf_to_mgmt *pf_to_mgmt =
 507                                 ((struct hinic_hwdev *)hwdev)->pf_to_mgmt;
 508         int err = -EINVAL;
 509
 510         if (!MSG_SZ_IS_VALID(in_size)) {
 511                 PMD_DRV_LOG(ERR, "Mgmt msg buffer size is invalid");
 512                 return err;
 513         }
 514
 515         err = hinic_mutex_lock(&pf_to_mgmt->sync_msg_mutex);
 516         if (err)
 517                 return err;
 518
 519         err = send_msg_to_mgmt_sync(pf_to_mgmt, mod, cmd, buf_in, in_size,
 520                                     HINIC_MSG_NO_ACK, HINIC_MSG_DIRECT_SEND,
 521                                     MSG_NO_RESP);
 522
 523         (void)hinic_mutex_unlock(&pf_to_mgmt->sync_msg_mutex);
 524
 525         return err;
 526 }
 527
 528 static bool check_mgmt_seq_id_and_seg_len(struct hinic_recv_msg *recv_msg,
 529                                           u8 seq_id, u8 seg_len)
 530 {
 531         if (seq_id > HINIC_SEQ_ID_MAX_VAL || seg_len > HINIC_MSG_SEG_LEN)
 532                 return false;
 533
 534         if (seq_id == 0) {
 535                 recv_msg->sed_id = seq_id;
 536         } else {
 537                 if (seq_id != recv_msg->sed_id + 1) {
 538                         recv_msg->sed_id = 0;
 539                         return false;
 540                 }
 541                 recv_msg->sed_id = seq_id;
 542         }
 543
 544         return true;
 545 }
 546
 547 /**
 548  * hinic_mgmt_recv_msg_handler - handler for message from mgmt cpu
 549  * @pf_to_mgmt: PF to MGMT channel
 550  * @recv_msg: received message details
 551  * @param: customized parameter
 552  */
 553 static void hinic_mgmt_recv_msg_handler(struct hinic_msg_pf_to_mgmt *pf_to_mgmt,
 554                                         struct hinic_recv_msg *recv_msg,
 555                                         void *param)
 556 {
 557         void *buf_out = recv_msg->buf_out;
 558         u16 out_size = 0;
 559
 560         switch (recv_msg->mod) {
 561         case HINIC_MOD_COMM:
 562                 hinic_comm_async_event_handle(pf_to_mgmt->hwdev,
 563                                               recv_msg->cmd, recv_msg->msg,
 564                                               recv_msg->msg_len,
 565                                               buf_out, &out_size);
 566                 break;
 567         case HINIC_MOD_L2NIC:
 568                 hinic_l2nic_async_event_handle(pf_to_mgmt->hwdev, param,
 569                                                recv_msg->cmd, recv_msg->msg,
 570                                                recv_msg->msg_len,
 571                                                buf_out, &out_size);
 572                 break;
 573         case HINIC_MOD_HILINK:
 574                 hinic_hilink_async_event_handle(pf_to_mgmt->hwdev,
 575                                                 recv_msg->cmd, recv_msg->msg,
 576                                                 recv_msg->msg_len,
 577                                                 buf_out, &out_size);
 578                 break;
 579         default:
 580                 PMD_DRV_LOG(ERR, "No handler, mod = %d", recv_msg->mod);
 581                 break;
 582         }
 583
 584         if (!recv_msg->async_mgmt_to_pf) {
 585                 if (!out_size)
 586                         out_size = BUF_OUT_DEFAULT_SIZE;
 587
 588                 /* MGMT sent sync msg, send the response */
 589                 (void)send_msg_to_mgmt_async(pf_to_mgmt, recv_msg->mod,
 590                                              recv_msg->cmd, buf_out, out_size,
 591                                              HINIC_MSG_RESPONSE,
 592                                              recv_msg->msg_id);
 593         }
 594 }
 595
 596 /**
 597  * recv_mgmt_msg_handler - handler a message from mgmt cpu
 598  * @pf_to_mgmt: PF to MGMT channel
 599  * @header: the header of the message
 600  * @recv_msg: received message details
 601  * @param: customized parameter
 602  * Return: 0 when aeq is response message, -1 default result,
 603  * and when wrong message or not last message
 604  */
 605 static int recv_mgmt_msg_handler(struct hinic_msg_pf_to_mgmt *pf_to_mgmt,
 606                                  u8 *header, struct hinic_recv_msg *recv_msg,
 607                                  void *param)
 608 {
 609         u64 msg_header = *((u64 *)header);
 610         void *msg_body = header + sizeof(msg_header);
 611         u8 *dest_msg;
 612         u8 seq_id, seq_len;
 613         u32 msg_buf_max = MAX_PF_MGMT_BUF_SIZE;
 614
 615         seq_id = HINIC_MSG_HEADER_GET(msg_header, SEQID);
 616         seq_len = HINIC_MSG_HEADER_GET(msg_header, SEG_LEN);
 617
 618         if (!check_mgmt_seq_id_and_seg_len(recv_msg, seq_id, seq_len)) {
 619                 PMD_DRV_LOG(ERR,
 620                         "Mgmt msg sequence and segment check fail, "
 621                         "func id: 0x%x, front id: 0x%x, current id: 0x%x, seg len: 0x%x",
 622                         hinic_global_func_id(pf_to_mgmt->hwdev),
 623                         recv_msg->sed_id, seq_id, seq_len);
 624                 return HINIC_ERROR;
 625         }
 626
 627         dest_msg = (u8 *)recv_msg->msg + seq_id * HINIC_MSG_SEG_LEN;
 628         msg_buf_max -= seq_id * HINIC_MSG_SEG_LEN;
 629         memcpy(dest_msg, msg_body, seq_len);
 630
 631         if (!HINIC_MSG_HEADER_GET(msg_header, LAST))
 632                 return HINIC_ERROR;
 633
 634         recv_msg->cmd = HINIC_MSG_HEADER_GET(msg_header, CMD);
 635         recv_msg->mod = HINIC_MSG_HEADER_GET(msg_header, MODULE);
 636         recv_msg->async_mgmt_to_pf = HINIC_MSG_HEADER_GET(msg_header,
 637                                                           ASYNC_MGMT_TO_PF);
 638         recv_msg->msg_len = HINIC_MSG_HEADER_GET(msg_header, MSG_LEN);
 639         recv_msg->msg_id = HINIC_MSG_HEADER_GET(msg_header, MSG_ID);
 640
 641         if (HINIC_MSG_HEADER_GET(msg_header, DIRECTION) == HINIC_MSG_RESPONSE)
 642                 return HINIC_OK;
 643
 644         hinic_mgmt_recv_msg_handler(pf_to_mgmt, recv_msg, param);
 645
 646         return HINIC_ERROR;
 647 }
 648
 649 /**
 650  * hinic_mgmt_msg_aeqe_handler - handler for a mgmt message event
 651  * @hwdev: the pointer to the private hardware device object
 652  * @header: the header of the message
 653  * @size: unused
 654  * @param: customized parameter
 655  * Return: 0 when aeq is response message,
 656  *         -1 default result, and when wrong message or not last message
 657  */
 658 static int hinic_mgmt_msg_aeqe_handler(void *hwdev, u8 *header,
 659                         __rte_unused u8 size, void *param)
 660 {
 661         struct hinic_msg_pf_to_mgmt *pf_to_mgmt =
 662                                 ((struct hinic_hwdev *)hwdev)->pf_to_mgmt;
 663         struct hinic_recv_msg *recv_msg;
 664
 665         recv_msg = (HINIC_MSG_HEADER_GET(*(u64 *)header, DIRECTION) ==
 666                     HINIC_MSG_DIRECT_SEND) ?
 667                     &pf_to_mgmt->recv_msg_from_mgmt :
 668                     &pf_to_mgmt->recv_resp_msg_from_mgmt;
 669
 670         return recv_mgmt_msg_handler(pf_to_mgmt, header, recv_msg, param);
 671 }
 672
 673 static int hinic_handle_aeqe(void *handle, enum hinic_aeq_type event,
 674                       u8 *data, u8 size, void *param)
 675 {
 676         int rc = 0;
 677
 678         switch (event) {
 679         case HINIC_MSG_FROM_MGMT_CPU:
 680                 rc = hinic_mgmt_msg_aeqe_handler(handle, data, size, param);
 681                 break;
 682         case HINIC_MBX_FROM_FUNC:
 683                 rc = hinic_mbox_func_aeqe_handler(handle, data, size, param);
 684                 break;
 685         default:
 686                 PMD_DRV_LOG(ERR, "Unknown event type: 0x%x, size: %d",
 687                             event, size);
 688                 rc = HINIC_ERROR;
 689                 break;
 690         }
 691
 692         return rc;
 693 }
 694
 695 /**
 696  * hinic_aeq_poll_msg - poll one or continue aeqe, and call dedicated process
 697  * @eq: aeq of the chip
 698  * @timeout: 0   - poll all aeqe in eq, used in interrupt mode,
 699  *           > 0 - poll aeq until get aeqe with 'last' field set to 1,
 700  *           used in polling mode.
 701  * @param: customized parameter
 702  * Return: 0 - Success, EIO - poll timeout, ENODEV - swe not support
 703  */
 704 int hinic_aeq_poll_msg(struct hinic_eq *eq, u32 timeout, void *param)
 705 {
 706         struct hinic_aeq_elem *aeqe_pos;
 707         enum hinic_aeq_type event;
 708         u32 aeqe_desc = 0;
 709         u16 i;
 710         u8 size;
 711         int done = HINIC_ERROR;
 712         int err = -EFAULT;
 713         unsigned long end;
 714
 715         for (i = 0; ((timeout == 0) && (i < eq->eq_len)) ||
 716              ((timeout > 0) && (done != HINIC_OK) && (i < eq->eq_len)); i++) {
 717                 err = -EIO;
 718                 end = jiffies + msecs_to_jiffies(timeout);
 719                 do {
 720                         aeqe_pos = GET_CURR_AEQ_ELEM(eq);
 721                         rte_rmb();
 722
 723                         /* Data in HW is in Big endian Format */
 724                         aeqe_desc = be32_to_cpu(aeqe_pos->desc);
 725
 726                         /* HW updates wrapped bit,
 727                          * when it adds eq element event
 728                          */
 729                         if (EQ_ELEM_DESC_GET(aeqe_desc, WRAPPED)
 730                             != eq->wrapped) {
 731                                 err = 0;
 732                                 break;
 733                         }
 734
 735                         if (timeout != 0)
 736                                 usleep(1000);
 737                 } while (time_before(jiffies, end));
 738
 739                 if (err != HINIC_OK) /*poll time out*/
 740                         break;
 741
 742                 event = EQ_ELEM_DESC_GET(aeqe_desc, TYPE);
 743                 if (EQ_ELEM_DESC_GET(aeqe_desc, SRC)) {
 744                         PMD_DRV_LOG(ERR, "AEQ sw event not support %d",
 745                                 event);
 746                         return -ENODEV;
 747
 748                 } else {
 749                         size = EQ_ELEM_DESC_GET(aeqe_desc, SIZE);
 750                         done = hinic_handle_aeqe(eq->hwdev, event,
 751                                                  aeqe_pos->aeqe_data,
 752                                                  size, param);
 753                 }
 754
 755                 eq->cons_idx++;
 756                 if (eq->cons_idx == eq->eq_len) {
 757                         eq->cons_idx = 0;
 758                         eq->wrapped = !eq->wrapped;
 759                 }
 760         }
 761
 762         eq_update_ci(eq);
 763
 764         return err;
 765 }
 766
 767 int hinic_comm_pf_to_mgmt_init(struct hinic_hwdev *hwdev)
 768 {
 769         int rc;
 770
 771         /* VF do not support send msg to mgmt directly */
 772         if (hinic_func_type(hwdev) == TYPE_VF)
 773                 return 0;
 774
 775         rc = hinic_pf_to_mgmt_init(hwdev);
 776         if (rc)
 777                 return rc;
 778
 779         hwdev->pf_to_mgmt->rx_aeq = &hwdev->aeqs->aeq[HINIC_MGMT_RSP_AEQN];
 780
 781         return 0;
 782 }
 783
 784 void hinic_comm_pf_to_mgmt_free(struct hinic_hwdev *hwdev)
 785 {
 786         /* VF do not support send msg to mgmt directly */
 787         if (hinic_func_type(hwdev) == TYPE_VF)
 788                 return;
 789
 790         hinic_pf_to_mgmt_free(hwdev);
 791 }
 792
 793 void hinic_dev_handle_aeq_event(struct hinic_hwdev *hwdev, void *param)
 794 {
 795         struct hinic_eq *aeq = &hwdev->aeqs->aeq[0];
 796
 797         /* clear resend timer cnt register */
 798         hinic_misx_intr_clear_resend_bit(hwdev, aeq->eq_irq.msix_entry_idx,
 799                                          EQ_MSIX_RESEND_TIMER_CLEAR);
 800         (void)hinic_aeq_poll_msg(aeq, 0, param);
 801 }