1 /* SPDX-License-Identifier: BSD-3-Clause 2 * Copyright(c) 2010-2018 Intel Corporation 3 */ 4 5 #include <stdlib.h> 6 #include <string.h> 7 8 #include <rte_ethdev.h> 9 #include <rte_string_fns.h> 10 11 #include "link.h" 12 #include "mempool.h" 13 14 static struct link_list link_list; 15 16 int 17 link_init(void) 18 { 19 TAILQ_INIT(&link_list); 20 21 return 0; 22 } 23 24 struct link * 25 link_find(const char *name) 26 { 27 struct link *link; 28 29 if (name == NULL) 30 return NULL; 31 32 TAILQ_FOREACH(link, &link_list, node) 33 if (strcmp(link->name, name) == 0) 34 return link; 35 36 return NULL; 37 } 38 39 struct link * 40 link_next(struct link *link) 41 { 42 return (link == NULL) ? TAILQ_FIRST(&link_list) : TAILQ_NEXT(link, node); 43 } 44 45 static struct rte_eth_conf port_conf_default = { 46 .link_speeds = 0, 47 .rxmode = { 48 .mq_mode = RTE_ETH_MQ_RX_NONE, 49 .mtu = 9000 - (RTE_ETHER_HDR_LEN + RTE_ETHER_CRC_LEN), /* Jumbo frame MTU */ 50 .split_hdr_size = 0, /* Header split buffer size */ 51 }, 52 .rx_adv_conf = { 53 .rss_conf = { 54 .rss_key = NULL, 55 .rss_key_len = 40, 56 .rss_hf = 0, 57 }, 58 }, 59 .txmode = { 60 .mq_mode = RTE_ETH_MQ_TX_NONE, 61 }, 62 .lpbk_mode = 0, 63 }; 64 65 #define RETA_CONF_SIZE (RTE_ETH_RSS_RETA_SIZE_512 / RTE_ETH_RETA_GROUP_SIZE) 66 67 static int 68 rss_setup(uint16_t port_id, 69 uint16_t reta_size, 70 struct link_params_rss *rss) 71 { 72 struct rte_eth_rss_reta_entry64 reta_conf[RETA_CONF_SIZE]; 73 uint32_t i; 74 int status; 75 76 /* RETA setting */ 77 memset(reta_conf, 0, sizeof(reta_conf)); 78 79 for (i = 0; i < reta_size; i++) 80 reta_conf[i / RTE_ETH_RETA_GROUP_SIZE].mask = UINT64_MAX; 81 82 for (i = 0; i < reta_size; i++) { 83 uint32_t reta_id = i / RTE_ETH_RETA_GROUP_SIZE; 84 uint32_t reta_pos = i % RTE_ETH_RETA_GROUP_SIZE; 85 uint32_t rss_qs_pos = i % rss->n_queues; 86 87 reta_conf[reta_id].reta[reta_pos] = 88 (uint16_t) rss->queue_id[rss_qs_pos]; 89 } 90 91 /* RETA update */ 92 status = rte_eth_dev_rss_reta_update(port_id, 93 reta_conf, 94 reta_size); 95 96 return status; 97 } 98 99 struct link * 100 link_create(const char *name, struct link_params *params) 101 { 102 struct rte_eth_dev_info port_info; 103 struct rte_eth_conf port_conf; 104 struct link *link; 105 struct link_params_rss *rss; 106 struct mempool *mempool; 107 uint32_t cpu_id, i; 108 int status; 109 uint16_t port_id; 110 111 /* Check input params */ 112 if ((name == NULL) || 113 link_find(name) || 114 (params == NULL) || 115 (params->rx.n_queues == 0) || 116 (params->rx.queue_size == 0) || 117 (params->tx.n_queues == 0) || 118 (params->tx.queue_size == 0)) 119 return NULL; 120 121 port_id = params->port_id; 122 if (params->dev_name) { 123 status = rte_eth_dev_get_port_by_name(params->dev_name, 124 &port_id); 125 126 if (status) 127 return NULL; 128 } else 129 if (!rte_eth_dev_is_valid_port(port_id)) 130 return NULL; 131 132 if (rte_eth_dev_info_get(port_id, &port_info) != 0) 133 return NULL; 134 135 mempool = mempool_find(params->rx.mempool_name); 136 if (mempool == NULL) 137 return NULL; 138 139 rss = params->rx.rss; 140 if (rss) { 141 if ((port_info.reta_size == 0) || 142 (port_info.reta_size > RTE_ETH_RSS_RETA_SIZE_512)) 143 return NULL; 144 145 if ((rss->n_queues == 0) || 146 (rss->n_queues >= LINK_RXQ_RSS_MAX)) 147 return NULL; 148 149 for (i = 0; i < rss->n_queues; i++) 150 if (rss->queue_id[i] >= port_info.max_rx_queues) 151 return NULL; 152 } 153 154 /** 155 * Resource create 156 */ 157 /* Port */ 158 memcpy(&port_conf, &port_conf_default, sizeof(port_conf)); 159 if (rss) { 160 port_conf.rxmode.mq_mode = RTE_ETH_MQ_RX_RSS; 161 port_conf.rx_adv_conf.rss_conf.rss_hf = 162 (RTE_ETH_RSS_IP | RTE_ETH_RSS_TCP | RTE_ETH_RSS_UDP) & 163 port_info.flow_type_rss_offloads; 164 } 165 166 cpu_id = (uint32_t) rte_eth_dev_socket_id(port_id); 167 if (cpu_id == (uint32_t) SOCKET_ID_ANY) 168 cpu_id = 0; 169 170 status = rte_eth_dev_configure( 171 port_id, 172 params->rx.n_queues, 173 params->tx.n_queues, 174 &port_conf); 175 176 if (status < 0) 177 return NULL; 178 179 if (params->promiscuous) { 180 status = rte_eth_promiscuous_enable(port_id); 181 if (status != 0) 182 return NULL; 183 } 184 185 /* Port RX */ 186 for (i = 0; i < params->rx.n_queues; i++) { 187 status = rte_eth_rx_queue_setup( 188 port_id, 189 i, 190 params->rx.queue_size, 191 cpu_id, 192 NULL, 193 mempool->m); 194 195 if (status < 0) 196 return NULL; 197 } 198 199 /* Port TX */ 200 for (i = 0; i < params->tx.n_queues; i++) { 201 status = rte_eth_tx_queue_setup( 202 port_id, 203 i, 204 params->tx.queue_size, 205 cpu_id, 206 NULL); 207 208 if (status < 0) 209 return NULL; 210 } 211 212 /* Port start */ 213 status = rte_eth_dev_start(port_id); 214 if (status < 0) 215 return NULL; 216 217 if (rss) { 218 status = rss_setup(port_id, port_info.reta_size, rss); 219 220 if (status) { 221 rte_eth_dev_stop(port_id); 222 return NULL; 223 } 224 } 225 226 /* Port link up */ 227 status = rte_eth_dev_set_link_up(port_id); 228 if ((status < 0) && (status != -ENOTSUP)) { 229 rte_eth_dev_stop(port_id); 230 return NULL; 231 } 232 233 /* Node allocation */ 234 link = calloc(1, sizeof(struct link)); 235 if (link == NULL) { 236 rte_eth_dev_stop(port_id); 237 return NULL; 238 } 239 240 /* Node fill in */ 241 strlcpy(link->name, name, sizeof(link->name)); 242 link->port_id = port_id; 243 link->n_rxq = params->rx.n_queues; 244 link->n_txq = params->tx.n_queues; 245 246 /* Node add to list */ 247 TAILQ_INSERT_TAIL(&link_list, link, node); 248 249 return link; 250 } 251 252 int 253 link_is_up(const char *name) 254 { 255 struct rte_eth_link link_params; 256 struct link *link; 257 258 /* Check input params */ 259 if (name == NULL) 260 return 0; 261 262 link = link_find(name); 263 if (link == NULL) 264 return 0; 265 266 /* Resource */ 267 if (rte_eth_link_get(link->port_id, &link_params) < 0) 268 return 0; 269 270 return (link_params.link_status == RTE_ETH_LINK_DOWN) ? 0 : 1; 271 } 272