18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci/* Marvell OcteonTX CPT driver 38c2ecf20Sopenharmony_ci * 48c2ecf20Sopenharmony_ci * Copyright (C) 2019 Marvell International Ltd. 58c2ecf20Sopenharmony_ci * 68c2ecf20Sopenharmony_ci * This program is free software; you can redistribute it and/or modify 78c2ecf20Sopenharmony_ci * it under the terms of the GNU General Public License version 2 as 88c2ecf20Sopenharmony_ci * published by the Free Software Foundation. 98c2ecf20Sopenharmony_ci */ 108c2ecf20Sopenharmony_ci 118c2ecf20Sopenharmony_ci#include <linux/delay.h> 128c2ecf20Sopenharmony_ci#include "otx_cptvf.h" 138c2ecf20Sopenharmony_ci 148c2ecf20Sopenharmony_ci#define CPT_MBOX_MSG_TIMEOUT 2000 158c2ecf20Sopenharmony_ci 168c2ecf20Sopenharmony_cistatic char *get_mbox_opcode_str(int msg_opcode) 178c2ecf20Sopenharmony_ci{ 188c2ecf20Sopenharmony_ci char *str = "Unknown"; 198c2ecf20Sopenharmony_ci 208c2ecf20Sopenharmony_ci switch (msg_opcode) { 218c2ecf20Sopenharmony_ci case OTX_CPT_MSG_VF_UP: 228c2ecf20Sopenharmony_ci str = "UP"; 238c2ecf20Sopenharmony_ci break; 248c2ecf20Sopenharmony_ci 258c2ecf20Sopenharmony_ci case OTX_CPT_MSG_VF_DOWN: 268c2ecf20Sopenharmony_ci str = "DOWN"; 278c2ecf20Sopenharmony_ci break; 288c2ecf20Sopenharmony_ci 298c2ecf20Sopenharmony_ci case OTX_CPT_MSG_READY: 308c2ecf20Sopenharmony_ci str = "READY"; 318c2ecf20Sopenharmony_ci break; 328c2ecf20Sopenharmony_ci 338c2ecf20Sopenharmony_ci case OTX_CPT_MSG_QLEN: 348c2ecf20Sopenharmony_ci str = "QLEN"; 358c2ecf20Sopenharmony_ci break; 368c2ecf20Sopenharmony_ci 378c2ecf20Sopenharmony_ci case OTX_CPT_MSG_QBIND_GRP: 388c2ecf20Sopenharmony_ci str = "QBIND_GRP"; 398c2ecf20Sopenharmony_ci break; 408c2ecf20Sopenharmony_ci 418c2ecf20Sopenharmony_ci case OTX_CPT_MSG_VQ_PRIORITY: 428c2ecf20Sopenharmony_ci str = "VQ_PRIORITY"; 438c2ecf20Sopenharmony_ci break; 448c2ecf20Sopenharmony_ci 458c2ecf20Sopenharmony_ci case OTX_CPT_MSG_PF_TYPE: 468c2ecf20Sopenharmony_ci str = "PF_TYPE"; 478c2ecf20Sopenharmony_ci break; 488c2ecf20Sopenharmony_ci 498c2ecf20Sopenharmony_ci case OTX_CPT_MSG_ACK: 508c2ecf20Sopenharmony_ci str = "ACK"; 518c2ecf20Sopenharmony_ci break; 528c2ecf20Sopenharmony_ci 538c2ecf20Sopenharmony_ci case OTX_CPT_MSG_NACK: 548c2ecf20Sopenharmony_ci str = "NACK"; 558c2ecf20Sopenharmony_ci break; 568c2ecf20Sopenharmony_ci } 578c2ecf20Sopenharmony_ci return str; 588c2ecf20Sopenharmony_ci} 598c2ecf20Sopenharmony_ci 608c2ecf20Sopenharmony_cistatic void dump_mbox_msg(struct otx_cpt_mbox *mbox_msg, int vf_id) 618c2ecf20Sopenharmony_ci{ 628c2ecf20Sopenharmony_ci char raw_data_str[OTX_CPT_MAX_MBOX_DATA_STR_SIZE]; 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_ci hex_dump_to_buffer(mbox_msg, sizeof(struct otx_cpt_mbox), 16, 8, 658c2ecf20Sopenharmony_ci raw_data_str, OTX_CPT_MAX_MBOX_DATA_STR_SIZE, false); 668c2ecf20Sopenharmony_ci if (vf_id >= 0) 678c2ecf20Sopenharmony_ci pr_debug("MBOX msg %s received from VF%d raw_data %s", 688c2ecf20Sopenharmony_ci get_mbox_opcode_str(mbox_msg->msg), vf_id, 698c2ecf20Sopenharmony_ci raw_data_str); 708c2ecf20Sopenharmony_ci else 718c2ecf20Sopenharmony_ci pr_debug("MBOX msg %s received from PF raw_data %s", 728c2ecf20Sopenharmony_ci get_mbox_opcode_str(mbox_msg->msg), raw_data_str); 738c2ecf20Sopenharmony_ci} 748c2ecf20Sopenharmony_ci 758c2ecf20Sopenharmony_cistatic void cptvf_send_msg_to_pf(struct otx_cptvf *cptvf, 768c2ecf20Sopenharmony_ci struct otx_cpt_mbox *mbx) 778c2ecf20Sopenharmony_ci{ 788c2ecf20Sopenharmony_ci /* Writing mbox(1) causes interrupt */ 798c2ecf20Sopenharmony_ci writeq(mbx->msg, cptvf->reg_base + OTX_CPT_VFX_PF_MBOXX(0, 0)); 808c2ecf20Sopenharmony_ci writeq(mbx->data, cptvf->reg_base + OTX_CPT_VFX_PF_MBOXX(0, 1)); 818c2ecf20Sopenharmony_ci} 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_ci/* Interrupt handler to handle mailbox messages from VFs */ 848c2ecf20Sopenharmony_civoid otx_cptvf_handle_mbox_intr(struct otx_cptvf *cptvf) 858c2ecf20Sopenharmony_ci{ 868c2ecf20Sopenharmony_ci struct otx_cpt_mbox mbx = {}; 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci /* 898c2ecf20Sopenharmony_ci * MBOX[0] contains msg 908c2ecf20Sopenharmony_ci * MBOX[1] contains data 918c2ecf20Sopenharmony_ci */ 928c2ecf20Sopenharmony_ci mbx.msg = readq(cptvf->reg_base + OTX_CPT_VFX_PF_MBOXX(0, 0)); 938c2ecf20Sopenharmony_ci mbx.data = readq(cptvf->reg_base + OTX_CPT_VFX_PF_MBOXX(0, 1)); 948c2ecf20Sopenharmony_ci 958c2ecf20Sopenharmony_ci dump_mbox_msg(&mbx, -1); 968c2ecf20Sopenharmony_ci 978c2ecf20Sopenharmony_ci switch (mbx.msg) { 988c2ecf20Sopenharmony_ci case OTX_CPT_MSG_VF_UP: 998c2ecf20Sopenharmony_ci cptvf->pf_acked = true; 1008c2ecf20Sopenharmony_ci cptvf->num_vfs = mbx.data; 1018c2ecf20Sopenharmony_ci break; 1028c2ecf20Sopenharmony_ci case OTX_CPT_MSG_READY: 1038c2ecf20Sopenharmony_ci cptvf->pf_acked = true; 1048c2ecf20Sopenharmony_ci cptvf->vfid = mbx.data; 1058c2ecf20Sopenharmony_ci dev_dbg(&cptvf->pdev->dev, "Received VFID %d\n", cptvf->vfid); 1068c2ecf20Sopenharmony_ci break; 1078c2ecf20Sopenharmony_ci case OTX_CPT_MSG_QBIND_GRP: 1088c2ecf20Sopenharmony_ci cptvf->pf_acked = true; 1098c2ecf20Sopenharmony_ci cptvf->vftype = mbx.data; 1108c2ecf20Sopenharmony_ci dev_dbg(&cptvf->pdev->dev, "VF %d type %s group %d\n", 1118c2ecf20Sopenharmony_ci cptvf->vfid, 1128c2ecf20Sopenharmony_ci ((mbx.data == OTX_CPT_SE_TYPES) ? "SE" : "AE"), 1138c2ecf20Sopenharmony_ci cptvf->vfgrp); 1148c2ecf20Sopenharmony_ci break; 1158c2ecf20Sopenharmony_ci case OTX_CPT_MSG_ACK: 1168c2ecf20Sopenharmony_ci cptvf->pf_acked = true; 1178c2ecf20Sopenharmony_ci break; 1188c2ecf20Sopenharmony_ci case OTX_CPT_MSG_NACK: 1198c2ecf20Sopenharmony_ci cptvf->pf_nacked = true; 1208c2ecf20Sopenharmony_ci break; 1218c2ecf20Sopenharmony_ci default: 1228c2ecf20Sopenharmony_ci dev_err(&cptvf->pdev->dev, "Invalid msg from PF, msg 0x%llx\n", 1238c2ecf20Sopenharmony_ci mbx.msg); 1248c2ecf20Sopenharmony_ci break; 1258c2ecf20Sopenharmony_ci } 1268c2ecf20Sopenharmony_ci} 1278c2ecf20Sopenharmony_ci 1288c2ecf20Sopenharmony_cistatic int cptvf_send_msg_to_pf_timeout(struct otx_cptvf *cptvf, 1298c2ecf20Sopenharmony_ci struct otx_cpt_mbox *mbx) 1308c2ecf20Sopenharmony_ci{ 1318c2ecf20Sopenharmony_ci int timeout = CPT_MBOX_MSG_TIMEOUT; 1328c2ecf20Sopenharmony_ci int sleep = 10; 1338c2ecf20Sopenharmony_ci 1348c2ecf20Sopenharmony_ci cptvf->pf_acked = false; 1358c2ecf20Sopenharmony_ci cptvf->pf_nacked = false; 1368c2ecf20Sopenharmony_ci cptvf_send_msg_to_pf(cptvf, mbx); 1378c2ecf20Sopenharmony_ci /* Wait for previous message to be acked, timeout 2sec */ 1388c2ecf20Sopenharmony_ci while (!cptvf->pf_acked) { 1398c2ecf20Sopenharmony_ci if (cptvf->pf_nacked) 1408c2ecf20Sopenharmony_ci return -EINVAL; 1418c2ecf20Sopenharmony_ci msleep(sleep); 1428c2ecf20Sopenharmony_ci if (cptvf->pf_acked) 1438c2ecf20Sopenharmony_ci break; 1448c2ecf20Sopenharmony_ci timeout -= sleep; 1458c2ecf20Sopenharmony_ci if (!timeout) { 1468c2ecf20Sopenharmony_ci dev_err(&cptvf->pdev->dev, 1478c2ecf20Sopenharmony_ci "PF didn't ack to mbox msg %llx from VF%u\n", 1488c2ecf20Sopenharmony_ci mbx->msg, cptvf->vfid); 1498c2ecf20Sopenharmony_ci return -EBUSY; 1508c2ecf20Sopenharmony_ci } 1518c2ecf20Sopenharmony_ci } 1528c2ecf20Sopenharmony_ci return 0; 1538c2ecf20Sopenharmony_ci} 1548c2ecf20Sopenharmony_ci 1558c2ecf20Sopenharmony_ci/* 1568c2ecf20Sopenharmony_ci * Checks if VF is able to comminicate with PF 1578c2ecf20Sopenharmony_ci * and also gets the CPT number this VF is associated to. 1588c2ecf20Sopenharmony_ci */ 1598c2ecf20Sopenharmony_ciint otx_cptvf_check_pf_ready(struct otx_cptvf *cptvf) 1608c2ecf20Sopenharmony_ci{ 1618c2ecf20Sopenharmony_ci struct otx_cpt_mbox mbx = {}; 1628c2ecf20Sopenharmony_ci int ret; 1638c2ecf20Sopenharmony_ci 1648c2ecf20Sopenharmony_ci mbx.msg = OTX_CPT_MSG_READY; 1658c2ecf20Sopenharmony_ci ret = cptvf_send_msg_to_pf_timeout(cptvf, &mbx); 1668c2ecf20Sopenharmony_ci 1678c2ecf20Sopenharmony_ci return ret; 1688c2ecf20Sopenharmony_ci} 1698c2ecf20Sopenharmony_ci 1708c2ecf20Sopenharmony_ci/* 1718c2ecf20Sopenharmony_ci * Communicate VQs size to PF to program CPT(0)_PF_Q(0-15)_CTL of the VF. 1728c2ecf20Sopenharmony_ci * Must be ACKed. 1738c2ecf20Sopenharmony_ci */ 1748c2ecf20Sopenharmony_ciint otx_cptvf_send_vq_size_msg(struct otx_cptvf *cptvf) 1758c2ecf20Sopenharmony_ci{ 1768c2ecf20Sopenharmony_ci struct otx_cpt_mbox mbx = {}; 1778c2ecf20Sopenharmony_ci int ret; 1788c2ecf20Sopenharmony_ci 1798c2ecf20Sopenharmony_ci mbx.msg = OTX_CPT_MSG_QLEN; 1808c2ecf20Sopenharmony_ci mbx.data = cptvf->qsize; 1818c2ecf20Sopenharmony_ci ret = cptvf_send_msg_to_pf_timeout(cptvf, &mbx); 1828c2ecf20Sopenharmony_ci 1838c2ecf20Sopenharmony_ci return ret; 1848c2ecf20Sopenharmony_ci} 1858c2ecf20Sopenharmony_ci 1868c2ecf20Sopenharmony_ci/* 1878c2ecf20Sopenharmony_ci * Communicate VF group required to PF and get the VQ binded to that group 1888c2ecf20Sopenharmony_ci */ 1898c2ecf20Sopenharmony_ciint otx_cptvf_send_vf_to_grp_msg(struct otx_cptvf *cptvf, int group) 1908c2ecf20Sopenharmony_ci{ 1918c2ecf20Sopenharmony_ci struct otx_cpt_mbox mbx = {}; 1928c2ecf20Sopenharmony_ci int ret; 1938c2ecf20Sopenharmony_ci 1948c2ecf20Sopenharmony_ci mbx.msg = OTX_CPT_MSG_QBIND_GRP; 1958c2ecf20Sopenharmony_ci /* Convey group of the VF */ 1968c2ecf20Sopenharmony_ci mbx.data = group; 1978c2ecf20Sopenharmony_ci ret = cptvf_send_msg_to_pf_timeout(cptvf, &mbx); 1988c2ecf20Sopenharmony_ci if (ret) 1998c2ecf20Sopenharmony_ci return ret; 2008c2ecf20Sopenharmony_ci cptvf->vfgrp = group; 2018c2ecf20Sopenharmony_ci 2028c2ecf20Sopenharmony_ci return 0; 2038c2ecf20Sopenharmony_ci} 2048c2ecf20Sopenharmony_ci 2058c2ecf20Sopenharmony_ci/* 2068c2ecf20Sopenharmony_ci * Communicate VF group required to PF and get the VQ binded to that group 2078c2ecf20Sopenharmony_ci */ 2088c2ecf20Sopenharmony_ciint otx_cptvf_send_vf_priority_msg(struct otx_cptvf *cptvf) 2098c2ecf20Sopenharmony_ci{ 2108c2ecf20Sopenharmony_ci struct otx_cpt_mbox mbx = {}; 2118c2ecf20Sopenharmony_ci int ret; 2128c2ecf20Sopenharmony_ci 2138c2ecf20Sopenharmony_ci mbx.msg = OTX_CPT_MSG_VQ_PRIORITY; 2148c2ecf20Sopenharmony_ci /* Convey group of the VF */ 2158c2ecf20Sopenharmony_ci mbx.data = cptvf->priority; 2168c2ecf20Sopenharmony_ci ret = cptvf_send_msg_to_pf_timeout(cptvf, &mbx); 2178c2ecf20Sopenharmony_ci 2188c2ecf20Sopenharmony_ci return ret; 2198c2ecf20Sopenharmony_ci} 2208c2ecf20Sopenharmony_ci 2218c2ecf20Sopenharmony_ci/* 2228c2ecf20Sopenharmony_ci * Communicate to PF that VF is UP and running 2238c2ecf20Sopenharmony_ci */ 2248c2ecf20Sopenharmony_ciint otx_cptvf_send_vf_up(struct otx_cptvf *cptvf) 2258c2ecf20Sopenharmony_ci{ 2268c2ecf20Sopenharmony_ci struct otx_cpt_mbox mbx = {}; 2278c2ecf20Sopenharmony_ci int ret; 2288c2ecf20Sopenharmony_ci 2298c2ecf20Sopenharmony_ci mbx.msg = OTX_CPT_MSG_VF_UP; 2308c2ecf20Sopenharmony_ci ret = cptvf_send_msg_to_pf_timeout(cptvf, &mbx); 2318c2ecf20Sopenharmony_ci 2328c2ecf20Sopenharmony_ci return ret; 2338c2ecf20Sopenharmony_ci} 2348c2ecf20Sopenharmony_ci 2358c2ecf20Sopenharmony_ci/* 2368c2ecf20Sopenharmony_ci * Communicate to PF that VF is DOWN and running 2378c2ecf20Sopenharmony_ci */ 2388c2ecf20Sopenharmony_ciint otx_cptvf_send_vf_down(struct otx_cptvf *cptvf) 2398c2ecf20Sopenharmony_ci{ 2408c2ecf20Sopenharmony_ci struct otx_cpt_mbox mbx = {}; 2418c2ecf20Sopenharmony_ci int ret; 2428c2ecf20Sopenharmony_ci 2438c2ecf20Sopenharmony_ci mbx.msg = OTX_CPT_MSG_VF_DOWN; 2448c2ecf20Sopenharmony_ci ret = cptvf_send_msg_to_pf_timeout(cptvf, &mbx); 2458c2ecf20Sopenharmony_ci 2468c2ecf20Sopenharmony_ci return ret; 2478c2ecf20Sopenharmony_ci} 248