290 lines · c
1// SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)2#include "dpaa2-eth.h"3/* Copyright 2020 NXP4 */5 6#define DPAA2_ETH_TRAP_DROP(_id, _group_id) \7 DEVLINK_TRAP_GENERIC(DROP, DROP, _id, \8 DEVLINK_TRAP_GROUP_GENERIC_ID_##_group_id, 0)9 10static const struct devlink_trap_group dpaa2_eth_trap_groups_arr[] = {11 DEVLINK_TRAP_GROUP_GENERIC(PARSER_ERROR_DROPS, 0),12};13 14static const struct devlink_trap dpaa2_eth_traps_arr[] = {15 DPAA2_ETH_TRAP_DROP(VXLAN_PARSING, PARSER_ERROR_DROPS),16 DPAA2_ETH_TRAP_DROP(LLC_SNAP_PARSING, PARSER_ERROR_DROPS),17 DPAA2_ETH_TRAP_DROP(VLAN_PARSING, PARSER_ERROR_DROPS),18 DPAA2_ETH_TRAP_DROP(PPPOE_PPP_PARSING, PARSER_ERROR_DROPS),19 DPAA2_ETH_TRAP_DROP(MPLS_PARSING, PARSER_ERROR_DROPS),20 DPAA2_ETH_TRAP_DROP(ARP_PARSING, PARSER_ERROR_DROPS),21 DPAA2_ETH_TRAP_DROP(IP_1_PARSING, PARSER_ERROR_DROPS),22 DPAA2_ETH_TRAP_DROP(IP_N_PARSING, PARSER_ERROR_DROPS),23 DPAA2_ETH_TRAP_DROP(GRE_PARSING, PARSER_ERROR_DROPS),24 DPAA2_ETH_TRAP_DROP(UDP_PARSING, PARSER_ERROR_DROPS),25 DPAA2_ETH_TRAP_DROP(TCP_PARSING, PARSER_ERROR_DROPS),26 DPAA2_ETH_TRAP_DROP(IPSEC_PARSING, PARSER_ERROR_DROPS),27 DPAA2_ETH_TRAP_DROP(SCTP_PARSING, PARSER_ERROR_DROPS),28 DPAA2_ETH_TRAP_DROP(DCCP_PARSING, PARSER_ERROR_DROPS),29 DPAA2_ETH_TRAP_DROP(GTP_PARSING, PARSER_ERROR_DROPS),30 DPAA2_ETH_TRAP_DROP(ESP_PARSING, PARSER_ERROR_DROPS),31};32 33static int dpaa2_eth_dl_info_get(struct devlink *devlink,34 struct devlink_info_req *req,35 struct netlink_ext_ack *extack)36{37 struct dpaa2_eth_devlink_priv *dl_priv = devlink_priv(devlink);38 struct dpaa2_eth_priv *priv = dl_priv->dpaa2_priv;39 char buf[10];40 41 scnprintf(buf, 10, "%d.%d", priv->dpni_ver_major, priv->dpni_ver_minor);42 return devlink_info_version_running_put(req, "dpni", buf);43}44 45static struct dpaa2_eth_trap_item *46dpaa2_eth_dl_trap_item_lookup(struct dpaa2_eth_priv *priv, u16 trap_id)47{48 struct dpaa2_eth_trap_data *dpaa2_eth_trap_data = priv->trap_data;49 int i;50 51 for (i = 0; i < ARRAY_SIZE(dpaa2_eth_traps_arr); i++) {52 if (dpaa2_eth_traps_arr[i].id == trap_id)53 return &dpaa2_eth_trap_data->trap_items_arr[i];54 }55 56 return NULL;57}58 59struct dpaa2_eth_trap_item *dpaa2_eth_dl_get_trap(struct dpaa2_eth_priv *priv,60 struct dpaa2_fapr *fapr)61{62 static const struct dpaa2_faf_error_bit {63 int position;64 enum devlink_trap_generic_id trap_id;65 } faf_bits[] = {66 { .position = 5, .trap_id = DEVLINK_TRAP_GENERIC_ID_VXLAN_PARSING },67 { .position = 20, .trap_id = DEVLINK_TRAP_GENERIC_ID_LLC_SNAP_PARSING },68 { .position = 24, .trap_id = DEVLINK_TRAP_GENERIC_ID_VLAN_PARSING },69 { .position = 26, .trap_id = DEVLINK_TRAP_GENERIC_ID_PPPOE_PPP_PARSING },70 { .position = 29, .trap_id = DEVLINK_TRAP_GENERIC_ID_MPLS_PARSING },71 { .position = 31, .trap_id = DEVLINK_TRAP_GENERIC_ID_ARP_PARSING },72 { .position = 52, .trap_id = DEVLINK_TRAP_GENERIC_ID_IP_1_PARSING },73 { .position = 61, .trap_id = DEVLINK_TRAP_GENERIC_ID_IP_N_PARSING },74 { .position = 67, .trap_id = DEVLINK_TRAP_GENERIC_ID_GRE_PARSING },75 { .position = 71, .trap_id = DEVLINK_TRAP_GENERIC_ID_UDP_PARSING },76 { .position = 76, .trap_id = DEVLINK_TRAP_GENERIC_ID_TCP_PARSING },77 { .position = 80, .trap_id = DEVLINK_TRAP_GENERIC_ID_IPSEC_PARSING },78 { .position = 82, .trap_id = DEVLINK_TRAP_GENERIC_ID_SCTP_PARSING },79 { .position = 84, .trap_id = DEVLINK_TRAP_GENERIC_ID_DCCP_PARSING },80 { .position = 88, .trap_id = DEVLINK_TRAP_GENERIC_ID_GTP_PARSING },81 { .position = 90, .trap_id = DEVLINK_TRAP_GENERIC_ID_ESP_PARSING },82 };83 u64 faf_word;84 u64 mask;85 int i;86 87 for (i = 0; i < ARRAY_SIZE(faf_bits); i++) {88 if (faf_bits[i].position < 32) {89 /* Low part of FAF.90 * position ranges from 31 to 0, mask from 0 to 31.91 */92 mask = 1ull << (31 - faf_bits[i].position);93 faf_word = __le32_to_cpu(fapr->faf_lo);94 } else {95 /* High part of FAF.96 * position ranges from 95 to 32, mask from 0 to 63.97 */98 mask = 1ull << (63 - (faf_bits[i].position - 32));99 faf_word = __le64_to_cpu(fapr->faf_hi);100 }101 if (faf_word & mask)102 return dpaa2_eth_dl_trap_item_lookup(priv, faf_bits[i].trap_id);103 }104 return NULL;105}106 107static int dpaa2_eth_dl_trap_init(struct devlink *devlink,108 const struct devlink_trap *trap,109 void *trap_ctx)110{111 struct dpaa2_eth_devlink_priv *dl_priv = devlink_priv(devlink);112 struct dpaa2_eth_priv *priv = dl_priv->dpaa2_priv;113 struct dpaa2_eth_trap_item *dpaa2_eth_trap_item;114 115 dpaa2_eth_trap_item = dpaa2_eth_dl_trap_item_lookup(priv, trap->id);116 if (WARN_ON(!dpaa2_eth_trap_item))117 return -ENOENT;118 119 dpaa2_eth_trap_item->trap_ctx = trap_ctx;120 121 return 0;122}123 124static int dpaa2_eth_dl_trap_action_set(struct devlink *devlink,125 const struct devlink_trap *trap,126 enum devlink_trap_action action,127 struct netlink_ext_ack *extack)128{129 /* No support for changing the action of an independent packet trap,130 * only per trap group - parser error drops131 */132 NL_SET_ERR_MSG_MOD(extack,133 "Cannot change trap action independently of group");134 return -EOPNOTSUPP;135}136 137static int dpaa2_eth_dl_trap_group_action_set(struct devlink *devlink,138 const struct devlink_trap_group *group,139 enum devlink_trap_action action,140 struct netlink_ext_ack *extack)141{142 struct dpaa2_eth_devlink_priv *dl_priv = devlink_priv(devlink);143 struct dpaa2_eth_priv *priv = dl_priv->dpaa2_priv;144 struct net_device *net_dev = priv->net_dev;145 struct device *dev = net_dev->dev.parent;146 struct dpni_error_cfg err_cfg = {0};147 int err;148 149 if (group->id != DEVLINK_TRAP_GROUP_GENERIC_ID_PARSER_ERROR_DROPS)150 return -EOPNOTSUPP;151 152 /* Configure handling of frames marked as errors from the parser */153 err_cfg.errors = DPAA2_FAS_RX_ERR_MASK;154 err_cfg.set_frame_annotation = 1;155 156 switch (action) {157 case DEVLINK_TRAP_ACTION_DROP:158 err_cfg.error_action = DPNI_ERROR_ACTION_DISCARD;159 break;160 case DEVLINK_TRAP_ACTION_TRAP:161 err_cfg.error_action = DPNI_ERROR_ACTION_SEND_TO_ERROR_QUEUE;162 break;163 default:164 return -EOPNOTSUPP;165 }166 167 err = dpni_set_errors_behavior(priv->mc_io, 0, priv->mc_token, &err_cfg);168 if (err) {169 dev_err(dev, "dpni_set_errors_behavior failed\n");170 return err;171 }172 173 return 0;174}175 176static const struct devlink_ops dpaa2_eth_devlink_ops = {177 .info_get = dpaa2_eth_dl_info_get,178 .trap_init = dpaa2_eth_dl_trap_init,179 .trap_action_set = dpaa2_eth_dl_trap_action_set,180 .trap_group_action_set = dpaa2_eth_dl_trap_group_action_set,181};182 183int dpaa2_eth_dl_alloc(struct dpaa2_eth_priv *priv)184{185 struct net_device *net_dev = priv->net_dev;186 struct device *dev = net_dev->dev.parent;187 struct dpaa2_eth_devlink_priv *dl_priv;188 189 priv->devlink =190 devlink_alloc(&dpaa2_eth_devlink_ops, sizeof(*dl_priv), dev);191 if (!priv->devlink) {192 dev_err(dev, "devlink_alloc failed\n");193 return -ENOMEM;194 }195 dl_priv = devlink_priv(priv->devlink);196 dl_priv->dpaa2_priv = priv;197 return 0;198}199 200void dpaa2_eth_dl_free(struct dpaa2_eth_priv *priv)201{202 devlink_free(priv->devlink);203}204 205 206void dpaa2_eth_dl_register(struct dpaa2_eth_priv *priv)207{208 devlink_register(priv->devlink);209}210 211void dpaa2_eth_dl_unregister(struct dpaa2_eth_priv *priv)212{213 devlink_unregister(priv->devlink);214}215 216int dpaa2_eth_dl_port_add(struct dpaa2_eth_priv *priv)217{218 struct devlink_port *devlink_port = &priv->devlink_port;219 struct devlink_port_attrs attrs = {};220 221 attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL;222 devlink_port_attrs_set(devlink_port, &attrs);223 return devlink_port_register(priv->devlink, devlink_port, 0);224}225 226void dpaa2_eth_dl_port_del(struct dpaa2_eth_priv *priv)227{228 struct devlink_port *devlink_port = &priv->devlink_port;229 230 devlink_port_unregister(devlink_port);231}232 233int dpaa2_eth_dl_traps_register(struct dpaa2_eth_priv *priv)234{235 struct dpaa2_eth_trap_data *dpaa2_eth_trap_data;236 struct net_device *net_dev = priv->net_dev;237 struct device *dev = net_dev->dev.parent;238 int err;239 240 dpaa2_eth_trap_data = kzalloc(sizeof(*dpaa2_eth_trap_data), GFP_KERNEL);241 if (!dpaa2_eth_trap_data)242 return -ENOMEM;243 priv->trap_data = dpaa2_eth_trap_data;244 245 dpaa2_eth_trap_data->trap_items_arr = kcalloc(ARRAY_SIZE(dpaa2_eth_traps_arr),246 sizeof(struct dpaa2_eth_trap_item),247 GFP_KERNEL);248 if (!dpaa2_eth_trap_data->trap_items_arr) {249 err = -ENOMEM;250 goto trap_data_free;251 }252 253 err = devlink_trap_groups_register(priv->devlink, dpaa2_eth_trap_groups_arr,254 ARRAY_SIZE(dpaa2_eth_trap_groups_arr));255 if (err) {256 dev_err(dev, "devlink_trap_groups_register() = %d\n", err);257 goto trap_items_arr_free;258 }259 260 err = devlink_traps_register(priv->devlink, dpaa2_eth_traps_arr,261 ARRAY_SIZE(dpaa2_eth_traps_arr), priv);262 if (err) {263 dev_err(dev, "devlink_traps_register() = %d\n", err);264 goto trap_groups_unregiser;265 }266 267 return 0;268 269trap_groups_unregiser:270 devlink_trap_groups_unregister(priv->devlink, dpaa2_eth_trap_groups_arr,271 ARRAY_SIZE(dpaa2_eth_trap_groups_arr));272trap_items_arr_free:273 kfree(dpaa2_eth_trap_data->trap_items_arr);274trap_data_free:275 kfree(dpaa2_eth_trap_data);276 priv->trap_data = NULL;277 278 return err;279}280 281void dpaa2_eth_dl_traps_unregister(struct dpaa2_eth_priv *priv)282{283 devlink_traps_unregister(priv->devlink, dpaa2_eth_traps_arr,284 ARRAY_SIZE(dpaa2_eth_traps_arr));285 devlink_trap_groups_unregister(priv->devlink, dpaa2_eth_trap_groups_arr,286 ARRAY_SIZE(dpaa2_eth_trap_groups_arr));287 kfree(priv->trap_data->trap_items_arr);288 kfree(priv->trap_data);289}290