Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 1 | /* |
| 2 | *------------------------------------------------------------------ |
| 3 | * af_packet.c - linux kernel packet interface |
| 4 | * |
| 5 | * Copyright (c) 2016 Cisco and/or its affiliates. |
| 6 | * Licensed under the Apache License, Version 2.0 (the "License"); |
| 7 | * you may not use this file except in compliance with the License. |
| 8 | * You may obtain a copy of the License at: |
| 9 | * |
| 10 | * http://www.apache.org/licenses/LICENSE-2.0 |
| 11 | * |
| 12 | * Unless required by applicable law or agreed to in writing, software |
| 13 | * distributed under the License is distributed on an "AS IS" BASIS, |
| 14 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| 15 | * See the License for the specific language governing permissions and |
| 16 | * limitations under the License. |
| 17 | *------------------------------------------------------------------ |
| 18 | */ |
| 19 | |
| 20 | #include <linux/if_packet.h> |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 21 | #include <sys/socket.h> |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 22 | #include <sys/ioctl.h> |
| 23 | #include <net/if.h> |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 24 | #include <net/if_arp.h> |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 25 | |
| 26 | #include <vlib/vlib.h> |
| 27 | #include <vlib/unix/unix.h> |
| 28 | #include <vnet/ip/ip.h> |
| 29 | #include <vnet/ethernet/ethernet.h> |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 30 | #include <vnet/ip/ip4_packet.h> |
| 31 | #include <vnet/ip/ip6_packet.h> |
| 32 | #include <vnet/ip/ip_psh_cksum.h> |
| 33 | #include <vnet/tcp/tcp_packet.h> |
| 34 | #include <vnet/udp/udp_packet.h> |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 35 | |
| 36 | #include <vnet/devices/af_packet/af_packet.h> |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 37 | #include <vnet/devices/virtio/virtio_std.h> |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 38 | |
Chris Luke | 4b46c84 | 2016-05-23 21:30:26 -0400 | [diff] [blame] | 39 | #define foreach_af_packet_tx_func_error \ |
| 40 | _(FRAME_NOT_READY, "tx frame not ready") \ |
| 41 | _(TXRING_EAGAIN, "tx sendto temporary failure") \ |
| 42 | _(TXRING_FATAL, "tx sendto fatal failure") \ |
| 43 | _(TXRING_OVERRUN, "tx ring overrun") |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 44 | |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 45 | typedef enum |
| 46 | { |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 47 | #define _(f,s) AF_PACKET_TX_ERROR_##f, |
| 48 | foreach_af_packet_tx_func_error |
| 49 | #undef _ |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 50 | AF_PACKET_TX_N_ERROR, |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 51 | } af_packet_tx_func_error_t; |
| 52 | |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 53 | static char *af_packet_tx_func_error_strings[] = { |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 54 | #define _(n,s) s, |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 55 | foreach_af_packet_tx_func_error |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 56 | #undef _ |
| 57 | }; |
| 58 | |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 59 | typedef struct |
| 60 | { |
| 61 | u32 buffer_index; |
| 62 | u32 hw_if_index; |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 63 | u16 queue_id; |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 64 | tpacket3_hdr_t tph; |
| 65 | vnet_virtio_net_hdr_t vnet_hdr; |
| 66 | vlib_buffer_t buffer; |
| 67 | } af_packet_tx_trace_t; |
Damjan Marion | c517020 | 2017-10-11 14:15:47 +0200 | [diff] [blame] | 68 | |
Filip Tehlar | aee7364 | 2019-03-13 05:50:44 -0700 | [diff] [blame] | 69 | #ifndef CLIB_MARCH_VARIANT |
Damjan Marion | ceab788 | 2018-01-19 20:56:12 +0100 | [diff] [blame] | 70 | u8 * |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 71 | format_af_packet_device_name (u8 * s, va_list * args) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 72 | { |
| 73 | u32 i = va_arg (*args, u32); |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 74 | af_packet_main_t *apm = &af_packet_main; |
| 75 | af_packet_if_t *apif = pool_elt_at_index (apm->interfaces, i); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 76 | |
| 77 | s = format (s, "host-%s", apif->host_if_name); |
| 78 | return s; |
| 79 | } |
Filip Tehlar | aee7364 | 2019-03-13 05:50:44 -0700 | [diff] [blame] | 80 | #endif /* CLIB_MARCH_VARIANT */ |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 81 | |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 82 | static u8 * |
| 83 | format_af_packet_device (u8 * s, va_list * args) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 84 | { |
Nathan Skrzypczak | ffc6bdc | 2021-02-01 17:13:59 +0100 | [diff] [blame] | 85 | u32 dev_instance = va_arg (*args, u32); |
| 86 | u32 indent = format_get_indent (s); |
| 87 | int __clib_unused verbose = va_arg (*args, int); |
| 88 | |
| 89 | af_packet_main_t *apm = &af_packet_main; |
| 90 | af_packet_if_t *apif = pool_elt_at_index (apm->interfaces, dev_instance); |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 91 | af_packet_queue_t *rx_queue = 0; |
| 92 | af_packet_queue_t *tx_queue = 0; |
Nathan Skrzypczak | ffc6bdc | 2021-02-01 17:13:59 +0100 | [diff] [blame] | 93 | |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 94 | s = format (s, "Linux PACKET socket interface"); |
Mohsin Kazmi | 2b6479c | 2022-04-05 12:03:47 +0000 | [diff] [blame] | 95 | s = format (s, "\n%UFEATURES:", format_white_space, indent); |
| 96 | if (apif->is_qdisc_bypass_enabled) |
| 97 | s = format (s, "\n%Uqdisc-bpass-enabled", format_white_space, indent + 2); |
Nathan Skrzypczak | ffc6bdc | 2021-02-01 17:13:59 +0100 | [diff] [blame] | 98 | |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 99 | vec_foreach (rx_queue, apif->rx_queues) |
Nathan Skrzypczak | ffc6bdc | 2021-02-01 17:13:59 +0100 | [diff] [blame] | 100 | { |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 101 | u32 rx_block_size = rx_queue->rx_req->tp_block_size; |
| 102 | u32 rx_frame_size = rx_queue->rx_req->tp_frame_size; |
| 103 | u32 rx_frame_nr = rx_queue->rx_req->tp_frame_nr; |
| 104 | u32 rx_block_nr = rx_queue->rx_req->tp_block_nr; |
Nathan Skrzypczak | ffc6bdc | 2021-02-01 17:13:59 +0100 | [diff] [blame] | 105 | |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 106 | s = format (s, "\n%URX Queue %u:", format_white_space, indent, |
| 107 | rx_queue->queue_id); |
| 108 | s = format (s, "\n%Ublock size:%d nr:%d frame size:%d nr:%d", |
| 109 | format_white_space, indent + 2, rx_block_size, rx_block_nr, |
| 110 | rx_frame_size, rx_frame_nr); |
| 111 | s = format (s, " next block:%d", rx_queue->next_rx_block); |
| 112 | if (rx_queue->is_rx_pending) |
| 113 | { |
| 114 | s = format ( |
| 115 | s, "\n%UPending Request: num-rx-pkts:%d next-frame-offset:%d", |
| 116 | format_white_space, indent + 2, rx_queue->num_rx_pkts, |
| 117 | rx_queue->rx_frame_offset); |
| 118 | } |
| 119 | } |
| 120 | |
| 121 | vec_foreach (tx_queue, apif->tx_queues) |
| 122 | { |
| 123 | clib_spinlock_lock (&tx_queue->lockp); |
| 124 | u32 tx_block_sz = tx_queue->tx_req->tp_block_size; |
| 125 | u32 tx_frame_sz = tx_queue->tx_req->tp_frame_size; |
| 126 | u32 tx_frame_nr = tx_queue->tx_req->tp_frame_nr; |
| 127 | u32 tx_block_nr = tx_queue->tx_req->tp_block_nr; |
| 128 | int block = 0; |
| 129 | int n_send_req = 0, n_avail = 0, n_sending = 0, n_tot = 0, n_wrong = 0; |
| 130 | u8 *tx_block_start = tx_queue->tx_ring[block]; |
| 131 | u32 tx_frame = tx_queue->next_tx_frame; |
| 132 | tpacket3_hdr_t *tph; |
| 133 | |
| 134 | s = format (s, "\n%UTX Queue %u:", format_white_space, indent, |
| 135 | tx_queue->queue_id); |
| 136 | s = format (s, "\n%Ublock size:%d nr:%d frame size:%d nr:%d", |
| 137 | format_white_space, indent + 2, tx_block_sz, tx_block_nr, |
| 138 | tx_frame_sz, tx_frame_nr); |
| 139 | s = format (s, " next frame:%d", tx_queue->next_tx_frame); |
| 140 | |
| 141 | do |
| 142 | { |
| 143 | tph = (tpacket3_hdr_t *) (tx_block_start + tx_frame * tx_frame_sz); |
| 144 | tx_frame = (tx_frame + 1) % tx_frame_nr; |
| 145 | if (tph->tp_status == 0) |
| 146 | n_avail++; |
| 147 | else if (tph->tp_status & TP_STATUS_SEND_REQUEST) |
| 148 | n_send_req++; |
| 149 | else if (tph->tp_status & TP_STATUS_SENDING) |
| 150 | n_sending++; |
| 151 | else |
| 152 | n_wrong++; |
| 153 | n_tot++; |
| 154 | } |
| 155 | while (tx_frame != tx_queue->next_tx_frame); |
| 156 | s = |
| 157 | format (s, "\n%Uavailable:%d request:%d sending:%d wrong:%d total:%d", |
| 158 | format_white_space, indent + 2, n_avail, n_send_req, n_sending, |
| 159 | n_wrong, n_tot); |
| 160 | clib_spinlock_unlock (&tx_queue->lockp); |
| 161 | } |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 162 | return s; |
| 163 | } |
| 164 | |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 165 | static u8 * |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 166 | format_af_packet_tx_trace (u8 *s, va_list *va) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 167 | { |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 168 | CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *); |
| 169 | CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *); |
| 170 | af_packet_tx_trace_t *t = va_arg (*va, af_packet_tx_trace_t *); |
| 171 | u32 indent = format_get_indent (s); |
| 172 | |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 173 | s = format (s, "af_packet: hw_if_index %u tx-queue %u", t->hw_if_index, |
| 174 | t->queue_id); |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 175 | |
| 176 | s = |
| 177 | format (s, |
| 178 | "\n%Utpacket3_hdr:\n%Ustatus 0x%x len %u snaplen %u mac %u net %u" |
| 179 | "\n%Usec 0x%x nsec 0x%x vlan %U" |
| 180 | #ifdef TP_STATUS_VLAN_TPID_VALID |
| 181 | " vlan_tpid %u" |
| 182 | #endif |
| 183 | , |
| 184 | format_white_space, indent + 2, format_white_space, indent + 4, |
| 185 | t->tph.tp_status, t->tph.tp_len, t->tph.tp_snaplen, t->tph.tp_mac, |
| 186 | t->tph.tp_net, format_white_space, indent + 4, t->tph.tp_sec, |
| 187 | t->tph.tp_nsec, format_ethernet_vlan_tci, t->tph.hv1.tp_vlan_tci |
| 188 | #ifdef TP_STATUS_VLAN_TPID_VALID |
| 189 | , |
| 190 | t->tph.hv1.tp_vlan_tpid |
| 191 | #endif |
| 192 | ); |
| 193 | |
| 194 | s = format (s, |
| 195 | "\n%Uvnet-hdr:\n%Uflags 0x%02x gso_type 0x%02x hdr_len %u" |
| 196 | "\n%Ugso_size %u csum_start %u csum_offset %u", |
| 197 | format_white_space, indent + 2, format_white_space, indent + 4, |
| 198 | t->vnet_hdr.flags, t->vnet_hdr.gso_type, t->vnet_hdr.hdr_len, |
| 199 | format_white_space, indent + 4, t->vnet_hdr.gso_size, |
| 200 | t->vnet_hdr.csum_start, t->vnet_hdr.csum_offset); |
| 201 | |
| 202 | s = format (s, "\n%Ubuffer 0x%x:\n%U%U", format_white_space, indent + 2, |
| 203 | t->buffer_index, format_white_space, indent + 4, |
| 204 | format_vnet_buffer_no_chain, &t->buffer); |
| 205 | s = format (s, "\n%U%U", format_white_space, indent + 2, |
| 206 | format_ethernet_header_with_length, t->buffer.pre_data, |
| 207 | sizeof (t->buffer.pre_data)); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 208 | return s; |
| 209 | } |
| 210 | |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 211 | static void |
| 212 | af_packet_tx_trace (vlib_main_t *vm, vlib_node_runtime_t *node, |
| 213 | vlib_buffer_t *b0, u32 bi, tpacket3_hdr_t *tph, |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 214 | vnet_virtio_net_hdr_t *vnet_hdr, u32 hw_if_index, |
| 215 | u16 queue_id) |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 216 | { |
| 217 | af_packet_tx_trace_t *t; |
| 218 | t = vlib_add_trace (vm, node, b0, sizeof (t[0])); |
| 219 | t->hw_if_index = hw_if_index; |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 220 | t->queue_id = queue_id; |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 221 | t->buffer_index = bi; |
| 222 | |
| 223 | clib_memcpy_fast (&t->tph, tph, sizeof (*tph)); |
| 224 | clib_memcpy_fast (&t->vnet_hdr, vnet_hdr, sizeof (*vnet_hdr)); |
| 225 | clib_memcpy_fast (&t->buffer, b0, sizeof (*b0) - sizeof (b0->pre_data)); |
| 226 | clib_memcpy_fast (t->buffer.pre_data, vlib_buffer_get_current (b0), |
| 227 | sizeof (t->buffer.pre_data)); |
| 228 | } |
| 229 | |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 230 | static_always_inline void |
| 231 | fill_gso_offload (vlib_buffer_t *b0, vnet_virtio_net_hdr_t *vnet_hdr) |
| 232 | { |
| 233 | vnet_buffer_oflags_t oflags = vnet_buffer (b0)->oflags; |
| 234 | if (b0->flags & VNET_BUFFER_F_IS_IP4) |
| 235 | { |
| 236 | ip4_header_t *ip4; |
| 237 | vnet_hdr->gso_type = VIRTIO_NET_HDR_GSO_TCPV4; |
| 238 | vnet_hdr->gso_size = vnet_buffer2 (b0)->gso_size; |
| 239 | vnet_hdr->hdr_len = |
| 240 | vnet_buffer (b0)->l4_hdr_offset + vnet_buffer2 (b0)->gso_l4_hdr_sz; |
| 241 | vnet_hdr->flags = VIRTIO_NET_HDR_F_NEEDS_CSUM; |
| 242 | vnet_hdr->csum_start = vnet_buffer (b0)->l4_hdr_offset; // 0x22; |
| 243 | vnet_hdr->csum_offset = STRUCT_OFFSET_OF (tcp_header_t, checksum); |
| 244 | ip4 = (ip4_header_t *) (vlib_buffer_get_current (b0) + |
| 245 | vnet_buffer (b0)->l3_hdr_offset); |
| 246 | if (oflags & VNET_BUFFER_OFFLOAD_F_IP_CKSUM) |
| 247 | ip4->checksum = ip4_header_checksum (ip4); |
| 248 | } |
| 249 | else if (b0->flags & VNET_BUFFER_F_IS_IP6) |
| 250 | { |
| 251 | vnet_hdr->gso_type = VIRTIO_NET_HDR_GSO_TCPV6; |
| 252 | vnet_hdr->gso_size = vnet_buffer2 (b0)->gso_size; |
| 253 | vnet_hdr->hdr_len = |
| 254 | vnet_buffer (b0)->l4_hdr_offset + vnet_buffer2 (b0)->gso_l4_hdr_sz; |
| 255 | vnet_hdr->flags = VIRTIO_NET_HDR_F_NEEDS_CSUM; |
| 256 | vnet_hdr->csum_start = vnet_buffer (b0)->l4_hdr_offset; // 0x36; |
| 257 | vnet_hdr->csum_offset = STRUCT_OFFSET_OF (tcp_header_t, checksum); |
| 258 | } |
| 259 | } |
| 260 | |
| 261 | static_always_inline void |
| 262 | fill_cksum_offload (vlib_buffer_t *b0, vnet_virtio_net_hdr_t *vnet_hdr) |
| 263 | { |
| 264 | vnet_buffer_oflags_t oflags = vnet_buffer (b0)->oflags; |
| 265 | if (b0->flags & VNET_BUFFER_F_IS_IP4) |
| 266 | { |
| 267 | ip4_header_t *ip4; |
| 268 | ip4 = (ip4_header_t *) (vlib_buffer_get_current (b0) + |
| 269 | vnet_buffer (b0)->l3_hdr_offset); |
| 270 | if (oflags & VNET_BUFFER_OFFLOAD_F_IP_CKSUM) |
| 271 | ip4->checksum = ip4_header_checksum (ip4); |
| 272 | vnet_hdr->flags = VIRTIO_NET_HDR_F_NEEDS_CSUM; |
| 273 | vnet_hdr->csum_start = 0x22; |
| 274 | if (oflags & VNET_BUFFER_OFFLOAD_F_TCP_CKSUM) |
| 275 | { |
| 276 | tcp_header_t *tcp = |
| 277 | (tcp_header_t *) (vlib_buffer_get_current (b0) + |
| 278 | vnet_buffer (b0)->l4_hdr_offset); |
| 279 | tcp->checksum = ip4_pseudo_header_cksum (ip4); |
| 280 | vnet_hdr->csum_offset = STRUCT_OFFSET_OF (tcp_header_t, checksum); |
| 281 | } |
| 282 | else if (oflags & VNET_BUFFER_OFFLOAD_F_UDP_CKSUM) |
| 283 | { |
| 284 | udp_header_t *udp = |
| 285 | (udp_header_t *) (vlib_buffer_get_current (b0) + |
| 286 | vnet_buffer (b0)->l4_hdr_offset); |
| 287 | udp->checksum = ip4_pseudo_header_cksum (ip4); |
| 288 | vnet_hdr->csum_offset = STRUCT_OFFSET_OF (udp_header_t, checksum); |
| 289 | } |
| 290 | } |
| 291 | else if (b0->flags & VNET_BUFFER_F_IS_IP6) |
| 292 | { |
| 293 | ip6_header_t *ip6; |
| 294 | vnet_hdr->flags = VIRTIO_NET_HDR_F_NEEDS_CSUM; |
| 295 | vnet_hdr->csum_start = 0x36; |
| 296 | ip6 = (ip6_header_t *) (vlib_buffer_get_current (b0) + |
| 297 | vnet_buffer (b0)->l3_hdr_offset); |
| 298 | if (oflags & VNET_BUFFER_OFFLOAD_F_TCP_CKSUM) |
| 299 | { |
| 300 | tcp_header_t *tcp = |
| 301 | (tcp_header_t *) (vlib_buffer_get_current (b0) + |
| 302 | vnet_buffer (b0)->l4_hdr_offset); |
| 303 | tcp->checksum = ip6_pseudo_header_cksum (ip6); |
| 304 | vnet_hdr->csum_offset = STRUCT_OFFSET_OF (tcp_header_t, checksum); |
| 305 | } |
| 306 | else if (oflags & VNET_BUFFER_OFFLOAD_F_UDP_CKSUM) |
| 307 | { |
| 308 | udp_header_t *udp = |
| 309 | (udp_header_t *) (vlib_buffer_get_current (b0) + |
| 310 | vnet_buffer (b0)->l4_hdr_offset); |
| 311 | udp->checksum = ip6_pseudo_header_cksum (ip6); |
| 312 | vnet_hdr->csum_offset = STRUCT_OFFSET_OF (udp_header_t, checksum); |
| 313 | } |
| 314 | } |
| 315 | } |
| 316 | |
Filip Tehlar | aee7364 | 2019-03-13 05:50:44 -0700 | [diff] [blame] | 317 | VNET_DEVICE_CLASS_TX_FN (af_packet_device_class) (vlib_main_t * vm, |
| 318 | vlib_node_runtime_t * node, |
| 319 | vlib_frame_t * frame) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 320 | { |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 321 | af_packet_main_t *apm = &af_packet_main; |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 322 | vnet_hw_if_tx_frame_t *tf = vlib_frame_scalar_args (frame); |
Damjan Marion | a3d5986 | 2018-11-10 10:23:00 +0100 | [diff] [blame] | 323 | u32 *buffers = vlib_frame_vector_args (frame); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 324 | u32 n_left = frame->n_vectors; |
| 325 | u32 n_sent = 0; |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 326 | vnet_interface_output_runtime_t *rd = (void *) node->runtime_data; |
| 327 | af_packet_if_t *apif = |
| 328 | pool_elt_at_index (apm->interfaces, rd->dev_instance); |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 329 | u16 queue_id = tf->queue_id; |
| 330 | af_packet_queue_t *tx_queue = vec_elt_at_index (apif->tx_queues, queue_id); |
| 331 | u32 block = 0, frame_size = 0, frame_num = 0, tx_frame = 0; |
| 332 | u8 *block_start = 0; |
| 333 | tpacket3_hdr_t *tph = 0; |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 334 | u32 frame_not_ready = 0; |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 335 | u8 is_cksum_gso_enabled = (apif->is_cksum_gso_enabled == 1) ? 1 : 0; |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 336 | |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 337 | if (tf->shared_queue) |
| 338 | clib_spinlock_lock (&tx_queue->lockp); |
| 339 | |
| 340 | frame_size = tx_queue->tx_req->tp_frame_size; |
| 341 | frame_num = tx_queue->tx_req->tp_frame_nr; |
| 342 | block_start = tx_queue->tx_ring[block]; |
| 343 | tx_frame = tx_queue->next_tx_frame; |
| 344 | |
Nathan Skrzypczak | ffc6bdc | 2021-02-01 17:13:59 +0100 | [diff] [blame] | 345 | while (n_left) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 346 | { |
| 347 | u32 len; |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 348 | vnet_virtio_net_hdr_t *vnet_hdr = 0; |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 349 | u32 offset = 0; |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 350 | vlib_buffer_t *b0 = 0, *b0_first = 0; |
| 351 | u32 bi, bi_first; |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 352 | |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 353 | bi = bi_first = buffers[0]; |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 354 | n_left--; |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 355 | buffers++; |
| 356 | |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 357 | tph = (tpacket3_hdr_t *) (block_start + tx_frame * frame_size); |
Nathan Skrzypczak | ffc6bdc | 2021-02-01 17:13:59 +0100 | [diff] [blame] | 358 | if (PREDICT_FALSE (tph->tp_status & |
| 359 | (TP_STATUS_SEND_REQUEST | TP_STATUS_SENDING))) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 360 | { |
| 361 | frame_not_ready++; |
Mohammed Hawari | eed6fc9 | 2021-09-06 11:48:17 +0200 | [diff] [blame] | 362 | goto next; |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 363 | } |
| 364 | |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 365 | b0_first = b0 = vlib_get_buffer (vm, bi); |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 366 | |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 367 | if (PREDICT_TRUE (is_cksum_gso_enabled)) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 368 | { |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 369 | vnet_hdr = |
| 370 | (vnet_virtio_net_hdr_t *) ((u8 *) tph + TPACKET_ALIGN (sizeof ( |
| 371 | tpacket3_hdr_t))); |
| 372 | |
| 373 | clib_memset_u8 (vnet_hdr, 0, sizeof (vnet_virtio_net_hdr_t)); |
| 374 | offset = sizeof (vnet_virtio_net_hdr_t); |
| 375 | |
| 376 | if (b0->flags & VNET_BUFFER_F_GSO) |
| 377 | fill_gso_offload (b0, vnet_hdr); |
| 378 | else if (b0->flags & VNET_BUFFER_F_OFFLOAD) |
| 379 | fill_cksum_offload (b0, vnet_hdr); |
| 380 | } |
| 381 | |
| 382 | len = b0->current_length; |
| 383 | clib_memcpy_fast ((u8 *) tph + TPACKET_ALIGN (sizeof (tpacket3_hdr_t)) + |
| 384 | offset, |
| 385 | vlib_buffer_get_current (b0), len); |
| 386 | offset += len; |
| 387 | |
| 388 | while (b0->flags & VLIB_BUFFER_NEXT_PRESENT) |
| 389 | { |
| 390 | b0 = vlib_get_buffer (vm, b0->next_buffer); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 391 | len = b0->current_length; |
Mohsin Kazmi | c1fd17b | 2022-03-22 21:40:04 +0000 | [diff] [blame] | 392 | clib_memcpy_fast ((u8 *) tph + |
| 393 | TPACKET_ALIGN (sizeof (tpacket3_hdr_t)) + offset, |
| 394 | vlib_buffer_get_current (b0), len); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 395 | offset += len; |
| 396 | } |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 397 | |
| 398 | tph->tp_len = tph->tp_snaplen = offset; |
| 399 | tph->tp_status = TP_STATUS_SEND_REQUEST; |
| 400 | n_sent++; |
Nathan Skrzypczak | ffc6bdc | 2021-02-01 17:13:59 +0100 | [diff] [blame] | 401 | |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 402 | if (PREDICT_FALSE (b0_first->flags & VLIB_BUFFER_IS_TRACED)) |
| 403 | { |
| 404 | if (PREDICT_TRUE (is_cksum_gso_enabled)) |
| 405 | af_packet_tx_trace (vm, node, b0_first, bi_first, tph, vnet_hdr, |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 406 | apif->hw_if_index, queue_id); |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 407 | else |
| 408 | { |
| 409 | vnet_virtio_net_hdr_t vnet_hdr2 = {}; |
| 410 | af_packet_tx_trace (vm, node, b0_first, bi_first, tph, |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 411 | &vnet_hdr2, apif->hw_if_index, queue_id); |
Mohsin Kazmi | 9deb2ec | 2022-03-22 23:17:46 +0000 | [diff] [blame] | 412 | } |
| 413 | } |
Florin Coras | 837503c | 2017-11-28 11:59:20 -0800 | [diff] [blame] | 414 | tx_frame = (tx_frame + 1) % frame_num; |
| 415 | |
Mohammed Hawari | eed6fc9 | 2021-09-06 11:48:17 +0200 | [diff] [blame] | 416 | next: |
Chris Luke | 4b46c84 | 2016-05-23 21:30:26 -0400 | [diff] [blame] | 417 | /* check if we've exhausted the ring */ |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 418 | if (PREDICT_FALSE (frame_not_ready + n_sent == frame_num)) |
| 419 | break; |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 420 | } |
| 421 | |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 422 | CLIB_MEMORY_BARRIER (); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 423 | |
Nathan Skrzypczak | ffc6bdc | 2021-02-01 17:13:59 +0100 | [diff] [blame] | 424 | if (PREDICT_TRUE (n_sent)) |
Mohammed Hawari | eed6fc9 | 2021-09-06 11:48:17 +0200 | [diff] [blame] | 425 | { |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 426 | tx_queue->next_tx_frame = tx_frame; |
Mohammed Hawari | eed6fc9 | 2021-09-06 11:48:17 +0200 | [diff] [blame] | 427 | |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 428 | if (PREDICT_FALSE ( |
| 429 | sendto (tx_queue->fd, NULL, 0, MSG_DONTWAIT, NULL, 0) == -1)) |
Mohammed Hawari | eed6fc9 | 2021-09-06 11:48:17 +0200 | [diff] [blame] | 430 | { |
| 431 | /* Uh-oh, drop & move on, but count whether it was fatal or not. |
| 432 | * Note that we have no reliable way to properly determine the |
| 433 | * disposition of the packets we just enqueued for delivery. |
| 434 | */ |
| 435 | vlib_error_count (vm, node->node_index, |
| 436 | unix_error_is_fatal (errno) ? |
| 437 | AF_PACKET_TX_ERROR_TXRING_FATAL : |
| 438 | AF_PACKET_TX_ERROR_TXRING_EAGAIN, |
| 439 | n_sent); |
| 440 | } |
| 441 | } |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 442 | |
Mohsin Kazmi | 5a7aa51 | 2022-03-25 14:27:45 +0000 | [diff] [blame] | 443 | if (tf->shared_queue) |
| 444 | clib_spinlock_unlock (&tx_queue->lockp); |
Mohsin KAZMI | cf751ec | 2017-01-18 11:59:45 +0100 | [diff] [blame] | 445 | |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 446 | if (PREDICT_FALSE (frame_not_ready)) |
| 447 | vlib_error_count (vm, node->node_index, |
| 448 | AF_PACKET_TX_ERROR_FRAME_NOT_READY, frame_not_ready); |
Chris Luke | 4b46c84 | 2016-05-23 21:30:26 -0400 | [diff] [blame] | 449 | |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 450 | if (PREDICT_FALSE (frame_not_ready + n_sent == frame_num)) |
Chris Luke | 4b46c84 | 2016-05-23 21:30:26 -0400 | [diff] [blame] | 451 | vlib_error_count (vm, node->node_index, AF_PACKET_TX_ERROR_TXRING_OVERRUN, |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 452 | n_left); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 453 | |
Damjan Marion | a3d5986 | 2018-11-10 10:23:00 +0100 | [diff] [blame] | 454 | vlib_buffer_free (vm, vlib_frame_vector_args (frame), frame->n_vectors); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 455 | return frame->n_vectors; |
| 456 | } |
| 457 | |
| 458 | static void |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 459 | af_packet_set_interface_next_node (vnet_main_t * vnm, u32 hw_if_index, |
| 460 | u32 node_index) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 461 | { |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 462 | af_packet_main_t *apm = &af_packet_main; |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 463 | vnet_hw_interface_t *hw = vnet_get_hw_interface (vnm, hw_if_index); |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 464 | af_packet_if_t *apif = |
| 465 | pool_elt_at_index (apm->interfaces, hw->dev_instance); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 466 | |
| 467 | /* Shut off redirection */ |
| 468 | if (node_index == ~0) |
| 469 | { |
| 470 | apif->per_interface_next_index = node_index; |
| 471 | return; |
| 472 | } |
| 473 | |
| 474 | apif->per_interface_next_index = |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 475 | vlib_node_add_next (vlib_get_main (), af_packet_input_node.index, |
| 476 | node_index); |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 477 | } |
| 478 | |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 479 | static void |
| 480 | af_packet_clear_hw_interface_counters (u32 instance) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 481 | { |
| 482 | /* Nothing for now */ |
| 483 | } |
| 484 | |
| 485 | static clib_error_t * |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 486 | af_packet_interface_admin_up_down (vnet_main_t * vnm, u32 hw_if_index, |
| 487 | u32 flags) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 488 | { |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 489 | af_packet_main_t *apm = &af_packet_main; |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 490 | vnet_hw_interface_t *hw = vnet_get_hw_interface (vnm, hw_if_index); |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 491 | af_packet_if_t *apif = |
| 492 | pool_elt_at_index (apm->interfaces, hw->dev_instance); |
Alpesh Patel | 83cc4e1 | 2016-04-05 12:49:30 -0700 | [diff] [blame] | 493 | u32 hw_flags; |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 494 | int rv, fd = socket (AF_UNIX, SOCK_DGRAM, 0); |
| 495 | struct ifreq ifr; |
| 496 | |
Ray Kinsella | e6cc9cc | 2017-05-20 13:42:30 +0100 | [diff] [blame] | 497 | if (0 > fd) |
| 498 | { |
Mohsin Kazmi | acba9f7 | 2018-05-17 15:42:27 +0200 | [diff] [blame] | 499 | vlib_log_warn (apm->log_class, "af_packet_%s could not open socket", |
| 500 | apif->host_if_name); |
Ray Kinsella | e6cc9cc | 2017-05-20 13:42:30 +0100 | [diff] [blame] | 501 | return 0; |
| 502 | } |
| 503 | |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 504 | /* if interface is a bridge ignore */ |
| 505 | if (apif->host_if_index < 0) |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 506 | goto error; /* no error */ |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 507 | |
| 508 | /* use host_if_index in case host name has changed */ |
| 509 | ifr.ifr_ifindex = apif->host_if_index; |
| 510 | if ((rv = ioctl (fd, SIOCGIFNAME, &ifr)) < 0) |
| 511 | { |
Mohsin Kazmi | acba9f7 | 2018-05-17 15:42:27 +0200 | [diff] [blame] | 512 | vlib_log_warn (apm->log_class, |
| 513 | "af_packet_%s ioctl could not retrieve eth name", |
| 514 | apif->host_if_name); |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 515 | goto error; |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 516 | } |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 517 | |
| 518 | apif->is_admin_up = (flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) != 0; |
| 519 | |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 520 | if ((rv = ioctl (fd, SIOCGIFFLAGS, &ifr)) < 0) |
| 521 | { |
Mohsin Kazmi | acba9f7 | 2018-05-17 15:42:27 +0200 | [diff] [blame] | 522 | vlib_log_warn (apm->log_class, "af_packet_%s error: %d", |
| 523 | apif->is_admin_up ? "up" : "down", rv); |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 524 | goto error; |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 525 | } |
| 526 | |
Alpesh Patel | 83cc4e1 | 2016-04-05 12:49:30 -0700 | [diff] [blame] | 527 | if (apif->is_admin_up) |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 528 | { |
| 529 | hw_flags = VNET_HW_INTERFACE_FLAG_LINK_UP; |
| 530 | ifr.ifr_flags |= IFF_UP; |
| 531 | } |
Alpesh Patel | 83cc4e1 | 2016-04-05 12:49:30 -0700 | [diff] [blame] | 532 | else |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 533 | { |
| 534 | hw_flags = 0; |
| 535 | ifr.ifr_flags &= ~IFF_UP; |
| 536 | } |
| 537 | |
| 538 | if ((rv = ioctl (fd, SIOCSIFFLAGS, &ifr)) < 0) |
| 539 | { |
Mohsin Kazmi | acba9f7 | 2018-05-17 15:42:27 +0200 | [diff] [blame] | 540 | vlib_log_warn (apm->log_class, "af_packet_%s error: %d", |
| 541 | apif->is_admin_up ? "up" : "down", rv); |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 542 | goto error; |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 543 | } |
Alpesh Patel | 83cc4e1 | 2016-04-05 12:49:30 -0700 | [diff] [blame] | 544 | |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 545 | vnet_hw_interface_set_flags (vnm, hw_if_index, hw_flags); |
Alpesh Patel | 83cc4e1 | 2016-04-05 12:49:30 -0700 | [diff] [blame] | 546 | |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 547 | error: |
Ray Kinsella | e6cc9cc | 2017-05-20 13:42:30 +0100 | [diff] [blame] | 548 | if (0 <= fd) |
| 549 | close (fd); |
Ray Kinsella | c855b73 | 2017-04-21 12:24:43 +0100 | [diff] [blame] | 550 | |
| 551 | return 0; /* no error */ |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 552 | } |
| 553 | |
| 554 | static clib_error_t * |
| 555 | af_packet_subif_add_del_function (vnet_main_t * vnm, |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 556 | u32 hw_if_index, |
| 557 | struct vnet_sw_interface_t *st, int is_add) |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 558 | { |
| 559 | /* Nothing for now */ |
| 560 | return 0; |
| 561 | } |
| 562 | |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 563 | static clib_error_t *af_packet_set_mac_address_function |
Neale Ranns | 3b81a1e | 2018-09-06 09:50:26 -0700 | [diff] [blame] | 564 | (struct vnet_hw_interface_t *hi, const u8 * old_address, const u8 * address) |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 565 | { |
| 566 | af_packet_main_t *apm = &af_packet_main; |
| 567 | af_packet_if_t *apif = |
| 568 | pool_elt_at_index (apm->interfaces, hi->dev_instance); |
Klement Sekera | c3225dd | 2021-10-26 16:19:45 +0200 | [diff] [blame] | 569 | int rv, fd; |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 570 | struct ifreq ifr; |
| 571 | |
Mohsin Kazmi | cae84fa | 2021-10-08 15:10:49 +0000 | [diff] [blame] | 572 | if (apif->mode == AF_PACKET_IF_MODE_IP) |
| 573 | { |
| 574 | vlib_log_warn (apm->log_class, "af_packet_%s interface is in IP mode", |
| 575 | apif->host_if_name); |
| 576 | return clib_error_return (0, |
| 577 | " MAC update failed, interface is in IP mode"); |
| 578 | } |
| 579 | |
Klement Sekera | c3225dd | 2021-10-26 16:19:45 +0200 | [diff] [blame] | 580 | fd = socket (AF_UNIX, SOCK_DGRAM, 0); |
Ray Kinsella | e6cc9cc | 2017-05-20 13:42:30 +0100 | [diff] [blame] | 581 | if (0 > fd) |
| 582 | { |
Mohsin Kazmi | acba9f7 | 2018-05-17 15:42:27 +0200 | [diff] [blame] | 583 | vlib_log_warn (apm->log_class, "af_packet_%s could not open socket", |
| 584 | apif->host_if_name); |
Ray Kinsella | e6cc9cc | 2017-05-20 13:42:30 +0100 | [diff] [blame] | 585 | return 0; |
| 586 | } |
| 587 | |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 588 | /* if interface is a bridge ignore */ |
| 589 | if (apif->host_if_index < 0) |
| 590 | goto error; /* no error */ |
| 591 | |
| 592 | /* use host_if_index in case host name has changed */ |
| 593 | ifr.ifr_ifindex = apif->host_if_index; |
| 594 | if ((rv = ioctl (fd, SIOCGIFNAME, &ifr)) < 0) |
| 595 | { |
Mohsin Kazmi | acba9f7 | 2018-05-17 15:42:27 +0200 | [diff] [blame] | 596 | vlib_log_warn |
| 597 | (apm->log_class, |
| 598 | "af_packet_%s ioctl could not retrieve eth name, error: %d", |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 599 | apif->host_if_name, rv); |
| 600 | goto error; |
| 601 | } |
| 602 | |
| 603 | clib_memcpy (ifr.ifr_hwaddr.sa_data, address, 6); |
| 604 | ifr.ifr_hwaddr.sa_family = ARPHRD_ETHER; |
| 605 | |
| 606 | if ((rv = ioctl (fd, SIOCSIFHWADDR, &ifr)) < 0) |
| 607 | { |
Mohsin Kazmi | acba9f7 | 2018-05-17 15:42:27 +0200 | [diff] [blame] | 608 | vlib_log_warn (apm->log_class, |
| 609 | "af_packet_%s ioctl could not set mac, error: %d", |
| 610 | apif->host_if_name, rv); |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 611 | goto error; |
| 612 | } |
| 613 | |
| 614 | error: |
Ray Kinsella | e6cc9cc | 2017-05-20 13:42:30 +0100 | [diff] [blame] | 615 | |
| 616 | if (0 <= fd) |
| 617 | close (fd); |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 618 | |
| 619 | return 0; /* no error */ |
| 620 | } |
| 621 | |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 622 | VNET_DEVICE_CLASS (af_packet_device_class) = { |
| 623 | .name = "af-packet", |
Damjan Marion | 83243a0 | 2016-02-29 13:09:30 +0100 | [diff] [blame] | 624 | .format_device_name = format_af_packet_device_name, |
| 625 | .format_device = format_af_packet_device, |
| 626 | .format_tx_trace = format_af_packet_tx_trace, |
| 627 | .tx_function_n_errors = AF_PACKET_TX_N_ERROR, |
| 628 | .tx_function_error_strings = af_packet_tx_func_error_strings, |
| 629 | .rx_redirect_to_node = af_packet_set_interface_next_node, |
| 630 | .clear_counters = af_packet_clear_hw_interface_counters, |
| 631 | .admin_up_down_function = af_packet_interface_admin_up_down, |
| 632 | .subif_add_del_function = af_packet_subif_add_del_function, |
Ray Kinsella | 2038ad0 | 2017-05-18 11:56:28 +0100 | [diff] [blame] | 633 | .mac_addr_change_function = af_packet_set_mac_address_function, |
Alpesh Patel | 83cc4e1 | 2016-04-05 12:49:30 -0700 | [diff] [blame] | 634 | }; |
Damjan Marion | 00a9dca | 2016-08-17 17:05:46 +0200 | [diff] [blame] | 635 | |
| 636 | /* |
| 637 | * fd.io coding-style-patch-verification: ON |
| 638 | * |
| 639 | * Local Variables: |
| 640 | * eval: (c-set-style "gnu") |
| 641 | * End: |
| 642 | */ |