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 9d4134d41SSteen Hegelund #include "vcap_api_private.h" 10c9da1ac1SSteen Hegelund 118e10490bSSteen Hegelund /* Moving a rule in the VCAP address space */ 128e10490bSSteen Hegelund struct vcap_rule_move { 138e10490bSSteen Hegelund int addr; /* address to move */ 148e10490bSSteen Hegelund int offset; /* change in address */ 158e10490bSSteen Hegelund int count; /* blocksize of addresses to move */ 168e10490bSSteen Hegelund }; 178e10490bSSteen Hegelund 1867456717SSteen Hegelund /* Stores the filter cookie that enabled the port */ 1967456717SSteen Hegelund struct vcap_enabled_port { 2067456717SSteen Hegelund struct list_head list; /* for insertion in enabled ports list */ 2167456717SSteen Hegelund struct net_device *ndev; /* the enabled port */ 2267456717SSteen Hegelund unsigned long cookie; /* filter that enabled the port */ 2367456717SSteen Hegelund }; 2467456717SSteen Hegelund 25d4134d41SSteen Hegelund void vcap_iter_set(struct vcap_stream_iter *itr, int sw_width, 26683e05c0SSteen Hegelund const struct vcap_typegroup *tg, u32 offset) 27683e05c0SSteen Hegelund { 28683e05c0SSteen Hegelund memset(itr, 0, sizeof(*itr)); 29683e05c0SSteen Hegelund itr->offset = offset; 30683e05c0SSteen Hegelund itr->sw_width = sw_width; 31683e05c0SSteen Hegelund itr->regs_per_sw = DIV_ROUND_UP(sw_width, 32); 32683e05c0SSteen Hegelund itr->tg = tg; 33683e05c0SSteen Hegelund } 34683e05c0SSteen Hegelund 35683e05c0SSteen Hegelund static void vcap_iter_skip_tg(struct vcap_stream_iter *itr) 36683e05c0SSteen Hegelund { 37683e05c0SSteen Hegelund /* Compensate the field offset for preceding typegroups. 38683e05c0SSteen Hegelund * A typegroup table ends with an all-zero terminator. 39683e05c0SSteen Hegelund */ 40683e05c0SSteen Hegelund while (itr->tg->width && itr->offset >= itr->tg->offset) { 41683e05c0SSteen Hegelund itr->offset += itr->tg->width; 42683e05c0SSteen Hegelund itr->tg++; /* next typegroup */ 43683e05c0SSteen Hegelund } 44683e05c0SSteen Hegelund } 45683e05c0SSteen Hegelund 46d4134d41SSteen Hegelund void vcap_iter_update(struct vcap_stream_iter *itr) 47683e05c0SSteen Hegelund { 48683e05c0SSteen Hegelund int sw_idx, sw_bitpos; 49683e05c0SSteen Hegelund 50683e05c0SSteen Hegelund /* Calculate the subword index and bitposition for current bit */ 51683e05c0SSteen Hegelund sw_idx = itr->offset / itr->sw_width; 52683e05c0SSteen Hegelund sw_bitpos = itr->offset % itr->sw_width; 53683e05c0SSteen Hegelund /* Calculate the register index and bitposition for current bit */ 54683e05c0SSteen Hegelund itr->reg_idx = (sw_idx * itr->regs_per_sw) + (sw_bitpos / 32); 55683e05c0SSteen Hegelund itr->reg_bitpos = sw_bitpos % 32; 56683e05c0SSteen Hegelund } 57683e05c0SSteen Hegelund 58d4134d41SSteen Hegelund void vcap_iter_init(struct vcap_stream_iter *itr, int sw_width, 59683e05c0SSteen Hegelund const struct vcap_typegroup *tg, u32 offset) 60683e05c0SSteen Hegelund { 61683e05c0SSteen Hegelund vcap_iter_set(itr, sw_width, tg, offset); 62683e05c0SSteen Hegelund vcap_iter_skip_tg(itr); 63683e05c0SSteen Hegelund vcap_iter_update(itr); 64683e05c0SSteen Hegelund } 65683e05c0SSteen Hegelund 66d4134d41SSteen Hegelund void vcap_iter_next(struct vcap_stream_iter *itr) 67683e05c0SSteen Hegelund { 68683e05c0SSteen Hegelund itr->offset++; 69683e05c0SSteen Hegelund vcap_iter_skip_tg(itr); 70683e05c0SSteen Hegelund vcap_iter_update(itr); 71683e05c0SSteen Hegelund } 72683e05c0SSteen Hegelund 73683e05c0SSteen Hegelund static void vcap_set_bit(u32 *stream, struct vcap_stream_iter *itr, bool value) 74683e05c0SSteen Hegelund { 75683e05c0SSteen Hegelund u32 mask = BIT(itr->reg_bitpos); 76683e05c0SSteen Hegelund u32 *p = &stream[itr->reg_idx]; 77683e05c0SSteen Hegelund 78683e05c0SSteen Hegelund if (value) 79683e05c0SSteen Hegelund *p |= mask; 80683e05c0SSteen Hegelund else 81683e05c0SSteen Hegelund *p &= ~mask; 82683e05c0SSteen Hegelund } 83683e05c0SSteen Hegelund 84683e05c0SSteen Hegelund static void vcap_encode_bit(u32 *stream, struct vcap_stream_iter *itr, bool val) 85683e05c0SSteen Hegelund { 86683e05c0SSteen Hegelund /* When intersected by a type group field, stream the type group bits 87683e05c0SSteen Hegelund * before continuing with the value bit 88683e05c0SSteen Hegelund */ 89683e05c0SSteen Hegelund while (itr->tg->width && 90683e05c0SSteen Hegelund itr->offset >= itr->tg->offset && 91683e05c0SSteen Hegelund itr->offset < itr->tg->offset + itr->tg->width) { 92683e05c0SSteen Hegelund int tg_bitpos = itr->tg->offset - itr->offset; 93683e05c0SSteen Hegelund 94683e05c0SSteen Hegelund vcap_set_bit(stream, itr, (itr->tg->value >> tg_bitpos) & 0x1); 95683e05c0SSteen Hegelund itr->offset++; 96683e05c0SSteen Hegelund vcap_iter_update(itr); 97683e05c0SSteen Hegelund } 98683e05c0SSteen Hegelund vcap_set_bit(stream, itr, val); 99683e05c0SSteen Hegelund } 100683e05c0SSteen Hegelund 101683e05c0SSteen Hegelund static void vcap_encode_field(u32 *stream, struct vcap_stream_iter *itr, 102683e05c0SSteen Hegelund int width, const u8 *value) 103683e05c0SSteen Hegelund { 104683e05c0SSteen Hegelund int idx; 105683e05c0SSteen Hegelund 106683e05c0SSteen Hegelund /* Loop over the field value bits and add the value bits one by one to 107683e05c0SSteen Hegelund * the output stream. 108683e05c0SSteen Hegelund */ 109683e05c0SSteen Hegelund for (idx = 0; idx < width; idx++) { 110683e05c0SSteen Hegelund u8 bidx = idx & GENMASK(2, 0); 111683e05c0SSteen Hegelund 112683e05c0SSteen Hegelund /* Encode one field value bit */ 113683e05c0SSteen Hegelund vcap_encode_bit(stream, itr, (value[idx / 8] >> bidx) & 0x1); 114683e05c0SSteen Hegelund vcap_iter_next(itr); 115683e05c0SSteen Hegelund } 116683e05c0SSteen Hegelund } 117683e05c0SSteen Hegelund 118683e05c0SSteen Hegelund static void vcap_encode_typegroups(u32 *stream, int sw_width, 119683e05c0SSteen Hegelund const struct vcap_typegroup *tg, 120683e05c0SSteen Hegelund bool mask) 121683e05c0SSteen Hegelund { 122683e05c0SSteen Hegelund struct vcap_stream_iter iter; 123683e05c0SSteen Hegelund int idx; 124683e05c0SSteen Hegelund 125683e05c0SSteen Hegelund /* Mask bits must be set to zeros (inverted later when writing to the 126683e05c0SSteen Hegelund * mask cache register), so that the mask typegroup bits consist of 127683e05c0SSteen Hegelund * match-1 or match-0, or both 128683e05c0SSteen Hegelund */ 129683e05c0SSteen Hegelund vcap_iter_set(&iter, sw_width, tg, 0); 130683e05c0SSteen Hegelund while (iter.tg->width) { 131683e05c0SSteen Hegelund /* Set position to current typegroup bit */ 132683e05c0SSteen Hegelund iter.offset = iter.tg->offset; 133683e05c0SSteen Hegelund vcap_iter_update(&iter); 134683e05c0SSteen Hegelund for (idx = 0; idx < iter.tg->width; idx++) { 135683e05c0SSteen Hegelund /* Iterate over current typegroup bits. Mask typegroup 136683e05c0SSteen Hegelund * bits are always set 137683e05c0SSteen Hegelund */ 138683e05c0SSteen Hegelund if (mask) 139683e05c0SSteen Hegelund vcap_set_bit(stream, &iter, 0x1); 140683e05c0SSteen Hegelund else 141683e05c0SSteen Hegelund vcap_set_bit(stream, &iter, 142683e05c0SSteen Hegelund (iter.tg->value >> idx) & 0x1); 143683e05c0SSteen Hegelund iter.offset++; 144683e05c0SSteen Hegelund vcap_iter_update(&iter); 145683e05c0SSteen Hegelund } 146683e05c0SSteen Hegelund iter.tg++; /* next typegroup */ 147683e05c0SSteen Hegelund } 148683e05c0SSteen Hegelund } 149683e05c0SSteen Hegelund 15046be056eSSteen Hegelund /* Return the list of keyfields for the keyset */ 151d4134d41SSteen Hegelund const struct vcap_field *vcap_keyfields(struct vcap_control *vctrl, 15246be056eSSteen Hegelund enum vcap_type vt, 15346be056eSSteen Hegelund enum vcap_keyfield_set keyset) 15446be056eSSteen Hegelund { 15546be056eSSteen Hegelund /* Check that the keyset exists in the vcap keyset list */ 15646be056eSSteen Hegelund if (keyset >= vctrl->vcaps[vt].keyfield_set_size) 15746be056eSSteen Hegelund return NULL; 15846be056eSSteen Hegelund return vctrl->vcaps[vt].keyfield_set_map[keyset]; 15946be056eSSteen Hegelund } 16046be056eSSteen Hegelund 1618e10490bSSteen Hegelund /* Return the keyset information for the keyset */ 162d4134d41SSteen Hegelund const struct vcap_set *vcap_keyfieldset(struct vcap_control *vctrl, 1638e10490bSSteen Hegelund enum vcap_type vt, 1648e10490bSSteen Hegelund enum vcap_keyfield_set keyset) 1658e10490bSSteen Hegelund { 1668e10490bSSteen Hegelund const struct vcap_set *kset; 1678e10490bSSteen Hegelund 1688e10490bSSteen Hegelund /* Check that the keyset exists in the vcap keyset list */ 1698e10490bSSteen Hegelund if (keyset >= vctrl->vcaps[vt].keyfield_set_size) 1708e10490bSSteen Hegelund return NULL; 1718e10490bSSteen Hegelund kset = &vctrl->vcaps[vt].keyfield_set[keyset]; 1728e10490bSSteen Hegelund if (kset->sw_per_item == 0 || kset->sw_per_item > vctrl->vcaps[vt].sw_count) 1738e10490bSSteen Hegelund return NULL; 1748e10490bSSteen Hegelund return kset; 1758e10490bSSteen Hegelund } 1768e10490bSSteen Hegelund 177683e05c0SSteen Hegelund /* Return the typegroup table for the matching keyset (using subword size) */ 178d4134d41SSteen Hegelund const struct vcap_typegroup * 179683e05c0SSteen Hegelund vcap_keyfield_typegroup(struct vcap_control *vctrl, 180683e05c0SSteen Hegelund enum vcap_type vt, enum vcap_keyfield_set keyset) 181683e05c0SSteen Hegelund { 182683e05c0SSteen Hegelund const struct vcap_set *kset = vcap_keyfieldset(vctrl, vt, keyset); 183683e05c0SSteen Hegelund 184683e05c0SSteen Hegelund /* Check that the keyset is valid */ 185683e05c0SSteen Hegelund if (!kset) 186683e05c0SSteen Hegelund return NULL; 187683e05c0SSteen Hegelund return vctrl->vcaps[vt].keyfield_set_typegroups[kset->sw_per_item]; 188683e05c0SSteen Hegelund } 189683e05c0SSteen Hegelund 190683e05c0SSteen Hegelund /* Return the number of keyfields in the keyset */ 191d4134d41SSteen Hegelund int vcap_keyfield_count(struct vcap_control *vctrl, 192683e05c0SSteen Hegelund enum vcap_type vt, enum vcap_keyfield_set keyset) 193683e05c0SSteen Hegelund { 194683e05c0SSteen Hegelund /* Check that the keyset exists in the vcap keyset list */ 195683e05c0SSteen Hegelund if (keyset >= vctrl->vcaps[vt].keyfield_set_size) 196683e05c0SSteen Hegelund return 0; 197683e05c0SSteen Hegelund return vctrl->vcaps[vt].keyfield_set_map_size[keyset]; 198683e05c0SSteen Hegelund } 199683e05c0SSteen Hegelund 200683e05c0SSteen Hegelund static void vcap_encode_keyfield(struct vcap_rule_internal *ri, 201683e05c0SSteen Hegelund const struct vcap_client_keyfield *kf, 202683e05c0SSteen Hegelund const struct vcap_field *rf, 203683e05c0SSteen Hegelund const struct vcap_typegroup *tgt) 204683e05c0SSteen Hegelund { 205683e05c0SSteen Hegelund int sw_width = ri->vctrl->vcaps[ri->admin->vtype].sw_width; 206683e05c0SSteen Hegelund struct vcap_cache_data *cache = &ri->admin->cache; 207683e05c0SSteen Hegelund struct vcap_stream_iter iter; 208683e05c0SSteen Hegelund const u8 *value, *mask; 209683e05c0SSteen Hegelund 210683e05c0SSteen Hegelund /* Encode the fields for the key and the mask in their respective 211683e05c0SSteen Hegelund * streams, respecting the subword width. 212683e05c0SSteen Hegelund */ 213683e05c0SSteen Hegelund switch (kf->ctrl.type) { 214683e05c0SSteen Hegelund case VCAP_FIELD_BIT: 215683e05c0SSteen Hegelund value = &kf->data.u1.value; 216683e05c0SSteen Hegelund mask = &kf->data.u1.mask; 217683e05c0SSteen Hegelund break; 218683e05c0SSteen Hegelund case VCAP_FIELD_U32: 219683e05c0SSteen Hegelund value = (const u8 *)&kf->data.u32.value; 220683e05c0SSteen Hegelund mask = (const u8 *)&kf->data.u32.mask; 221683e05c0SSteen Hegelund break; 222683e05c0SSteen Hegelund case VCAP_FIELD_U48: 223683e05c0SSteen Hegelund value = kf->data.u48.value; 224683e05c0SSteen Hegelund mask = kf->data.u48.mask; 225683e05c0SSteen Hegelund break; 226683e05c0SSteen Hegelund case VCAP_FIELD_U56: 227683e05c0SSteen Hegelund value = kf->data.u56.value; 228683e05c0SSteen Hegelund mask = kf->data.u56.mask; 229683e05c0SSteen Hegelund break; 230683e05c0SSteen Hegelund case VCAP_FIELD_U64: 231683e05c0SSteen Hegelund value = kf->data.u64.value; 232683e05c0SSteen Hegelund mask = kf->data.u64.mask; 233683e05c0SSteen Hegelund break; 234683e05c0SSteen Hegelund case VCAP_FIELD_U72: 235683e05c0SSteen Hegelund value = kf->data.u72.value; 236683e05c0SSteen Hegelund mask = kf->data.u72.mask; 237683e05c0SSteen Hegelund break; 238683e05c0SSteen Hegelund case VCAP_FIELD_U112: 239683e05c0SSteen Hegelund value = kf->data.u112.value; 240683e05c0SSteen Hegelund mask = kf->data.u112.mask; 241683e05c0SSteen Hegelund break; 242683e05c0SSteen Hegelund case VCAP_FIELD_U128: 243683e05c0SSteen Hegelund value = kf->data.u128.value; 244683e05c0SSteen Hegelund mask = kf->data.u128.mask; 245683e05c0SSteen Hegelund break; 246683e05c0SSteen Hegelund } 247683e05c0SSteen Hegelund vcap_iter_init(&iter, sw_width, tgt, rf->offset); 248683e05c0SSteen Hegelund vcap_encode_field(cache->keystream, &iter, rf->width, value); 249683e05c0SSteen Hegelund vcap_iter_init(&iter, sw_width, tgt, rf->offset); 250683e05c0SSteen Hegelund vcap_encode_field(cache->maskstream, &iter, rf->width, mask); 251683e05c0SSteen Hegelund } 252683e05c0SSteen Hegelund 253683e05c0SSteen Hegelund static void vcap_encode_keyfield_typegroups(struct vcap_control *vctrl, 254683e05c0SSteen Hegelund struct vcap_rule_internal *ri, 255683e05c0SSteen Hegelund const struct vcap_typegroup *tgt) 256683e05c0SSteen Hegelund { 257683e05c0SSteen Hegelund int sw_width = vctrl->vcaps[ri->admin->vtype].sw_width; 258683e05c0SSteen Hegelund struct vcap_cache_data *cache = &ri->admin->cache; 259683e05c0SSteen Hegelund 260683e05c0SSteen Hegelund /* Encode the typegroup bits for the key and the mask in their streams, 261683e05c0SSteen Hegelund * respecting the subword width. 262683e05c0SSteen Hegelund */ 263683e05c0SSteen Hegelund vcap_encode_typegroups(cache->keystream, sw_width, tgt, false); 264683e05c0SSteen Hegelund vcap_encode_typegroups(cache->maskstream, sw_width, tgt, true); 265683e05c0SSteen Hegelund } 266683e05c0SSteen Hegelund 267683e05c0SSteen Hegelund static int vcap_encode_rule_keyset(struct vcap_rule_internal *ri) 268683e05c0SSteen Hegelund { 269683e05c0SSteen Hegelund const struct vcap_client_keyfield *ckf; 270683e05c0SSteen Hegelund const struct vcap_typegroup *tg_table; 271683e05c0SSteen Hegelund const struct vcap_field *kf_table; 272683e05c0SSteen Hegelund int keyset_size; 273683e05c0SSteen Hegelund 274683e05c0SSteen Hegelund /* Get a valid set of fields for the specific keyset */ 275683e05c0SSteen Hegelund kf_table = vcap_keyfields(ri->vctrl, ri->admin->vtype, ri->data.keyset); 276683e05c0SSteen Hegelund if (!kf_table) { 277683e05c0SSteen Hegelund pr_err("%s:%d: no fields available for this keyset: %d\n", 278683e05c0SSteen Hegelund __func__, __LINE__, ri->data.keyset); 279683e05c0SSteen Hegelund return -EINVAL; 280683e05c0SSteen Hegelund } 281683e05c0SSteen Hegelund /* Get a valid typegroup for the specific keyset */ 282683e05c0SSteen Hegelund tg_table = vcap_keyfield_typegroup(ri->vctrl, ri->admin->vtype, 283683e05c0SSteen Hegelund ri->data.keyset); 284683e05c0SSteen Hegelund if (!tg_table) { 285683e05c0SSteen Hegelund pr_err("%s:%d: no typegroups available for this keyset: %d\n", 286683e05c0SSteen Hegelund __func__, __LINE__, ri->data.keyset); 287683e05c0SSteen Hegelund return -EINVAL; 288683e05c0SSteen Hegelund } 289683e05c0SSteen Hegelund /* Get a valid size for the specific keyset */ 290683e05c0SSteen Hegelund keyset_size = vcap_keyfield_count(ri->vctrl, ri->admin->vtype, 291683e05c0SSteen Hegelund ri->data.keyset); 292683e05c0SSteen Hegelund if (keyset_size == 0) { 293683e05c0SSteen Hegelund pr_err("%s:%d: zero field count for this keyset: %d\n", 294683e05c0SSteen Hegelund __func__, __LINE__, ri->data.keyset); 295683e05c0SSteen Hegelund return -EINVAL; 296683e05c0SSteen Hegelund } 297683e05c0SSteen Hegelund /* Iterate over the keyfields (key, mask) in the rule 298683e05c0SSteen Hegelund * and encode these bits 299683e05c0SSteen Hegelund */ 300683e05c0SSteen Hegelund if (list_empty(&ri->data.keyfields)) { 301683e05c0SSteen Hegelund pr_err("%s:%d: no keyfields in the rule\n", __func__, __LINE__); 302683e05c0SSteen Hegelund return -EINVAL; 303683e05c0SSteen Hegelund } 304683e05c0SSteen Hegelund list_for_each_entry(ckf, &ri->data.keyfields, ctrl.list) { 305683e05c0SSteen Hegelund /* Check that the client entry exists in the keyset */ 306683e05c0SSteen Hegelund if (ckf->ctrl.key >= keyset_size) { 307683e05c0SSteen Hegelund pr_err("%s:%d: key %d is not in vcap\n", 308683e05c0SSteen Hegelund __func__, __LINE__, ckf->ctrl.key); 309683e05c0SSteen Hegelund return -EINVAL; 310683e05c0SSteen Hegelund } 311683e05c0SSteen Hegelund vcap_encode_keyfield(ri, ckf, &kf_table[ckf->ctrl.key], tg_table); 312683e05c0SSteen Hegelund } 313683e05c0SSteen Hegelund /* Add typegroup bits to the key/mask bitstreams */ 314683e05c0SSteen Hegelund vcap_encode_keyfield_typegroups(ri->vctrl, ri, tg_table); 315683e05c0SSteen Hegelund return 0; 316683e05c0SSteen Hegelund } 317683e05c0SSteen Hegelund 318683e05c0SSteen Hegelund /* Return the list of actionfields for the actionset */ 319683e05c0SSteen Hegelund static const struct vcap_field * 320683e05c0SSteen Hegelund vcap_actionfields(struct vcap_control *vctrl, 321683e05c0SSteen Hegelund enum vcap_type vt, enum vcap_actionfield_set actionset) 322683e05c0SSteen Hegelund { 323683e05c0SSteen Hegelund /* Check that the actionset exists in the vcap actionset list */ 324683e05c0SSteen Hegelund if (actionset >= vctrl->vcaps[vt].actionfield_set_size) 325683e05c0SSteen Hegelund return NULL; 326683e05c0SSteen Hegelund return vctrl->vcaps[vt].actionfield_set_map[actionset]; 327683e05c0SSteen Hegelund } 328683e05c0SSteen Hegelund 3298e10490bSSteen Hegelund static const struct vcap_set * 3308e10490bSSteen Hegelund vcap_actionfieldset(struct vcap_control *vctrl, 3318e10490bSSteen Hegelund enum vcap_type vt, enum vcap_actionfield_set actionset) 3328e10490bSSteen Hegelund { 3338e10490bSSteen Hegelund const struct vcap_set *aset; 3348e10490bSSteen Hegelund 3358e10490bSSteen Hegelund /* Check that the actionset exists in the vcap actionset list */ 3368e10490bSSteen Hegelund if (actionset >= vctrl->vcaps[vt].actionfield_set_size) 3378e10490bSSteen Hegelund return NULL; 3388e10490bSSteen Hegelund aset = &vctrl->vcaps[vt].actionfield_set[actionset]; 3398e10490bSSteen Hegelund if (aset->sw_per_item == 0 || aset->sw_per_item > vctrl->vcaps[vt].sw_count) 3408e10490bSSteen Hegelund return NULL; 3418e10490bSSteen Hegelund return aset; 3428e10490bSSteen Hegelund } 3438e10490bSSteen Hegelund 344683e05c0SSteen Hegelund /* Return the typegroup table for the matching actionset (using subword size) */ 345683e05c0SSteen Hegelund static const struct vcap_typegroup * 346683e05c0SSteen Hegelund vcap_actionfield_typegroup(struct vcap_control *vctrl, 347683e05c0SSteen Hegelund enum vcap_type vt, enum vcap_actionfield_set actionset) 348683e05c0SSteen Hegelund { 349683e05c0SSteen Hegelund const struct vcap_set *aset = vcap_actionfieldset(vctrl, vt, actionset); 350683e05c0SSteen Hegelund 351683e05c0SSteen Hegelund /* Check that the actionset is valid */ 352683e05c0SSteen Hegelund if (!aset) 353683e05c0SSteen Hegelund return NULL; 354683e05c0SSteen Hegelund return vctrl->vcaps[vt].actionfield_set_typegroups[aset->sw_per_item]; 355683e05c0SSteen Hegelund } 356683e05c0SSteen Hegelund 357683e05c0SSteen Hegelund /* Return the number of actionfields in the actionset */ 358683e05c0SSteen Hegelund static int vcap_actionfield_count(struct vcap_control *vctrl, 359683e05c0SSteen Hegelund enum vcap_type vt, 360683e05c0SSteen Hegelund enum vcap_actionfield_set actionset) 361683e05c0SSteen Hegelund { 362683e05c0SSteen Hegelund /* Check that the actionset exists in the vcap actionset list */ 363683e05c0SSteen Hegelund if (actionset >= vctrl->vcaps[vt].actionfield_set_size) 364683e05c0SSteen Hegelund return 0; 365683e05c0SSteen Hegelund return vctrl->vcaps[vt].actionfield_set_map_size[actionset]; 366683e05c0SSteen Hegelund } 367683e05c0SSteen Hegelund 368683e05c0SSteen Hegelund static void vcap_encode_actionfield(struct vcap_rule_internal *ri, 369683e05c0SSteen Hegelund const struct vcap_client_actionfield *af, 370683e05c0SSteen Hegelund const struct vcap_field *rf, 371683e05c0SSteen Hegelund const struct vcap_typegroup *tgt) 372683e05c0SSteen Hegelund { 373683e05c0SSteen Hegelund int act_width = ri->vctrl->vcaps[ri->admin->vtype].act_width; 374683e05c0SSteen Hegelund 375683e05c0SSteen Hegelund struct vcap_cache_data *cache = &ri->admin->cache; 376683e05c0SSteen Hegelund struct vcap_stream_iter iter; 377683e05c0SSteen Hegelund const u8 *value; 378683e05c0SSteen Hegelund 379683e05c0SSteen Hegelund /* Encode the action field in the stream, respecting the subword width */ 380683e05c0SSteen Hegelund switch (af->ctrl.type) { 381683e05c0SSteen Hegelund case VCAP_FIELD_BIT: 382683e05c0SSteen Hegelund value = &af->data.u1.value; 383683e05c0SSteen Hegelund break; 384683e05c0SSteen Hegelund case VCAP_FIELD_U32: 385683e05c0SSteen Hegelund value = (const u8 *)&af->data.u32.value; 386683e05c0SSteen Hegelund break; 387683e05c0SSteen Hegelund case VCAP_FIELD_U48: 388683e05c0SSteen Hegelund value = af->data.u48.value; 389683e05c0SSteen Hegelund break; 390683e05c0SSteen Hegelund case VCAP_FIELD_U56: 391683e05c0SSteen Hegelund value = af->data.u56.value; 392683e05c0SSteen Hegelund break; 393683e05c0SSteen Hegelund case VCAP_FIELD_U64: 394683e05c0SSteen Hegelund value = af->data.u64.value; 395683e05c0SSteen Hegelund break; 396683e05c0SSteen Hegelund case VCAP_FIELD_U72: 397683e05c0SSteen Hegelund value = af->data.u72.value; 398683e05c0SSteen Hegelund break; 399683e05c0SSteen Hegelund case VCAP_FIELD_U112: 400683e05c0SSteen Hegelund value = af->data.u112.value; 401683e05c0SSteen Hegelund break; 402683e05c0SSteen Hegelund case VCAP_FIELD_U128: 403683e05c0SSteen Hegelund value = af->data.u128.value; 404683e05c0SSteen Hegelund break; 405683e05c0SSteen Hegelund } 406683e05c0SSteen Hegelund vcap_iter_init(&iter, act_width, tgt, rf->offset); 407683e05c0SSteen Hegelund vcap_encode_field(cache->actionstream, &iter, rf->width, value); 408683e05c0SSteen Hegelund } 409683e05c0SSteen Hegelund 410683e05c0SSteen Hegelund static void vcap_encode_actionfield_typegroups(struct vcap_rule_internal *ri, 411683e05c0SSteen Hegelund const struct vcap_typegroup *tgt) 412683e05c0SSteen Hegelund { 413683e05c0SSteen Hegelund int sw_width = ri->vctrl->vcaps[ri->admin->vtype].act_width; 414683e05c0SSteen Hegelund struct vcap_cache_data *cache = &ri->admin->cache; 415683e05c0SSteen Hegelund 416683e05c0SSteen Hegelund /* Encode the typegroup bits for the actionstream respecting the subword 417683e05c0SSteen Hegelund * width. 418683e05c0SSteen Hegelund */ 419683e05c0SSteen Hegelund vcap_encode_typegroups(cache->actionstream, sw_width, tgt, false); 420683e05c0SSteen Hegelund } 421683e05c0SSteen Hegelund 422683e05c0SSteen Hegelund static int vcap_encode_rule_actionset(struct vcap_rule_internal *ri) 423683e05c0SSteen Hegelund { 424683e05c0SSteen Hegelund const struct vcap_client_actionfield *caf; 425683e05c0SSteen Hegelund const struct vcap_typegroup *tg_table; 426683e05c0SSteen Hegelund const struct vcap_field *af_table; 427683e05c0SSteen Hegelund int actionset_size; 428683e05c0SSteen Hegelund 429683e05c0SSteen Hegelund /* Get a valid set of actionset fields for the specific actionset */ 430683e05c0SSteen Hegelund af_table = vcap_actionfields(ri->vctrl, ri->admin->vtype, 431683e05c0SSteen Hegelund ri->data.actionset); 432683e05c0SSteen Hegelund if (!af_table) { 433683e05c0SSteen Hegelund pr_err("%s:%d: no fields available for this actionset: %d\n", 434683e05c0SSteen Hegelund __func__, __LINE__, ri->data.actionset); 435683e05c0SSteen Hegelund return -EINVAL; 436683e05c0SSteen Hegelund } 437683e05c0SSteen Hegelund /* Get a valid typegroup for the specific actionset */ 438683e05c0SSteen Hegelund tg_table = vcap_actionfield_typegroup(ri->vctrl, ri->admin->vtype, 439683e05c0SSteen Hegelund ri->data.actionset); 440683e05c0SSteen Hegelund if (!tg_table) { 441683e05c0SSteen Hegelund pr_err("%s:%d: no typegroups available for this actionset: %d\n", 442683e05c0SSteen Hegelund __func__, __LINE__, ri->data.actionset); 443683e05c0SSteen Hegelund return -EINVAL; 444683e05c0SSteen Hegelund } 445683e05c0SSteen Hegelund /* Get a valid actionset size for the specific actionset */ 446683e05c0SSteen Hegelund actionset_size = vcap_actionfield_count(ri->vctrl, ri->admin->vtype, 447683e05c0SSteen Hegelund ri->data.actionset); 448683e05c0SSteen Hegelund if (actionset_size == 0) { 449683e05c0SSteen Hegelund pr_err("%s:%d: zero field count for this actionset: %d\n", 450683e05c0SSteen Hegelund __func__, __LINE__, ri->data.actionset); 451683e05c0SSteen Hegelund return -EINVAL; 452683e05c0SSteen Hegelund } 453683e05c0SSteen Hegelund /* Iterate over the actionfields in the rule 454683e05c0SSteen Hegelund * and encode these bits 455683e05c0SSteen Hegelund */ 456683e05c0SSteen Hegelund if (list_empty(&ri->data.actionfields)) 457683e05c0SSteen Hegelund pr_warn("%s:%d: no actionfields in the rule\n", 458683e05c0SSteen Hegelund __func__, __LINE__); 459683e05c0SSteen Hegelund list_for_each_entry(caf, &ri->data.actionfields, ctrl.list) { 460683e05c0SSteen Hegelund /* Check that the client action exists in the actionset */ 461683e05c0SSteen Hegelund if (caf->ctrl.action >= actionset_size) { 462683e05c0SSteen Hegelund pr_err("%s:%d: action %d is not in vcap\n", 463683e05c0SSteen Hegelund __func__, __LINE__, caf->ctrl.action); 464683e05c0SSteen Hegelund return -EINVAL; 465683e05c0SSteen Hegelund } 466683e05c0SSteen Hegelund vcap_encode_actionfield(ri, caf, &af_table[caf->ctrl.action], 467683e05c0SSteen Hegelund tg_table); 468683e05c0SSteen Hegelund } 469683e05c0SSteen Hegelund /* Add typegroup bits to the entry bitstreams */ 470683e05c0SSteen Hegelund vcap_encode_actionfield_typegroups(ri, tg_table); 471683e05c0SSteen Hegelund return 0; 472683e05c0SSteen Hegelund } 473683e05c0SSteen Hegelund 4748e10490bSSteen Hegelund static int vcap_encode_rule(struct vcap_rule_internal *ri) 4758e10490bSSteen Hegelund { 476683e05c0SSteen Hegelund int err; 477683e05c0SSteen Hegelund 478683e05c0SSteen Hegelund err = vcap_encode_rule_keyset(ri); 479683e05c0SSteen Hegelund if (err) 480683e05c0SSteen Hegelund return err; 481683e05c0SSteen Hegelund err = vcap_encode_rule_actionset(ri); 482683e05c0SSteen Hegelund if (err) 483683e05c0SSteen Hegelund return err; 4848e10490bSSteen Hegelund return 0; 4858e10490bSSteen Hegelund } 4868e10490bSSteen Hegelund 487d4134d41SSteen Hegelund int vcap_api_check(struct vcap_control *ctrl) 4888e10490bSSteen Hegelund { 4898e10490bSSteen Hegelund if (!ctrl) { 4908e10490bSSteen Hegelund pr_err("%s:%d: vcap control is missing\n", __func__, __LINE__); 4918e10490bSSteen Hegelund return -EINVAL; 4928e10490bSSteen Hegelund } 4938e10490bSSteen Hegelund if (!ctrl->ops || !ctrl->ops->validate_keyset || 4948e10490bSSteen Hegelund !ctrl->ops->add_default_fields || !ctrl->ops->cache_erase || 4958e10490bSSteen Hegelund !ctrl->ops->cache_write || !ctrl->ops->cache_read || 4968e10490bSSteen Hegelund !ctrl->ops->init || !ctrl->ops->update || !ctrl->ops->move || 49767456717SSteen Hegelund !ctrl->ops->port_info || !ctrl->ops->enable) { 4988e10490bSSteen Hegelund pr_err("%s:%d: client operations are missing\n", 4998e10490bSSteen Hegelund __func__, __LINE__); 5008e10490bSSteen Hegelund return -ENOENT; 5018e10490bSSteen Hegelund } 5028e10490bSSteen Hegelund return 0; 5038e10490bSSteen Hegelund } 5048e10490bSSteen Hegelund 505*3a792156SSteen Hegelund void vcap_erase_cache(struct vcap_rule_internal *ri) 5068e10490bSSteen Hegelund { 5078e10490bSSteen Hegelund ri->vctrl->ops->cache_erase(ri->admin); 5088e10490bSSteen Hegelund } 5098e10490bSSteen Hegelund 510c9da1ac1SSteen Hegelund /* Update the keyset for the rule */ 511c9da1ac1SSteen Hegelund int vcap_set_rule_set_keyset(struct vcap_rule *rule, 512c9da1ac1SSteen Hegelund enum vcap_keyfield_set keyset) 513c9da1ac1SSteen Hegelund { 5148e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 5158e10490bSSteen Hegelund const struct vcap_set *kset; 5168e10490bSSteen Hegelund int sw_width; 5178e10490bSSteen Hegelund 5188e10490bSSteen Hegelund kset = vcap_keyfieldset(ri->vctrl, ri->admin->vtype, keyset); 5198e10490bSSteen Hegelund /* Check that the keyset is valid */ 5208e10490bSSteen Hegelund if (!kset) 5218e10490bSSteen Hegelund return -EINVAL; 5228e10490bSSteen Hegelund ri->keyset_sw = kset->sw_per_item; 5238e10490bSSteen Hegelund sw_width = ri->vctrl->vcaps[ri->admin->vtype].sw_width; 5248e10490bSSteen Hegelund ri->keyset_sw_regs = DIV_ROUND_UP(sw_width, 32); 5258e10490bSSteen Hegelund ri->data.keyset = keyset; 526c9da1ac1SSteen Hegelund return 0; 527c9da1ac1SSteen Hegelund } 528c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_set_rule_set_keyset); 529c9da1ac1SSteen Hegelund 530c9da1ac1SSteen Hegelund /* Update the actionset for the rule */ 531c9da1ac1SSteen Hegelund int vcap_set_rule_set_actionset(struct vcap_rule *rule, 532c9da1ac1SSteen Hegelund enum vcap_actionfield_set actionset) 533c9da1ac1SSteen Hegelund { 5348e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 5358e10490bSSteen Hegelund const struct vcap_set *aset; 5368e10490bSSteen Hegelund int act_width; 5378e10490bSSteen Hegelund 5388e10490bSSteen Hegelund aset = vcap_actionfieldset(ri->vctrl, ri->admin->vtype, actionset); 5398e10490bSSteen Hegelund /* Check that the actionset is valid */ 5408e10490bSSteen Hegelund if (!aset) 5418e10490bSSteen Hegelund return -EINVAL; 5428e10490bSSteen Hegelund ri->actionset_sw = aset->sw_per_item; 5438e10490bSSteen Hegelund act_width = ri->vctrl->vcaps[ri->admin->vtype].act_width; 5448e10490bSSteen Hegelund ri->actionset_sw_regs = DIV_ROUND_UP(act_width, 32); 5458e10490bSSteen Hegelund ri->data.actionset = actionset; 546c9da1ac1SSteen Hegelund return 0; 547c9da1ac1SSteen Hegelund } 548c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_set_rule_set_actionset); 549c9da1ac1SSteen Hegelund 550c9da1ac1SSteen Hegelund /* Find a rule with a provided rule id */ 551c9da1ac1SSteen Hegelund static struct vcap_rule_internal *vcap_lookup_rule(struct vcap_control *vctrl, 552c9da1ac1SSteen Hegelund u32 id) 553c9da1ac1SSteen Hegelund { 554c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri; 555c9da1ac1SSteen Hegelund struct vcap_admin *admin; 556c9da1ac1SSteen Hegelund 557c9da1ac1SSteen Hegelund /* Look for the rule id in all vcaps */ 558c9da1ac1SSteen Hegelund list_for_each_entry(admin, &vctrl->list, list) 559c9da1ac1SSteen Hegelund list_for_each_entry(ri, &admin->rules, list) 560c9da1ac1SSteen Hegelund if (ri->data.id == id) 561c9da1ac1SSteen Hegelund return ri; 562c9da1ac1SSteen Hegelund return NULL; 563c9da1ac1SSteen Hegelund } 564c9da1ac1SSteen Hegelund 565c9da1ac1SSteen Hegelund /* Find a rule id with a provided cookie */ 566c9da1ac1SSteen Hegelund int vcap_lookup_rule_by_cookie(struct vcap_control *vctrl, u64 cookie) 567c9da1ac1SSteen Hegelund { 568c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri; 569c9da1ac1SSteen Hegelund struct vcap_admin *admin; 570c9da1ac1SSteen Hegelund 571c9da1ac1SSteen Hegelund /* Look for the rule id in all vcaps */ 572c9da1ac1SSteen Hegelund list_for_each_entry(admin, &vctrl->list, list) 573c9da1ac1SSteen Hegelund list_for_each_entry(ri, &admin->rules, list) 574c9da1ac1SSteen Hegelund if (ri->data.cookie == cookie) 575c9da1ac1SSteen Hegelund return ri->data.id; 576c9da1ac1SSteen Hegelund return -ENOENT; 577c9da1ac1SSteen Hegelund } 578c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_lookup_rule_by_cookie); 579c9da1ac1SSteen Hegelund 5808e10490bSSteen Hegelund /* Make a shallow copy of the rule without the fields */ 581*3a792156SSteen Hegelund struct vcap_rule_internal *vcap_dup_rule(struct vcap_rule_internal *ri) 5828e10490bSSteen Hegelund { 5838e10490bSSteen Hegelund struct vcap_rule_internal *duprule; 5848e10490bSSteen Hegelund 5858e10490bSSteen Hegelund /* Allocate the client part */ 5868e10490bSSteen Hegelund duprule = kzalloc(sizeof(*duprule), GFP_KERNEL); 5878e10490bSSteen Hegelund if (!duprule) 5888e10490bSSteen Hegelund return ERR_PTR(-ENOMEM); 5898e10490bSSteen Hegelund *duprule = *ri; 5908e10490bSSteen Hegelund /* Not inserted in the VCAP */ 5918e10490bSSteen Hegelund INIT_LIST_HEAD(&duprule->list); 5928e10490bSSteen Hegelund /* No elements in these lists */ 5938e10490bSSteen Hegelund INIT_LIST_HEAD(&duprule->data.keyfields); 5948e10490bSSteen Hegelund INIT_LIST_HEAD(&duprule->data.actionfields); 5958e10490bSSteen Hegelund return duprule; 5968e10490bSSteen Hegelund } 5978e10490bSSteen Hegelund 5988e10490bSSteen Hegelund /* Write VCAP cache content to the VCAP HW instance */ 5998e10490bSSteen Hegelund static int vcap_write_rule(struct vcap_rule_internal *ri) 6008e10490bSSteen Hegelund { 6018e10490bSSteen Hegelund struct vcap_admin *admin = ri->admin; 6028e10490bSSteen Hegelund int sw_idx, ent_idx = 0, act_idx = 0; 6038e10490bSSteen Hegelund u32 addr = ri->addr; 6048e10490bSSteen Hegelund 6058e10490bSSteen Hegelund if (!ri->size || !ri->keyset_sw_regs || !ri->actionset_sw_regs) { 6068e10490bSSteen Hegelund pr_err("%s:%d: rule is empty\n", __func__, __LINE__); 6078e10490bSSteen Hegelund return -EINVAL; 6088e10490bSSteen Hegelund } 6098e10490bSSteen Hegelund /* Use the values in the streams to write the VCAP cache */ 6108e10490bSSteen Hegelund for (sw_idx = 0; sw_idx < ri->size; sw_idx++, addr++) { 6118e10490bSSteen Hegelund ri->vctrl->ops->cache_write(ri->ndev, admin, 6128e10490bSSteen Hegelund VCAP_SEL_ENTRY, ent_idx, 6138e10490bSSteen Hegelund ri->keyset_sw_regs); 6148e10490bSSteen Hegelund ri->vctrl->ops->cache_write(ri->ndev, admin, 6158e10490bSSteen Hegelund VCAP_SEL_ACTION, act_idx, 6168e10490bSSteen Hegelund ri->actionset_sw_regs); 6178e10490bSSteen Hegelund ri->vctrl->ops->update(ri->ndev, admin, VCAP_CMD_WRITE, 6188e10490bSSteen Hegelund VCAP_SEL_ALL, addr); 6198e10490bSSteen Hegelund ent_idx += ri->keyset_sw_regs; 6208e10490bSSteen Hegelund act_idx += ri->actionset_sw_regs; 6218e10490bSSteen Hegelund } 6228e10490bSSteen Hegelund return 0; 6238e10490bSSteen Hegelund } 6248e10490bSSteen Hegelund 625f13230a4SSteen Hegelund static int vcap_write_counter(struct vcap_rule_internal *ri, 626f13230a4SSteen Hegelund struct vcap_counter *ctr) 627f13230a4SSteen Hegelund { 628f13230a4SSteen Hegelund struct vcap_admin *admin = ri->admin; 629f13230a4SSteen Hegelund 630f13230a4SSteen Hegelund admin->cache.counter = ctr->value; 631f13230a4SSteen Hegelund admin->cache.sticky = ctr->sticky; 632f13230a4SSteen Hegelund ri->vctrl->ops->cache_write(ri->ndev, admin, VCAP_SEL_COUNTER, 633f13230a4SSteen Hegelund ri->counter_id, 0); 634f13230a4SSteen Hegelund ri->vctrl->ops->update(ri->ndev, admin, VCAP_CMD_WRITE, 635f13230a4SSteen Hegelund VCAP_SEL_COUNTER, ri->addr); 636f13230a4SSteen Hegelund return 0; 637f13230a4SSteen Hegelund } 638f13230a4SSteen Hegelund 6397de1dcadSSteen Hegelund /* Convert a chain id to a VCAP lookup index */ 6407de1dcadSSteen Hegelund int vcap_chain_id_to_lookup(struct vcap_admin *admin, int cur_cid) 6417de1dcadSSteen Hegelund { 6427de1dcadSSteen Hegelund int lookup_first = admin->vinst * admin->lookups_per_instance; 6437de1dcadSSteen Hegelund int lookup_last = lookup_first + admin->lookups_per_instance; 6447de1dcadSSteen Hegelund int cid_next = admin->first_cid + VCAP_CID_LOOKUP_SIZE; 6457de1dcadSSteen Hegelund int cid = admin->first_cid; 6467de1dcadSSteen Hegelund int lookup; 6477de1dcadSSteen Hegelund 6487de1dcadSSteen Hegelund for (lookup = lookup_first; lookup < lookup_last; ++lookup, 6497de1dcadSSteen Hegelund cid += VCAP_CID_LOOKUP_SIZE, cid_next += VCAP_CID_LOOKUP_SIZE) 6507de1dcadSSteen Hegelund if (cur_cid >= cid && cur_cid < cid_next) 6517de1dcadSSteen Hegelund return lookup; 6527de1dcadSSteen Hegelund return 0; 6537de1dcadSSteen Hegelund } 6547de1dcadSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_chain_id_to_lookup); 6557de1dcadSSteen Hegelund 656c9da1ac1SSteen Hegelund /* Lookup a vcap instance using chain id */ 657c9da1ac1SSteen Hegelund struct vcap_admin *vcap_find_admin(struct vcap_control *vctrl, int cid) 658c9da1ac1SSteen Hegelund { 659c9da1ac1SSteen Hegelund struct vcap_admin *admin; 660c9da1ac1SSteen Hegelund 6618e10490bSSteen Hegelund if (vcap_api_check(vctrl)) 6628e10490bSSteen Hegelund return NULL; 6638e10490bSSteen Hegelund 664c9da1ac1SSteen Hegelund list_for_each_entry(admin, &vctrl->list, list) { 665c9da1ac1SSteen Hegelund if (cid >= admin->first_cid && cid <= admin->last_cid) 666c9da1ac1SSteen Hegelund return admin; 667c9da1ac1SSteen Hegelund } 668c9da1ac1SSteen Hegelund return NULL; 669c9da1ac1SSteen Hegelund } 670c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_find_admin); 671c9da1ac1SSteen Hegelund 672392d0ab0SSteen Hegelund /* Is the next chain id in the following lookup, possible in another VCAP */ 673392d0ab0SSteen Hegelund bool vcap_is_next_lookup(struct vcap_control *vctrl, int cur_cid, int next_cid) 674392d0ab0SSteen Hegelund { 675392d0ab0SSteen Hegelund struct vcap_admin *admin, *next_admin; 676392d0ab0SSteen Hegelund int lookup, next_lookup; 677392d0ab0SSteen Hegelund 678392d0ab0SSteen Hegelund /* The offset must be at least one lookup */ 679392d0ab0SSteen Hegelund if (next_cid < cur_cid + VCAP_CID_LOOKUP_SIZE) 680392d0ab0SSteen Hegelund return false; 681392d0ab0SSteen Hegelund 682392d0ab0SSteen Hegelund if (vcap_api_check(vctrl)) 683392d0ab0SSteen Hegelund return false; 684392d0ab0SSteen Hegelund 685392d0ab0SSteen Hegelund admin = vcap_find_admin(vctrl, cur_cid); 686392d0ab0SSteen Hegelund if (!admin) 687392d0ab0SSteen Hegelund return false; 688392d0ab0SSteen Hegelund 689392d0ab0SSteen Hegelund /* If no VCAP contains the next chain, the next chain must be beyond 690392d0ab0SSteen Hegelund * the last chain in the current VCAP 691392d0ab0SSteen Hegelund */ 692392d0ab0SSteen Hegelund next_admin = vcap_find_admin(vctrl, next_cid); 693392d0ab0SSteen Hegelund if (!next_admin) 694392d0ab0SSteen Hegelund return next_cid > admin->last_cid; 695392d0ab0SSteen Hegelund 696392d0ab0SSteen Hegelund lookup = vcap_chain_id_to_lookup(admin, cur_cid); 697392d0ab0SSteen Hegelund next_lookup = vcap_chain_id_to_lookup(next_admin, next_cid); 698392d0ab0SSteen Hegelund 699392d0ab0SSteen Hegelund /* Next lookup must be the following lookup */ 700392d0ab0SSteen Hegelund if (admin == next_admin || admin->vtype == next_admin->vtype) 701392d0ab0SSteen Hegelund return next_lookup == lookup + 1; 702392d0ab0SSteen Hegelund 703392d0ab0SSteen Hegelund /* Must be the first lookup in the next VCAP instance */ 704392d0ab0SSteen Hegelund return next_lookup == 0; 705392d0ab0SSteen Hegelund } 706392d0ab0SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_is_next_lookup); 707392d0ab0SSteen Hegelund 7088e10490bSSteen Hegelund /* Check if there is room for a new rule */ 7098e10490bSSteen Hegelund static int vcap_rule_space(struct vcap_admin *admin, int size) 7108e10490bSSteen Hegelund { 7118e10490bSSteen Hegelund if (admin->last_used_addr - size < admin->first_valid_addr) { 7128e10490bSSteen Hegelund pr_err("%s:%d: No room for rule size: %u, %u\n", 7138e10490bSSteen Hegelund __func__, __LINE__, size, admin->first_valid_addr); 7148e10490bSSteen Hegelund return -ENOSPC; 7158e10490bSSteen Hegelund } 7168e10490bSSteen Hegelund return 0; 7178e10490bSSteen Hegelund } 7188e10490bSSteen Hegelund 7198e10490bSSteen Hegelund /* Add the keyset typefield to the list of rule keyfields */ 7208e10490bSSteen Hegelund static int vcap_add_type_keyfield(struct vcap_rule *rule) 7218e10490bSSteen Hegelund { 7228e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 7238e10490bSSteen Hegelund enum vcap_keyfield_set keyset = rule->keyset; 7248e10490bSSteen Hegelund enum vcap_type vt = ri->admin->vtype; 7258e10490bSSteen Hegelund const struct vcap_field *fields; 7268e10490bSSteen Hegelund const struct vcap_set *kset; 7278e10490bSSteen Hegelund int ret = -EINVAL; 7288e10490bSSteen Hegelund 7298e10490bSSteen Hegelund kset = vcap_keyfieldset(ri->vctrl, vt, keyset); 7308e10490bSSteen Hegelund if (!kset) 7318e10490bSSteen Hegelund return ret; 7328e10490bSSteen Hegelund if (kset->type_id == (u8)-1) /* No type field is needed */ 7338e10490bSSteen Hegelund return 0; 7348e10490bSSteen Hegelund 7358e10490bSSteen Hegelund fields = vcap_keyfields(ri->vctrl, vt, keyset); 7368e10490bSSteen Hegelund if (!fields) 7378e10490bSSteen Hegelund return -EINVAL; 7388e10490bSSteen Hegelund if (fields[VCAP_KF_TYPE].width > 1) { 7398e10490bSSteen Hegelund ret = vcap_rule_add_key_u32(rule, VCAP_KF_TYPE, 7408e10490bSSteen Hegelund kset->type_id, 0xff); 7418e10490bSSteen Hegelund } else { 7428e10490bSSteen Hegelund if (kset->type_id) 7438e10490bSSteen Hegelund ret = vcap_rule_add_key_bit(rule, VCAP_KF_TYPE, 7448e10490bSSteen Hegelund VCAP_BIT_1); 7458e10490bSSteen Hegelund else 7468e10490bSSteen Hegelund ret = vcap_rule_add_key_bit(rule, VCAP_KF_TYPE, 7478e10490bSSteen Hegelund VCAP_BIT_0); 7488e10490bSSteen Hegelund } 7498e10490bSSteen Hegelund return 0; 7508e10490bSSteen Hegelund } 7518e10490bSSteen Hegelund 752abc4010dSSteen Hegelund /* Add a keyset to a keyset list */ 753abc4010dSSteen Hegelund bool vcap_keyset_list_add(struct vcap_keyset_list *keysetlist, 754abc4010dSSteen Hegelund enum vcap_keyfield_set keyset) 755abc4010dSSteen Hegelund { 756abc4010dSSteen Hegelund int idx; 757abc4010dSSteen Hegelund 758abc4010dSSteen Hegelund if (keysetlist->cnt < keysetlist->max) { 759abc4010dSSteen Hegelund /* Avoid duplicates */ 760abc4010dSSteen Hegelund for (idx = 0; idx < keysetlist->cnt; ++idx) 761abc4010dSSteen Hegelund if (keysetlist->keysets[idx] == keyset) 762abc4010dSSteen Hegelund return keysetlist->cnt < keysetlist->max; 763abc4010dSSteen Hegelund keysetlist->keysets[keysetlist->cnt++] = keyset; 764abc4010dSSteen Hegelund } 765abc4010dSSteen Hegelund return keysetlist->cnt < keysetlist->max; 766abc4010dSSteen Hegelund } 767abc4010dSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_keyset_list_add); 768abc4010dSSteen Hegelund 769abc4010dSSteen Hegelund /* map keyset id to a string with the keyset name */ 770abc4010dSSteen Hegelund const char *vcap_keyset_name(struct vcap_control *vctrl, 771abc4010dSSteen Hegelund enum vcap_keyfield_set keyset) 772abc4010dSSteen Hegelund { 773abc4010dSSteen Hegelund return vctrl->stats->keyfield_set_names[keyset]; 774abc4010dSSteen Hegelund } 775abc4010dSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_keyset_name); 776abc4010dSSteen Hegelund 777abc4010dSSteen Hegelund /* map key field id to a string with the key name */ 778abc4010dSSteen Hegelund const char *vcap_keyfield_name(struct vcap_control *vctrl, 779abc4010dSSteen Hegelund enum vcap_key_field key) 780abc4010dSSteen Hegelund { 781abc4010dSSteen Hegelund return vctrl->stats->keyfield_names[key]; 782abc4010dSSteen Hegelund } 783abc4010dSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_keyfield_name); 784abc4010dSSteen Hegelund 785*3a792156SSteen Hegelund /* map actionset id to a string with the actionset name */ 786*3a792156SSteen Hegelund const char *vcap_actionset_name(struct vcap_control *vctrl, 787*3a792156SSteen Hegelund enum vcap_actionfield_set actionset) 788*3a792156SSteen Hegelund { 789*3a792156SSteen Hegelund return vctrl->stats->actionfield_set_names[actionset]; 790*3a792156SSteen Hegelund } 791*3a792156SSteen Hegelund 792242df4f7SSteen Hegelund /* map action field id to a string with the action name */ 793*3a792156SSteen Hegelund const char *vcap_actionfield_name(struct vcap_control *vctrl, 794242df4f7SSteen Hegelund enum vcap_action_field action) 795242df4f7SSteen Hegelund { 796242df4f7SSteen Hegelund return vctrl->stats->actionfield_names[action]; 797242df4f7SSteen Hegelund } 798242df4f7SSteen Hegelund 799abc4010dSSteen Hegelund /* Return the keyfield that matches a key in a keyset */ 800abc4010dSSteen Hegelund static const struct vcap_field * 801abc4010dSSteen Hegelund vcap_find_keyset_keyfield(struct vcap_control *vctrl, 802abc4010dSSteen Hegelund enum vcap_type vtype, 803abc4010dSSteen Hegelund enum vcap_keyfield_set keyset, 804abc4010dSSteen Hegelund enum vcap_key_field key) 805abc4010dSSteen Hegelund { 806abc4010dSSteen Hegelund const struct vcap_field *fields; 807abc4010dSSteen Hegelund int idx, count; 808abc4010dSSteen Hegelund 809abc4010dSSteen Hegelund fields = vcap_keyfields(vctrl, vtype, keyset); 810abc4010dSSteen Hegelund if (!fields) 811abc4010dSSteen Hegelund return NULL; 812abc4010dSSteen Hegelund 813abc4010dSSteen Hegelund /* Iterate the keyfields of the keyset */ 814abc4010dSSteen Hegelund count = vcap_keyfield_count(vctrl, vtype, keyset); 815abc4010dSSteen Hegelund for (idx = 0; idx < count; ++idx) { 816abc4010dSSteen Hegelund if (fields[idx].width == 0) 817abc4010dSSteen Hegelund continue; 818abc4010dSSteen Hegelund 819abc4010dSSteen Hegelund if (key == idx) 820abc4010dSSteen Hegelund return &fields[idx]; 821abc4010dSSteen Hegelund } 822abc4010dSSteen Hegelund 823abc4010dSSteen Hegelund return NULL; 824abc4010dSSteen Hegelund } 825abc4010dSSteen Hegelund 826abc4010dSSteen Hegelund /* Match a list of keys against the keysets available in a vcap type */ 827abc4010dSSteen Hegelund static bool vcap_rule_find_keysets(struct vcap_rule_internal *ri, 828abc4010dSSteen Hegelund struct vcap_keyset_list *matches) 829abc4010dSSteen Hegelund { 830abc4010dSSteen Hegelund const struct vcap_client_keyfield *ckf; 831abc4010dSSteen Hegelund int keyset, found, keycount, map_size; 832abc4010dSSteen Hegelund const struct vcap_field **map; 833abc4010dSSteen Hegelund enum vcap_type vtype; 834abc4010dSSteen Hegelund 835abc4010dSSteen Hegelund vtype = ri->admin->vtype; 836abc4010dSSteen Hegelund map = ri->vctrl->vcaps[vtype].keyfield_set_map; 837abc4010dSSteen Hegelund map_size = ri->vctrl->vcaps[vtype].keyfield_set_size; 838abc4010dSSteen Hegelund 839abc4010dSSteen Hegelund /* Get a count of the keyfields we want to match */ 840abc4010dSSteen Hegelund keycount = 0; 841abc4010dSSteen Hegelund list_for_each_entry(ckf, &ri->data.keyfields, ctrl.list) 842abc4010dSSteen Hegelund ++keycount; 843abc4010dSSteen Hegelund 844abc4010dSSteen Hegelund matches->cnt = 0; 845abc4010dSSteen Hegelund /* Iterate the keysets of the VCAP */ 846abc4010dSSteen Hegelund for (keyset = 0; keyset < map_size; ++keyset) { 847abc4010dSSteen Hegelund if (!map[keyset]) 848abc4010dSSteen Hegelund continue; 849abc4010dSSteen Hegelund 850abc4010dSSteen Hegelund /* Iterate the keys in the rule */ 851abc4010dSSteen Hegelund found = 0; 852abc4010dSSteen Hegelund list_for_each_entry(ckf, &ri->data.keyfields, ctrl.list) 853abc4010dSSteen Hegelund if (vcap_find_keyset_keyfield(ri->vctrl, vtype, 854abc4010dSSteen Hegelund keyset, ckf->ctrl.key)) 855abc4010dSSteen Hegelund ++found; 856abc4010dSSteen Hegelund 857abc4010dSSteen Hegelund /* Save the keyset if all keyfields were found */ 858abc4010dSSteen Hegelund if (found == keycount) 859abc4010dSSteen Hegelund if (!vcap_keyset_list_add(matches, keyset)) 860abc4010dSSteen Hegelund /* bail out when the quota is filled */ 861abc4010dSSteen Hegelund break; 862abc4010dSSteen Hegelund } 863abc4010dSSteen Hegelund 864abc4010dSSteen Hegelund return matches->cnt > 0; 865abc4010dSSteen Hegelund } 866abc4010dSSteen Hegelund 867c9da1ac1SSteen Hegelund /* Validate a rule with respect to available port keys */ 868c9da1ac1SSteen Hegelund int vcap_val_rule(struct vcap_rule *rule, u16 l3_proto) 869c9da1ac1SSteen Hegelund { 870c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 871abc4010dSSteen Hegelund struct vcap_keyset_list matches = {}; 8728e10490bSSteen Hegelund enum vcap_keyfield_set keysets[10]; 8738e10490bSSteen Hegelund int ret; 874c9da1ac1SSteen Hegelund 8758e10490bSSteen Hegelund ret = vcap_api_check(ri->vctrl); 8768e10490bSSteen Hegelund if (ret) 8778e10490bSSteen Hegelund return ret; 878c9da1ac1SSteen Hegelund if (!ri->admin) { 879c9da1ac1SSteen Hegelund ri->data.exterr = VCAP_ERR_NO_ADMIN; 880c9da1ac1SSteen Hegelund return -EINVAL; 881c9da1ac1SSteen Hegelund } 882c9da1ac1SSteen Hegelund if (!ri->ndev) { 883c9da1ac1SSteen Hegelund ri->data.exterr = VCAP_ERR_NO_NETDEV; 884c9da1ac1SSteen Hegelund return -EINVAL; 885c9da1ac1SSteen Hegelund } 886abc4010dSSteen Hegelund 887abc4010dSSteen Hegelund matches.keysets = keysets; 888abc4010dSSteen Hegelund matches.max = ARRAY_SIZE(keysets); 889c9da1ac1SSteen Hegelund if (ri->data.keyset == VCAP_KFS_NO_VALUE) { 890abc4010dSSteen Hegelund /* Iterate over rule keyfields and select keysets that fits */ 891abc4010dSSteen Hegelund if (!vcap_rule_find_keysets(ri, &matches)) { 892c9da1ac1SSteen Hegelund ri->data.exterr = VCAP_ERR_NO_KEYSET_MATCH; 893c9da1ac1SSteen Hegelund return -EINVAL; 894c9da1ac1SSteen Hegelund } 895abc4010dSSteen Hegelund } else { 8968e10490bSSteen Hegelund /* prepare for keyset validation */ 8978e10490bSSteen Hegelund keysets[0] = ri->data.keyset; 898abc4010dSSteen Hegelund matches.cnt = 1; 899abc4010dSSteen Hegelund } 900abc4010dSSteen Hegelund 9018e10490bSSteen Hegelund /* Pick a keyset that is supported in the port lookups */ 902abc4010dSSteen Hegelund ret = ri->vctrl->ops->validate_keyset(ri->ndev, ri->admin, rule, 903abc4010dSSteen Hegelund &matches, l3_proto); 9048e10490bSSteen Hegelund if (ret < 0) { 9058e10490bSSteen Hegelund pr_err("%s:%d: keyset validation failed: %d\n", 9068e10490bSSteen Hegelund __func__, __LINE__, ret); 9078e10490bSSteen Hegelund ri->data.exterr = VCAP_ERR_NO_PORT_KEYSET_MATCH; 9088e10490bSSteen Hegelund return ret; 9098e10490bSSteen Hegelund } 910abc4010dSSteen Hegelund /* use the keyset that is supported in the port lookups */ 911abc4010dSSteen Hegelund ret = vcap_set_rule_set_keyset(rule, ret); 912abc4010dSSteen Hegelund if (ret < 0) { 913abc4010dSSteen Hegelund pr_err("%s:%d: keyset was not updated: %d\n", 914abc4010dSSteen Hegelund __func__, __LINE__, ret); 915abc4010dSSteen Hegelund return ret; 916abc4010dSSteen Hegelund } 917c9da1ac1SSteen Hegelund if (ri->data.actionset == VCAP_AFS_NO_VALUE) { 918abc4010dSSteen Hegelund /* Later also actionsets will be matched against actions in 919abc4010dSSteen Hegelund * the rule, and the type will be set accordingly 920abc4010dSSteen Hegelund */ 921c9da1ac1SSteen Hegelund ri->data.exterr = VCAP_ERR_NO_ACTIONSET_MATCH; 922c9da1ac1SSteen Hegelund return -EINVAL; 923c9da1ac1SSteen Hegelund } 9248e10490bSSteen Hegelund vcap_add_type_keyfield(rule); 9258e10490bSSteen Hegelund /* Add default fields to this rule */ 9268e10490bSSteen Hegelund ri->vctrl->ops->add_default_fields(ri->ndev, ri->admin, rule); 9278e10490bSSteen Hegelund 9288e10490bSSteen Hegelund /* Rule size is the maximum of the entry and action subword count */ 9298e10490bSSteen Hegelund ri->size = max(ri->keyset_sw, ri->actionset_sw); 9308e10490bSSteen Hegelund 9318e10490bSSteen Hegelund /* Finally check if there is room for the rule in the VCAP */ 9328e10490bSSteen Hegelund return vcap_rule_space(ri->admin, ri->size); 933c9da1ac1SSteen Hegelund } 934c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_val_rule); 935c9da1ac1SSteen Hegelund 936990e4839SSteen Hegelund /* Entries are sorted with increasing values of sort_key. 937990e4839SSteen Hegelund * I.e. Lowest numerical sort_key is first in list. 938990e4839SSteen Hegelund * In order to locate largest keys first in list we negate the key size with 939990e4839SSteen Hegelund * (max_size - size). 940990e4839SSteen Hegelund */ 941990e4839SSteen Hegelund static u32 vcap_sort_key(u32 max_size, u32 size, u8 user, u16 prio) 942990e4839SSteen Hegelund { 943990e4839SSteen Hegelund return ((max_size - size) << 24) | (user << 16) | prio; 944990e4839SSteen Hegelund } 945990e4839SSteen Hegelund 9468e10490bSSteen Hegelund /* calculate the address of the next rule after this (lower address and prio) */ 9478e10490bSSteen Hegelund static u32 vcap_next_rule_addr(u32 addr, struct vcap_rule_internal *ri) 9488e10490bSSteen Hegelund { 9498e10490bSSteen Hegelund return ((addr - ri->size) / ri->size) * ri->size; 9508e10490bSSteen Hegelund } 9518e10490bSSteen Hegelund 952c9da1ac1SSteen Hegelund /* Assign a unique rule id and autogenerate one if id == 0 */ 953c9da1ac1SSteen Hegelund static u32 vcap_set_rule_id(struct vcap_rule_internal *ri) 954c9da1ac1SSteen Hegelund { 955c9da1ac1SSteen Hegelund u32 next_id; 956c9da1ac1SSteen Hegelund 957c9da1ac1SSteen Hegelund if (ri->data.id != 0) 958c9da1ac1SSteen Hegelund return ri->data.id; 959c9da1ac1SSteen Hegelund 960c9da1ac1SSteen Hegelund next_id = ri->vctrl->rule_id + 1; 961c9da1ac1SSteen Hegelund 962c9da1ac1SSteen Hegelund for (next_id = ri->vctrl->rule_id + 1; next_id < ~0; ++next_id) { 963c9da1ac1SSteen Hegelund if (!vcap_lookup_rule(ri->vctrl, next_id)) { 964c9da1ac1SSteen Hegelund ri->data.id = next_id; 965c9da1ac1SSteen Hegelund ri->vctrl->rule_id = next_id; 966c9da1ac1SSteen Hegelund break; 967c9da1ac1SSteen Hegelund } 968c9da1ac1SSteen Hegelund } 969c9da1ac1SSteen Hegelund return ri->data.id; 970c9da1ac1SSteen Hegelund } 971c9da1ac1SSteen Hegelund 9728e10490bSSteen Hegelund static int vcap_insert_rule(struct vcap_rule_internal *ri, 9738e10490bSSteen Hegelund struct vcap_rule_move *move) 9748e10490bSSteen Hegelund { 975990e4839SSteen Hegelund int sw_count = ri->vctrl->vcaps[ri->admin->vtype].sw_count; 976990e4839SSteen Hegelund struct vcap_rule_internal *duprule, *iter, *elem = NULL; 9778e10490bSSteen Hegelund struct vcap_admin *admin = ri->admin; 978990e4839SSteen Hegelund u32 addr; 9798e10490bSSteen Hegelund 980990e4839SSteen Hegelund ri->sort_key = vcap_sort_key(sw_count, ri->size, ri->data.user, 981990e4839SSteen Hegelund ri->data.priority); 982990e4839SSteen Hegelund 983990e4839SSteen Hegelund /* Insert the new rule in the list of rule based on the sort key 984990e4839SSteen Hegelund * If the rule needs to be inserted between existing rules then move 985990e4839SSteen Hegelund * these rules to make room for the new rule and update their start 986990e4839SSteen Hegelund * address. 987990e4839SSteen Hegelund */ 988990e4839SSteen Hegelund list_for_each_entry(iter, &admin->rules, list) { 989990e4839SSteen Hegelund if (ri->sort_key < iter->sort_key) { 990990e4839SSteen Hegelund elem = iter; 991990e4839SSteen Hegelund break; 992990e4839SSteen Hegelund } 993990e4839SSteen Hegelund } 994990e4839SSteen Hegelund 995990e4839SSteen Hegelund if (!elem) { 9968e10490bSSteen Hegelund ri->addr = vcap_next_rule_addr(admin->last_used_addr, ri); 9978e10490bSSteen Hegelund admin->last_used_addr = ri->addr; 998990e4839SSteen Hegelund 9998e10490bSSteen Hegelund /* Add a shallow copy of the rule to the VCAP list */ 10008e10490bSSteen Hegelund duprule = vcap_dup_rule(ri); 10018e10490bSSteen Hegelund if (IS_ERR(duprule)) 10028e10490bSSteen Hegelund return PTR_ERR(duprule); 1003990e4839SSteen Hegelund 10048e10490bSSteen Hegelund list_add_tail(&duprule->list, &admin->rules); 10058e10490bSSteen Hegelund return 0; 10068e10490bSSteen Hegelund } 10078e10490bSSteen Hegelund 1008990e4839SSteen Hegelund /* Reuse the space of the current rule */ 1009990e4839SSteen Hegelund addr = elem->addr + elem->size; 1010990e4839SSteen Hegelund ri->addr = vcap_next_rule_addr(addr, ri); 1011990e4839SSteen Hegelund addr = ri->addr; 1012990e4839SSteen Hegelund 1013990e4839SSteen Hegelund /* Add a shallow copy of the rule to the VCAP list */ 1014990e4839SSteen Hegelund duprule = vcap_dup_rule(ri); 1015990e4839SSteen Hegelund if (IS_ERR(duprule)) 1016990e4839SSteen Hegelund return PTR_ERR(duprule); 1017990e4839SSteen Hegelund 1018990e4839SSteen Hegelund /* Add before the current entry */ 1019990e4839SSteen Hegelund list_add_tail(&duprule->list, &elem->list); 1020990e4839SSteen Hegelund 1021990e4839SSteen Hegelund /* Update the current rule */ 1022990e4839SSteen Hegelund elem->addr = vcap_next_rule_addr(addr, elem); 1023990e4839SSteen Hegelund addr = elem->addr; 1024990e4839SSteen Hegelund 1025990e4839SSteen Hegelund /* Update the address in the remaining rules in the list */ 1026990e4839SSteen Hegelund list_for_each_entry_continue(elem, &admin->rules, list) { 1027990e4839SSteen Hegelund elem->addr = vcap_next_rule_addr(addr, elem); 1028990e4839SSteen Hegelund addr = elem->addr; 1029990e4839SSteen Hegelund } 1030990e4839SSteen Hegelund 1031990e4839SSteen Hegelund /* Update the move info */ 1032990e4839SSteen Hegelund move->addr = admin->last_used_addr; 1033990e4839SSteen Hegelund move->count = ri->addr - addr; 1034990e4839SSteen Hegelund move->offset = admin->last_used_addr - addr; 1035990e4839SSteen Hegelund admin->last_used_addr = addr; 1036990e4839SSteen Hegelund return 0; 1037990e4839SSteen Hegelund } 1038990e4839SSteen Hegelund 10398e10490bSSteen Hegelund static void vcap_move_rules(struct vcap_rule_internal *ri, 10408e10490bSSteen Hegelund struct vcap_rule_move *move) 10418e10490bSSteen Hegelund { 10428e10490bSSteen Hegelund ri->vctrl->ops->move(ri->ndev, ri->admin, move->addr, 10438e10490bSSteen Hegelund move->offset, move->count); 10448e10490bSSteen Hegelund } 10458e10490bSSteen Hegelund 1046c9da1ac1SSteen Hegelund /* Encode and write a validated rule to the VCAP */ 1047c9da1ac1SSteen Hegelund int vcap_add_rule(struct vcap_rule *rule) 1048c9da1ac1SSteen Hegelund { 10498e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 10508e10490bSSteen Hegelund struct vcap_rule_move move = {0}; 10518e10490bSSteen Hegelund int ret; 10528e10490bSSteen Hegelund 10538e10490bSSteen Hegelund ret = vcap_api_check(ri->vctrl); 10548e10490bSSteen Hegelund if (ret) 10558e10490bSSteen Hegelund return ret; 10568e10490bSSteen Hegelund /* Insert the new rule in the list of vcap rules */ 10578e10490bSSteen Hegelund ret = vcap_insert_rule(ri, &move); 10588e10490bSSteen Hegelund if (ret < 0) { 10598e10490bSSteen Hegelund pr_err("%s:%d: could not insert rule in vcap list: %d\n", 10608e10490bSSteen Hegelund __func__, __LINE__, ret); 10618e10490bSSteen Hegelund goto out; 10628e10490bSSteen Hegelund } 10638e10490bSSteen Hegelund if (move.count > 0) 10648e10490bSSteen Hegelund vcap_move_rules(ri, &move); 10658e10490bSSteen Hegelund ret = vcap_encode_rule(ri); 10668e10490bSSteen Hegelund if (ret) { 10678e10490bSSteen Hegelund pr_err("%s:%d: rule encoding error: %d\n", __func__, __LINE__, ret); 10688e10490bSSteen Hegelund goto out; 10698e10490bSSteen Hegelund } 10708e10490bSSteen Hegelund 10718e10490bSSteen Hegelund ret = vcap_write_rule(ri); 10728e10490bSSteen Hegelund if (ret) 10738e10490bSSteen Hegelund pr_err("%s:%d: rule write error: %d\n", __func__, __LINE__, ret); 10748e10490bSSteen Hegelund out: 10758e10490bSSteen Hegelund return ret; 1076c9da1ac1SSteen Hegelund } 1077c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_add_rule); 1078c9da1ac1SSteen Hegelund 1079c9da1ac1SSteen Hegelund /* Allocate a new rule with the provided arguments */ 1080c9da1ac1SSteen Hegelund struct vcap_rule *vcap_alloc_rule(struct vcap_control *vctrl, 1081c9da1ac1SSteen Hegelund struct net_device *ndev, int vcap_chain_id, 1082c9da1ac1SSteen Hegelund enum vcap_user user, u16 priority, 1083c9da1ac1SSteen Hegelund u32 id) 1084c9da1ac1SSteen Hegelund { 1085c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri; 1086c9da1ac1SSteen Hegelund struct vcap_admin *admin; 1087990e4839SSteen Hegelund int err, maxsize; 1088c9da1ac1SSteen Hegelund 1089990e4839SSteen Hegelund err = vcap_api_check(vctrl); 1090990e4839SSteen Hegelund if (err) 1091990e4839SSteen Hegelund return ERR_PTR(err); 1092c9da1ac1SSteen Hegelund if (!ndev) 1093c9da1ac1SSteen Hegelund return ERR_PTR(-ENODEV); 1094c9da1ac1SSteen Hegelund /* Get the VCAP instance */ 1095c9da1ac1SSteen Hegelund admin = vcap_find_admin(vctrl, vcap_chain_id); 1096c9da1ac1SSteen Hegelund if (!admin) 1097c9da1ac1SSteen Hegelund return ERR_PTR(-ENOENT); 10988e10490bSSteen Hegelund /* Sanity check that this VCAP is supported on this platform */ 10998e10490bSSteen Hegelund if (vctrl->vcaps[admin->vtype].rows == 0) 11008e10490bSSteen Hegelund return ERR_PTR(-EINVAL); 11018e10490bSSteen Hegelund /* Check if a rule with this id already exists */ 11028e10490bSSteen Hegelund if (vcap_lookup_rule(vctrl, id)) 11038e10490bSSteen Hegelund return ERR_PTR(-EEXIST); 11048e10490bSSteen Hegelund /* Check if there is room for the rule in the block(s) of the VCAP */ 11058e10490bSSteen Hegelund maxsize = vctrl->vcaps[admin->vtype].sw_count; /* worst case rule size */ 11068e10490bSSteen Hegelund if (vcap_rule_space(admin, maxsize)) 11078e10490bSSteen Hegelund return ERR_PTR(-ENOSPC); 1108c9da1ac1SSteen Hegelund /* Create a container for the rule and return it */ 1109c9da1ac1SSteen Hegelund ri = kzalloc(sizeof(*ri), GFP_KERNEL); 1110c9da1ac1SSteen Hegelund if (!ri) 1111c9da1ac1SSteen Hegelund return ERR_PTR(-ENOMEM); 1112c9da1ac1SSteen Hegelund ri->data.vcap_chain_id = vcap_chain_id; 1113c9da1ac1SSteen Hegelund ri->data.user = user; 1114c9da1ac1SSteen Hegelund ri->data.priority = priority; 1115c9da1ac1SSteen Hegelund ri->data.id = id; 1116c9da1ac1SSteen Hegelund ri->data.keyset = VCAP_KFS_NO_VALUE; 1117c9da1ac1SSteen Hegelund ri->data.actionset = VCAP_AFS_NO_VALUE; 1118c9da1ac1SSteen Hegelund INIT_LIST_HEAD(&ri->list); 1119c9da1ac1SSteen Hegelund INIT_LIST_HEAD(&ri->data.keyfields); 1120c9da1ac1SSteen Hegelund INIT_LIST_HEAD(&ri->data.actionfields); 1121c9da1ac1SSteen Hegelund ri->ndev = ndev; 1122c9da1ac1SSteen Hegelund ri->admin = admin; /* refer to the vcap instance */ 1123c9da1ac1SSteen Hegelund ri->vctrl = vctrl; /* refer to the client */ 1124c9da1ac1SSteen Hegelund if (vcap_set_rule_id(ri) == 0) 1125c9da1ac1SSteen Hegelund goto out_free; 11268e10490bSSteen Hegelund vcap_erase_cache(ri); 1127c9da1ac1SSteen Hegelund return (struct vcap_rule *)ri; 1128c9da1ac1SSteen Hegelund 1129c9da1ac1SSteen Hegelund out_free: 1130c9da1ac1SSteen Hegelund kfree(ri); 1131c9da1ac1SSteen Hegelund return ERR_PTR(-EINVAL); 1132c9da1ac1SSteen Hegelund } 1133c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_alloc_rule); 1134c9da1ac1SSteen Hegelund 1135c9da1ac1SSteen Hegelund /* Free mem of a rule owned by client after the rule as been added to the VCAP */ 1136c9da1ac1SSteen Hegelund void vcap_free_rule(struct vcap_rule *rule) 1137c9da1ac1SSteen Hegelund { 1138c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1139c9da1ac1SSteen Hegelund struct vcap_client_actionfield *caf, *next_caf; 1140c9da1ac1SSteen Hegelund struct vcap_client_keyfield *ckf, *next_ckf; 1141c9da1ac1SSteen Hegelund 1142c9da1ac1SSteen Hegelund /* Deallocate the list of keys and actions */ 1143c9da1ac1SSteen Hegelund list_for_each_entry_safe(ckf, next_ckf, &ri->data.keyfields, ctrl.list) { 1144c9da1ac1SSteen Hegelund list_del(&ckf->ctrl.list); 1145c9da1ac1SSteen Hegelund kfree(ckf); 1146c9da1ac1SSteen Hegelund } 1147c9da1ac1SSteen Hegelund list_for_each_entry_safe(caf, next_caf, &ri->data.actionfields, ctrl.list) { 1148c9da1ac1SSteen Hegelund list_del(&caf->ctrl.list); 1149c9da1ac1SSteen Hegelund kfree(caf); 1150c9da1ac1SSteen Hegelund } 1151c9da1ac1SSteen Hegelund /* Deallocate the rule */ 1152c9da1ac1SSteen Hegelund kfree(rule); 1153c9da1ac1SSteen Hegelund } 1154c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_free_rule); 1155c9da1ac1SSteen Hegelund 1156990e4839SSteen Hegelund /* Return the alignment offset for a new rule address */ 1157990e4839SSteen Hegelund static int vcap_valid_rule_move(struct vcap_rule_internal *el, int offset) 1158990e4839SSteen Hegelund { 1159990e4839SSteen Hegelund return (el->addr + offset) % el->size; 1160990e4839SSteen Hegelund } 1161990e4839SSteen Hegelund 1162990e4839SSteen Hegelund /* Update the rule address with an offset */ 1163990e4839SSteen Hegelund static void vcap_adjust_rule_addr(struct vcap_rule_internal *el, int offset) 1164990e4839SSteen Hegelund { 1165990e4839SSteen Hegelund el->addr += offset; 1166990e4839SSteen Hegelund } 1167990e4839SSteen Hegelund 1168990e4839SSteen Hegelund /* Rules needs to be moved to fill the gap of the deleted rule */ 1169990e4839SSteen Hegelund static int vcap_fill_rule_gap(struct vcap_rule_internal *ri) 1170990e4839SSteen Hegelund { 1171990e4839SSteen Hegelund struct vcap_admin *admin = ri->admin; 1172990e4839SSteen Hegelund struct vcap_rule_internal *elem; 1173990e4839SSteen Hegelund struct vcap_rule_move move; 1174990e4839SSteen Hegelund int gap = 0, offset = 0; 1175990e4839SSteen Hegelund 1176990e4839SSteen Hegelund /* If the first rule is deleted: Move other rules to the top */ 1177990e4839SSteen Hegelund if (list_is_first(&ri->list, &admin->rules)) 1178990e4839SSteen Hegelund offset = admin->last_valid_addr + 1 - ri->addr - ri->size; 1179990e4839SSteen Hegelund 1180990e4839SSteen Hegelund /* Locate gaps between odd size rules and adjust the move */ 1181990e4839SSteen Hegelund elem = ri; 1182990e4839SSteen Hegelund list_for_each_entry_continue(elem, &admin->rules, list) 1183990e4839SSteen Hegelund gap += vcap_valid_rule_move(elem, ri->size); 1184990e4839SSteen Hegelund 1185990e4839SSteen Hegelund /* Update the address in the remaining rules in the list */ 1186990e4839SSteen Hegelund elem = ri; 1187990e4839SSteen Hegelund list_for_each_entry_continue(elem, &admin->rules, list) 1188990e4839SSteen Hegelund vcap_adjust_rule_addr(elem, ri->size + gap + offset); 1189990e4839SSteen Hegelund 1190990e4839SSteen Hegelund /* Update the move info */ 1191990e4839SSteen Hegelund move.addr = admin->last_used_addr; 1192990e4839SSteen Hegelund move.count = ri->addr - admin->last_used_addr - gap; 1193990e4839SSteen Hegelund move.offset = -(ri->size + gap + offset); 1194990e4839SSteen Hegelund 1195990e4839SSteen Hegelund /* Do the actual move operation */ 1196990e4839SSteen Hegelund vcap_move_rules(ri, &move); 1197990e4839SSteen Hegelund 1198990e4839SSteen Hegelund return gap + offset; 1199990e4839SSteen Hegelund } 1200990e4839SSteen Hegelund 1201c9da1ac1SSteen Hegelund /* Delete rule in a VCAP instance */ 1202c9da1ac1SSteen Hegelund int vcap_del_rule(struct vcap_control *vctrl, struct net_device *ndev, u32 id) 1203c9da1ac1SSteen Hegelund { 1204c9da1ac1SSteen Hegelund struct vcap_rule_internal *ri, *elem; 1205c9da1ac1SSteen Hegelund struct vcap_admin *admin; 1206990e4839SSteen Hegelund int gap = 0, err; 1207c9da1ac1SSteen Hegelund 1208c9da1ac1SSteen Hegelund /* This will later also handle rule moving */ 1209c9da1ac1SSteen Hegelund if (!ndev) 1210c9da1ac1SSteen Hegelund return -ENODEV; 12118e10490bSSteen Hegelund err = vcap_api_check(vctrl); 12128e10490bSSteen Hegelund if (err) 12138e10490bSSteen Hegelund return err; 1214c9da1ac1SSteen Hegelund /* Look for the rule id in all vcaps */ 1215c9da1ac1SSteen Hegelund ri = vcap_lookup_rule(vctrl, id); 1216c9da1ac1SSteen Hegelund if (!ri) 1217c9da1ac1SSteen Hegelund return -EINVAL; 1218c9da1ac1SSteen Hegelund admin = ri->admin; 12198e10490bSSteen Hegelund 1220990e4839SSteen Hegelund if (ri->addr > admin->last_used_addr) 1221990e4839SSteen Hegelund gap = vcap_fill_rule_gap(ri); 1222990e4839SSteen Hegelund 1223990e4839SSteen Hegelund /* Delete the rule from the list of rules and the cache */ 1224990e4839SSteen Hegelund list_del(&ri->list); 1225990e4839SSteen Hegelund vctrl->ops->init(ndev, admin, admin->last_used_addr, ri->size + gap); 1226990e4839SSteen Hegelund kfree(ri); 1227990e4839SSteen Hegelund 1228277e9179SSteen Hegelund /* Update the last used address, set to default when no rules */ 1229c9da1ac1SSteen Hegelund if (list_empty(&admin->rules)) { 1230277e9179SSteen Hegelund admin->last_used_addr = admin->last_valid_addr + 1; 1231c9da1ac1SSteen Hegelund } else { 1232990e4839SSteen Hegelund elem = list_last_entry(&admin->rules, struct vcap_rule_internal, 1233990e4839SSteen Hegelund list); 1234c9da1ac1SSteen Hegelund admin->last_used_addr = elem->addr; 1235c9da1ac1SSteen Hegelund } 1236c9da1ac1SSteen Hegelund return 0; 1237c9da1ac1SSteen Hegelund } 1238c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_del_rule); 1239c9da1ac1SSteen Hegelund 12408e10490bSSteen Hegelund /* Delete all rules in the VCAP instance */ 12418e10490bSSteen Hegelund int vcap_del_rules(struct vcap_control *vctrl, struct vcap_admin *admin) 12428e10490bSSteen Hegelund { 124367456717SSteen Hegelund struct vcap_enabled_port *eport, *next_eport; 12448e10490bSSteen Hegelund struct vcap_rule_internal *ri, *next_ri; 12458e10490bSSteen Hegelund int ret = vcap_api_check(vctrl); 12468e10490bSSteen Hegelund 12478e10490bSSteen Hegelund if (ret) 12488e10490bSSteen Hegelund return ret; 12498e10490bSSteen Hegelund list_for_each_entry_safe(ri, next_ri, &admin->rules, list) { 12508e10490bSSteen Hegelund vctrl->ops->init(ri->ndev, admin, ri->addr, ri->size); 12518e10490bSSteen Hegelund list_del(&ri->list); 12528e10490bSSteen Hegelund kfree(ri); 12538e10490bSSteen Hegelund } 12548e10490bSSteen Hegelund admin->last_used_addr = admin->last_valid_addr; 125567456717SSteen Hegelund 125667456717SSteen Hegelund /* Remove list of enabled ports */ 125767456717SSteen Hegelund list_for_each_entry_safe(eport, next_eport, &admin->enabled, list) { 125867456717SSteen Hegelund list_del(&eport->list); 125967456717SSteen Hegelund kfree(eport); 126067456717SSteen Hegelund } 126167456717SSteen Hegelund 12628e10490bSSteen Hegelund return 0; 12638e10490bSSteen Hegelund } 12648e10490bSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_del_rules); 12658e10490bSSteen Hegelund 126646be056eSSteen Hegelund /* Find information on a key field in a rule */ 126746be056eSSteen Hegelund const struct vcap_field *vcap_lookup_keyfield(struct vcap_rule *rule, 126846be056eSSteen Hegelund enum vcap_key_field key) 126946be056eSSteen Hegelund { 12708e10490bSSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 127146be056eSSteen Hegelund enum vcap_keyfield_set keyset = rule->keyset; 127246be056eSSteen Hegelund enum vcap_type vt = ri->admin->vtype; 127346be056eSSteen Hegelund const struct vcap_field *fields; 127446be056eSSteen Hegelund 127546be056eSSteen Hegelund if (keyset == VCAP_KFS_NO_VALUE) 127646be056eSSteen Hegelund return NULL; 127746be056eSSteen Hegelund fields = vcap_keyfields(ri->vctrl, vt, keyset); 127846be056eSSteen Hegelund if (!fields) 127946be056eSSteen Hegelund return NULL; 128046be056eSSteen Hegelund return &fields[key]; 128146be056eSSteen Hegelund } 128246be056eSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_lookup_keyfield); 128346be056eSSteen Hegelund 1284c9da1ac1SSteen Hegelund static void vcap_copy_from_client_keyfield(struct vcap_rule *rule, 1285c9da1ac1SSteen Hegelund struct vcap_client_keyfield *field, 1286c9da1ac1SSteen Hegelund struct vcap_client_keyfield_data *data) 1287c9da1ac1SSteen Hegelund { 1288c9da1ac1SSteen Hegelund /* This will be expanded later to handle different vcap memory layouts */ 1289c9da1ac1SSteen Hegelund memcpy(&field->data, data, sizeof(field->data)); 1290c9da1ac1SSteen Hegelund } 1291c9da1ac1SSteen Hegelund 1292242df4f7SSteen Hegelund /* Check if the keyfield is already in the rule */ 1293242df4f7SSteen Hegelund static bool vcap_keyfield_unique(struct vcap_rule *rule, 1294242df4f7SSteen Hegelund enum vcap_key_field key) 1295242df4f7SSteen Hegelund { 1296242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1297242df4f7SSteen Hegelund const struct vcap_client_keyfield *ckf; 1298242df4f7SSteen Hegelund 1299242df4f7SSteen Hegelund list_for_each_entry(ckf, &ri->data.keyfields, ctrl.list) 1300242df4f7SSteen Hegelund if (ckf->ctrl.key == key) 1301242df4f7SSteen Hegelund return false; 1302242df4f7SSteen Hegelund return true; 1303242df4f7SSteen Hegelund } 1304242df4f7SSteen Hegelund 1305242df4f7SSteen Hegelund /* Check if the keyfield is in the keyset */ 1306242df4f7SSteen Hegelund static bool vcap_keyfield_match_keyset(struct vcap_rule *rule, 1307242df4f7SSteen Hegelund enum vcap_key_field key) 1308242df4f7SSteen Hegelund { 1309242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1310242df4f7SSteen Hegelund enum vcap_keyfield_set keyset = rule->keyset; 1311242df4f7SSteen Hegelund enum vcap_type vt = ri->admin->vtype; 1312242df4f7SSteen Hegelund const struct vcap_field *fields; 1313242df4f7SSteen Hegelund 1314242df4f7SSteen Hegelund /* the field is accepted if the rule has no keyset yet */ 1315242df4f7SSteen Hegelund if (keyset == VCAP_KFS_NO_VALUE) 1316242df4f7SSteen Hegelund return true; 1317242df4f7SSteen Hegelund fields = vcap_keyfields(ri->vctrl, vt, keyset); 1318242df4f7SSteen Hegelund if (!fields) 1319242df4f7SSteen Hegelund return false; 1320242df4f7SSteen Hegelund /* if there is a width there is a way */ 1321242df4f7SSteen Hegelund return fields[key].width > 0; 1322242df4f7SSteen Hegelund } 1323242df4f7SSteen Hegelund 1324c9da1ac1SSteen Hegelund static int vcap_rule_add_key(struct vcap_rule *rule, 1325c9da1ac1SSteen Hegelund enum vcap_key_field key, 1326c9da1ac1SSteen Hegelund enum vcap_field_type ftype, 1327c9da1ac1SSteen Hegelund struct vcap_client_keyfield_data *data) 1328c9da1ac1SSteen Hegelund { 1329242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1330c9da1ac1SSteen Hegelund struct vcap_client_keyfield *field; 1331c9da1ac1SSteen Hegelund 1332242df4f7SSteen Hegelund if (!vcap_keyfield_unique(rule, key)) { 1333242df4f7SSteen Hegelund pr_warn("%s:%d: keyfield %s is already in the rule\n", 1334242df4f7SSteen Hegelund __func__, __LINE__, 1335242df4f7SSteen Hegelund vcap_keyfield_name(ri->vctrl, key)); 1336242df4f7SSteen Hegelund return -EINVAL; 1337242df4f7SSteen Hegelund } 1338242df4f7SSteen Hegelund 1339242df4f7SSteen Hegelund if (!vcap_keyfield_match_keyset(rule, key)) { 1340242df4f7SSteen Hegelund pr_err("%s:%d: keyfield %s does not belong in the rule keyset\n", 1341242df4f7SSteen Hegelund __func__, __LINE__, 1342242df4f7SSteen Hegelund vcap_keyfield_name(ri->vctrl, key)); 1343242df4f7SSteen Hegelund return -EINVAL; 1344242df4f7SSteen Hegelund } 1345242df4f7SSteen Hegelund 1346c9da1ac1SSteen Hegelund field = kzalloc(sizeof(*field), GFP_KERNEL); 1347c9da1ac1SSteen Hegelund if (!field) 1348c9da1ac1SSteen Hegelund return -ENOMEM; 1349c9da1ac1SSteen Hegelund field->ctrl.key = key; 1350c9da1ac1SSteen Hegelund field->ctrl.type = ftype; 1351c9da1ac1SSteen Hegelund vcap_copy_from_client_keyfield(rule, field, data); 1352c9da1ac1SSteen Hegelund list_add_tail(&field->ctrl.list, &rule->keyfields); 1353c9da1ac1SSteen Hegelund return 0; 1354c9da1ac1SSteen Hegelund } 1355c9da1ac1SSteen Hegelund 135646be056eSSteen Hegelund static void vcap_rule_set_key_bitsize(struct vcap_u1_key *u1, enum vcap_bit val) 135746be056eSSteen Hegelund { 135846be056eSSteen Hegelund switch (val) { 135946be056eSSteen Hegelund case VCAP_BIT_0: 136046be056eSSteen Hegelund u1->value = 0; 136146be056eSSteen Hegelund u1->mask = 1; 136246be056eSSteen Hegelund break; 136346be056eSSteen Hegelund case VCAP_BIT_1: 136446be056eSSteen Hegelund u1->value = 1; 136546be056eSSteen Hegelund u1->mask = 1; 136646be056eSSteen Hegelund break; 136746be056eSSteen Hegelund case VCAP_BIT_ANY: 136846be056eSSteen Hegelund u1->value = 0; 136946be056eSSteen Hegelund u1->mask = 0; 137046be056eSSteen Hegelund break; 137146be056eSSteen Hegelund } 137246be056eSSteen Hegelund } 137346be056eSSteen Hegelund 137446be056eSSteen Hegelund /* Add a bit key with value and mask to the rule */ 137546be056eSSteen Hegelund int vcap_rule_add_key_bit(struct vcap_rule *rule, enum vcap_key_field key, 137646be056eSSteen Hegelund enum vcap_bit val) 137746be056eSSteen Hegelund { 137846be056eSSteen Hegelund struct vcap_client_keyfield_data data; 137946be056eSSteen Hegelund 138046be056eSSteen Hegelund vcap_rule_set_key_bitsize(&data.u1, val); 138146be056eSSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_BIT, &data); 138246be056eSSteen Hegelund } 138346be056eSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_bit); 138446be056eSSteen Hegelund 138546be056eSSteen Hegelund /* Add a 32 bit key field with value and mask to the rule */ 138646be056eSSteen Hegelund int vcap_rule_add_key_u32(struct vcap_rule *rule, enum vcap_key_field key, 138746be056eSSteen Hegelund u32 value, u32 mask) 138846be056eSSteen Hegelund { 138946be056eSSteen Hegelund struct vcap_client_keyfield_data data; 139046be056eSSteen Hegelund 139146be056eSSteen Hegelund data.u32.value = value; 139246be056eSSteen Hegelund data.u32.mask = mask; 139346be056eSSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_U32, &data); 139446be056eSSteen Hegelund } 139546be056eSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_u32); 139646be056eSSteen Hegelund 1397c9da1ac1SSteen Hegelund /* Add a 48 bit key with value and mask to the rule */ 1398c9da1ac1SSteen Hegelund int vcap_rule_add_key_u48(struct vcap_rule *rule, enum vcap_key_field key, 1399c9da1ac1SSteen Hegelund struct vcap_u48_key *fieldval) 1400c9da1ac1SSteen Hegelund { 1401c9da1ac1SSteen Hegelund struct vcap_client_keyfield_data data; 1402c9da1ac1SSteen Hegelund 1403c9da1ac1SSteen Hegelund memcpy(&data.u48, fieldval, sizeof(data.u48)); 1404c9da1ac1SSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_U48, &data); 1405c9da1ac1SSteen Hegelund } 1406c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_u48); 1407c9da1ac1SSteen Hegelund 140846be056eSSteen Hegelund /* Add a 72 bit key with value and mask to the rule */ 140946be056eSSteen Hegelund int vcap_rule_add_key_u72(struct vcap_rule *rule, enum vcap_key_field key, 141046be056eSSteen Hegelund struct vcap_u72_key *fieldval) 141146be056eSSteen Hegelund { 141246be056eSSteen Hegelund struct vcap_client_keyfield_data data; 141346be056eSSteen Hegelund 141446be056eSSteen Hegelund memcpy(&data.u72, fieldval, sizeof(data.u72)); 141546be056eSSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_U72, &data); 141646be056eSSteen Hegelund } 141746be056eSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_u72); 141846be056eSSteen Hegelund 1419d6c2964dSSteen Hegelund /* Add a 128 bit key with value and mask to the rule */ 1420d6c2964dSSteen Hegelund int vcap_rule_add_key_u128(struct vcap_rule *rule, enum vcap_key_field key, 1421d6c2964dSSteen Hegelund struct vcap_u128_key *fieldval) 1422d6c2964dSSteen Hegelund { 1423d6c2964dSSteen Hegelund struct vcap_client_keyfield_data data; 1424d6c2964dSSteen Hegelund 1425d6c2964dSSteen Hegelund memcpy(&data.u128, fieldval, sizeof(data.u128)); 1426d6c2964dSSteen Hegelund return vcap_rule_add_key(rule, key, VCAP_FIELD_U128, &data); 1427d6c2964dSSteen Hegelund } 1428d6c2964dSSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_key_u128); 1429d6c2964dSSteen Hegelund 1430c9da1ac1SSteen Hegelund static void vcap_copy_from_client_actionfield(struct vcap_rule *rule, 1431c9da1ac1SSteen Hegelund struct vcap_client_actionfield *field, 1432c9da1ac1SSteen Hegelund struct vcap_client_actionfield_data *data) 1433c9da1ac1SSteen Hegelund { 1434c9da1ac1SSteen Hegelund /* This will be expanded later to handle different vcap memory layouts */ 1435c9da1ac1SSteen Hegelund memcpy(&field->data, data, sizeof(field->data)); 1436c9da1ac1SSteen Hegelund } 1437c9da1ac1SSteen Hegelund 1438242df4f7SSteen Hegelund /* Check if the actionfield is already in the rule */ 1439242df4f7SSteen Hegelund static bool vcap_actionfield_unique(struct vcap_rule *rule, 1440242df4f7SSteen Hegelund enum vcap_action_field act) 1441242df4f7SSteen Hegelund { 1442242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1443242df4f7SSteen Hegelund const struct vcap_client_actionfield *caf; 1444242df4f7SSteen Hegelund 1445242df4f7SSteen Hegelund list_for_each_entry(caf, &ri->data.actionfields, ctrl.list) 1446242df4f7SSteen Hegelund if (caf->ctrl.action == act) 1447242df4f7SSteen Hegelund return false; 1448242df4f7SSteen Hegelund return true; 1449242df4f7SSteen Hegelund } 1450242df4f7SSteen Hegelund 1451242df4f7SSteen Hegelund /* Check if the actionfield is in the actionset */ 1452242df4f7SSteen Hegelund static bool vcap_actionfield_match_actionset(struct vcap_rule *rule, 1453242df4f7SSteen Hegelund enum vcap_action_field action) 1454242df4f7SSteen Hegelund { 1455242df4f7SSteen Hegelund enum vcap_actionfield_set actionset = rule->actionset; 1456242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1457242df4f7SSteen Hegelund enum vcap_type vt = ri->admin->vtype; 1458242df4f7SSteen Hegelund const struct vcap_field *fields; 1459242df4f7SSteen Hegelund 1460242df4f7SSteen Hegelund /* the field is accepted if the rule has no actionset yet */ 1461242df4f7SSteen Hegelund if (actionset == VCAP_AFS_NO_VALUE) 1462242df4f7SSteen Hegelund return true; 1463242df4f7SSteen Hegelund fields = vcap_actionfields(ri->vctrl, vt, actionset); 1464242df4f7SSteen Hegelund if (!fields) 1465242df4f7SSteen Hegelund return false; 1466242df4f7SSteen Hegelund /* if there is a width there is a way */ 1467242df4f7SSteen Hegelund return fields[action].width > 0; 1468242df4f7SSteen Hegelund } 1469242df4f7SSteen Hegelund 1470c9da1ac1SSteen Hegelund static int vcap_rule_add_action(struct vcap_rule *rule, 1471c9da1ac1SSteen Hegelund enum vcap_action_field action, 1472c9da1ac1SSteen Hegelund enum vcap_field_type ftype, 1473c9da1ac1SSteen Hegelund struct vcap_client_actionfield_data *data) 1474c9da1ac1SSteen Hegelund { 1475242df4f7SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1476c9da1ac1SSteen Hegelund struct vcap_client_actionfield *field; 1477c9da1ac1SSteen Hegelund 1478242df4f7SSteen Hegelund if (!vcap_actionfield_unique(rule, action)) { 1479242df4f7SSteen Hegelund pr_warn("%s:%d: actionfield %s is already in the rule\n", 1480242df4f7SSteen Hegelund __func__, __LINE__, 1481242df4f7SSteen Hegelund vcap_actionfield_name(ri->vctrl, action)); 1482242df4f7SSteen Hegelund return -EINVAL; 1483242df4f7SSteen Hegelund } 1484242df4f7SSteen Hegelund 1485242df4f7SSteen Hegelund if (!vcap_actionfield_match_actionset(rule, action)) { 1486242df4f7SSteen Hegelund pr_err("%s:%d: actionfield %s does not belong in the rule actionset\n", 1487242df4f7SSteen Hegelund __func__, __LINE__, 1488242df4f7SSteen Hegelund vcap_actionfield_name(ri->vctrl, action)); 1489242df4f7SSteen Hegelund return -EINVAL; 1490242df4f7SSteen Hegelund } 1491242df4f7SSteen Hegelund 1492c9da1ac1SSteen Hegelund field = kzalloc(sizeof(*field), GFP_KERNEL); 1493c9da1ac1SSteen Hegelund if (!field) 1494c9da1ac1SSteen Hegelund return -ENOMEM; 1495c9da1ac1SSteen Hegelund field->ctrl.action = action; 1496c9da1ac1SSteen Hegelund field->ctrl.type = ftype; 1497c9da1ac1SSteen Hegelund vcap_copy_from_client_actionfield(rule, field, data); 1498c9da1ac1SSteen Hegelund list_add_tail(&field->ctrl.list, &rule->actionfields); 1499c9da1ac1SSteen Hegelund return 0; 1500c9da1ac1SSteen Hegelund } 1501c9da1ac1SSteen Hegelund 1502c9da1ac1SSteen Hegelund static void vcap_rule_set_action_bitsize(struct vcap_u1_action *u1, 1503c9da1ac1SSteen Hegelund enum vcap_bit val) 1504c9da1ac1SSteen Hegelund { 1505c9da1ac1SSteen Hegelund switch (val) { 1506c9da1ac1SSteen Hegelund case VCAP_BIT_0: 1507c9da1ac1SSteen Hegelund u1->value = 0; 1508c9da1ac1SSteen Hegelund break; 1509c9da1ac1SSteen Hegelund case VCAP_BIT_1: 1510c9da1ac1SSteen Hegelund u1->value = 1; 1511c9da1ac1SSteen Hegelund break; 1512c9da1ac1SSteen Hegelund case VCAP_BIT_ANY: 1513c9da1ac1SSteen Hegelund u1->value = 0; 1514c9da1ac1SSteen Hegelund break; 1515c9da1ac1SSteen Hegelund } 1516c9da1ac1SSteen Hegelund } 1517c9da1ac1SSteen Hegelund 1518c9da1ac1SSteen Hegelund /* Add a bit action with value to the rule */ 1519c9da1ac1SSteen Hegelund int vcap_rule_add_action_bit(struct vcap_rule *rule, 1520c9da1ac1SSteen Hegelund enum vcap_action_field action, 1521c9da1ac1SSteen Hegelund enum vcap_bit val) 1522c9da1ac1SSteen Hegelund { 1523c9da1ac1SSteen Hegelund struct vcap_client_actionfield_data data; 1524c9da1ac1SSteen Hegelund 1525c9da1ac1SSteen Hegelund vcap_rule_set_action_bitsize(&data.u1, val); 1526c9da1ac1SSteen Hegelund return vcap_rule_add_action(rule, action, VCAP_FIELD_BIT, &data); 1527c9da1ac1SSteen Hegelund } 1528c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_action_bit); 1529c9da1ac1SSteen Hegelund 1530c9da1ac1SSteen Hegelund /* Add a 32 bit action field with value to the rule */ 1531c9da1ac1SSteen Hegelund int vcap_rule_add_action_u32(struct vcap_rule *rule, 1532c9da1ac1SSteen Hegelund enum vcap_action_field action, 1533c9da1ac1SSteen Hegelund u32 value) 1534c9da1ac1SSteen Hegelund { 1535c9da1ac1SSteen Hegelund struct vcap_client_actionfield_data data; 1536c9da1ac1SSteen Hegelund 1537c9da1ac1SSteen Hegelund data.u32.value = value; 1538c9da1ac1SSteen Hegelund return vcap_rule_add_action(rule, action, VCAP_FIELD_U32, &data); 1539c9da1ac1SSteen Hegelund } 1540c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_add_action_u32); 1541c9da1ac1SSteen Hegelund 1542f13230a4SSteen Hegelund static int vcap_read_counter(struct vcap_rule_internal *ri, 1543f13230a4SSteen Hegelund struct vcap_counter *ctr) 1544f13230a4SSteen Hegelund { 1545f13230a4SSteen Hegelund struct vcap_admin *admin = ri->admin; 1546f13230a4SSteen Hegelund 1547f13230a4SSteen Hegelund ri->vctrl->ops->update(ri->ndev, admin, VCAP_CMD_READ, VCAP_SEL_COUNTER, 1548f13230a4SSteen Hegelund ri->addr); 1549f13230a4SSteen Hegelund ri->vctrl->ops->cache_read(ri->ndev, admin, VCAP_SEL_COUNTER, 1550f13230a4SSteen Hegelund ri->counter_id, 0); 1551f13230a4SSteen Hegelund ctr->value = admin->cache.counter; 1552f13230a4SSteen Hegelund ctr->sticky = admin->cache.sticky; 1553f13230a4SSteen Hegelund return 0; 1554f13230a4SSteen Hegelund } 1555f13230a4SSteen Hegelund 1556c9da1ac1SSteen Hegelund /* Copy to host byte order */ 1557c9da1ac1SSteen Hegelund void vcap_netbytes_copy(u8 *dst, u8 *src, int count) 1558c9da1ac1SSteen Hegelund { 1559c9da1ac1SSteen Hegelund int idx; 1560c9da1ac1SSteen Hegelund 1561c9da1ac1SSteen Hegelund for (idx = 0; idx < count; ++idx, ++dst) 1562c9da1ac1SSteen Hegelund *dst = src[count - idx - 1]; 1563c9da1ac1SSteen Hegelund } 1564c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_netbytes_copy); 1565c9da1ac1SSteen Hegelund 1566c9da1ac1SSteen Hegelund /* Convert validation error code into tc extact error message */ 1567c9da1ac1SSteen Hegelund void vcap_set_tc_exterr(struct flow_cls_offload *fco, struct vcap_rule *vrule) 1568c9da1ac1SSteen Hegelund { 1569c9da1ac1SSteen Hegelund switch (vrule->exterr) { 1570c9da1ac1SSteen Hegelund case VCAP_ERR_NONE: 1571c9da1ac1SSteen Hegelund break; 1572c9da1ac1SSteen Hegelund case VCAP_ERR_NO_ADMIN: 1573c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1574c9da1ac1SSteen Hegelund "Missing VCAP instance"); 1575c9da1ac1SSteen Hegelund break; 1576c9da1ac1SSteen Hegelund case VCAP_ERR_NO_NETDEV: 1577c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1578c9da1ac1SSteen Hegelund "Missing network interface"); 1579c9da1ac1SSteen Hegelund break; 1580c9da1ac1SSteen Hegelund case VCAP_ERR_NO_KEYSET_MATCH: 1581c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1582c9da1ac1SSteen Hegelund "No keyset matched the filter keys"); 1583c9da1ac1SSteen Hegelund break; 1584c9da1ac1SSteen Hegelund case VCAP_ERR_NO_ACTIONSET_MATCH: 1585c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1586c9da1ac1SSteen Hegelund "No actionset matched the filter actions"); 1587c9da1ac1SSteen Hegelund break; 1588c9da1ac1SSteen Hegelund case VCAP_ERR_NO_PORT_KEYSET_MATCH: 1589c9da1ac1SSteen Hegelund NL_SET_ERR_MSG_MOD(fco->common.extack, 1590c9da1ac1SSteen Hegelund "No port keyset matched the filter keys"); 1591c9da1ac1SSteen Hegelund break; 1592c9da1ac1SSteen Hegelund } 1593c9da1ac1SSteen Hegelund } 1594c9da1ac1SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_set_tc_exterr); 159567d63751SSteen Hegelund 159667456717SSteen Hegelund /* Check if this port is already enabled for this VCAP instance */ 159767456717SSteen Hegelund static bool vcap_is_enabled(struct vcap_admin *admin, struct net_device *ndev, 159867456717SSteen Hegelund unsigned long cookie) 159967456717SSteen Hegelund { 160067456717SSteen Hegelund struct vcap_enabled_port *eport; 160167456717SSteen Hegelund 160267456717SSteen Hegelund list_for_each_entry(eport, &admin->enabled, list) 160367456717SSteen Hegelund if (eport->cookie == cookie || eport->ndev == ndev) 160467456717SSteen Hegelund return true; 160567456717SSteen Hegelund 160667456717SSteen Hegelund return false; 160767456717SSteen Hegelund } 160867456717SSteen Hegelund 160967456717SSteen Hegelund /* Enable this port for this VCAP instance */ 161067456717SSteen Hegelund static int vcap_enable(struct vcap_admin *admin, struct net_device *ndev, 161167456717SSteen Hegelund unsigned long cookie) 161267456717SSteen Hegelund { 161367456717SSteen Hegelund struct vcap_enabled_port *eport; 161467456717SSteen Hegelund 161567456717SSteen Hegelund eport = kzalloc(sizeof(*eport), GFP_KERNEL); 161667456717SSteen Hegelund if (!eport) 161767456717SSteen Hegelund return -ENOMEM; 161867456717SSteen Hegelund 161967456717SSteen Hegelund eport->ndev = ndev; 162067456717SSteen Hegelund eport->cookie = cookie; 162167456717SSteen Hegelund list_add_tail(&eport->list, &admin->enabled); 162267456717SSteen Hegelund 162367456717SSteen Hegelund return 0; 162467456717SSteen Hegelund } 162567456717SSteen Hegelund 162667456717SSteen Hegelund /* Disable this port for this VCAP instance */ 162767456717SSteen Hegelund static int vcap_disable(struct vcap_admin *admin, struct net_device *ndev, 162867456717SSteen Hegelund unsigned long cookie) 162967456717SSteen Hegelund { 163067456717SSteen Hegelund struct vcap_enabled_port *eport; 163167456717SSteen Hegelund 163267456717SSteen Hegelund list_for_each_entry(eport, &admin->enabled, list) { 163367456717SSteen Hegelund if (eport->cookie == cookie && eport->ndev == ndev) { 163467456717SSteen Hegelund list_del(&eport->list); 163567456717SSteen Hegelund kfree(eport); 163667456717SSteen Hegelund return 0; 163767456717SSteen Hegelund } 163867456717SSteen Hegelund } 163967456717SSteen Hegelund 164067456717SSteen Hegelund return -ENOENT; 164167456717SSteen Hegelund } 164267456717SSteen Hegelund 164367456717SSteen Hegelund /* Find the VCAP instance that enabled the port using a specific filter */ 164467456717SSteen Hegelund static struct vcap_admin *vcap_find_admin_by_cookie(struct vcap_control *vctrl, 164567456717SSteen Hegelund unsigned long cookie) 164667456717SSteen Hegelund { 164767456717SSteen Hegelund struct vcap_enabled_port *eport; 164867456717SSteen Hegelund struct vcap_admin *admin; 164967456717SSteen Hegelund 165067456717SSteen Hegelund list_for_each_entry(admin, &vctrl->list, list) 165167456717SSteen Hegelund list_for_each_entry(eport, &admin->enabled, list) 165267456717SSteen Hegelund if (eport->cookie == cookie) 165367456717SSteen Hegelund return admin; 165467456717SSteen Hegelund 165567456717SSteen Hegelund return NULL; 165667456717SSteen Hegelund } 165767456717SSteen Hegelund 165867456717SSteen Hegelund /* Enable/Disable the VCAP instance lookups. Chain id 0 means disable */ 165967456717SSteen Hegelund int vcap_enable_lookups(struct vcap_control *vctrl, struct net_device *ndev, 166067456717SSteen Hegelund int chain_id, unsigned long cookie, bool enable) 166167456717SSteen Hegelund { 166267456717SSteen Hegelund struct vcap_admin *admin; 166367456717SSteen Hegelund int err; 166467456717SSteen Hegelund 166567456717SSteen Hegelund err = vcap_api_check(vctrl); 166667456717SSteen Hegelund if (err) 166767456717SSteen Hegelund return err; 166867456717SSteen Hegelund 166967456717SSteen Hegelund if (!ndev) 167067456717SSteen Hegelund return -ENODEV; 167167456717SSteen Hegelund 167267456717SSteen Hegelund if (chain_id) 167367456717SSteen Hegelund admin = vcap_find_admin(vctrl, chain_id); 167467456717SSteen Hegelund else 167567456717SSteen Hegelund admin = vcap_find_admin_by_cookie(vctrl, cookie); 167667456717SSteen Hegelund if (!admin) 167767456717SSteen Hegelund return -ENOENT; 167867456717SSteen Hegelund 167967456717SSteen Hegelund /* first instance and first chain */ 168067456717SSteen Hegelund if (admin->vinst || chain_id > admin->first_cid) 168167456717SSteen Hegelund return -EFAULT; 168267456717SSteen Hegelund 168367456717SSteen Hegelund err = vctrl->ops->enable(ndev, admin, enable); 168467456717SSteen Hegelund if (err) 168567456717SSteen Hegelund return err; 168667456717SSteen Hegelund 168767456717SSteen Hegelund if (chain_id) { 168867456717SSteen Hegelund if (vcap_is_enabled(admin, ndev, cookie)) 168967456717SSteen Hegelund return -EADDRINUSE; 169067456717SSteen Hegelund vcap_enable(admin, ndev, cookie); 169167456717SSteen Hegelund } else { 169267456717SSteen Hegelund vcap_disable(admin, ndev, cookie); 169367456717SSteen Hegelund } 169467456717SSteen Hegelund 169567456717SSteen Hegelund return 0; 169667456717SSteen Hegelund } 169767456717SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_enable_lookups); 169867456717SSteen Hegelund 1699f13230a4SSteen Hegelund /* Set a rule counter id (for certain vcaps only) */ 1700f13230a4SSteen Hegelund void vcap_rule_set_counter_id(struct vcap_rule *rule, u32 counter_id) 1701f13230a4SSteen Hegelund { 1702f13230a4SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1703f13230a4SSteen Hegelund 1704f13230a4SSteen Hegelund ri->counter_id = counter_id; 1705f13230a4SSteen Hegelund } 1706f13230a4SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_set_counter_id); 1707f13230a4SSteen Hegelund 170840e7fe18SSteen Hegelund /* Provide all rules via a callback interface */ 170940e7fe18SSteen Hegelund int vcap_rule_iter(struct vcap_control *vctrl, 171040e7fe18SSteen Hegelund int (*callback)(void *, struct vcap_rule *), void *arg) 171140e7fe18SSteen Hegelund { 171240e7fe18SSteen Hegelund struct vcap_rule_internal *ri; 171340e7fe18SSteen Hegelund struct vcap_admin *admin; 171440e7fe18SSteen Hegelund int ret; 171540e7fe18SSteen Hegelund 171640e7fe18SSteen Hegelund ret = vcap_api_check(vctrl); 171740e7fe18SSteen Hegelund if (ret) 171840e7fe18SSteen Hegelund return ret; 171940e7fe18SSteen Hegelund 172040e7fe18SSteen Hegelund /* Iterate all rules in each VCAP instance */ 172140e7fe18SSteen Hegelund list_for_each_entry(admin, &vctrl->list, list) { 172240e7fe18SSteen Hegelund list_for_each_entry(ri, &admin->rules, list) { 172340e7fe18SSteen Hegelund ret = callback(arg, &ri->data); 172440e7fe18SSteen Hegelund if (ret) 172540e7fe18SSteen Hegelund return ret; 172640e7fe18SSteen Hegelund } 172740e7fe18SSteen Hegelund } 172840e7fe18SSteen Hegelund 172940e7fe18SSteen Hegelund return 0; 173040e7fe18SSteen Hegelund } 173140e7fe18SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_iter); 173240e7fe18SSteen Hegelund 1733f13230a4SSteen Hegelund int vcap_rule_set_counter(struct vcap_rule *rule, struct vcap_counter *ctr) 1734f13230a4SSteen Hegelund { 1735f13230a4SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1736f13230a4SSteen Hegelund int err; 1737f13230a4SSteen Hegelund 1738f13230a4SSteen Hegelund err = vcap_api_check(ri->vctrl); 1739f13230a4SSteen Hegelund if (err) 1740f13230a4SSteen Hegelund return err; 1741f13230a4SSteen Hegelund if (!ctr) { 1742f13230a4SSteen Hegelund pr_err("%s:%d: counter is missing\n", __func__, __LINE__); 1743f13230a4SSteen Hegelund return -EINVAL; 1744f13230a4SSteen Hegelund } 1745f13230a4SSteen Hegelund return vcap_write_counter(ri, ctr); 1746f13230a4SSteen Hegelund } 1747f13230a4SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_set_counter); 1748f13230a4SSteen Hegelund 1749f13230a4SSteen Hegelund int vcap_rule_get_counter(struct vcap_rule *rule, struct vcap_counter *ctr) 1750f13230a4SSteen Hegelund { 1751f13230a4SSteen Hegelund struct vcap_rule_internal *ri = to_intrule(rule); 1752f13230a4SSteen Hegelund int err; 1753f13230a4SSteen Hegelund 1754f13230a4SSteen Hegelund err = vcap_api_check(ri->vctrl); 1755f13230a4SSteen Hegelund if (err) 1756f13230a4SSteen Hegelund return err; 1757f13230a4SSteen Hegelund if (!ctr) { 1758f13230a4SSteen Hegelund pr_err("%s:%d: counter is missing\n", __func__, __LINE__); 1759f13230a4SSteen Hegelund return -EINVAL; 1760f13230a4SSteen Hegelund } 1761f13230a4SSteen Hegelund return vcap_read_counter(ri, ctr); 1762f13230a4SSteen Hegelund } 1763f13230a4SSteen Hegelund EXPORT_SYMBOL_GPL(vcap_rule_get_counter); 1764f13230a4SSteen Hegelund 176567d63751SSteen Hegelund #ifdef CONFIG_VCAP_KUNIT_TEST 176667d63751SSteen Hegelund #include "vcap_api_kunit.c" 176767d63751SSteen Hegelund #endif 1768