| // SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) |
| /* Copyright (C) 2017-2018 Netronome Systems, Inc. */ |
| |
| #include <linux/bitfield.h> |
| #include <net/pkt_cls.h> |
| |
| #include "cmsg.h" |
| #include "main.h" |
| |
| static void |
| nfp_flower_compile_meta_tci(struct nfp_flower_meta_tci *ext, |
| struct nfp_flower_meta_tci *msk, |
| struct flow_rule *rule, u8 key_type, bool qinq_sup) |
| { |
| u16 tmp_tci; |
| |
| memset(ext, 0, sizeof(struct nfp_flower_meta_tci)); |
| memset(msk, 0, sizeof(struct nfp_flower_meta_tci)); |
| |
| /* Populate the metadata frame. */ |
| ext->nfp_flow_key_layer = key_type; |
| ext->mask_id = ~0; |
| |
| msk->nfp_flow_key_layer = key_type; |
| msk->mask_id = ~0; |
| |
| if (!qinq_sup && flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN)) { |
| struct flow_match_vlan match; |
| |
| flow_rule_match_vlan(rule, &match); |
| /* Populate the tci field. */ |
| tmp_tci = NFP_FLOWER_MASK_VLAN_PRESENT; |
| tmp_tci |= FIELD_PREP(NFP_FLOWER_MASK_VLAN_PRIO, |
| match.key->vlan_priority) | |
| FIELD_PREP(NFP_FLOWER_MASK_VLAN_VID, |
| match.key->vlan_id); |
| ext->tci = cpu_to_be16(tmp_tci); |
| |
| tmp_tci = NFP_FLOWER_MASK_VLAN_PRESENT; |
| tmp_tci |= FIELD_PREP(NFP_FLOWER_MASK_VLAN_PRIO, |
| match.mask->vlan_priority) | |
| FIELD_PREP(NFP_FLOWER_MASK_VLAN_VID, |
| match.mask->vlan_id); |
| msk->tci = cpu_to_be16(tmp_tci); |
| } |
| } |
| |
| static void |
| nfp_flower_compile_ext_meta(struct nfp_flower_ext_meta *frame, u32 key_ext) |
| { |
| frame->nfp_flow_key_layer2 = cpu_to_be32(key_ext); |
| } |
| |
| static int |
| nfp_flower_compile_port(struct nfp_flower_in_port *frame, u32 cmsg_port, |
| bool mask_version, enum nfp_flower_tun_type tun_type, |
| struct netlink_ext_ack *extack) |
| { |
| if (mask_version) { |
| frame->in_port = cpu_to_be32(~0); |
| return 0; |
| } |
| |
| if (tun_type) { |
| frame->in_port = cpu_to_be32(NFP_FL_PORT_TYPE_TUN | tun_type); |
| } else { |
| if (!cmsg_port) { |
| NL_SET_ERR_MSG_MOD(extack, "unsupported offload: invalid ingress interface for match offload"); |
| return -EOPNOTSUPP; |
| } |
| frame->in_port = cpu_to_be32(cmsg_port); |
| } |
| |
| return 0; |
| } |
| |
| static int |
| nfp_flower_compile_mac(struct nfp_flower_mac_mpls *ext, |
| struct nfp_flower_mac_mpls *msk, struct flow_rule *rule, |
| struct netlink_ext_ack *extack) |
| { |
| memset(ext, 0, sizeof(struct nfp_flower_mac_mpls)); |
| memset(msk, 0, sizeof(struct nfp_flower_mac_mpls)); |
| |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS)) { |
| struct flow_match_eth_addrs match; |
| |
| flow_rule_match_eth_addrs(rule, &match); |
| /* Populate mac frame. */ |
| ether_addr_copy(ext->mac_dst, &match.key->dst[0]); |
| ether_addr_copy(ext->mac_src, &match.key->src[0]); |
| ether_addr_copy(msk->mac_dst, &match.mask->dst[0]); |
| ether_addr_copy(msk->mac_src, &match.mask->src[0]); |
| } |
| |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_MPLS)) { |
| struct flow_match_mpls match; |
| u32 t_mpls; |
| |
| flow_rule_match_mpls(rule, &match); |
| |
| /* Only support matching the first LSE */ |
| if (match.mask->used_lses != 1) { |
| NL_SET_ERR_MSG_MOD(extack, |
| "unsupported offload: invalid LSE depth for MPLS match offload"); |
| return -EOPNOTSUPP; |
| } |
| |
| t_mpls = FIELD_PREP(NFP_FLOWER_MASK_MPLS_LB, |
| match.key->ls[0].mpls_label) | |
| FIELD_PREP(NFP_FLOWER_MASK_MPLS_TC, |
| match.key->ls[0].mpls_tc) | |
| FIELD_PREP(NFP_FLOWER_MASK_MPLS_BOS, |
| match.key->ls[0].mpls_bos) | |
| NFP_FLOWER_MASK_MPLS_Q; |
| ext->mpls_lse = cpu_to_be32(t_mpls); |
| t_mpls = FIELD_PREP(NFP_FLOWER_MASK_MPLS_LB, |
| match.mask->ls[0].mpls_label) | |
| FIELD_PREP(NFP_FLOWER_MASK_MPLS_TC, |
| match.mask->ls[0].mpls_tc) | |
| FIELD_PREP(NFP_FLOWER_MASK_MPLS_BOS, |
| match.mask->ls[0].mpls_bos) | |
| NFP_FLOWER_MASK_MPLS_Q; |
| msk->mpls_lse = cpu_to_be32(t_mpls); |
| } else if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { |
| /* Check for mpls ether type and set NFP_FLOWER_MASK_MPLS_Q |
| * bit, which indicates an mpls ether type but without any |
| * mpls fields. |
| */ |
| struct flow_match_basic match; |
| |
| flow_rule_match_basic(rule, &match); |
| if (match.key->n_proto == cpu_to_be16(ETH_P_MPLS_UC) || |
| match.key->n_proto == cpu_to_be16(ETH_P_MPLS_MC)) { |
| ext->mpls_lse = cpu_to_be32(NFP_FLOWER_MASK_MPLS_Q); |
| msk->mpls_lse = cpu_to_be32(NFP_FLOWER_MASK_MPLS_Q); |
| } |
| } |
| |
| return 0; |
| } |
| |
| static void |
| nfp_flower_compile_tport(struct nfp_flower_tp_ports *ext, |
| struct nfp_flower_tp_ports *msk, |
| struct flow_rule *rule) |
| { |
| memset(ext, 0, sizeof(struct nfp_flower_tp_ports)); |
| memset(msk, 0, sizeof(struct nfp_flower_tp_ports)); |
| |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_PORTS)) { |
| struct flow_match_ports match; |
| |
| flow_rule_match_ports(rule, &match); |
| ext->port_src = match.key->src; |
| ext->port_dst = match.key->dst; |
| msk->port_src = match.mask->src; |
| msk->port_dst = match.mask->dst; |
| } |
| } |
| |
| static void |
| nfp_flower_compile_ip_ext(struct nfp_flower_ip_ext *ext, |
| struct nfp_flower_ip_ext *msk, struct flow_rule *rule) |
| { |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_BASIC)) { |
| struct flow_match_basic match; |
| |
| flow_rule_match_basic(rule, &match); |
| ext->proto = match.key->ip_proto; |
| msk->proto = match.mask->ip_proto; |
| } |
| |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IP)) { |
| struct flow_match_ip match; |
| |
| flow_rule_match_ip(rule, &match); |
| ext->tos = match.key->tos; |
| ext->ttl = match.key->ttl; |
| msk->tos = match.mask->tos; |
| msk->ttl = match.mask->ttl; |
| } |
| |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_TCP)) { |
| u16 tcp_flags, tcp_flags_mask; |
| struct flow_match_tcp match; |
| |
| flow_rule_match_tcp(rule, &match); |
| tcp_flags = be16_to_cpu(match.key->flags); |
| tcp_flags_mask = be16_to_cpu(match.mask->flags); |
| |
| if (tcp_flags & TCPHDR_FIN) |
| ext->flags |= NFP_FL_TCP_FLAG_FIN; |
| if (tcp_flags_mask & TCPHDR_FIN) |
| msk->flags |= NFP_FL_TCP_FLAG_FIN; |
| |
| if (tcp_flags & TCPHDR_SYN) |
| ext->flags |= NFP_FL_TCP_FLAG_SYN; |
| if (tcp_flags_mask & TCPHDR_SYN) |
| msk->flags |= NFP_FL_TCP_FLAG_SYN; |
| |
| if (tcp_flags & TCPHDR_RST) |
| ext->flags |= NFP_FL_TCP_FLAG_RST; |
| if (tcp_flags_mask & TCPHDR_RST) |
| msk->flags |= NFP_FL_TCP_FLAG_RST; |
| |
| if (tcp_flags & TCPHDR_PSH) |
| ext->flags |= NFP_FL_TCP_FLAG_PSH; |
| if (tcp_flags_mask & TCPHDR_PSH) |
| msk->flags |= NFP_FL_TCP_FLAG_PSH; |
| |
| if (tcp_flags & TCPHDR_URG) |
| ext->flags |= NFP_FL_TCP_FLAG_URG; |
| if (tcp_flags_mask & TCPHDR_URG) |
| msk->flags |= NFP_FL_TCP_FLAG_URG; |
| } |
| |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CONTROL)) { |
| struct flow_match_control match; |
| |
| flow_rule_match_control(rule, &match); |
| if (match.key->flags & FLOW_DIS_IS_FRAGMENT) |
| ext->flags |= NFP_FL_IP_FRAGMENTED; |
| if (match.mask->flags & FLOW_DIS_IS_FRAGMENT) |
| msk->flags |= NFP_FL_IP_FRAGMENTED; |
| if (match.key->flags & FLOW_DIS_FIRST_FRAG) |
| ext->flags |= NFP_FL_IP_FRAG_FIRST; |
| if (match.mask->flags & FLOW_DIS_FIRST_FRAG) |
| msk->flags |= NFP_FL_IP_FRAG_FIRST; |
| } |
| } |
| |
| static void |
| nfp_flower_fill_vlan(struct flow_dissector_key_vlan *key, |
| struct nfp_flower_vlan *frame, |
| bool outer_vlan) |
| { |
| u16 tci; |
| |
| tci = NFP_FLOWER_MASK_VLAN_PRESENT; |
| tci |= FIELD_PREP(NFP_FLOWER_MASK_VLAN_PRIO, |
| key->vlan_priority) | |
| FIELD_PREP(NFP_FLOWER_MASK_VLAN_VID, |
| key->vlan_id); |
| |
| if (outer_vlan) { |
| frame->outer_tci = cpu_to_be16(tci); |
| frame->outer_tpid = key->vlan_tpid; |
| } else { |
| frame->inner_tci = cpu_to_be16(tci); |
| frame->inner_tpid = key->vlan_tpid; |
| } |
| } |
| |
| static void |
| nfp_flower_compile_vlan(struct nfp_flower_vlan *ext, |
| struct nfp_flower_vlan *msk, |
| struct flow_rule *rule) |
| { |
| struct flow_match_vlan match; |
| |
| memset(ext, 0, sizeof(struct nfp_flower_vlan)); |
| memset(msk, 0, sizeof(struct nfp_flower_vlan)); |
| |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_VLAN)) { |
| flow_rule_match_vlan(rule, &match); |
| nfp_flower_fill_vlan(match.key, ext, true); |
| nfp_flower_fill_vlan(match.mask, msk, true); |
| } |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_CVLAN)) { |
| flow_rule_match_cvlan(rule, &match); |
| nfp_flower_fill_vlan(match.key, ext, false); |
| nfp_flower_fill_vlan(match.mask, msk, false); |
| } |
| } |
| |
| static void |
| nfp_flower_compile_ipv4(struct nfp_flower_ipv4 *ext, |
| struct nfp_flower_ipv4 *msk, struct flow_rule *rule) |
| { |
| struct flow_match_ipv4_addrs match; |
| |
| memset(ext, 0, sizeof(struct nfp_flower_ipv4)); |
| memset(msk, 0, sizeof(struct nfp_flower_ipv4)); |
| |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IPV4_ADDRS)) { |
| flow_rule_match_ipv4_addrs(rule, &match); |
| ext->ipv4_src = match.key->src; |
| ext->ipv4_dst = match.key->dst; |
| msk->ipv4_src = match.mask->src; |
| msk->ipv4_dst = match.mask->dst; |
| } |
| |
| nfp_flower_compile_ip_ext(&ext->ip_ext, &msk->ip_ext, rule); |
| } |
| |
| static void |
| nfp_flower_compile_ipv6(struct nfp_flower_ipv6 *ext, |
| struct nfp_flower_ipv6 *msk, struct flow_rule *rule) |
| { |
| memset(ext, 0, sizeof(struct nfp_flower_ipv6)); |
| memset(msk, 0, sizeof(struct nfp_flower_ipv6)); |
| |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_IPV6_ADDRS)) { |
| struct flow_match_ipv6_addrs match; |
| |
| flow_rule_match_ipv6_addrs(rule, &match); |
| ext->ipv6_src = match.key->src; |
| ext->ipv6_dst = match.key->dst; |
| msk->ipv6_src = match.mask->src; |
| msk->ipv6_dst = match.mask->dst; |
| } |
| |
| nfp_flower_compile_ip_ext(&ext->ip_ext, &msk->ip_ext, rule); |
| } |
| |
| static int |
| nfp_flower_compile_geneve_opt(void *ext, void *msk, struct flow_rule *rule) |
| { |
| struct flow_match_enc_opts match; |
| |
| flow_rule_match_enc_opts(rule, &match); |
| memcpy(ext, match.key->data, match.key->len); |
| memcpy(msk, match.mask->data, match.mask->len); |
| |
| return 0; |
| } |
| |
| static void |
| nfp_flower_compile_tun_ipv4_addrs(struct nfp_flower_tun_ipv4 *ext, |
| struct nfp_flower_tun_ipv4 *msk, |
| struct flow_rule *rule) |
| { |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS)) { |
| struct flow_match_ipv4_addrs match; |
| |
| flow_rule_match_enc_ipv4_addrs(rule, &match); |
| ext->src = match.key->src; |
| ext->dst = match.key->dst; |
| msk->src = match.mask->src; |
| msk->dst = match.mask->dst; |
| } |
| } |
| |
| static void |
| nfp_flower_compile_tun_ipv6_addrs(struct nfp_flower_tun_ipv6 *ext, |
| struct nfp_flower_tun_ipv6 *msk, |
| struct flow_rule *rule) |
| { |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS)) { |
| struct flow_match_ipv6_addrs match; |
| |
| flow_rule_match_enc_ipv6_addrs(rule, &match); |
| ext->src = match.key->src; |
| ext->dst = match.key->dst; |
| msk->src = match.mask->src; |
| msk->dst = match.mask->dst; |
| } |
| } |
| |
| static void |
| nfp_flower_compile_tun_ip_ext(struct nfp_flower_tun_ip_ext *ext, |
| struct nfp_flower_tun_ip_ext *msk, |
| struct flow_rule *rule) |
| { |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_IP)) { |
| struct flow_match_ip match; |
| |
| flow_rule_match_enc_ip(rule, &match); |
| ext->tos = match.key->tos; |
| ext->ttl = match.key->ttl; |
| msk->tos = match.mask->tos; |
| msk->ttl = match.mask->ttl; |
| } |
| } |
| |
| static void |
| nfp_flower_compile_tun_udp_key(__be32 *key, __be32 *key_msk, |
| struct flow_rule *rule) |
| { |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_KEYID)) { |
| struct flow_match_enc_keyid match; |
| u32 vni; |
| |
| flow_rule_match_enc_keyid(rule, &match); |
| vni = be32_to_cpu(match.key->keyid) << NFP_FL_TUN_VNI_OFFSET; |
| *key = cpu_to_be32(vni); |
| vni = be32_to_cpu(match.mask->keyid) << NFP_FL_TUN_VNI_OFFSET; |
| *key_msk = cpu_to_be32(vni); |
| } |
| } |
| |
| static void |
| nfp_flower_compile_tun_gre_key(__be32 *key, __be32 *key_msk, __be16 *flags, |
| __be16 *flags_msk, struct flow_rule *rule) |
| { |
| if (flow_rule_match_key(rule, FLOW_DISSECTOR_KEY_ENC_KEYID)) { |
| struct flow_match_enc_keyid match; |
| |
| flow_rule_match_enc_keyid(rule, &match); |
| *key = match.key->keyid; |
| *key_msk = match.mask->keyid; |
| |
| *flags = cpu_to_be16(NFP_FL_GRE_FLAG_KEY); |
| *flags_msk = cpu_to_be16(NFP_FL_GRE_FLAG_KEY); |
| } |
| } |
| |
| static void |
| nfp_flower_compile_ipv4_gre_tun(struct nfp_flower_ipv4_gre_tun *ext, |
| struct nfp_flower_ipv4_gre_tun *msk, |
| struct flow_rule *rule) |
| { |
| memset(ext, 0, sizeof(struct nfp_flower_ipv4_gre_tun)); |
| memset(msk, 0, sizeof(struct nfp_flower_ipv4_gre_tun)); |
| |
| /* NVGRE is the only supported GRE tunnel type */ |
| ext->ethertype = cpu_to_be16(ETH_P_TEB); |
| msk->ethertype = cpu_to_be16(~0); |
| |
| nfp_flower_compile_tun_ipv4_addrs(&ext->ipv4, &msk->ipv4, rule); |
| nfp_flower_compile_tun_ip_ext(&ext->ip_ext, &msk->ip_ext, rule); |
| nfp_flower_compile_tun_gre_key(&ext->tun_key, &msk->tun_key, |
| &ext->tun_flags, &msk->tun_flags, rule); |
| } |
| |
| static void |
| nfp_flower_compile_ipv4_udp_tun(struct nfp_flower_ipv4_udp_tun *ext, |
| struct nfp_flower_ipv4_udp_tun *msk, |
| struct flow_rule *rule) |
| { |
| memset(ext, 0, sizeof(struct nfp_flower_ipv4_udp_tun)); |
| memset(msk, 0, sizeof(struct nfp_flower_ipv4_udp_tun)); |
| |
| nfp_flower_compile_tun_ipv4_addrs(&ext->ipv4, &msk->ipv4, rule); |
| nfp_flower_compile_tun_ip_ext(&ext->ip_ext, &msk->ip_ext, rule); |
| nfp_flower_compile_tun_udp_key(&ext->tun_id, &msk->tun_id, rule); |
| } |
| |
| static void |
| nfp_flower_compile_ipv6_udp_tun(struct nfp_flower_ipv6_udp_tun *ext, |
| struct nfp_flower_ipv6_udp_tun *msk, |
| struct flow_rule *rule) |
| { |
| memset(ext, 0, sizeof(struct nfp_flower_ipv6_udp_tun)); |
| memset(msk, 0, sizeof(struct nfp_flower_ipv6_udp_tun)); |
| |
| nfp_flower_compile_tun_ipv6_addrs(&ext->ipv6, &msk->ipv6, rule); |
| nfp_flower_compile_tun_ip_ext(&ext->ip_ext, &msk->ip_ext, rule); |
| nfp_flower_compile_tun_udp_key(&ext->tun_id, &msk->tun_id, rule); |
| } |
| |
| static void |
| nfp_flower_compile_ipv6_gre_tun(struct nfp_flower_ipv6_gre_tun *ext, |
| struct nfp_flower_ipv6_gre_tun *msk, |
| struct flow_rule *rule) |
| { |
| memset(ext, 0, sizeof(struct nfp_flower_ipv6_gre_tun)); |
| memset(msk, 0, sizeof(struct nfp_flower_ipv6_gre_tun)); |
| |
| /* NVGRE is the only supported GRE tunnel type */ |
| ext->ethertype = cpu_to_be16(ETH_P_TEB); |
| msk->ethertype = cpu_to_be16(~0); |
| |
| nfp_flower_compile_tun_ipv6_addrs(&ext->ipv6, &msk->ipv6, rule); |
| nfp_flower_compile_tun_ip_ext(&ext->ip_ext, &msk->ip_ext, rule); |
| nfp_flower_compile_tun_gre_key(&ext->tun_key, &msk->tun_key, |
| &ext->tun_flags, &msk->tun_flags, rule); |
| } |
| |
| int nfp_flower_compile_flow_match(struct nfp_app *app, |
| struct flow_cls_offload *flow, |
| struct nfp_fl_key_ls *key_ls, |
| struct net_device *netdev, |
| struct nfp_fl_payload *nfp_flow, |
| enum nfp_flower_tun_type tun_type, |
| struct netlink_ext_ack *extack) |
| { |
| struct flow_rule *rule = flow_cls_offload_flow_rule(flow); |
| struct nfp_flower_priv *priv = app->priv; |
| bool qinq_sup; |
| u32 port_id; |
| int ext_len; |
| int err; |
| u8 *ext; |
| u8 *msk; |
| |
| port_id = nfp_flower_get_port_id_from_netdev(app, netdev); |
| |
| memset(nfp_flow->unmasked_data, 0, key_ls->key_size); |
| memset(nfp_flow->mask_data, 0, key_ls->key_size); |
| |
| ext = nfp_flow->unmasked_data; |
| msk = nfp_flow->mask_data; |
| |
| qinq_sup = !!(priv->flower_ext_feats & NFP_FL_FEATS_VLAN_QINQ); |
| |
| nfp_flower_compile_meta_tci((struct nfp_flower_meta_tci *)ext, |
| (struct nfp_flower_meta_tci *)msk, |
| rule, key_ls->key_layer, qinq_sup); |
| ext += sizeof(struct nfp_flower_meta_tci); |
| msk += sizeof(struct nfp_flower_meta_tci); |
| |
| /* Populate Extended Metadata if Required. */ |
| if (NFP_FLOWER_LAYER_EXT_META & key_ls->key_layer) { |
| nfp_flower_compile_ext_meta((struct nfp_flower_ext_meta *)ext, |
| key_ls->key_layer_two); |
| nfp_flower_compile_ext_meta((struct nfp_flower_ext_meta *)msk, |
| key_ls->key_layer_two); |
| ext += sizeof(struct nfp_flower_ext_meta); |
| msk += sizeof(struct nfp_flower_ext_meta); |
| } |
| |
| /* Populate Exact Port data. */ |
| err = nfp_flower_compile_port((struct nfp_flower_in_port *)ext, |
| port_id, false, tun_type, extack); |
| if (err) |
| return err; |
| |
| /* Populate Mask Port Data. */ |
| err = nfp_flower_compile_port((struct nfp_flower_in_port *)msk, |
| port_id, true, tun_type, extack); |
| if (err) |
| return err; |
| |
| ext += sizeof(struct nfp_flower_in_port); |
| msk += sizeof(struct nfp_flower_in_port); |
| |
| if (NFP_FLOWER_LAYER_MAC & key_ls->key_layer) { |
| err = nfp_flower_compile_mac((struct nfp_flower_mac_mpls *)ext, |
| (struct nfp_flower_mac_mpls *)msk, |
| rule, extack); |
| if (err) |
| return err; |
| |
| ext += sizeof(struct nfp_flower_mac_mpls); |
| msk += sizeof(struct nfp_flower_mac_mpls); |
| } |
| |
| if (NFP_FLOWER_LAYER_TP & key_ls->key_layer) { |
| nfp_flower_compile_tport((struct nfp_flower_tp_ports *)ext, |
| (struct nfp_flower_tp_ports *)msk, |
| rule); |
| ext += sizeof(struct nfp_flower_tp_ports); |
| msk += sizeof(struct nfp_flower_tp_ports); |
| } |
| |
| if (NFP_FLOWER_LAYER_IPV4 & key_ls->key_layer) { |
| nfp_flower_compile_ipv4((struct nfp_flower_ipv4 *)ext, |
| (struct nfp_flower_ipv4 *)msk, |
| rule); |
| ext += sizeof(struct nfp_flower_ipv4); |
| msk += sizeof(struct nfp_flower_ipv4); |
| } |
| |
| if (NFP_FLOWER_LAYER_IPV6 & key_ls->key_layer) { |
| nfp_flower_compile_ipv6((struct nfp_flower_ipv6 *)ext, |
| (struct nfp_flower_ipv6 *)msk, |
| rule); |
| ext += sizeof(struct nfp_flower_ipv6); |
| msk += sizeof(struct nfp_flower_ipv6); |
| } |
| |
| if (key_ls->key_layer_two & NFP_FLOWER_LAYER2_GRE) { |
| if (key_ls->key_layer_two & NFP_FLOWER_LAYER2_TUN_IPV6) { |
| struct nfp_flower_ipv6_gre_tun *gre_match; |
| struct nfp_ipv6_addr_entry *entry; |
| struct in6_addr *dst; |
| |
| nfp_flower_compile_ipv6_gre_tun((void *)ext, |
| (void *)msk, rule); |
| gre_match = (struct nfp_flower_ipv6_gre_tun *)ext; |
| dst = &gre_match->ipv6.dst; |
| ext += sizeof(struct nfp_flower_ipv6_gre_tun); |
| msk += sizeof(struct nfp_flower_ipv6_gre_tun); |
| |
| entry = nfp_tunnel_add_ipv6_off(app, dst); |
| if (!entry) |
| return -EOPNOTSUPP; |
| |
| nfp_flow->nfp_tun_ipv6 = entry; |
| } else { |
| __be32 dst; |
| |
| nfp_flower_compile_ipv4_gre_tun((void *)ext, |
| (void *)msk, rule); |
| dst = ((struct nfp_flower_ipv4_gre_tun *)ext)->ipv4.dst; |
| ext += sizeof(struct nfp_flower_ipv4_gre_tun); |
| msk += sizeof(struct nfp_flower_ipv4_gre_tun); |
| |
| /* Store the tunnel destination in the rule data. |
| * This must be present and be an exact match. |
| */ |
| nfp_flow->nfp_tun_ipv4_addr = dst; |
| nfp_tunnel_add_ipv4_off(app, dst); |
| } |
| } |
| |
| if (NFP_FLOWER_LAYER2_QINQ & key_ls->key_layer_two) { |
| nfp_flower_compile_vlan((struct nfp_flower_vlan *)ext, |
| (struct nfp_flower_vlan *)msk, |
| rule); |
| ext += sizeof(struct nfp_flower_vlan); |
| msk += sizeof(struct nfp_flower_vlan); |
| } |
| |
| if (key_ls->key_layer & NFP_FLOWER_LAYER_VXLAN || |
| key_ls->key_layer_two & NFP_FLOWER_LAYER2_GENEVE) { |
| if (key_ls->key_layer_two & NFP_FLOWER_LAYER2_TUN_IPV6) { |
| struct nfp_flower_ipv6_udp_tun *udp_match; |
| struct nfp_ipv6_addr_entry *entry; |
| struct in6_addr *dst; |
| |
| nfp_flower_compile_ipv6_udp_tun((void *)ext, |
| (void *)msk, rule); |
| udp_match = (struct nfp_flower_ipv6_udp_tun *)ext; |
| dst = &udp_match->ipv6.dst; |
| ext += sizeof(struct nfp_flower_ipv6_udp_tun); |
| msk += sizeof(struct nfp_flower_ipv6_udp_tun); |
| |
| entry = nfp_tunnel_add_ipv6_off(app, dst); |
| if (!entry) |
| return -EOPNOTSUPP; |
| |
| nfp_flow->nfp_tun_ipv6 = entry; |
| } else { |
| __be32 dst; |
| |
| nfp_flower_compile_ipv4_udp_tun((void *)ext, |
| (void *)msk, rule); |
| dst = ((struct nfp_flower_ipv4_udp_tun *)ext)->ipv4.dst; |
| ext += sizeof(struct nfp_flower_ipv4_udp_tun); |
| msk += sizeof(struct nfp_flower_ipv4_udp_tun); |
| |
| /* Store the tunnel destination in the rule data. |
| * This must be present and be an exact match. |
| */ |
| nfp_flow->nfp_tun_ipv4_addr = dst; |
| nfp_tunnel_add_ipv4_off(app, dst); |
| } |
| |
| if (key_ls->key_layer_two & NFP_FLOWER_LAYER2_GENEVE_OP) { |
| err = nfp_flower_compile_geneve_opt(ext, msk, rule); |
| if (err) |
| return err; |
| } |
| } |
| |
| /* Check that the flow key does not exceed the maximum limit. |
| * All structures in the key is multiples of 4 bytes, so use u32. |
| */ |
| ext_len = (u32 *)ext - (u32 *)nfp_flow->unmasked_data; |
| if (ext_len > NFP_FLOWER_KEY_MAX_LW) { |
| NL_SET_ERR_MSG_MOD(extack, |
| "unsupported offload: flow key too long"); |
| return -EOPNOTSUPP; |
| } |
| |
| return 0; |
| } |