/* * Copyright (c) 2018 Cisco and/or its affiliates. * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at: * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ #include #include #include #include /** * per-interface vector of which MAP is used by which interface * for each output source */ index_t *qos_mark_configs[QOS_N_SOURCES]; void qos_mark_ip_enable_disable (u32 sw_if_index, u8 enable) { vnet_feature_enable_disable ("ip6-output", "ip6-qos-mark", sw_if_index, enable, NULL, 0); vnet_feature_enable_disable ("ip4-output", "ip4-qos-mark", sw_if_index, enable, NULL, 0); } void qos_mark_vlan_enable_disable (u32 sw_if_index, u8 enable) { /* * one cannot run a feature on a sub-interface, so we need * to enable a feature on all the L3 output paths */ vnet_feature_enable_disable ("ip6-output", "vlan-ip6-qos-mark", sw_if_index, enable, NULL, 0); vnet_feature_enable_disable ("ip4-output", "vlan-ip4-qos-mark", sw_if_index, enable, NULL, 0); vnet_feature_enable_disable ("mpls-output", "vlan-mpls-qos-mark", sw_if_index, enable, NULL, 0); } void qos_mark_mpls_enable_disable (u32 sw_if_index, u8 enable) { vnet_feature_enable_disable ("mpls-output", "mpls-qos-mark", sw_if_index, enable, NULL, 0); } static void qos_egress_map_feature_config (u32 sw_if_index, qos_source_t qs, u8 enable) { switch (qs) { case QOS_SOURCE_EXT: ASSERT (0); break; case QOS_SOURCE_VLAN: qos_mark_vlan_enable_disable (sw_if_index, enable); break; case QOS_SOURCE_MPLS: qos_mark_mpls_enable_disable (sw_if_index, enable); break; case QOS_SOURCE_IP: qos_mark_ip_enable_disable (sw_if_index, enable); break; } } always_inline qos_egress_map_t * qos_egress_map_interface (u32 sw_if_index, qos_source_t output_source) { ASSERT (vec_len (qos_mark_configs[output_source]) > sw_if_index); return pool_elt_at_index (qem_pool, qos_mark_configs[output_source][sw_if_index]); } /** * per-packet trace data */ typedef struct qos_mark_trace_t_ { /* per-pkt trace data */ qos_bits_t bits; qos_source_t input; u32 used; } qos_mark_trace_t; static inline uword qos_mark_inline (vlib_main_t * vm, vlib_node_runtime_t * node, vlib_frame_t * frame, qos_source_t output_source, int is_ip6) { u32 n_left_from, *from, *to_next, next_index; next_index = 0; n_left_from = frame->n_vectors; from = vlib_frame_vector_args (frame); while (n_left_from > 0) { u32 n_left_to_next; vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next); while (n_left_from > 0 && n_left_to_next > 0) { qos_source_t input_source0; ethernet_vlan_header_t *vlan0; u32 sw_if_index0, next0, bi0; qos_egress_map_t *qem0; ip4_header_t *ip4_0; ip6_header_t *ip6_0; vlib_buffer_t *b0; qos_bits_t qos0; u8 *mpls_bytes_0; u8 eos0; next0 = 0; bi0 = from[0]; to_next[0] = bi0; from += 1; to_next += 1; n_left_from -= 1; n_left_to_next -= 1; b0 = vlib_get_buffer (vm, bi0); sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_TX]; input_source0 = vnet_buffer2 (b0)->qos.source; qem0 = qos_egress_map_interface (sw_if_index0, output_source); qos0 = qem0->qem_output[input_source0][vnet_buffer2 (b0)->qos.bits]; if (PREDICT_TRUE (b0->flags & VNET_BUFFER_F_QOS_DATA_VALID)) { /* there is a source of QoS recording for this packet */ if (QOS_SOURCE_IP == output_source) { if (is_ip6) { ip6_0 = (vlib_buffer_get_current (b0) + vnet_buffer (b0)->ip.save_rewrite_length); ip6_set_traffic_class_network_order (ip6_0, qos0); } else { ip4_0 = (vlib_buffer_get_current (b0) + vnet_buffer (b0)->ip.save_rewrite_length); if (PREDICT_FALSE (qos0 != ip4_0->tos)) { ip4_0->tos = qos0; ip4_0->checksum = ip4_header_checksum (ip4_0); } } } else if (QOS_SOURCE_MPLS == output_source) { mpls_bytes_0 = (vlib_buffer_get_current (b0) + vnet_buffer (b0)->mpls.save_rewrite_length); /* apply to all the labels in the stack */ do { /* clear out the old COS bts */ mpls_bytes_0[2] &= 0xf1; /* OR in 3 bits of the mapped value */ mpls_bytes_0[2] |= (qos0 & 0x7) << 1; eos0 = mpls_bytes_0[2] & 0x1; mpls_bytes_0 += 4; } while (!eos0); } else if (QOS_SOURCE_VLAN == output_source) { vlan0 = (vlib_buffer_get_current (b0) + sizeof (ethernet_header_t));