1c9da1ac1SSteen Hegelund // SPDX-License-Identifier: GPL-2.0+ 2c9da1ac1SSteen Hegelund /* Microchip VCAP API 3c9da1ac1SSteen Hegelund * 4c9da1ac1SSteen Hegelund * Copyright (c) 2022 Microchip Technology Inc. and its subsidiaries. 5c9da1ac1SSteen Hegelund */ 6c9da1ac1SSteen Hegelund 7c9da1ac1SSteen Hegelund #include <linux/types.h> 8c9da1ac1SSteen Hegelund 9c9da1ac1SSteen Hegelund #include "vcap_api.h" 10c9da1ac1SSteen Hegelund #include "vcap_api_client.h" 11c9da1ac1SSteen Hegelund 12c9da1ac1SSteen Hegelund #define to_intrule(rule) container_of((rule), struct vcap_rule_internal, data) 13c9da1ac1SSteen Hegelund 14c9da1ac1SSteen Hegelund /* Private VCAP API rule data */ 15c9da1ac1SSteen Hegelund struct vcap_rule_internal { 16c9da1ac1SSteen Hegelund struct vcap_rule data; /* provided by the client */ 17c9da1ac1SSteen Hegelund struct list_head list; /* for insertion in the vcap admin list of rules */ 18c9da1ac1SSteen Hegelund struct vcap_admin *admin; /* vcap hw instance */ 19c9da1ac1SSteen Hegelund struct net_device *ndev; /* the interface that the rule applies to */ 20c9da1ac1SSteen Hegelund struct vcap_control *vctrl; /* the client control */ 218e10490bSSteen Hegelund u32 sort_key; /* defines the position in the VCAP */ 228e10490bSSteen Hegelund int keyset_sw; /* subwords in a keyset */ 238e10490bSSteen Hegelund int actionset_sw; /* subwords in an actionset */ 248e10490bSSteen Hegelund int keyset_sw_regs; /* registers in a subword in an keyset */ 258e10490bSSteen Hegelund int actionset_sw_regs; /* registers in a subword in an actionset */ 268e10490bSSteen Hegelund int size; /* the size of the rule: max(entry, action) */ 27c9da1ac1SSteen Hegelund u32 addr; /* address in the VCAP at insertion */ 28c9da1ac1SSteen Hegelund }; 29c9da1ac1SSteen Hegelund 308e10490bSSteen Hegelund /* Moving a rule in the VCAP address space */ 318e10490bSSteen Hegelund struct vcap_rule_move { 328e10490bSSteen Hegelund int addr; /* address to move */ 338e10490bSSteen Hegelund int offset; /* change in address */ 348e10490bSSteen Hegelund int count; /* blocksize of addresses to move */ 358e10490bSSteen Hegelund }; 368e10490bSSteen Hegelund 37683e05c0SSteen Hegelund /* Bit iterator for the VCAP cache streams */ 38683e05c0SSteen Hegelund struct vcap_stream_iter { 39683e05c0SSteen Hegelund u32 offset; /* bit offset from the stream start */ 40683e05c0SSteen Hegelund u32 sw_width; /* subword width in bits */ 41683e05c0SSteen Hegelund u32 regs_per_sw; /* registers per subword */ 42683e05c0SSteen Hegelund u32 reg_idx; /* current register index */ 43683e05c0SSteen Hegelund u32 reg_bitpos; /* bit offset in current register */ 44683e05c0SSteen Hegelund const struct vcap_typegroup *tg; /* current typegroup */ 45683e05c0SSteen Hegelund }; 46683e05c0SSteen Hegelund 4767456717SSteen Hegelund /* Stores the filter cookie that enabled the port */ 4867456717SSteen Hegelund struct vcap_enabled_port { 4967456717SSteen Hegelund struct list_head list; /* for insertion in enabled ports list */ 5067456717SSteen Hegelund struct net_device *ndev; /* the enabled port */ 5167456717SSteen Hegelund unsigned long cookie; /* filter that enabled the port */ 5267456717SSteen Hegelund }; 5367456717SSteen Hegelund 54683e05c0SSteen Hegelund static void vcap_iter_set(struct vcap_stream_iter *itr, int sw_width, 55683e05c0SSteen Hegelund const struct vcap_typegroup *tg, u32 offset) 56683e05c0SSteen Hegelund { 57683e05c0SSteen Hegelund memset(itr, 0, sizeof(*itr)); 58683e05c0SSteen Hegelund itr->offset = offset; 59683e05c0SSteen Hegelund itr->sw_width = sw_width; 60683e05c0SSteen Hegelund itr->regs_per_sw = DIV_ROUND_UP(sw_width, 32); 61683e05c0SSteen Hegelund itr->tg = tg; 62683e05c0SSteen Hegelund } 63683e05c0SSteen Hegelund 64683e05c0SSteen Hegelund static void vcap_iter_skip_tg(struct vcap_stream_iter *itr) 65683e05c0SSteen Hegelund { 66683e05c0SSteen Hegelund /* Compensate the field offset for preceding typegroups. 67683e05c0SSteen Hegelund * A typegroup table ends with an all-zero terminator. 68683e05c0SSteen Hegelund */ 69683e05c0SSteen Hegelund while (itr->tg->width && itr->offset >= itr->tg->offset) { 70683e05c0SSteen Hegelund itr->offset += itr->tg->width; 71683e05c0SSteen Hegelund itr->tg++; /* next typegroup */ 72683e05c0SSteen Hegelund } 73683e05c0SSteen Hegelund } 74683e05c0SSteen Hegelund 75683e05c0SSteen Hegelund static void vcap_iter_update(struct vcap_stream_iter *itr) 76683e05c0SSteen Hegelund { 77683e05c0SSteen Hegelund int sw_idx, sw_bitpos; 78683e05c0SSteen Hegelund 79683e05c0SSteen Hegelund /* Calculate the subword index and bitposition for current bit */ 80683e05c0SSteen Hegelund sw_idx = itr->offset / itr->sw_width; 81683e05c0SSteen Hegelund sw_bitpos = itr->offset % itr->sw_width; 82683e05c0SSteen Hegelund /* Calculate the register index and bitposition for current bit */ 83683e05c0SSteen Hegelund itr->reg_idx = (sw_idx * itr->regs_per_sw) + (sw_bitpos / 32); 84683e05c0SSteen Hegelund itr->reg_bitpos = sw_bitpos % 32; 85683e05c0SSteen Hegelund } 86683e05c0SSteen Hegelund 87683e05c0SSteen Hegelund static void vcap_iter_init(struct vcap_stream_iter *itr, int sw_width, 88683e05c0SSteen Hegelund const struct vcap_typegroup *tg, u32 offset) 89683e05c0SSteen Hegelund { 90683e05c0SSteen Hegelund vcap_iter_set(itr, sw_width, tg, offset); 91683e05c0SSteen Hegelund vcap_iter_skip_tg(itr); 92683e05c0SSteen Hegelund vcap_iter_update(itr); 93683e05c0SSteen Hegelund } 94683e05c0SSteen Hegelund 95683e05c0SSteen Hegelund static void vcap_iter_next(struct vcap_stream_iter *itr) 96683e05c0SSteen Hegelund { 97683e05c0SSteen Hegelund itr->offset++; 98683e05c0SSteen Hegelund vcap_iter_skip_tg(itr); 99683e05c0SSteen Hegelund vcap_iter_update(itr); 100683e05c0SSteen Hegelund } 101683e05c0SSteen Hegelund 102683e05c0SSteen Hegelund static void vcap_set_bit(u32 *stream, struct vcap_stream_iter *itr, bool value) 103683e05c0SSteen Hegelund { 104683e05c0SSteen Hegelund u32 mask = BIT(itr->reg_bitpos); 105683e05c0SSteen Hegelund u32 *p = &stream[itr->reg_idx]; 106683e05c0SSteen Hegelund 107683e05c0SSteen Hegelund if (value) 108683e05c0SSteen Hegelund *p |= mask; 109683e05c0SSteen Hegelund else 110683e05c0SSteen Hegelund *p &= ~mask; 111683e05c0SSteen Hegelund } 112683e05c0SSteen Hegelund 113683e05c0SSteen Hegelund static void vcap_encode_bit(u32 *stream, struct vcap_stream_iter *itr, bool val) 114683e05c0SSteen Hegelund { 115683e05c0SSteen Hegelund /* When intersected by a type group field, stream the type group bits 116683e05c0SSteen Hegelund * before continuing with the value bit 117683e05c0SSteen Hegelund */ 118683e05c0SSteen Hegelund while (itr->tg->width && 119683e05c0SSteen Hegelund itr->offset >= itr->tg->offset && 120683e05c0SSteen Hegelund itr->offset < itr->tg->offset + itr->tg->width) { 121683e05c0SSteen Hegelund int tg_bitpos = itr->tg->offset - itr->offset; 122683e05c0SSteen Hegelund 123683e05c0SSteen Hegelund vcap_set_bit(stream, itr, (itr->tg->value >> tg_bitpos) & 0x1); 124683e05c0SSteen Hegelund itr->offset++; 125683e05c0SSteen Hegelund vcap_iter_update(itr); 126683e05c0SSteen Hegelund } 127683e05c0SSteen Hegelund vcap_set_bit(stream, itr, val); 128683e05c0SSteen Hegelund } 129683e05c0SSteen Hegelund 130683e05c0SSteen Hegelund static void vcap_encode_field(u32 *stream, struct vcap_stream_iter *itr, 131683e05c0SSteen Hegelund int width, const u8 *value) 132683e05c0SSteen Hegelund { 133683e05c0SSteen Hegelund int idx; 134683e05c0SSteen Hegelund 135683e05c0SSteen Hegelund /* Loop over the field value bits and add the value bits one by one to 136683e05c0SSteen Hegelund * the output stream. 137683e05c0SSteen Hegelund */ 138683e05c0SSteen Hegelund for (idx = 0; idx < width; idx++) { 139683e05c0SSteen Hegelund u8 bidx = idx & GENMASK(2, 0); 140683e05c0SSteen Hegelund 141683e05c0SSteen Hegelund /* Encode one field value bit */ 142683e05c0SSteen Hegelund vcap_encode_bit(stream, itr, (value[idx / 8] >> bidx) & 0x1); 143683e05c0SSteen Hegelund vcap_iter_next(itr); 144683e05c0SSteen Hegelund } 145683e05c0SSteen Hegelund } 146683e05c0SSteen Hegelund 147683e05c0SSteen Hegelund static void vcap_encode_typegroups(u32 *stream, int sw_width, 148683e05c0SSteen Hegelund const struct vcap_typegroup *tg, 149683e05c0SSteen Hegelund bool mask) 150683e05c0SSteen Hegelund { 151683e05c0SSteen Hegelund struct vcap_stream_iter iter; 152683e05c0SSteen Hegelund int idx; 153683e05c0SSteen Hegelund 154683e05c0SSteen Hegelund /* Mask bits must be set to zeros (inverted later when writing to the 155683e05c0SSteen Hegelund * mask cache register), so that the mask typegroup bits consist of 156683e05c0SSteen Hegelund * match-1 or match-0, or both 157683e05c0SSteen Hegelund */ 158683e05c0SSteen Hegelund vcap_iter_set(&iter, sw_width, tg, 0); 159683e05c0SSteen Hegelund while (iter.tg->width) { 160683e05c0SSteen Hegelund /* Set position to current typegroup bit */ 161683e05c0SSteen Hegelund iter.offset = iter.tg->offset; 162683e05c0SSteen Hegelund vcap_iter_update(&iter); 163683e05c0SSteen Hegelund for (idx = 0; idx < iter.tg->width; idx++) { 164683e05c0SSteen Hegelund /* Iterate over current typegroup bits. Mask typegroup 165683e05c0SSteen Hegelund * bits are always set 166683e05c0SSteen Hegelund */ 167683e05c0SSteen Hegelund if (mask) 168683e05c0SSteen Hegelund vcap_set_bit(stream, &iter, 0x1); 169683e05c0SSteen Hegelund else 170683e05c0SSteen Hegelund vcap_set_bit(stream, &iter, 171683e05c0SSteen Hegelund (iter.tg->value >> idx) & 0x1); 172683e05c0SSteen Hegelund iter.offset++; 173683e05c0SSteen Hegelund vcap_iter_update(&iter); 174683e05c0SSteen Hegelund } 175683e05c0SSteen Hegelund iter.tg++; /* next typegroup */ 176683e05c0SSteen Hegelund } 177683e05c0SSteen Hegelund } 178683e05c0SSteen Hegelund 17946be056eSSteen Hegelund /* Return the list of keyfields for the keyset */ 18046be056eSSteen Hegelund static const struct vcap_field *vcap_keyfields(struct vcap_control *vctrl, 18146be056eSSteen Hegelund enum vcap_type vt, 18246be056eSSteen Hegelund enum vcap_keyfield_set keyset) 18346be056eSSteen Hegelund { 18446be056eSSteen Hegelund /* Check that the keyset exists in the vcap keyset list */ 18546be056eSSteen Hegelund if (keyset >= vctrl->vcaps[vt].keyfield_set_size) 18646be056eSSteen Hegelund return NULL; 18746be056eSSteen Hegelund return vctrl->vcaps[vt].keyfield_set_map[keyset]; 18846be056eSSteen Hegelund } 18946be056eSSteen Hegelund 1908e10490bSSteen Hegelund /* Return the keyset information for the keyset */ 1918e10490bSSteen Hegelund static const struct vcap_set *vcap_keyfieldset(struct vcap_control *vctrl, 1928e10490bSSteen Hegelund enum vcap_type vt, 1938e10490bSSteen Hegelund enum vcap_keyfield_set keyset) 1948e10490bSSteen Hegelund { 1958e10490bSSteen Hegelund const struct vcap_set *kset; 1968e10490bSSteen Hegelund 1978e10490bSSteen Hegelund /* Check that the keyset exists in the vcap keyset list */ 1988e10490bSSteen Hegelund if (keyset >= vctrl->vcaps[vt].keyfield_set_size) 1998e10490bSSteen Hegelund return NULL; 2008e10490bSSteen Hegelund kset = &vctrl->vcaps[vt].keyfield_set[keyset]; 2018e10490bSSteen Hegelund if (kset->sw_per_item == 0 || kset->sw_per_item > vctrl->vcaps[vt].sw_count) 2028e10490bSSteen Hegelund return NULL; 2038e10490bSSteen Hegelund return kset; 2048e10490bSSteen Hegelund } 2058e10490bSSteen Hegelund 206683e05c0SSteen Hegelund /* Return the typegroup table for the matching keyset (using subword size) */ 207683e05c0SSteen Hegelund static const struct vcap_typegroup * 208683e05c0SSteen Hegelund vcap_keyfield_typegroup(struct vcap_control *vctrl, 209683e05c0SSteen Hegelund enum vcap_type vt, enum vcap_keyfield_set keyset) 210683e05c0SSteen Hegelund { 211683e05c0SSteen Hegelund const struct vcap_set *kset = vcap_keyfieldset(vctrl, vt, keyset); 212683e05c0SSteen Hegelund 213683e05c0SSteen Hegelund /* Check that the keyset is valid */ 214683e05c0SSteen Hegelund if (!kset) 215683e05c0SSteen Hegelund return NULL; 216683e05c0SSteen Hegelund return vctrl->vcaps[vt].keyfield_set_typegroups[kset->sw_per_item]; 217683e05c0SSteen Hegelund } 218683e05c0SSteen Hegelund 219683e05c0SSteen Hegelund /* Return the number of keyfields in the keyset */ 220683e05c0SSteen Hegelund static int vcap_keyfield_count(struct vcap_control *vctrl, 221683e05c0SSteen Hegelund enum vcap_type vt, enum vcap_keyfield_set keyset) 222683e05c0SSteen Hegelund { 223683e05c0SSteen Hegelund /* Check that the keyset exists in the vcap keyset list */ 224683e05c0SSteen Hegelund if (keyset >= vctrl->vcaps[vt].keyfield_set_size) 225683e05c0SSteen Hegelund return 0; 226683e05c0SSteen Hegelund return vctrl->vcaps[vt].keyfield_set_map_size[keyset]; 227683e05c0SSteen Hegelund } 228683e05c0SSteen Hegelund 229683e05c0SSteen Hegelund static void vcap_encode_keyfield(struct vcap_rule_internal *ri, 230683e05c0SSteen Hegelund const struct vcap_client_keyfield *kf, 231683e05c0SSteen Hegelund const struct vcap_field *rf, 232683e05c0SSteen Hegelund const struct vcap_typegroup *tgt) 233683e05c0SSteen Hegelund { 234683e05c0SSteen Hegelund int sw_width = ri->vctrl->vcaps[ri->admin->vtype].sw_width; 235683e05c0SSteen Hegelund struct vcap_cache_data *cache = &ri->admin->cache; 236683e05c0SSteen Hegelund struct vcap_stream_iter iter; 237683e05c0SSteen Hegelund const u8 *value, *mask; 238683e05c0SSteen Hegelund 239683e05c0SSteen Hegelund /* Encode the fields for the key and the mask in their respective 240683e05c0SSteen Hegelund * streams, respecting the subword width. 241683e05c0SSteen Hegelund */ 242683e05c0SSteen Hegelund switch (kf->ctrl.type) { 243683e05c0SSteen Hegelund case VCAP_FIELD_BIT: 244683e05c0SSteen Hegelund value = &kf->data.u1.value; 245683e05c0SSteen Hegelund mask = &kf->data.u1.mask; 246683e05c0SSteen Hegelund break; 247683e05c0SSteen Hegelund case VCAP_FIELD_U32: 248683e05c0SSteen Hegelund value = (const u8 *)&kf->data.u32.value; 249683e05c0SSteen Hegelund mask = (const u8 *)&kf->data.u32.mask; 250683e05c0SSteen Hegelund break; 251683e05c0SSteen Hegelund case VCAP_FIELD_U48: 252683e05c0SSteen Hegelund value = kf->data.u48.value; 253683e05c0SSteen Hegelund mask = kf->data.u48.mask; 254683e05c0SSteen Hegelund break; 255683e05c0SSteen Hegelund case VCAP_FIELD_U56: 256683e05c0SSteen Hegelund value = kf->data.u56.value; 257683e05c0SSteen Hegelund mask = kf->data.u56.mask; 258683e05c0SSteen Hegelund break; 259683e05c0SSteen Hegelund case VCAP_FIELD_U64: 260683e05c0SSteen Hegelund value = kf->data.u64.value; 261683e05c0SSteen Hegelund mask = kf->data.u64.mask; 262683e05c0SSteen Hegelund break; 263683e05c0SSteen Hegelund case VCAP_FIELD_U72: 264683e05c0SSteen Hegelund value = kf->data.u72.value; 265683e05c0SSteen Hegelund mask = kf->data.u72.mask; 266683e05c0SSteen Hegelund break; 267683e05c0SSteen Hegelund case VCAP_FIELD_U112: 268683e05c0SSteen Hegelund value = kf->data.u112.value; 269683e05c0SSteen Hegelund mask = kf->data.u112.mask; 270683e05c0SSteen Hegelund break; 271683e05c0SSteen Hegelund case VCAP_FIELD_U128: 272683e05c0SSteen Hegelund value = kf->data.u128.value; 273683e05c0SSteen Hegelund mask = kf->data.u128.mask; 274683e05c0SSteen Hegelund break; 275683e05c0SSteen Hegelund } 276683e05c0SSteen Hegelund vcap_iter_init(&iter, sw_width, tgt, rf->offset); 277683e05c0SSteen Hegelund vcap_encode_field(cache->keystream, &iter, rf->width, value); 278683e05c0SSteen Hegelund vcap_iter_init(&iter, sw_width, tgt, rf->offset); 279683e05c0SSteen Hegelund vcap_encode_field(cache->maskstream, &iter, rf->width, mask); 280683e05c0SSteen Hegelund } 281683e05c0SSteen Hegelund 282683e05c0SSteen Hegelund static void vcap_encode_keyfield_typegroups(struct vcap_control *vctrl, 283683e05c0SSteen Hegelund struct vcap_rule_internal *ri, 284683e05c0SSteen Hegelund const struct vcap_typegroup *tgt) 285683e05c0SSteen Hegelund { 286683e05c0SSteen Hegelund int sw_width = vctrl->vcaps[ri->admin->vtype].sw_width; 287683e05c0SSteen Hegelund struct vcap_cache_data *cache = &ri->admin->cache; 288683e05c0SSteen Hegelund 289683e05c0SSteen Hegelund /* Encode the typegroup bits for the key and the mask in their streams, 290683e05c0SSteen Hegelund * respecting the subword width. 291683e05c0SSteen Hegelund */ 292683e05c0SSteen Hegelund vcap_encode_typegroups(cache->keystream, sw_width, tgt, false); 293683e05c0SSteen Hegelund vcap_encode_typegroups(cache->maskstream, sw_width, tgt, true); 294683e05c0SSteen Hegelund } 295683e05c0SSteen Hegelund 296683e05c0SSteen Hegelund static int vcap_encode_rule_keyset(struct vcap_rule_internal *ri) 297683e05c0SSteen Hegelund { 298683e05c0SSteen Hegelund const struct vcap_client_keyfield *ckf; 299683e05c0SSteen Hegelund const struct vcap_typegroup *tg_table; 300683e05c0SSteen Hegelund const struct vcap_field *kf_table; 301683e05c0SSteen Hegelund int keyset_size; 302683e05c0SSteen Hegelund 303683e05c0SSteen Hegelund /* Get a valid set of fields for the specific keyset */ 304683e05c0SSteen Hegelund kf_table = vcap_keyfields(ri->vctrl, ri->admin->vtype, ri->data.keyset); 305683e05c0SSteen Hegelund if (!kf_table) { 306683e05c0SSteen Hegelund pr_err("%s:%d: no fields available for this keyset: %d\n", 307683e05c0SSteen Hegelund __func__, __LINE__, ri->data.keyset); 308683e05c0SSteen Hegelund return -EINVAL; 309683e05c0SSteen Hegelund } 310683e05c0SSteen Hegelund /* Get a valid typegroup for the specific keyset */ 311683e05c0SSteen Hegelund tg_table = vcap_keyfield_typegroup(ri->vctrl, ri->admin->vtype, 312683e05c0SSteen Hegelund ri->data.keyset); 313683e05c0SSteen Hegelund if (!tg_table) { 314683e05c0SSteen Hegelund pr_err("%s:%d: no typegroups available for this keyset: %d\n", 315683e05c0SSteen Hegelund __func__, __LINE__, ri->data.keyset); 316683e05c0SSteen Hegelund return -EINVAL; 317683e05c0SSteen Hegelund } 318683e05c0SSteen Hegelund /* Get a valid size for the specific keyset */ 319683e05c0SSteen Hegelund keyset_size = vcap_keyfield_count(ri->vctrl, ri->admin->vtype, 320683e05c0SSteen Hegelund ri->data.keyset); 321683e05c0SSteen Hegelund if (keyset_size == 0) { 322683e05c0SSteen Hegelund pr_err("%s:%d: zero field count for this keyset: %d\n", 323683e05c0SSteen Hegelund __func__, __LINE__, ri->data.keyset); 324683e05c0SSteen Hegelund return -EINVAL; 325683e05c0SSteen Hegelund } 326683e05c0SSteen Hegelund /* Iterate over the keyfields (key, mask) in the rule 327683e05c0SSteen Hegelund * and encode these bits 328683e05c0SSteen Hegelund */ 329683e05c0SSteen Hegelund if (list_empty(&ri->data.keyfields)) { 330683e05c0SSteen Hegelund pr_err("%s:%d: no keyfields in the rule\n", __func__, __LINE__); 331683e05c0SSteen Hegelund return -EINVAL; 332683e05c0SSteen Hegelund } 333683e05c0SSteen Hegelund list_for_each_entry(ckf, &ri->data.keyfields, ctrl.list) { 334683e05c0SSteen Hegelund /* Check that the client entry exists in the keyset */ 335683e05c0SSteen Hegelund if (ckf->ctrl.key >= keyset_size) { 336683e05c0SSteen Hegelund pr_err("%s:%d: key %d is not in vcap\n", 337683e05c0SSteen Hegelund __func__, __LINE__, ckf->ctrl.key); 338683e05c0SSteen Hegelund return -EINVAL; 339683e05c0SSteen Hegelund } 340683e05c0SSteen Hegelund vcap_encode_keyfield(ri, ckf, &kf_table[ckf->ctrl.key], tg_table); 341683e05c0SSteen Hegelund } 342683e05c0SSteen Hegelund /* Add typegroup bits to the key/mask bitstreams */ 343683e05c0SSteen Hegelund vcap_encode_keyfield_typegroups(ri->vctrl, ri, tg_table); 344683e05c0SSteen Hegelund return 0; 345683e05c0SSteen Hegelund } 346683e05c0SSteen Hegelund 347683e05c0SSteen Hegelund /* Return the list of actionfields for the actionset */ 348683e05c0SSteen Hegelund static const struct vcap_field * 349683e05c0SSteen Hegelund vcap_actionfields(struct vcap_control *vctrl, 350683e05c0SSteen Hegelund enum vcap_type vt, enum vcap_actionfield_set actionset) 351683e05c0SSteen Hegelund { 352683e05c0SSteen Hegelund /* Check that the actionset exists in the vcap actionset list */ 353683e05c0SSteen Hegelund if (actionset >= vctrl->vcaps[vt].actionfield_set_size) 354683e05c0SSteen Hegelund return NULL; 355683e05c0SSteen Hegelund return vctrl->vcaps[vt].actionfield_set_map[actionset]; 356683e05c0SSteen Hegelund } 357683e05c0SSteen Hegelund 3588e10490bSSteen Hegelund static const struct vcap_set * 3598e10490bSSteen Hegelund vcap_actionfieldset(struct vcap_control *vctrl, 3608e10490bSSteen Hegelund enum vcap_type vt, enum vcap_actionfield_set actionset) 3618e10490bSSteen Hegelund { 3628e10490bSSteen Hegelund const struct vcap_set *aset; 3638e10490bSSteen Hegelund 3648e10490bSSteen Hegelund /* Check that the actionset exists in the vcap actionset list */ 3658e10490bSSteen Hegelund if (actionset >= vctrl->vcaps[vt].actionfield_set_size) 3668e10490bSSteen Hegelund return NULL; 3678e10490bSSteen Hegelund aset = &vctrl->vcaps[vt].actionfield_set[actionset]; 3688e10490bSSteen Hegelund if (aset->sw_per_item == 0 || aset->sw_per_item > vctrl->vcaps[vt].sw_count) 3698e10490bSSteen Hegelund return NULL; 3708e10490bSSteen Hegelund return aset; 3718e10490bSSteen Hegelund } 3728e10490bSSteen Hegelund 373683e05c0SSteen Hegelund /* Return the typegroup table for the matching actionset (using subword size) */ 374683e05c0SSteen Hegelund static const struct vcap_typegroup * 375683e05c0SSteen Hegelund vcap_actionfield_typegroup(struct vcap_control *vctrl, 376683e05c0SSteen Hegelund enum vcap_type vt, enum vcap_actionfield_set actionset) 377683e05c0SSteen Hegelund { 378683e05c0SSteen Hegelund const struct vcap_set *aset = vcap_actionfieldset(vctrl, vt, actionset); 379683e05c0SSteen Hegelund 380683e05c0SSteen Hegelund /* Check that the actionset is valid */ 381683e05c0SSteen Hegelund if (!aset) 382683e05c0SSteen Hegelund return NULL; 383683e05c0SSteen Hegelund return vctrl->vcaps[vt].actionfield_set_typegroups[aset->sw_per_item]; 384683e05c0SSteen Hegelund } 385683e05c0SSteen Hegelund 386683e05c0SSteen Hegelund /* Return the number of actionfields in the actionset */ 387683e05c0SSteen Hegelund static int vcap_actionfield_count(struct vcap_control *vctrl, 388683e05c0SSteen Hegelund enum vcap_type vt, 389683e05c0SSteen Hegelund enum vcap_actionfield_set actionset) 390683e05c0SSteen Hegelund { 391683e05c0SSteen Hegelund /* Check that the actionset exists in the vcap actionset list */ 392683e05c0SSteen Hegelund if (actionset >= vctrl->vcaps[vt].actionfield_set_size) 393683e05c0SSteen Hegelund return 0; 394683e05c0SSteen Hegelund return vctrl->vcaps[vt].actionfield_set_map_size[actionset]; 395683e05c0SSteen Hegelund } 396683e05c0SSteen Hegelund 397683e05c0SSteen Hegelund static void vcap_encode_actionfield(struct vcap_rule_internal *ri, 398683e05c0SSteen Hegelund const struct vcap_client_actionfield *af, 399683e05c0SSteen Hegelund const struct vcap_field *rf, 400683e05c0SSteen Hegelund const struct vcap_typegroup *tgt) 401683e05c0SSteen Hegelund { 402683e05c0SSteen Hegelund int act_width = ri->vctrl->vcaps[ri->admin->vtype].act_width; 403683e05c0SSteen Hegelund 404683e05c0SSteen Hegelund struct vcap_cache_data *cache = &ri->admin->cache; 405683e05c0SSteen Hegelund struct vcap_stream_iter iter; 406683e05c0SSteen Hegelund const u8 *value; 407683e05c0SSteen Hegelund 408683e05c0SSteen Hegelund /* Encode the action field in the stream, respecting the subword width */ 409683e05c0SSteen Hegelund switch (af->ctrl.type) { 410683e05c0SSteen Hegelund case VCAP_FIELD_BIT: 411683e05c0SSteen Hegelund value = &af->data.u1.value; 412683e05c0SSteen Hegelund break; 413683e05c0SSteen Hegelund case VCAP_FIELD_U32: 414683e05c0SSteen Hegelund value = (const u8 *)&af->data.u32.value; 415683e05c0SSteen Hegelund break; 416683e05c0SSteen Hegelund case VCAP_FIELD_U48: 417683e05c0SSteen Hegelund value = af->data.u48.value; 418683e05c0SSteen Hegelund break; 419683e05c0SSteen Hegelund case VCAP_FIELD_U56: 420683e05c0SSteen Hegelund value = af->data.u56.value; 421683e05c0SSteen Hegelund break; 422683e05c0SSteen Hegelund case VCAP_FIELD_U64: 423683e05c0SSteen Hegelund value = af->data.u64.value; 424683e05c0SSteen Hegelund break; 425683e05c0SSteen Hegelund case VCAP_FIELD_U72: 426683e05c0SSteen Hegelund value = af->data.u72.value; 427683e05c0SSteen Hegelund break; 428683e05c0SSteen Hegelund case VCAP_FIELD_U112: 429683e05c0SSteen Hegelund value = af->data.u112.value; 430683e05c0SSteen Hegelund break; 431683e05c0SSteen Hegelund case VCAP_FIELD_U128: 432683e05c0SSteen Hegelund value = af->data.u128.value; 433683e05c0SSteen Hegelund break; 434683e05c0SSteen Hegelund } 435683e05c0SSteen Hegelund vcap_iter_init(&iter, act_width, tgt, rf->offset); 436683e05c0SSteen Hegelund vcap_encode_field(cache->actionstream, &iter, rf->width, value); 437683e05c0SSteen Hegelund } 438683e05c0SSteen Hegelund 439683e05c0SSteen Hegelund static void vcap_encode_actionfield_typegroups(struct vcap_rule_internal *ri, 440683e05c0SSteen Hegelund const struct vcap_typegroup *tgt) 441683e05c0SSteen Hegelund { 442683e05c0SSteen Hegelund int sw_width = ri->vctrl->vcaps[ri->admin->vtype].act_width; 443683e05c0SSteen Hegelund struct vcap_cache_data *cache = &ri->admin->cache; 444683e05c0SSteen Hegelund 445683e05c0SSteen Hegelund /* Encode the typegroup bits for the actionstream respecting the subword 446683e05c0SSteen Hegelund * width. 447683e05c0SSteen Hegelund */ 448683e05c0SSteen Hegelund vcap_encode_typegroups(cache->actionstream, sw_width, tgt, false); 449683e05c0SSteen Hegelund } 450683e05c0SSteen Hegelund 451683e05c0SSteen Hegelund static int vcap_encode_rule_actionset(struct vcap_rule_internal *ri) 452683e05c0SSteen Hegelund { 453683e05c0SSteen Hegelund const struct vcap_client_actionfield *caf; 454683e05c0SSteen Hegelund const struct vcap_typegroup *tg_table; 455683e05c0SSteen Hegelund const struct vcap_field *af_table; 456683e05c0SSteen Hegelund int actionset_size; 457683e05c0SSteen Hegelund 458683e05c0SSteen Hegelund /* Get a valid set of actionset fields for the specific actionset */ 459683e05c0SSteen Hegelund af_table = vcap_actionfields(ri->vctrl, ri->admin->vtype, 460683e05c0SSteen Hegelund ri->data.actionset); 461683e05c0SSteen Hegelund if (!af_table) { 462683e05c0SSteen Hegelund pr_err("%s:%d: no fields available for this actionset: %d\n", 463683e05c0SSteen Hegelund __func__, __LINE__, ri->data.actionset); 464683e05c0SSteen Hegelund return -EINVAL; 465683e05c0SSteen Hegelund } 466683e05c0SSteen Hegelund /* Get a valid typegroup for the specific actionset */ 467683e05c0SSteen Hegelund tg_table = vcap_actionfield_typegroup(ri->vctrl, ri->admin->vtype, 468683e05c0SSteen Hegelund ri->data.actionset); 469683e05c0SSteen Hegelund if (!tg_table) { 470683e05c0SSteen Hegelund pr_err("%s:%d: no typegroups available for this actionset: %d\n", 471683e05c0SSteen Hegelund __func__, __LINE__, ri->data.actionset); 472683e05c0SSteen Hegelund return -EINVAL; 473683e05c0SSteen Hegelund } 474683e05c0SSteen Hegelund /* Get a valid actionset size for the specific actionset */ 475683e05c0SSteen Hegelund actionset_size = vcap_actionfield_count(ri->vctrl, ri->admin->vtype, 476683e05c0SSteen Hegelund ri->data.actionset); 477683e05c0SSteen Hegelund if (actionset_size == 0) { 478683e05c0SSteen Hegelund pr_err("%s:%d: zero field count for this actionset: %d\n", 479683e05c0SSteen Hegelund __func__, __LINE__, ri->data.actionset); 480683e05c0SSteen Hegelund return -EINVAL; 481683e05c0SSteen Hegelund } 482683e05c0SSteen Hegelund /* Iterate over the actionfields in the rule 483683e05c0SSteen Hegelund * and encode these bits 484683e05c0SSteen Hegelund */ 485683e05c0SSteen Hegelund if (list_empty(&ri->data.actionfields)) 486683e05c0SSteen Hegelund pr_warn("%s:%d: no actionfields in the rule\n", 487683e05c0SSteen Hegelund __func__, __LINE__); 488683e05c0SSteen Hegelund list_for_each_entry(caf, &ri->data.actionfields, ctrl.list) { 489683e05c0SSteen Hegelund /* Check that the client action exists in the actionset */ 490683e05c0SSteen Hegelund if (caf->ctrl.action >= actionset_size) { 491683e05c0SSteen Hegelund pr_err("%s:%d: action %d is not in vcap\n", 492683e05c0SSteen Hegelund __func__, __LINE__, caf->ctrl.action); 493683e05c0SSteen Hegelund return -EINVAL; 494683e05c0SSteen Hegelund } 495683e05c0SSteen Hegelund vcap_encode_actionfield(ri, caf, &af_table[caf->ctrl.action], 496683e05c0SSteen Hegelund tg_table); 497683e05c0SSteen Hegelund } 498683e05c0SSteen Hegelund /* Add typegroup bits to the entry bitstreams */ 499683e05c0SSteen Hegelund vcap_encode_actionfield_typegroups(ri, tg_table); 500683e05c0SSteen Hegelund return 0; 501683e05c0SSteen Hegelund } 502683e05c0SSteen Hegelund 5038e10490bSSteen Hegelund static int vcap_encode_rule(struct vcap_rule_internal *ri) 5048e10490bSSteen Hegelund { 505683e05c0SSteen Hegelund int err; 506683e05c0SSteen Hegelund 507683e05c0SSteen Hegelund err = vcap_encode_rule_keyset(ri); 508683e05c0SSteen Hegelund if (err) 509683e05c0SSteen Hegelund return err; 510683e05c0SSteen Hegelund err = vcap_encode_rule_actionset(ri); 511683e05c0SSteen Hegelund if (err) 512683e05c0SSteen Hegelund return err; 5138e10490bSSteen Hegelund return 0; 5148e10490bSSteen Hegelund } 5158e10490bSSteen Hegelund 5168e10490bSSteen Hegelund static int vcap_api_check(struct vcap_control *ctrl) 5178e10490bSSteen Hegelund { 5188e10490bSSteen Hegelund if (!ctrl) { 5198e10490bSSteen Hegelund pr_err("%s:%d: vcap control is missing\n", __func__, __LINE__); 5208e10490bSSteen Hegelund return -EINVAL; 5218e10490bSSteen Hegelund } 5228e10490bSSteen Hegelund if (!ctrl->ops || !ctrl->ops->validate_keyset || 5238e10490bSSteen Hegelund !ctrl->ops->add_default_fields || !ctrl->ops->cache_erase || 5248e10490bSSteen Hegelund !ctrl->ops->cache_write || !ctrl->ops->cache_read || 5258e10490bSSteen Hegelund !ctrl->ops->init || !ctrl->ops->update || !ctrl->ops->move || 52667456717SSteen Hegelund !ctrl->ops->port_info || !ctrl->ops->enable) { 5278e10490bSSteen Hegelund pr_err("%s:%d: client operations are missing\n", 5288e10490bSSteen Hegelund __func__, __LINE__); 5298e10490bSSteen Hegelund return -ENOENT; 5308e10490bSSteen Hegelund } 5318e10490bSSteen Hegelund return 0; 5328e10490bSSteen Hegelund } 5338e10490bSSteen Hegelund 5348e10490bSSteen Hegelund static void vcap_erase_cache(struct vcap_rule_internal *ri) 5358e10490bSSteen Hegelund { 5368e10490bSSteen Hegelund ri->vctrl->ops->cache_erase(ri->admin); 5378e10490bSSteen Hegelund } 5388e10490bSSteen Hegelund 539c9da1ac1SSteen Hegelund /* Update the keyset for the rule */ 540c9da1ac1SSteen Hegelund int vcap_set_rule_set_keyset(struct vcap_rule *rule, 541c9da1ac1SSteen Hegelund enum vcap_keyfield_set keyset) 542c9da1ac1SSteen Hegelund { 5438e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 5448e10490bSSteen Hegelund const struct vcap_set *kset; 5458e10490bSSteen Hegelund int sw_width; 5468e10490bSSteen Hegelund 5478e10490bSSteen Hegelund kset = vcap_keyfieldset(ri->vctrl, ri->admin->vtype, keyset); 5488e10490bSSteen Hegelund /* Check that the keyset is valid */ 5498e10490bSSteen Hegelund if (!kset) 5508e10490bSSteen Hegelund return -EINVAL; 5518e10490bSSteen Hegelund ri->keyset_sw = kset->sw_per_item; 5528e10490bSSteen Hegelund sw_width = ri->vctrl->vcaps[ri->admin->vtype].sw_width; 5538e10490bSSteen Hegelund ri->keyset_sw_regs = DIV_ROUND_UP(sw_width, 32); 5548e10490bSSteen Hegelund ri->data.keyset = keyset; 555c9da1ac1SSteen Hegelund return 0; 556c9da1ac1SSteen Hegelund } 557c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_set_rule_set_keyset); 558c9da1ac1SSteen Hegelund 559c9da1ac1SSteen Hegelund /* Update the actionset for the rule */ 560c9da1ac1SSteen Hegelund int vcap_set_rule_set_actionset(struct vcap_rule *rule, 561c9da1ac1SSteen Hegelund enum vcap_actionfield_set actionset) 562c9da1ac1SSteen Hegelund { 5638e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 5648e10490bSSteen Hegelund const struct vcap_set *aset; 5658e10490bSSteen Hegelund int act_width; 5668e10490bSSteen Hegelund 5678e10490bSSteen Hegelund aset = vcap_actionfieldset(ri->vctrl, ri->admin->vtype, actionset); 5688e10490bSSteen Hegelund /* Check that the actionset is valid */ 5698e10490bSSteen Hegelund if (!aset) 5708e10490bSSteen Hegelund return -EINVAL; 5718e10490bSSteen Hegelund ri->actionset_sw = aset->sw_per_item; 5728e10490bSSteen Hegelund act_width = ri->vctrl->vcaps[ri->admin->vtype].act_width; 5738e10490bSSteen Hegelund ri->actionset_sw_regs = DIV_ROUND_UP(act_width, 32); 5748e10490bSSteen Hegelund ri->data.actionset = actionset; 575c9da1ac1SSteen Hegelund return 0; 576c9da1ac1SSteen Hegelund } 577c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_set_rule_set_actionset); 578c9da1ac1SSteen Hegelund 579c9da1ac1SSteen Hegelund /* Find a rule with a provided rule id */ 580c9da1ac1SSteen Hegelund static struct vcap_rule_internal *vcap_lookup_rule(struct vcap_control *vctrl, 581c9da1ac1SSteen Hegelund u32 id) 582c9da1ac1SSteen Hegelund { 583c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri; 584c9da1ac1SSteen Hegelund struct vcap_admin *admin; 585c9da1ac1SSteen Hegelund 586c9da1ac1SSteen Hegelund /* Look for the rule id in all vcaps */ 587c9da1ac1SSteen Hegelund list_for_each_entry(admin, &vctrl->list, list) 588c9da1ac1SSteen Hegelund list_for_each_entry(ri, &admin->rules, list) 589c9da1ac1SSteen Hegelund if (ri->data.id == id) 590c9da1ac1SSteen Hegelund return ri; 591c9da1ac1SSteen Hegelund return NULL; 592c9da1ac1SSteen Hegelund } 593c9da1ac1SSteen Hegelund 594c9da1ac1SSteen Hegelund /* Find a rule id with a provided cookie */ 595c9da1ac1SSteen Hegelund int vcap_lookup_rule_by_cookie(struct vcap_control *vctrl, u64 cookie) 596c9da1ac1SSteen Hegelund { 597c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri; 598c9da1ac1SSteen Hegelund struct vcap_admin *admin; 599c9da1ac1SSteen Hegelund 600c9da1ac1SSteen Hegelund /* Look for the rule id in all vcaps */ 601c9da1ac1SSteen Hegelund list_for_each_entry(admin, &vctrl->list, list) 602c9da1ac1SSteen Hegelund list_for_each_entry(ri, &admin->rules, list) 603c9da1ac1SSteen Hegelund if (ri->data.cookie == cookie) 604c9da1ac1SSteen Hegelund return ri->data.id; 605c9da1ac1SSteen Hegelund return -ENOENT; 606c9da1ac1SSteen Hegelund } 607c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_lookup_rule_by_cookie); 608c9da1ac1SSteen Hegelund 6098e10490bSSteen Hegelund /* Make a shallow copy of the rule without the fields */ 6108e10490bSSteen Hegelund static struct vcap_rule_internal *vcap_dup_rule(struct vcap_rule_internal *ri) 6118e10490bSSteen Hegelund { 6128e10490bSSteen Hegelund struct vcap_rule_internal *duprule; 6138e10490bSSteen Hegelund 6148e10490bSSteen Hegelund /* Allocate the client part */ 6158e10490bSSteen Hegelund duprule = kzalloc(sizeof(*duprule), GFP_KERNEL); 6168e10490bSSteen Hegelund if (!duprule) 6178e10490bSSteen Hegelund return ERR_PTR(-ENOMEM); 6188e10490bSSteen Hegelund *duprule = *ri; 6198e10490bSSteen Hegelund /* Not inserted in the VCAP */ 6208e10490bSSteen Hegelund INIT_LIST_HEAD(&duprule->list); 6218e10490bSSteen Hegelund /* No elements in these lists */ 6228e10490bSSteen Hegelund INIT_LIST_HEAD(&duprule->data.keyfields); 6238e10490bSSteen Hegelund INIT_LIST_HEAD(&duprule->data.actionfields); 6248e10490bSSteen Hegelund return duprule; 6258e10490bSSteen Hegelund } 6268e10490bSSteen Hegelund 6278e10490bSSteen Hegelund /* Write VCAP cache content to the VCAP HW instance */ 6288e10490bSSteen Hegelund static int vcap_write_rule(struct vcap_rule_internal *ri) 6298e10490bSSteen Hegelund { 6308e10490bSSteen Hegelund struct vcap_admin *admin = ri->admin; 6318e10490bSSteen Hegelund int sw_idx, ent_idx = 0, act_idx = 0; 6328e10490bSSteen Hegelund u32 addr = ri->addr; 6338e10490bSSteen Hegelund 6348e10490bSSteen Hegelund if (!ri->size || !ri->keyset_sw_regs || !ri->actionset_sw_regs) { 6358e10490bSSteen Hegelund pr_err("%s:%d: rule is empty\n", __func__, __LINE__); 6368e10490bSSteen Hegelund return -EINVAL; 6378e10490bSSteen Hegelund } 6388e10490bSSteen Hegelund /* Use the values in the streams to write the VCAP cache */ 6398e10490bSSteen Hegelund for (sw_idx = 0; sw_idx < ri->size; sw_idx++, addr++) { 6408e10490bSSteen Hegelund ri->vctrl->ops->cache_write(ri->ndev, admin, 6418e10490bSSteen Hegelund VCAP_SEL_ENTRY, ent_idx, 6428e10490bSSteen Hegelund ri->keyset_sw_regs); 6438e10490bSSteen Hegelund ri->vctrl->ops->cache_write(ri->ndev, admin, 6448e10490bSSteen Hegelund VCAP_SEL_ACTION, act_idx, 6458e10490bSSteen Hegelund ri->actionset_sw_regs); 6468e10490bSSteen Hegelund ri->vctrl->ops->update(ri->ndev, admin, VCAP_CMD_WRITE, 6478e10490bSSteen Hegelund VCAP_SEL_ALL, addr); 6488e10490bSSteen Hegelund ent_idx += ri->keyset_sw_regs; 6498e10490bSSteen Hegelund act_idx += ri->actionset_sw_regs; 6508e10490bSSteen Hegelund } 6518e10490bSSteen Hegelund return 0; 6528e10490bSSteen Hegelund } 6538e10490bSSteen Hegelund 6547de1dcadSSteen Hegelund /* Convert a chain id to a VCAP lookup index */ 6557de1dcadSSteen Hegelund int vcap_chain_id_to_lookup(struct vcap_admin *admin, int cur_cid) 6567de1dcadSSteen Hegelund { 6577de1dcadSSteen Hegelund int lookup_first = admin->vinst * admin->lookups_per_instance; 6587de1dcadSSteen Hegelund int lookup_last = lookup_first + admin->lookups_per_instance; 6597de1dcadSSteen Hegelund int cid_next = admin->first_cid + VCAP_CID_LOOKUP_SIZE; 6607de1dcadSSteen Hegelund int cid = admin->first_cid; 6617de1dcadSSteen Hegelund int lookup; 6627de1dcadSSteen Hegelund 6637de1dcadSSteen Hegelund for (lookup = lookup_first; lookup < lookup_last; ++lookup, 6647de1dcadSSteen Hegelund cid += VCAP_CID_LOOKUP_SIZE, cid_next += VCAP_CID_LOOKUP_SIZE) 6657de1dcadSSteen Hegelund if (cur_cid >= cid && cur_cid < cid_next) 6667de1dcadSSteen Hegelund return lookup; 6677de1dcadSSteen Hegelund return 0; 6687de1dcadSSteen Hegelund } 6697de1dcadSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_chain_id_to_lookup); 6707de1dcadSSteen Hegelund 671c9da1ac1SSteen Hegelund /* Lookup a vcap instance using chain id */ 672c9da1ac1SSteen Hegelund struct vcap_admin *vcap_find_admin(struct vcap_control *vctrl, int cid) 673c9da1ac1SSteen Hegelund { 674c9da1ac1SSteen Hegelund struct vcap_admin *admin; 675c9da1ac1SSteen Hegelund 6768e10490bSSteen Hegelund if (vcap_api_check(vctrl)) 6778e10490bSSteen Hegelund return NULL; 6788e10490bSSteen Hegelund 679c9da1ac1SSteen Hegelund list_for_each_entry(admin, &vctrl->list, list) { 680c9da1ac1SSteen Hegelund if (cid >= admin->first_cid && cid <= admin->last_cid) 681c9da1ac1SSteen Hegelund return admin; 682c9da1ac1SSteen Hegelund } 683c9da1ac1SSteen Hegelund return NULL; 684c9da1ac1SSteen Hegelund } 685c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_find_admin); 686c9da1ac1SSteen Hegelund 687392d0ab0SSteen Hegelund /* Is the next chain id in the following lookup, possible in another VCAP */ 688392d0ab0SSteen Hegelund bool vcap_is_next_lookup(struct vcap_control *vctrl, int cur_cid, int next_cid) 689392d0ab0SSteen Hegelund { 690392d0ab0SSteen Hegelund struct vcap_admin *admin, *next_admin; 691392d0ab0SSteen Hegelund int lookup, next_lookup; 692392d0ab0SSteen Hegelund 693392d0ab0SSteen Hegelund /* The offset must be at least one lookup */ 694392d0ab0SSteen Hegelund if (next_cid < cur_cid + VCAP_CID_LOOKUP_SIZE) 695392d0ab0SSteen Hegelund return false; 696392d0ab0SSteen Hegelund 697392d0ab0SSteen Hegelund if (vcap_api_check(vctrl)) 698392d0ab0SSteen Hegelund return false; 699392d0ab0SSteen Hegelund 700392d0ab0SSteen Hegelund admin = vcap_find_admin(vctrl, cur_cid); 701392d0ab0SSteen Hegelund if (!admin) 702392d0ab0SSteen Hegelund return false; 703392d0ab0SSteen Hegelund 704392d0ab0SSteen Hegelund /* If no VCAP contains the next chain, the next chain must be beyond 705392d0ab0SSteen Hegelund * the last chain in the current VCAP 706392d0ab0SSteen Hegelund */ 707392d0ab0SSteen Hegelund next_admin = vcap_find_admin(vctrl, next_cid); 708392d0ab0SSteen Hegelund if (!next_admin) 709392d0ab0SSteen Hegelund return next_cid > admin->last_cid; 710392d0ab0SSteen Hegelund 711392d0ab0SSteen Hegelund lookup = vcap_chain_id_to_lookup(admin, cur_cid); 712392d0ab0SSteen Hegelund next_lookup = vcap_chain_id_to_lookup(next_admin, next_cid); 713392d0ab0SSteen Hegelund 714392d0ab0SSteen Hegelund /* Next lookup must be the following lookup */ 715392d0ab0SSteen Hegelund if (admin == next_admin || admin->vtype == next_admin->vtype) 716392d0ab0SSteen Hegelund return next_lookup == lookup + 1; 717392d0ab0SSteen Hegelund 718392d0ab0SSteen Hegelund /* Must be the first lookup in the next VCAP instance */ 719392d0ab0SSteen Hegelund return next_lookup == 0; 720392d0ab0SSteen Hegelund } 721392d0ab0SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_is_next_lookup); 722392d0ab0SSteen Hegelund 7238e10490bSSteen Hegelund /* Check if there is room for a new rule */ 7248e10490bSSteen Hegelund static int vcap_rule_space(struct vcap_admin *admin, int size) 7258e10490bSSteen Hegelund { 7268e10490bSSteen Hegelund if (admin->last_used_addr - size < admin->first_valid_addr) { 7278e10490bSSteen Hegelund pr_err("%s:%d: No room for rule size: %u, %u\n", 7288e10490bSSteen Hegelund __func__, __LINE__, size, admin->first_valid_addr); 7298e10490bSSteen Hegelund return -ENOSPC; 7308e10490bSSteen Hegelund } 7318e10490bSSteen Hegelund return 0; 7328e10490bSSteen Hegelund } 7338e10490bSSteen Hegelund 7348e10490bSSteen Hegelund /* Add the keyset typefield to the list of rule keyfields */ 7358e10490bSSteen Hegelund static int vcap_add_type_keyfield(struct vcap_rule *rule) 7368e10490bSSteen Hegelund { 7378e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 7388e10490bSSteen Hegelund enum vcap_keyfield_set keyset = rule->keyset; 7398e10490bSSteen Hegelund enum vcap_type vt = ri->admin->vtype; 7408e10490bSSteen Hegelund const struct vcap_field *fields; 7418e10490bSSteen Hegelund const struct vcap_set *kset; 7428e10490bSSteen Hegelund int ret = -EINVAL; 7438e10490bSSteen Hegelund 7448e10490bSSteen Hegelund kset = vcap_keyfieldset(ri->vctrl, vt, keyset); 7458e10490bSSteen Hegelund if (!kset) 7468e10490bSSteen Hegelund return ret; 7478e10490bSSteen Hegelund if (kset->type_id == (u8)-1) /* No type field is needed */ 7488e10490bSSteen Hegelund return 0; 7498e10490bSSteen Hegelund 7508e10490bSSteen Hegelund fields = vcap_keyfields(ri->vctrl, vt, keyset); 7518e10490bSSteen Hegelund if (!fields) 7528e10490bSSteen Hegelund return -EINVAL; 7538e10490bSSteen Hegelund if (fields[VCAP_KF_TYPE].width > 1) { 7548e10490bSSteen Hegelund ret = vcap_rule_add_key_u32(rule, VCAP_KF_TYPE, 7558e10490bSSteen Hegelund kset->type_id, 0xff); 7568e10490bSSteen Hegelund } else { 7578e10490bSSteen Hegelund if (kset->type_id) 7588e10490bSSteen Hegelund ret = vcap_rule_add_key_bit(rule, VCAP_KF_TYPE, 7598e10490bSSteen Hegelund VCAP_BIT_1); 7608e10490bSSteen Hegelund else 7618e10490bSSteen Hegelund ret = vcap_rule_add_key_bit(rule, VCAP_KF_TYPE, 7628e10490bSSteen Hegelund VCAP_BIT_0); 7638e10490bSSteen Hegelund } 7648e10490bSSteen Hegelund return 0; 7658e10490bSSteen Hegelund } 7668e10490bSSteen Hegelund 767abc4010dSSteen Hegelund /* Add a keyset to a keyset list */ 768abc4010dSSteen Hegelund bool vcap_keyset_list_add(struct vcap_keyset_list *keysetlist, 769abc4010dSSteen Hegelund enum vcap_keyfield_set keyset) 770abc4010dSSteen Hegelund { 771abc4010dSSteen Hegelund int idx; 772abc4010dSSteen Hegelund 773abc4010dSSteen Hegelund if (keysetlist->cnt < keysetlist->max) { 774abc4010dSSteen Hegelund /* Avoid duplicates */ 775abc4010dSSteen Hegelund for (idx = 0; idx < keysetlist->cnt; ++idx) 776abc4010dSSteen Hegelund if (keysetlist->keysets[idx] == keyset) 777abc4010dSSteen Hegelund return keysetlist->cnt < keysetlist->max; 778abc4010dSSteen Hegelund keysetlist->keysets[keysetlist->cnt++] = keyset; 779abc4010dSSteen Hegelund } 780abc4010dSSteen Hegelund return keysetlist->cnt < keysetlist->max; 781abc4010dSSteen Hegelund } 782abc4010dSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_keyset_list_add); 783abc4010dSSteen Hegelund 784abc4010dSSteen Hegelund /* map keyset id to a string with the keyset name */ 785abc4010dSSteen Hegelund const char *vcap_keyset_name(struct vcap_control *vctrl, 786abc4010dSSteen Hegelund enum vcap_keyfield_set keyset) 787abc4010dSSteen Hegelund { 788abc4010dSSteen Hegelund return vctrl->stats->keyfield_set_names[keyset]; 789abc4010dSSteen Hegelund } 790abc4010dSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_keyset_name); 791abc4010dSSteen Hegelund 792abc4010dSSteen Hegelund /* map key field id to a string with the key name */ 793abc4010dSSteen Hegelund const char *vcap_keyfield_name(struct vcap_control *vctrl, 794abc4010dSSteen Hegelund enum vcap_key_field key) 795abc4010dSSteen Hegelund { 796abc4010dSSteen Hegelund return vctrl->stats->keyfield_names[key]; 797abc4010dSSteen Hegelund } 798abc4010dSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_keyfield_name); 799abc4010dSSteen Hegelund 800242df4f7SSteen Hegelund /* map action field id to a string with the action name */ 801242df4f7SSteen Hegelund static const char *vcap_actionfield_name(struct vcap_control *vctrl, 802242df4f7SSteen Hegelund enum vcap_action_field action) 803242df4f7SSteen Hegelund { 804242df4f7SSteen Hegelund return vctrl->stats->actionfield_names[action]; 805242df4f7SSteen Hegelund } 806242df4f7SSteen Hegelund 807abc4010dSSteen Hegelund /* Return the keyfield that matches a key in a keyset */ 808abc4010dSSteen Hegelund static const struct vcap_field * 809abc4010dSSteen Hegelund vcap_find_keyset_keyfield(struct vcap_control *vctrl, 810abc4010dSSteen Hegelund enum vcap_type vtype, 811abc4010dSSteen Hegelund enum vcap_keyfield_set keyset, 812abc4010dSSteen Hegelund enum vcap_key_field key) 813abc4010dSSteen Hegelund { 814abc4010dSSteen Hegelund const struct vcap_field *fields; 815abc4010dSSteen Hegelund int idx, count; 816abc4010dSSteen Hegelund 817abc4010dSSteen Hegelund fields = vcap_keyfields(vctrl, vtype, keyset); 818abc4010dSSteen Hegelund if (!fields) 819abc4010dSSteen Hegelund return NULL; 820abc4010dSSteen Hegelund 821abc4010dSSteen Hegelund /* Iterate the keyfields of the keyset */ 822abc4010dSSteen Hegelund count = vcap_keyfield_count(vctrl, vtype, keyset); 823abc4010dSSteen Hegelund for (idx = 0; idx < count; ++idx) { 824abc4010dSSteen Hegelund if (fields[idx].width == 0) 825abc4010dSSteen Hegelund continue; 826abc4010dSSteen Hegelund 827abc4010dSSteen Hegelund if (key == idx) 828abc4010dSSteen Hegelund return &fields[idx]; 829abc4010dSSteen Hegelund } 830abc4010dSSteen Hegelund 831abc4010dSSteen Hegelund return NULL; 832abc4010dSSteen Hegelund } 833abc4010dSSteen Hegelund 834abc4010dSSteen Hegelund /* Match a list of keys against the keysets available in a vcap type */ 835abc4010dSSteen Hegelund static bool vcap_rule_find_keysets(struct vcap_rule_internal *ri, 836abc4010dSSteen Hegelund struct vcap_keyset_list *matches) 837abc4010dSSteen Hegelund { 838abc4010dSSteen Hegelund const struct vcap_client_keyfield *ckf; 839abc4010dSSteen Hegelund int keyset, found, keycount, map_size; 840abc4010dSSteen Hegelund const struct vcap_field **map; 841abc4010dSSteen Hegelund enum vcap_type vtype; 842abc4010dSSteen Hegelund 843abc4010dSSteen Hegelund vtype = ri->admin->vtype; 844abc4010dSSteen Hegelund map = ri->vctrl->vcaps[vtype].keyfield_set_map; 845abc4010dSSteen Hegelund map_size = ri->vctrl->vcaps[vtype].keyfield_set_size; 846abc4010dSSteen Hegelund 847abc4010dSSteen Hegelund /* Get a count of the keyfields we want to match */ 848abc4010dSSteen Hegelund keycount = 0; 849abc4010dSSteen Hegelund list_for_each_entry(ckf, &ri->data.keyfields, ctrl.list) 850abc4010dSSteen Hegelund ++keycount; 851abc4010dSSteen Hegelund 852abc4010dSSteen Hegelund matches->cnt = 0; 853abc4010dSSteen Hegelund /* Iterate the keysets of the VCAP */ 854abc4010dSSteen Hegelund for (keyset = 0; keyset < map_size; ++keyset) { 855abc4010dSSteen Hegelund if (!map[keyset]) 856abc4010dSSteen Hegelund continue; 857abc4010dSSteen Hegelund 858abc4010dSSteen Hegelund /* Iterate the keys in the rule */ 859abc4010dSSteen Hegelund found = 0; 860abc4010dSSteen Hegelund list_for_each_entry(ckf, &ri->data.keyfields, ctrl.list) 861abc4010dSSteen Hegelund if (vcap_find_keyset_keyfield(ri->vctrl, vtype, 862abc4010dSSteen Hegelund keyset, ckf->ctrl.key)) 863abc4010dSSteen Hegelund ++found; 864abc4010dSSteen Hegelund 865abc4010dSSteen Hegelund /* Save the keyset if all keyfields were found */ 866abc4010dSSteen Hegelund if (found == keycount) 867abc4010dSSteen Hegelund if (!vcap_keyset_list_add(matches, keyset)) 868abc4010dSSteen Hegelund /* bail out when the quota is filled */ 869abc4010dSSteen Hegelund break; 870abc4010dSSteen Hegelund } 871abc4010dSSteen Hegelund 872abc4010dSSteen Hegelund return matches->cnt > 0; 873abc4010dSSteen Hegelund } 874abc4010dSSteen Hegelund 875c9da1ac1SSteen Hegelund /* Validate a rule with respect to available port keys */ 876c9da1ac1SSteen Hegelund int vcap_val_rule(struct vcap_rule *rule, u16 l3_proto) 877c9da1ac1SSteen Hegelund { 878c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 879abc4010dSSteen Hegelund struct vcap_keyset_list matches = {}; 8808e10490bSSteen Hegelund enum vcap_keyfield_set keysets[10]; 8818e10490bSSteen Hegelund int ret; 882c9da1ac1SSteen Hegelund 8838e10490bSSteen Hegelund ret = vcap_api_check(ri->vctrl); 8848e10490bSSteen Hegelund if (ret) 8858e10490bSSteen Hegelund return ret; 886c9da1ac1SSteen Hegelund if (!ri->admin) { 887c9da1ac1SSteen Hegelund ri->data.exterr = VCAP_ERR_NO_ADMIN; 888c9da1ac1SSteen Hegelund return -EINVAL; 889c9da1ac1SSteen Hegelund } 890c9da1ac1SSteen Hegelund if (!ri->ndev) { 891c9da1ac1SSteen Hegelund ri->data.exterr = VCAP_ERR_NO_NETDEV; 892c9da1ac1SSteen Hegelund return -EINVAL; 893c9da1ac1SSteen Hegelund } 894abc4010dSSteen Hegelund 895abc4010dSSteen Hegelund matches.keysets = keysets; 896abc4010dSSteen Hegelund matches.max = ARRAY_SIZE(keysets); 897c9da1ac1SSteen Hegelund if (ri->data.keyset == VCAP_KFS_NO_VALUE) { 898abc4010dSSteen Hegelund /* Iterate over rule keyfields and select keysets that fits */ 899abc4010dSSteen Hegelund if (!vcap_rule_find_keysets(ri, &matches)) { 900c9da1ac1SSteen Hegelund ri->data.exterr = VCAP_ERR_NO_KEYSET_MATCH; 901c9da1ac1SSteen Hegelund return -EINVAL; 902c9da1ac1SSteen Hegelund } 903abc4010dSSteen Hegelund } else { 9048e10490bSSteen Hegelund /* prepare for keyset validation */ 9058e10490bSSteen Hegelund keysets[0] = ri->data.keyset; 906abc4010dSSteen Hegelund matches.cnt = 1; 907abc4010dSSteen Hegelund } 908abc4010dSSteen Hegelund 9098e10490bSSteen Hegelund /* Pick a keyset that is supported in the port lookups */ 910abc4010dSSteen Hegelund ret = ri->vctrl->ops->validate_keyset(ri->ndev, ri->admin, rule, 911abc4010dSSteen Hegelund &matches, l3_proto); 9128e10490bSSteen Hegelund if (ret < 0) { 9138e10490bSSteen Hegelund pr_err("%s:%d: keyset validation failed: %d\n", 9148e10490bSSteen Hegelund __func__, __LINE__, ret); 9158e10490bSSteen Hegelund ri->data.exterr = VCAP_ERR_NO_PORT_KEYSET_MATCH; 9168e10490bSSteen Hegelund return ret; 9178e10490bSSteen Hegelund } 918abc4010dSSteen Hegelund /* use the keyset that is supported in the port lookups */ 919abc4010dSSteen Hegelund ret = vcap_set_rule_set_keyset(rule, ret); 920abc4010dSSteen Hegelund if (ret < 0) { 921abc4010dSSteen Hegelund pr_err("%s:%d: keyset was not updated: %d\n", 922abc4010dSSteen Hegelund __func__, __LINE__, ret); 923abc4010dSSteen Hegelund return ret; 924abc4010dSSteen Hegelund } 925c9da1ac1SSteen Hegelund if (ri->data.actionset == VCAP_AFS_NO_VALUE) { 926abc4010dSSteen Hegelund /* Later also actionsets will be matched against actions in 927abc4010dSSteen Hegelund * the rule, and the type will be set accordingly 928abc4010dSSteen Hegelund */ 929c9da1ac1SSteen Hegelund ri->data.exterr = VCAP_ERR_NO_ACTIONSET_MATCH; 930c9da1ac1SSteen Hegelund return -EINVAL; 931c9da1ac1SSteen Hegelund } 9328e10490bSSteen Hegelund vcap_add_type_keyfield(rule); 9338e10490bSSteen Hegelund /* Add default fields to this rule */ 9348e10490bSSteen Hegelund ri->vctrl->ops->add_default_fields(ri->ndev, ri->admin, rule); 9358e10490bSSteen Hegelund 9368e10490bSSteen Hegelund /* Rule size is the maximum of the entry and action subword count */ 9378e10490bSSteen Hegelund ri->size = max(ri->keyset_sw, ri->actionset_sw); 9388e10490bSSteen Hegelund 9398e10490bSSteen Hegelund /* Finally check if there is room for the rule in the VCAP */ 9408e10490bSSteen Hegelund return vcap_rule_space(ri->admin, ri->size); 941c9da1ac1SSteen Hegelund } 942c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_val_rule); 943c9da1ac1SSteen Hegelund 944*990e4839SSteen Hegelund /* Entries are sorted with increasing values of sort_key. 945*990e4839SSteen Hegelund * I.e. Lowest numerical sort_key is first in list. 946*990e4839SSteen Hegelund * In order to locate largest keys first in list we negate the key size with 947*990e4839SSteen Hegelund * (max_size - size). 948*990e4839SSteen Hegelund */ 949*990e4839SSteen Hegelund static u32 vcap_sort_key(u32 max_size, u32 size, u8 user, u16 prio) 950*990e4839SSteen Hegelund { 951*990e4839SSteen Hegelund return ((max_size - size) << 24) | (user << 16) | prio; 952*990e4839SSteen Hegelund } 953*990e4839SSteen Hegelund 9548e10490bSSteen Hegelund /* calculate the address of the next rule after this (lower address and prio) */ 9558e10490bSSteen Hegelund static u32 vcap_next_rule_addr(u32 addr, struct vcap_rule_internal *ri) 9568e10490bSSteen Hegelund { 9578e10490bSSteen Hegelund return ((addr - ri->size) / ri->size) * ri->size; 9588e10490bSSteen Hegelund } 9598e10490bSSteen Hegelund 960c9da1ac1SSteen Hegelund /* Assign a unique rule id and autogenerate one if id == 0 */ 961c9da1ac1SSteen Hegelund static u32 vcap_set_rule_id(struct vcap_rule_internal *ri) 962c9da1ac1SSteen Hegelund { 963c9da1ac1SSteen Hegelund u32 next_id; 964c9da1ac1SSteen Hegelund 965c9da1ac1SSteen Hegelund if (ri->data.id != 0) 966c9da1ac1SSteen Hegelund return ri->data.id; 967c9da1ac1SSteen Hegelund 968c9da1ac1SSteen Hegelund next_id = ri->vctrl->rule_id + 1; 969c9da1ac1SSteen Hegelund 970c9da1ac1SSteen Hegelund for (next_id = ri->vctrl->rule_id + 1; next_id < ~0; ++next_id) { 971c9da1ac1SSteen Hegelund if (!vcap_lookup_rule(ri->vctrl, next_id)) { 972c9da1ac1SSteen Hegelund ri->data.id = next_id; 973c9da1ac1SSteen Hegelund ri->vctrl->rule_id = next_id; 974c9da1ac1SSteen Hegelund break; 975c9da1ac1SSteen Hegelund } 976c9da1ac1SSteen Hegelund } 977c9da1ac1SSteen Hegelund return ri->data.id; 978c9da1ac1SSteen Hegelund } 979c9da1ac1SSteen Hegelund 9808e10490bSSteen Hegelund static int vcap_insert_rule(struct vcap_rule_internal *ri, 9818e10490bSSteen Hegelund struct vcap_rule_move *move) 9828e10490bSSteen Hegelund { 983*990e4839SSteen Hegelund int sw_count = ri->vctrl->vcaps[ri->admin->vtype].sw_count; 984*990e4839SSteen Hegelund struct vcap_rule_internal *duprule, *iter, *elem = NULL; 9858e10490bSSteen Hegelund struct vcap_admin *admin = ri->admin; 986*990e4839SSteen Hegelund u32 addr; 9878e10490bSSteen Hegelund 988*990e4839SSteen Hegelund ri->sort_key = vcap_sort_key(sw_count, ri->size, ri->data.user, 989*990e4839SSteen Hegelund ri->data.priority); 990*990e4839SSteen Hegelund 991*990e4839SSteen Hegelund /* Insert the new rule in the list of rule based on the sort key 992*990e4839SSteen Hegelund * If the rule needs to be inserted between existing rules then move 993*990e4839SSteen Hegelund * these rules to make room for the new rule and update their start 994*990e4839SSteen Hegelund * address. 995*990e4839SSteen Hegelund */ 996*990e4839SSteen Hegelund list_for_each_entry(iter, &admin->rules, list) { 997*990e4839SSteen Hegelund if (ri->sort_key < iter->sort_key) { 998*990e4839SSteen Hegelund elem = iter; 999*990e4839SSteen Hegelund break; 1000*990e4839SSteen Hegelund } 1001*990e4839SSteen Hegelund } 1002*990e4839SSteen Hegelund 1003*990e4839SSteen Hegelund if (!elem) { 10048e10490bSSteen Hegelund ri->addr = vcap_next_rule_addr(admin->last_used_addr, ri); 10058e10490bSSteen Hegelund admin->last_used_addr = ri->addr; 1006*990e4839SSteen Hegelund 10078e10490bSSteen Hegelund /* Add a shallow copy of the rule to the VCAP list */ 10088e10490bSSteen Hegelund duprule = vcap_dup_rule(ri); 10098e10490bSSteen Hegelund if (IS_ERR(duprule)) 10108e10490bSSteen Hegelund return PTR_ERR(duprule); 1011*990e4839SSteen Hegelund 10128e10490bSSteen Hegelund list_add_tail(&duprule->list, &admin->rules); 10138e10490bSSteen Hegelund return 0; 10148e10490bSSteen Hegelund } 10158e10490bSSteen Hegelund 1016*990e4839SSteen Hegelund /* Reuse the space of the current rule */ 1017*990e4839SSteen Hegelund addr = elem->addr + elem->size; 1018*990e4839SSteen Hegelund ri->addr = vcap_next_rule_addr(addr, ri); 1019*990e4839SSteen Hegelund addr = ri->addr; 1020*990e4839SSteen Hegelund 1021*990e4839SSteen Hegelund /* Add a shallow copy of the rule to the VCAP list */ 1022*990e4839SSteen Hegelund duprule = vcap_dup_rule(ri); 1023*990e4839SSteen Hegelund if (IS_ERR(duprule)) 1024*990e4839SSteen Hegelund return PTR_ERR(duprule); 1025*990e4839SSteen Hegelund 1026*990e4839SSteen Hegelund /* Add before the current entry */ 1027*990e4839SSteen Hegelund list_add_tail(&duprule->list, &elem->list); 1028*990e4839SSteen Hegelund 1029*990e4839SSteen Hegelund /* Update the current rule */ 1030*990e4839SSteen Hegelund elem->addr = vcap_next_rule_addr(addr, elem); 1031*990e4839SSteen Hegelund addr = elem->addr; 1032*990e4839SSteen Hegelund 1033*990e4839SSteen Hegelund /* Update the address in the remaining rules in the list */ 1034*990e4839SSteen Hegelund list_for_each_entry_continue(elem, &admin->rules, list) { 1035*990e4839SSteen Hegelund elem->addr = vcap_next_rule_addr(addr, elem); 1036*990e4839SSteen Hegelund addr = elem->addr; 1037*990e4839SSteen Hegelund } 1038*990e4839SSteen Hegelund 1039*990e4839SSteen Hegelund /* Update the move info */ 1040*990e4839SSteen Hegelund move->addr = admin->last_used_addr; 1041*990e4839SSteen Hegelund move->count = ri->addr - addr; 1042*990e4839SSteen Hegelund move->offset = admin->last_used_addr - addr; 1043*990e4839SSteen Hegelund admin->last_used_addr = addr; 1044*990e4839SSteen Hegelund return 0; 1045*990e4839SSteen Hegelund } 1046*990e4839SSteen Hegelund 10478e10490bSSteen Hegelund static void vcap_move_rules(struct vcap_rule_internal *ri, 10488e10490bSSteen Hegelund struct vcap_rule_move *move) 10498e10490bSSteen Hegelund { 10508e10490bSSteen Hegelund ri->vctrl->ops->move(ri->ndev, ri->admin, move->addr, 10518e10490bSSteen Hegelund move->offset, move->count); 10528e10490bSSteen Hegelund } 10538e10490bSSteen Hegelund 1054c9da1ac1SSteen Hegelund /* Encode and write a validated rule to the VCAP */ 1055c9da1ac1SSteen Hegelund int vcap_add_rule(struct vcap_rule *rule) 1056c9da1ac1SSteen Hegelund { 10578e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 10588e10490bSSteen Hegelund struct vcap_rule_move move = {0}; 10598e10490bSSteen Hegelund int ret; 10608e10490bSSteen Hegelund 10618e10490bSSteen Hegelund ret = vcap_api_check(ri->vctrl); 10628e10490bSSteen Hegelund if (ret) 10638e10490bSSteen Hegelund return ret; 10648e10490bSSteen Hegelund /* Insert the new rule in the list of vcap rules */ 10658e10490bSSteen Hegelund ret = vcap_insert_rule(ri, &move); 10668e10490bSSteen Hegelund if (ret < 0) { 10678e10490bSSteen Hegelund pr_err("%s:%d: could not insert rule in vcap list: %d\n", 10688e10490bSSteen Hegelund __func__, __LINE__, ret); 10698e10490bSSteen Hegelund goto out; 10708e10490bSSteen Hegelund } 10718e10490bSSteen Hegelund if (move.count > 0) 10728e10490bSSteen Hegelund vcap_move_rules(ri, &move); 10738e10490bSSteen Hegelund ret = vcap_encode_rule(ri); 10748e10490bSSteen Hegelund if (ret) { 10758e10490bSSteen Hegelund pr_err("%s:%d: rule encoding error: %d\n", __func__, __LINE__, ret); 10768e10490bSSteen Hegelund goto out; 10778e10490bSSteen Hegelund } 10788e10490bSSteen Hegelund 10798e10490bSSteen Hegelund ret = vcap_write_rule(ri); 10808e10490bSSteen Hegelund if (ret) 10818e10490bSSteen Hegelund pr_err("%s:%d: rule write error: %d\n", __func__, __LINE__, ret); 10828e10490bSSteen Hegelund out: 10838e10490bSSteen Hegelund return ret; 1084c9da1ac1SSteen Hegelund } 1085c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_add_rule); 1086c9da1ac1SSteen Hegelund 1087c9da1ac1SSteen Hegelund /* Allocate a new rule with the provided arguments */ 1088c9da1ac1SSteen Hegelund struct vcap_rule *vcap_alloc_rule(struct vcap_control *vctrl, 1089c9da1ac1SSteen Hegelund struct net_device *ndev, int vcap_chain_id, 1090c9da1ac1SSteen Hegelund enum vcap_user user, u16 priority, 1091c9da1ac1SSteen Hegelund u32 id) 1092c9da1ac1SSteen Hegelund { 1093c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri; 1094c9da1ac1SSteen Hegelund struct vcap_admin *admin; 1095*990e4839SSteen Hegelund int err, maxsize; 1096c9da1ac1SSteen Hegelund 1097*990e4839SSteen Hegelund err = vcap_api_check(vctrl); 1098*990e4839SSteen Hegelund if (err) 1099*990e4839SSteen Hegelund return ERR_PTR(err); 1100c9da1ac1SSteen Hegelund if (!ndev) 1101c9da1ac1SSteen Hegelund return ERR_PTR(-ENODEV); 1102c9da1ac1SSteen Hegelund /* Get the VCAP instance */ 1103c9da1ac1SSteen Hegelund admin = vcap_find_admin(vctrl, vcap_chain_id); 1104c9da1ac1SSteen Hegelund if (!admin) 1105c9da1ac1SSteen Hegelund return ERR_PTR(-ENOENT); 11068e10490bSSteen Hegelund /* Sanity check that this VCAP is supported on this platform */ 11078e10490bSSteen Hegelund if (vctrl->vcaps[admin->vtype].rows == 0) 11088e10490bSSteen Hegelund return ERR_PTR(-EINVAL); 11098e10490bSSteen Hegelund /* Check if a rule with this id already exists */ 11108e10490bSSteen Hegelund if (vcap_lookup_rule(vctrl, id)) 11118e10490bSSteen Hegelund return ERR_PTR(-EEXIST); 11128e10490bSSteen Hegelund /* Check if there is room for the rule in the block(s) of the VCAP */ 11138e10490bSSteen Hegelund maxsize = vctrl->vcaps[admin->vtype].sw_count; /* worst case rule size */ 11148e10490bSSteen Hegelund if (vcap_rule_space(admin, maxsize)) 11158e10490bSSteen Hegelund return ERR_PTR(-ENOSPC); 1116c9da1ac1SSteen Hegelund /* Create a container for the rule and return it */ 1117c9da1ac1SSteen Hegelund ri = kzalloc(sizeof(*ri), GFP_KERNEL); 1118c9da1ac1SSteen Hegelund if (!ri) 1119c9da1ac1SSteen Hegelund return ERR_PTR(-ENOMEM); 1120c9da1ac1SSteen Hegelund ri->data.vcap_chain_id = vcap_chain_id; 1121c9da1ac1SSteen Hegelund ri->data.user = user; 1122c9da1ac1SSteen Hegelund ri->data.priority = priority; 1123c9da1ac1SSteen Hegelund ri->data.id = id; 1124c9da1ac1SSteen Hegelund ri->data.keyset = VCAP_KFS_NO_VALUE; 1125c9da1ac1SSteen Hegelund ri->data.actionset = VCAP_AFS_NO_VALUE; 1126c9da1ac1SSteen Hegelund INIT_LIST_HEAD(&ri->list); 1127c9da1ac1SSteen Hegelund INIT_LIST_HEAD(&ri->data.keyfields); 1128c9da1ac1SSteen Hegelund INIT_LIST_HEAD(&ri->data.actionfields); 1129c9da1ac1SSteen Hegelund ri->ndev = ndev; 1130c9da1ac1SSteen Hegelund ri->admin = admin; /* refer to the vcap instance */ 1131c9da1ac1SSteen Hegelund ri->vctrl = vctrl; /* refer to the client */ 1132c9da1ac1SSteen Hegelund if (vcap_set_rule_id(ri) == 0) 1133c9da1ac1SSteen Hegelund goto out_free; 11348e10490bSSteen Hegelund vcap_erase_cache(ri); 1135c9da1ac1SSteen Hegelund return (struct vcap_rule *)ri; 1136c9da1ac1SSteen Hegelund 1137c9da1ac1SSteen Hegelund out_free: 1138c9da1ac1SSteen Hegelund kfree(ri); 1139c9da1ac1SSteen Hegelund return ERR_PTR(-EINVAL); 1140c9da1ac1SSteen Hegelund } 1141c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_alloc_rule); 1142c9da1ac1SSteen Hegelund 1143c9da1ac1SSteen Hegelund /* Free mem of a rule owned by client after the rule as been added to the VCAP */ 1144c9da1ac1SSteen Hegelund void vcap_free_rule(struct vcap_rule *rule) 1145c9da1ac1SSteen Hegelund { 1146c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1147c9da1ac1SSteen Hegelund struct vcap_client_actionfield *caf, *next_caf; 1148c9da1ac1SSteen Hegelund struct vcap_client_keyfield *ckf, *next_ckf; 1149c9da1ac1SSteen Hegelund 1150c9da1ac1SSteen Hegelund /* Deallocate the list of keys and actions */ 1151c9da1ac1SSteen Hegelund list_for_each_entry_safe(ckf, next_ckf, &ri->data.keyfields, ctrl.list) { 1152c9da1ac1SSteen Hegelund list_del(&ckf->ctrl.list); 1153c9da1ac1SSteen Hegelund kfree(ckf); 1154c9da1ac1SSteen Hegelund } 1155c9da1ac1SSteen Hegelund list_for_each_entry_safe(caf, next_caf, &ri->data.actionfields, ctrl.list) { 1156c9da1ac1SSteen Hegelund list_del(&caf->ctrl.list); 1157c9da1ac1SSteen Hegelund kfree(caf); 1158c9da1ac1SSteen Hegelund } 1159c9da1ac1SSteen Hegelund /* Deallocate the rule */ 1160c9da1ac1SSteen Hegelund kfree(rule); 1161c9da1ac1SSteen Hegelund } 1162c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_free_rule); 1163c9da1ac1SSteen Hegelund 1164*990e4839SSteen Hegelund /* Return the alignment offset for a new rule address */ 1165*990e4839SSteen Hegelund static int vcap_valid_rule_move(struct vcap_rule_internal *el, int offset) 1166*990e4839SSteen Hegelund { 1167*990e4839SSteen Hegelund return (el->addr + offset) % el->size; 1168*990e4839SSteen Hegelund } 1169*990e4839SSteen Hegelund 1170*990e4839SSteen Hegelund /* Update the rule address with an offset */ 1171*990e4839SSteen Hegelund static void vcap_adjust_rule_addr(struct vcap_rule_internal *el, int offset) 1172*990e4839SSteen Hegelund { 1173*990e4839SSteen Hegelund el->addr += offset; 1174*990e4839SSteen Hegelund } 1175*990e4839SSteen Hegelund 1176*990e4839SSteen Hegelund /* Rules needs to be moved to fill the gap of the deleted rule */ 1177*990e4839SSteen Hegelund static int vcap_fill_rule_gap(struct vcap_rule_internal *ri) 1178*990e4839SSteen Hegelund { 1179*990e4839SSteen Hegelund struct vcap_admin *admin = ri->admin; 1180*990e4839SSteen Hegelund struct vcap_rule_internal *elem; 1181*990e4839SSteen Hegelund struct vcap_rule_move move; 1182*990e4839SSteen Hegelund int gap = 0, offset = 0; 1183*990e4839SSteen Hegelund 1184*990e4839SSteen Hegelund /* If the first rule is deleted: Move other rules to the top */ 1185*990e4839SSteen Hegelund if (list_is_first(&ri->list, &admin->rules)) 1186*990e4839SSteen Hegelund offset = admin->last_valid_addr + 1 - ri->addr - ri->size; 1187*990e4839SSteen Hegelund 1188*990e4839SSteen Hegelund /* Locate gaps between odd size rules and adjust the move */ 1189*990e4839SSteen Hegelund elem = ri; 1190*990e4839SSteen Hegelund list_for_each_entry_continue(elem, &admin->rules, list) 1191*990e4839SSteen Hegelund gap += vcap_valid_rule_move(elem, ri->size); 1192*990e4839SSteen Hegelund 1193*990e4839SSteen Hegelund /* Update the address in the remaining rules in the list */ 1194*990e4839SSteen Hegelund elem = ri; 1195*990e4839SSteen Hegelund list_for_each_entry_continue(elem, &admin->rules, list) 1196*990e4839SSteen Hegelund vcap_adjust_rule_addr(elem, ri->size + gap + offset); 1197*990e4839SSteen Hegelund 1198*990e4839SSteen Hegelund /* Update the move info */ 1199*990e4839SSteen Hegelund move.addr = admin->last_used_addr; 1200*990e4839SSteen Hegelund move.count = ri->addr - admin->last_used_addr - gap; 1201*990e4839SSteen Hegelund move.offset = -(ri->size + gap + offset); 1202*990e4839SSteen Hegelund 1203*990e4839SSteen Hegelund /* Do the actual move operation */ 1204*990e4839SSteen Hegelund vcap_move_rules(ri, &move); 1205*990e4839SSteen Hegelund 1206*990e4839SSteen Hegelund return gap + offset; 1207*990e4839SSteen Hegelund } 1208*990e4839SSteen Hegelund 1209c9da1ac1SSteen Hegelund /* Delete rule in a VCAP instance */ 1210c9da1ac1SSteen Hegelund int vcap_del_rule(struct vcap_control *vctrl, struct net_device *ndev, u32 id) 1211c9da1ac1SSteen Hegelund { 1212c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri, *elem; 1213c9da1ac1SSteen Hegelund struct vcap_admin *admin; 1214*990e4839SSteen Hegelund int gap = 0, err; 1215c9da1ac1SSteen Hegelund 1216c9da1ac1SSteen Hegelund /* This will later also handle rule moving */ 1217c9da1ac1SSteen Hegelund if (!ndev) 1218c9da1ac1SSteen Hegelund return -ENODEV; 12198e10490bSSteen Hegelund err = vcap_api_check(vctrl); 12208e10490bSSteen Hegelund if (err) 12218e10490bSSteen Hegelund return err; 1222c9da1ac1SSteen Hegelund /* Look for the rule id in all vcaps */ 1223c9da1ac1SSteen Hegelund ri = vcap_lookup_rule(vctrl, id); 1224c9da1ac1SSteen Hegelund if (!ri) 1225c9da1ac1SSteen Hegelund return -EINVAL; 1226c9da1ac1SSteen Hegelund admin = ri->admin; 12278e10490bSSteen Hegelund 1228*990e4839SSteen Hegelund if (ri->addr > admin->last_used_addr) 1229*990e4839SSteen Hegelund gap = vcap_fill_rule_gap(ri); 1230*990e4839SSteen Hegelund 1231*990e4839SSteen Hegelund /* Delete the rule from the list of rules and the cache */ 1232*990e4839SSteen Hegelund list_del(&ri->list); 1233*990e4839SSteen Hegelund vctrl->ops->init(ndev, admin, admin->last_used_addr, ri->size + gap); 1234*990e4839SSteen Hegelund kfree(ri); 1235*990e4839SSteen Hegelund 1236*990e4839SSteen Hegelund /* Update the last used address */ 1237c9da1ac1SSteen Hegelund if (list_empty(&admin->rules)) { 1238c9da1ac1SSteen Hegelund admin->last_used_addr = admin->last_valid_addr; 1239c9da1ac1SSteen Hegelund } else { 1240*990e4839SSteen Hegelund elem = list_last_entry(&admin->rules, struct vcap_rule_internal, 1241*990e4839SSteen Hegelund list); 1242c9da1ac1SSteen Hegelund admin->last_used_addr = elem->addr; 1243c9da1ac1SSteen Hegelund } 1244c9da1ac1SSteen Hegelund return 0; 1245c9da1ac1SSteen Hegelund } 1246c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_del_rule); 1247c9da1ac1SSteen Hegelund 12488e10490bSSteen Hegelund /* Delete all rules in the VCAP instance */ 12498e10490bSSteen Hegelund int vcap_del_rules(struct vcap_control *vctrl, struct vcap_admin *admin) 12508e10490bSSteen Hegelund { 125167456717SSteen Hegelund struct vcap_enabled_port *eport, *next_eport; 12528e10490bSSteen Hegelund struct vcap_rule_internal *ri, *next_ri; 12538e10490bSSteen Hegelund int ret = vcap_api_check(vctrl); 12548e10490bSSteen Hegelund 12558e10490bSSteen Hegelund if (ret) 12568e10490bSSteen Hegelund return ret; 12578e10490bSSteen Hegelund list_for_each_entry_safe(ri, next_ri, &admin->rules, list) { 12588e10490bSSteen Hegelund vctrl->ops->init(ri->ndev, admin, ri->addr, ri->size); 12598e10490bSSteen Hegelund list_del(&ri->list); 12608e10490bSSteen Hegelund kfree(ri); 12618e10490bSSteen Hegelund } 12628e10490bSSteen Hegelund admin->last_used_addr = admin->last_valid_addr; 126367456717SSteen Hegelund 126467456717SSteen Hegelund /* Remove list of enabled ports */ 126567456717SSteen Hegelund list_for_each_entry_safe(eport, next_eport, &admin->enabled, list) { 126667456717SSteen Hegelund list_del(&eport->list); 126767456717SSteen Hegelund kfree(eport); 126867456717SSteen Hegelund } 126967456717SSteen Hegelund 12708e10490bSSteen Hegelund return 0; 12718e10490bSSteen Hegelund } 12728e10490bSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_del_rules); 12738e10490bSSteen Hegelund 127446be056eSSteen Hegelund /* Find information on a key field in a rule */ 127546be056eSSteen Hegelund const struct vcap_field *vcap_lookup_keyfield(struct vcap_rule *rule, 127646be056eSSteen Hegelund enum vcap_key_field key) 127746be056eSSteen Hegelund { 12788e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 127946be056eSSteen Hegelund enum vcap_keyfield_set keyset = rule->keyset; 128046be056eSSteen Hegelund enum vcap_type vt = ri->admin->vtype; 128146be056eSSteen Hegelund const struct vcap_field *fields; 128246be056eSSteen Hegelund 128346be056eSSteen Hegelund if (keyset == VCAP_KFS_NO_VALUE) 128446be056eSSteen Hegelund return NULL; 128546be056eSSteen Hegelund fields = vcap_keyfields(ri->vctrl, vt, keyset); 128646be056eSSteen Hegelund if (!fields) 128746be056eSSteen Hegelund return NULL; 128846be056eSSteen Hegelund return &fields[key]; 128946be056eSSteen Hegelund } 129046be056eSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_lookup_keyfield); 129146be056eSSteen Hegelund 1292c9da1ac1SSteen Hegelund static void vcap_copy_from_client_keyfield(struct vcap_rule *rule, 1293c9da1ac1SSteen Hegelund struct vcap_client_keyfield *field, 1294c9da1ac1SSteen Hegelund struct vcap_client_keyfield_data *data) 1295c9da1ac1SSteen Hegelund { 1296c9da1ac1SSteen Hegelund /* This will be expanded later to handle different vcap memory layouts */ 1297c9da1ac1SSteen Hegelund memcpy(&field->data, data, sizeof(field->data)); 1298c9da1ac1SSteen Hegelund } 1299c9da1ac1SSteen Hegelund 1300242df4f7SSteen Hegelund /* Check if the keyfield is already in the rule */ 1301242df4f7SSteen Hegelund static bool vcap_keyfield_unique(struct vcap_rule *rule, 1302242df4f7SSteen Hegelund enum vcap_key_field key) 1303242df4f7SSteen Hegelund { 1304242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1305242df4f7SSteen Hegelund const struct vcap_client_keyfield *ckf; 1306242df4f7SSteen Hegelund 1307242df4f7SSteen Hegelund list_for_each_entry(ckf, &ri->data.keyfields, ctrl.list) 1308242df4f7SSteen Hegelund if (ckf->ctrl.key == key) 1309242df4f7SSteen Hegelund return false; 1310242df4f7SSteen Hegelund return true; 1311242df4f7SSteen Hegelund } 1312242df4f7SSteen Hegelund 1313242df4f7SSteen Hegelund /* Check if the keyfield is in the keyset */ 1314242df4f7SSteen Hegelund static bool vcap_keyfield_match_keyset(struct vcap_rule *rule, 1315242df4f7SSteen Hegelund enum vcap_key_field key) 1316242df4f7SSteen Hegelund { 1317242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1318242df4f7SSteen Hegelund enum vcap_keyfield_set keyset = rule->keyset; 1319242df4f7SSteen Hegelund enum vcap_type vt = ri->admin->vtype; 1320242df4f7SSteen Hegelund const struct vcap_field *fields; 1321242df4f7SSteen Hegelund 1322242df4f7SSteen Hegelund /* the field is accepted if the rule has no keyset yet */ 1323242df4f7SSteen Hegelund if (keyset == VCAP_KFS_NO_VALUE) 1324242df4f7SSteen Hegelund return true; 1325242df4f7SSteen Hegelund fields = vcap_keyfields(ri->vctrl, vt, keyset); 1326242df4f7SSteen Hegelund if (!fields) 1327242df4f7SSteen Hegelund return false; 1328242df4f7SSteen Hegelund /* if there is a width there is a way */ 1329242df4f7SSteen Hegelund return fields[key].width > 0; 1330242df4f7SSteen Hegelund } 1331242df4f7SSteen Hegelund 1332c9da1ac1SSteen Hegelund static int vcap_rule_add_key(struct vcap_rule *rule, 1333c9da1ac1SSteen Hegelund enum vcap_key_field key, 1334c9da1ac1SSteen Hegelund enum vcap_field_type ftype, 1335c9da1ac1SSteen Hegelund struct vcap_client_keyfield_data *data) 1336c9da1ac1SSteen Hegelund { 1337242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1338c9da1ac1SSteen Hegelund struct vcap_client_keyfield *field; 1339c9da1ac1SSteen Hegelund 1340242df4f7SSteen Hegelund if (!vcap_keyfield_unique(rule, key)) { 1341242df4f7SSteen Hegelund pr_warn("%s:%d: keyfield %s is already in the rule\n", 1342242df4f7SSteen Hegelund __func__, __LINE__, 1343242df4f7SSteen Hegelund vcap_keyfield_name(ri->vctrl, key)); 1344242df4f7SSteen Hegelund return -EINVAL; 1345242df4f7SSteen Hegelund } 1346242df4f7SSteen Hegelund 1347242df4f7SSteen Hegelund if (!vcap_keyfield_match_keyset(rule, key)) { 1348242df4f7SSteen Hegelund pr_err("%s:%d: keyfield %s does not belong in the rule keyset\n", 1349242df4f7SSteen Hegelund __func__, __LINE__, 1350242df4f7SSteen Hegelund vcap_keyfield_name(ri->vctrl, key)); 1351242df4f7SSteen Hegelund return -EINVAL; 1352242df4f7SSteen Hegelund } 1353242df4f7SSteen Hegelund 1354c9da1ac1SSteen Hegelund field = kzalloc(sizeof(*field), GFP_KERNEL); 1355c9da1ac1SSteen Hegelund if (!field) 1356c9da1ac1SSteen Hegelund return -ENOMEM; 1357c9da1ac1SSteen Hegelund field->ctrl.key = key; 1358c9da1ac1SSteen Hegelund field->ctrl.type = ftype; 1359c9da1ac1SSteen Hegelund vcap_copy_from_client_keyfield(rule, field, data); 1360c9da1ac1SSteen Hegelund list_add_tail(&field->ctrl.list, &rule->keyfields); 1361c9da1ac1SSteen Hegelund return 0; 1362c9da1ac1SSteen Hegelund } 1363c9da1ac1SSteen Hegelund 136446be056eSSteen Hegelund static void vcap_rule_set_key_bitsize(struct vcap_u1_key *u1, enum vcap_bit val) 136546be056eSSteen Hegelund { 136646be056eSSteen Hegelund switch (val) { 136746be056eSSteen Hegelund case VCAP_BIT_0: 136846be056eSSteen Hegelund u1->value = 0; 136946be056eSSteen Hegelund u1->mask = 1; 137046be056eSSteen Hegelund break; 137146be056eSSteen Hegelund case VCAP_BIT_1: 137246be056eSSteen Hegelund u1->value = 1; 137346be056eSSteen Hegelund u1->mask = 1; 137446be056eSSteen Hegelund break; 137546be056eSSteen Hegelund case VCAP_BIT_ANY: 137646be056eSSteen Hegelund u1->value = 0; 137746be056eSSteen Hegelund u1->mask = 0; 137846be056eSSteen Hegelund break; 137946be056eSSteen Hegelund } 138046be056eSSteen Hegelund } 138146be056eSSteen Hegelund 138246be056eSSteen Hegelund /* Add a bit key with value and mask to the rule */ 138346be056eSSteen Hegelund int vcap_rule_add_key_bit(struct vcap_rule *rule, enum vcap_key_field key, 138446be056eSSteen Hegelund enum vcap_bit val) 138546be056eSSteen Hegelund { 138646be056eSSteen Hegelund struct vcap_client_keyfield_data data; 138746be056eSSteen Hegelund 138846be056eSSteen Hegelund vcap_rule_set_key_bitsize(&data.u1, val); 138946be056eSSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_BIT, &data); 139046be056eSSteen Hegelund } 139146be056eSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_bit); 139246be056eSSteen Hegelund 139346be056eSSteen Hegelund /* Add a 32 bit key field with value and mask to the rule */ 139446be056eSSteen Hegelund int vcap_rule_add_key_u32(struct vcap_rule *rule, enum vcap_key_field key, 139546be056eSSteen Hegelund u32 value, u32 mask) 139646be056eSSteen Hegelund { 139746be056eSSteen Hegelund struct vcap_client_keyfield_data data; 139846be056eSSteen Hegelund 139946be056eSSteen Hegelund data.u32.value = value; 140046be056eSSteen Hegelund data.u32.mask = mask; 140146be056eSSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_U32, &data); 140246be056eSSteen Hegelund } 140346be056eSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_u32); 140446be056eSSteen Hegelund 1405c9da1ac1SSteen Hegelund /* Add a 48 bit key with value and mask to the rule */ 1406c9da1ac1SSteen Hegelund int vcap_rule_add_key_u48(struct vcap_rule *rule, enum vcap_key_field key, 1407c9da1ac1SSteen Hegelund struct vcap_u48_key *fieldval) 1408c9da1ac1SSteen Hegelund { 1409c9da1ac1SSteen Hegelund struct vcap_client_keyfield_data data; 1410c9da1ac1SSteen Hegelund 1411c9da1ac1SSteen Hegelund memcpy(&data.u48, fieldval, sizeof(data.u48)); 1412c9da1ac1SSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_U48, &data); 1413c9da1ac1SSteen Hegelund } 1414c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_u48); 1415c9da1ac1SSteen Hegelund 141646be056eSSteen Hegelund /* Add a 72 bit key with value and mask to the rule */ 141746be056eSSteen Hegelund int vcap_rule_add_key_u72(struct vcap_rule *rule, enum vcap_key_field key, 141846be056eSSteen Hegelund struct vcap_u72_key *fieldval) 141946be056eSSteen Hegelund { 142046be056eSSteen Hegelund struct vcap_client_keyfield_data data; 142146be056eSSteen Hegelund 142246be056eSSteen Hegelund memcpy(&data.u72, fieldval, sizeof(data.u72)); 142346be056eSSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_U72, &data); 142446be056eSSteen Hegelund } 142546be056eSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_u72); 142646be056eSSteen Hegelund 1427d6c2964dSSteen Hegelund /* Add a 128 bit key with value and mask to the rule */ 1428d6c2964dSSteen Hegelund int vcap_rule_add_key_u128(struct vcap_rule *rule, enum vcap_key_field key, 1429d6c2964dSSteen Hegelund struct vcap_u128_key *fieldval) 1430d6c2964dSSteen Hegelund { 1431d6c2964dSSteen Hegelund struct vcap_client_keyfield_data data; 1432d6c2964dSSteen Hegelund 1433d6c2964dSSteen Hegelund memcpy(&data.u128, fieldval, sizeof(data.u128)); 1434d6c2964dSSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_U128, &data); 1435d6c2964dSSteen Hegelund } 1436d6c2964dSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_u128); 1437d6c2964dSSteen Hegelund 1438c9da1ac1SSteen Hegelund static void vcap_copy_from_client_actionfield(struct vcap_rule *rule, 1439c9da1ac1SSteen Hegelund struct vcap_client_actionfield *field, 1440c9da1ac1SSteen Hegelund struct vcap_client_actionfield_data *data) 1441c9da1ac1SSteen Hegelund { 1442c9da1ac1SSteen Hegelund /* This will be expanded later to handle different vcap memory layouts */ 1443c9da1ac1SSteen Hegelund memcpy(&field->data, data, sizeof(field->data)); 1444c9da1ac1SSteen Hegelund } 1445c9da1ac1SSteen Hegelund 1446242df4f7SSteen Hegelund /* Check if the actionfield is already in the rule */ 1447242df4f7SSteen Hegelund static bool vcap_actionfield_unique(struct vcap_rule *rule, 1448242df4f7SSteen Hegelund enum vcap_action_field act) 1449242df4f7SSteen Hegelund { 1450242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1451242df4f7SSteen Hegelund const struct vcap_client_actionfield *caf; 1452242df4f7SSteen Hegelund 1453242df4f7SSteen Hegelund list_for_each_entry(caf, &ri->data.actionfields, ctrl.list) 1454242df4f7SSteen Hegelund if (caf->ctrl.action == act) 1455242df4f7SSteen Hegelund return false; 1456242df4f7SSteen Hegelund return true; 1457242df4f7SSteen Hegelund } 1458242df4f7SSteen Hegelund 1459242df4f7SSteen Hegelund /* Check if the actionfield is in the actionset */ 1460242df4f7SSteen Hegelund static bool vcap_actionfield_match_actionset(struct vcap_rule *rule, 1461242df4f7SSteen Hegelund enum vcap_action_field action) 1462242df4f7SSteen Hegelund { 1463242df4f7SSteen Hegelund enum vcap_actionfield_set actionset = rule->actionset; 1464242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1465242df4f7SSteen Hegelund enum vcap_type vt = ri->admin->vtype; 1466242df4f7SSteen Hegelund const struct vcap_field *fields; 1467242df4f7SSteen Hegelund 1468242df4f7SSteen Hegelund /* the field is accepted if the rule has no actionset yet */ 1469242df4f7SSteen Hegelund if (actionset == VCAP_AFS_NO_VALUE) 1470242df4f7SSteen Hegelund return true; 1471242df4f7SSteen Hegelund fields = vcap_actionfields(ri->vctrl, vt, actionset); 1472242df4f7SSteen Hegelund if (!fields) 1473242df4f7SSteen Hegelund return false; 1474242df4f7SSteen Hegelund /* if there is a width there is a way */ 1475242df4f7SSteen Hegelund return fields[action].width > 0; 1476242df4f7SSteen Hegelund } 1477242df4f7SSteen Hegelund 1478c9da1ac1SSteen Hegelund static int vcap_rule_add_action(struct vcap_rule *rule, 1479c9da1ac1SSteen Hegelund enum vcap_action_field action, 1480c9da1ac1SSteen Hegelund enum vcap_field_type ftype, 1481c9da1ac1SSteen Hegelund struct vcap_client_actionfield_data *data) 1482c9da1ac1SSteen Hegelund { 1483242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1484c9da1ac1SSteen Hegelund struct vcap_client_actionfield *field; 1485c9da1ac1SSteen Hegelund 1486242df4f7SSteen Hegelund if (!vcap_actionfield_unique(rule, action)) { 1487242df4f7SSteen Hegelund pr_warn("%s:%d: actionfield %s is already in the rule\n", 1488242df4f7SSteen Hegelund __func__, __LINE__, 1489242df4f7SSteen Hegelund vcap_actionfield_name(ri->vctrl, action)); 1490242df4f7SSteen Hegelund return -EINVAL; 1491242df4f7SSteen Hegelund } 1492242df4f7SSteen Hegelund 1493242df4f7SSteen Hegelund if (!vcap_actionfield_match_actionset(rule, action)) { 1494242df4f7SSteen Hegelund pr_err("%s:%d: actionfield %s does not belong in the rule actionset\n", 1495242df4f7SSteen Hegelund __func__, __LINE__, 1496242df4f7SSteen Hegelund vcap_actionfield_name(ri->vctrl, action)); 1497242df4f7SSteen Hegelund return -EINVAL; 1498242df4f7SSteen Hegelund } 1499242df4f7SSteen Hegelund 1500c9da1ac1SSteen Hegelund field = kzalloc(sizeof(*field), GFP_KERNEL); 1501c9da1ac1SSteen Hegelund if (!field) 1502c9da1ac1SSteen Hegelund return -ENOMEM; 1503c9da1ac1SSteen Hegelund field->ctrl.action = action; 1504c9da1ac1SSteen Hegelund field->ctrl.type = ftype; 1505c9da1ac1SSteen Hegelund vcap_copy_from_client_actionfield(rule, field, data); 1506c9da1ac1SSteen Hegelund list_add_tail(&field->ctrl.list, &rule->actionfields); 1507c9da1ac1SSteen Hegelund return 0; 1508c9da1ac1SSteen Hegelund } 1509c9da1ac1SSteen Hegelund 1510c9da1ac1SSteen Hegelund static void vcap_rule_set_action_bitsize(struct vcap_u1_action *u1, 1511c9da1ac1SSteen Hegelund enum vcap_bit val) 1512c9da1ac1SSteen Hegelund { 1513c9da1ac1SSteen Hegelund switch (val) { 1514c9da1ac1SSteen Hegelund case VCAP_BIT_0: 1515c9da1ac1SSteen Hegelund u1->value = 0; 1516c9da1ac1SSteen Hegelund break; 1517c9da1ac1SSteen Hegelund case VCAP_BIT_1: 1518c9da1ac1SSteen Hegelund u1->value = 1; 1519c9da1ac1SSteen Hegelund break; 1520c9da1ac1SSteen Hegelund case VCAP_BIT_ANY: 1521c9da1ac1SSteen Hegelund u1->value = 0; 1522c9da1ac1SSteen Hegelund break; 1523c9da1ac1SSteen Hegelund } 1524c9da1ac1SSteen Hegelund } 1525c9da1ac1SSteen Hegelund 1526c9da1ac1SSteen Hegelund /* Add a bit action with value to the rule */ 1527c9da1ac1SSteen Hegelund int vcap_rule_add_action_bit(struct vcap_rule *rule, 1528c9da1ac1SSteen Hegelund enum vcap_action_field action, 1529c9da1ac1SSteen Hegelund enum vcap_bit val) 1530c9da1ac1SSteen Hegelund { 1531c9da1ac1SSteen Hegelund struct vcap_client_actionfield_data data; 1532c9da1ac1SSteen Hegelund 1533c9da1ac1SSteen Hegelund vcap_rule_set_action_bitsize(&data.u1, val); 1534c9da1ac1SSteen Hegelund return vcap_rule_add_action(rule, action, VCAP_FIELD_BIT, &data); 1535c9da1ac1SSteen Hegelund } 1536c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_action_bit); 1537c9da1ac1SSteen Hegelund 1538c9da1ac1SSteen Hegelund /* Add a 32 bit action field with value to the rule */ 1539c9da1ac1SSteen Hegelund int vcap_rule_add_action_u32(struct vcap_rule *rule, 1540c9da1ac1SSteen Hegelund enum vcap_action_field action, 1541c9da1ac1SSteen Hegelund u32 value) 1542c9da1ac1SSteen Hegelund { 1543c9da1ac1SSteen Hegelund struct vcap_client_actionfield_data data; 1544c9da1ac1SSteen Hegelund 1545c9da1ac1SSteen Hegelund data.u32.value = value; 1546c9da1ac1SSteen Hegelund return vcap_rule_add_action(rule, action, VCAP_FIELD_U32, &data); 1547c9da1ac1SSteen Hegelund } 1548c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_action_u32); 1549c9da1ac1SSteen Hegelund 1550c9da1ac1SSteen Hegelund /* Copy to host byte order */ 1551c9da1ac1SSteen Hegelund void vcap_netbytes_copy(u8 *dst, u8 *src, int count) 1552c9da1ac1SSteen Hegelund { 1553c9da1ac1SSteen Hegelund int idx; 1554c9da1ac1SSteen Hegelund 1555c9da1ac1SSteen Hegelund for (idx = 0; idx < count; ++idx, ++dst) 1556c9da1ac1SSteen Hegelund *dst = src[count - idx - 1]; 1557c9da1ac1SSteen Hegelund } 1558c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_netbytes_copy); 1559c9da1ac1SSteen Hegelund 1560c9da1ac1SSteen Hegelund /* Convert validation error code into tc extact error message */ 1561c9da1ac1SSteen Hegelund void vcap_set_tc_exterr(struct flow_cls_offload *fco, struct vcap_rule *vrule) 1562c9da1ac1SSteen Hegelund { 1563c9da1ac1SSteen Hegelund switch (vrule->exterr) { 1564c9da1ac1SSteen Hegelund case VCAP_ERR_NONE: 1565c9da1ac1SSteen Hegelund break; 1566c9da1ac1SSteen Hegelund case VCAP_ERR_NO_ADMIN: 1567c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1568c9da1ac1SSteen Hegelund "Missing VCAP instance"); 1569c9da1ac1SSteen Hegelund break; 1570c9da1ac1SSteen Hegelund case VCAP_ERR_NO_NETDEV: 1571c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1572c9da1ac1SSteen Hegelund "Missing network interface"); 1573c9da1ac1SSteen Hegelund break; 1574c9da1ac1SSteen Hegelund case VCAP_ERR_NO_KEYSET_MATCH: 1575c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1576c9da1ac1SSteen Hegelund "No keyset matched the filter keys"); 1577c9da1ac1SSteen Hegelund break; 1578c9da1ac1SSteen Hegelund case VCAP_ERR_NO_ACTIONSET_MATCH: 1579c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1580c9da1ac1SSteen Hegelund "No actionset matched the filter actions"); 1581c9da1ac1SSteen Hegelund break; 1582c9da1ac1SSteen Hegelund case VCAP_ERR_NO_PORT_KEYSET_MATCH: 1583c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1584c9da1ac1SSteen Hegelund "No port keyset matched the filter keys"); 1585c9da1ac1SSteen Hegelund break; 1586c9da1ac1SSteen Hegelund } 1587c9da1ac1SSteen Hegelund } 1588c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_set_tc_exterr); 158967d63751SSteen Hegelund 159067456717SSteen Hegelund /* Check if this port is already enabled for this VCAP instance */ 159167456717SSteen Hegelund static bool vcap_is_enabled(struct vcap_admin *admin, struct net_device *ndev, 159267456717SSteen Hegelund unsigned long cookie) 159367456717SSteen Hegelund { 159467456717SSteen Hegelund struct vcap_enabled_port *eport; 159567456717SSteen Hegelund 159667456717SSteen Hegelund list_for_each_entry(eport, &admin->enabled, list) 159767456717SSteen Hegelund if (eport->cookie == cookie || eport->ndev == ndev) 159867456717SSteen Hegelund return true; 159967456717SSteen Hegelund 160067456717SSteen Hegelund return false; 160167456717SSteen Hegelund } 160267456717SSteen Hegelund 160367456717SSteen Hegelund /* Enable this port for this VCAP instance */ 160467456717SSteen Hegelund static int vcap_enable(struct vcap_admin *admin, struct net_device *ndev, 160567456717SSteen Hegelund unsigned long cookie) 160667456717SSteen Hegelund { 160767456717SSteen Hegelund struct vcap_enabled_port *eport; 160867456717SSteen Hegelund 160967456717SSteen Hegelund eport = kzalloc(sizeof(*eport), GFP_KERNEL); 161067456717SSteen Hegelund if (!eport) 161167456717SSteen Hegelund return -ENOMEM; 161267456717SSteen Hegelund 161367456717SSteen Hegelund eport->ndev = ndev; 161467456717SSteen Hegelund eport->cookie = cookie; 161567456717SSteen Hegelund list_add_tail(&eport->list, &admin->enabled); 161667456717SSteen Hegelund 161767456717SSteen Hegelund return 0; 161867456717SSteen Hegelund } 161967456717SSteen Hegelund 162067456717SSteen Hegelund /* Disable this port for this VCAP instance */ 162167456717SSteen Hegelund static int vcap_disable(struct vcap_admin *admin, struct net_device *ndev, 162267456717SSteen Hegelund unsigned long cookie) 162367456717SSteen Hegelund { 162467456717SSteen Hegelund struct vcap_enabled_port *eport; 162567456717SSteen Hegelund 162667456717SSteen Hegelund list_for_each_entry(eport, &admin->enabled, list) { 162767456717SSteen Hegelund if (eport->cookie == cookie && eport->ndev == ndev) { 162867456717SSteen Hegelund list_del(&eport->list); 162967456717SSteen Hegelund kfree(eport); 163067456717SSteen Hegelund return 0; 163167456717SSteen Hegelund } 163267456717SSteen Hegelund } 163367456717SSteen Hegelund 163467456717SSteen Hegelund return -ENOENT; 163567456717SSteen Hegelund } 163667456717SSteen Hegelund 163767456717SSteen Hegelund /* Find the VCAP instance that enabled the port using a specific filter */ 163867456717SSteen Hegelund static struct vcap_admin *vcap_find_admin_by_cookie(struct vcap_control *vctrl, 163967456717SSteen Hegelund unsigned long cookie) 164067456717SSteen Hegelund { 164167456717SSteen Hegelund struct vcap_enabled_port *eport; 164267456717SSteen Hegelund struct vcap_admin *admin; 164367456717SSteen Hegelund 164467456717SSteen Hegelund list_for_each_entry(admin, &vctrl->list, list) 164567456717SSteen Hegelund list_for_each_entry(eport, &admin->enabled, list) 164667456717SSteen Hegelund if (eport->cookie == cookie) 164767456717SSteen Hegelund return admin; 164867456717SSteen Hegelund 164967456717SSteen Hegelund return NULL; 165067456717SSteen Hegelund } 165167456717SSteen Hegelund 165267456717SSteen Hegelund /* Enable/Disable the VCAP instance lookups. Chain id 0 means disable */ 165367456717SSteen Hegelund int vcap_enable_lookups(struct vcap_control *vctrl, struct net_device *ndev, 165467456717SSteen Hegelund int chain_id, unsigned long cookie, bool enable) 165567456717SSteen Hegelund { 165667456717SSteen Hegelund struct vcap_admin *admin; 165767456717SSteen Hegelund int err; 165867456717SSteen Hegelund 165967456717SSteen Hegelund err = vcap_api_check(vctrl); 166067456717SSteen Hegelund if (err) 166167456717SSteen Hegelund return err; 166267456717SSteen Hegelund 166367456717SSteen Hegelund if (!ndev) 166467456717SSteen Hegelund return -ENODEV; 166567456717SSteen Hegelund 166667456717SSteen Hegelund if (chain_id) 166767456717SSteen Hegelund admin = vcap_find_admin(vctrl, chain_id); 166867456717SSteen Hegelund else 166967456717SSteen Hegelund admin = vcap_find_admin_by_cookie(vctrl, cookie); 167067456717SSteen Hegelund if (!admin) 167167456717SSteen Hegelund return -ENOENT; 167267456717SSteen Hegelund 167367456717SSteen Hegelund /* first instance and first chain */ 167467456717SSteen Hegelund if (admin->vinst || chain_id > admin->first_cid) 167567456717SSteen Hegelund return -EFAULT; 167667456717SSteen Hegelund 167767456717SSteen Hegelund err = vctrl->ops->enable(ndev, admin, enable); 167867456717SSteen Hegelund if (err) 167967456717SSteen Hegelund return err; 168067456717SSteen Hegelund 168167456717SSteen Hegelund if (chain_id) { 168267456717SSteen Hegelund if (vcap_is_enabled(admin, ndev, cookie)) 168367456717SSteen Hegelund return -EADDRINUSE; 168467456717SSteen Hegelund vcap_enable(admin, ndev, cookie); 168567456717SSteen Hegelund } else { 168667456717SSteen Hegelund vcap_disable(admin, ndev, cookie); 168767456717SSteen Hegelund } 168867456717SSteen Hegelund 168967456717SSteen Hegelund return 0; 169067456717SSteen Hegelund } 169167456717SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_enable_lookups); 169267456717SSteen Hegelund 169367d63751SSteen Hegelund #ifdef CONFIG_VCAP_KUNIT_TEST 169467d63751SSteen Hegelund #include "vcap_api_kunit.c" 169567d63751SSteen Hegelund #endif 1696