mirror of https://gitee.com/openkylin/linux.git
832 lines
22 KiB
C
832 lines
22 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
|
|
#include <linux/ethtool_netlink.h>
|
|
#include <linux/bitmap.h>
|
|
#include "netlink.h"
|
|
#include "bitset.h"
|
|
|
|
/* Some bitmaps are internally represented as an array of unsigned long, some
|
|
* as an array of u32 (some even as single u32 for now). To avoid the need of
|
|
* wrappers on caller side, we provide two set of functions: those with "32"
|
|
* suffix in their names expect u32 based bitmaps, those without it expect
|
|
* unsigned long bitmaps.
|
|
*/
|
|
|
|
static u32 ethnl_lower_bits(unsigned int n)
|
|
{
|
|
return ~(u32)0 >> (32 - n % 32);
|
|
}
|
|
|
|
static u32 ethnl_upper_bits(unsigned int n)
|
|
{
|
|
return ~(u32)0 << (n % 32);
|
|
}
|
|
|
|
/**
|
|
* ethnl_bitmap32_clear() - Clear u32 based bitmap
|
|
* @dst: bitmap to clear
|
|
* @start: beginning of the interval
|
|
* @end: end of the interval
|
|
* @mod: set if bitmap was modified
|
|
*
|
|
* Clear @nbits bits of a bitmap with indices @start <= i < @end
|
|
*/
|
|
static void ethnl_bitmap32_clear(u32 *dst, unsigned int start, unsigned int end,
|
|
bool *mod)
|
|
{
|
|
unsigned int start_word = start / 32;
|
|
unsigned int end_word = end / 32;
|
|
unsigned int i;
|
|
u32 mask;
|
|
|
|
if (end <= start)
|
|
return;
|
|
|
|
if (start % 32) {
|
|
mask = ethnl_upper_bits(start);
|
|
if (end_word == start_word) {
|
|
mask &= ethnl_lower_bits(end);
|
|
if (dst[start_word] & mask) {
|
|
dst[start_word] &= ~mask;
|
|
*mod = true;
|
|
}
|
|
return;
|
|
}
|
|
if (dst[start_word] & mask) {
|
|
dst[start_word] &= ~mask;
|
|
*mod = true;
|
|
}
|
|
start_word++;
|
|
}
|
|
|
|
for (i = start_word; i < end_word; i++) {
|
|
if (dst[i]) {
|
|
dst[i] = 0;
|
|
*mod = true;
|
|
}
|
|
}
|
|
if (end % 32) {
|
|
mask = ethnl_lower_bits(end);
|
|
if (dst[end_word] & mask) {
|
|
dst[end_word] &= ~mask;
|
|
*mod = true;
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* ethnl_bitmap32_not_zero() - Check if any bit is set in an interval
|
|
* @map: bitmap to test
|
|
* @start: beginning of the interval
|
|
* @end: end of the interval
|
|
*
|
|
* Return: true if there is non-zero bit with index @start <= i < @end,
|
|
* false if the whole interval is zero
|
|
*/
|
|
static bool ethnl_bitmap32_not_zero(const u32 *map, unsigned int start,
|
|
unsigned int end)
|
|
{
|
|
unsigned int start_word = start / 32;
|
|
unsigned int end_word = end / 32;
|
|
u32 mask;
|
|
|
|
if (end <= start)
|
|
return true;
|
|
|
|
if (start % 32) {
|
|
mask = ethnl_upper_bits(start);
|
|
if (end_word == start_word) {
|
|
mask &= ethnl_lower_bits(end);
|
|
return map[start_word] & mask;
|
|
}
|
|
if (map[start_word] & mask)
|
|
return true;
|
|
start_word++;
|
|
}
|
|
|
|
if (!memchr_inv(map + start_word, '\0',
|
|
(end_word - start_word) * sizeof(u32)))
|
|
return true;
|
|
if (end % 32 == 0)
|
|
return true;
|
|
return map[end_word] & ethnl_lower_bits(end);
|
|
}
|
|
|
|
/**
|
|
* ethnl_bitmap32_update() - Modify u32 based bitmap according to value/mask
|
|
* pair
|
|
* @dst: bitmap to update
|
|
* @nbits: bit size of the bitmap
|
|
* @value: values to set
|
|
* @mask: mask of bits to set
|
|
* @mod: set to true if bitmap is modified, preserve if not
|
|
*
|
|
* Set bits in @dst bitmap which are set in @mask to values from @value, leave
|
|
* the rest untouched. If destination bitmap was modified, set @mod to true,
|
|
* leave as it is if not.
|
|
*/
|
|
static void ethnl_bitmap32_update(u32 *dst, unsigned int nbits,
|
|
const u32 *value, const u32 *mask, bool *mod)
|
|
{
|
|
while (nbits > 0) {
|
|
u32 real_mask = mask ? *mask : ~(u32)0;
|
|
u32 new_value;
|
|
|
|
if (nbits < 32)
|
|
real_mask &= ethnl_lower_bits(nbits);
|
|
new_value = (*dst & ~real_mask) | (*value & real_mask);
|
|
if (new_value != *dst) {
|
|
*dst = new_value;
|
|
*mod = true;
|
|
}
|
|
|
|
if (nbits <= 32)
|
|
break;
|
|
dst++;
|
|
nbits -= 32;
|
|
value++;
|
|
if (mask)
|
|
mask++;
|
|
}
|
|
}
|
|
|
|
static bool ethnl_bitmap32_test_bit(const u32 *map, unsigned int index)
|
|
{
|
|
return map[index / 32] & (1U << (index % 32));
|
|
}
|
|
|
|
/**
|
|
* ethnl_bitset32_size() - Calculate size of bitset nested attribute
|
|
* @val: value bitmap (u32 based)
|
|
* @mask: mask bitmap (u32 based, optional)
|
|
* @nbits: bit length of the bitset
|
|
* @names: array of bit names (optional)
|
|
* @compact: assume compact format for output
|
|
*
|
|
* Estimate length of netlink attribute composed by a later call to
|
|
* ethnl_put_bitset32() call with the same arguments.
|
|
*
|
|
* Return: negative error code or attribute length estimate
|
|
*/
|
|
int ethnl_bitset32_size(const u32 *val, const u32 *mask, unsigned int nbits,
|
|
ethnl_string_array_t names, bool compact)
|
|
{
|
|
unsigned int len = 0;
|
|
|
|
/* list flag */
|
|
if (!mask)
|
|
len += nla_total_size(sizeof(u32));
|
|
/* size */
|
|
len += nla_total_size(sizeof(u32));
|
|
|
|
if (compact) {
|
|
unsigned int nwords = DIV_ROUND_UP(nbits, 32);
|
|
|
|
/* value, mask */
|
|
len += (mask ? 2 : 1) * nla_total_size(nwords * sizeof(u32));
|
|
} else {
|
|
unsigned int bits_len = 0;
|
|
unsigned int bit_len, i;
|
|
|
|
for (i = 0; i < nbits; i++) {
|
|
const char *name = names ? names[i] : NULL;
|
|
|
|
if (!ethnl_bitmap32_test_bit(mask ?: val, i))
|
|
continue;
|
|
/* index */
|
|
bit_len = nla_total_size(sizeof(u32));
|
|
/* name */
|
|
if (name)
|
|
bit_len += ethnl_strz_size(name);
|
|
/* value */
|
|
if (mask && ethnl_bitmap32_test_bit(val, i))
|
|
bit_len += nla_total_size(0);
|
|
|
|
/* bit nest */
|
|
bits_len += nla_total_size(bit_len);
|
|
}
|
|
/* bits nest */
|
|
len += nla_total_size(bits_len);
|
|
}
|
|
|
|
/* outermost nest */
|
|
return nla_total_size(len);
|
|
}
|
|
|
|
/**
|
|
* ethnl_put_bitset32() - Put a bitset nest into a message
|
|
* @skb: skb with the message
|
|
* @attrtype: attribute type for the bitset nest
|
|
* @val: value bitmap (u32 based)
|
|
* @mask: mask bitmap (u32 based, optional)
|
|
* @nbits: bit length of the bitset
|
|
* @names: array of bit names (optional)
|
|
* @compact: use compact format for the output
|
|
*
|
|
* Compose a nested attribute representing a bitset. If @mask is null, simple
|
|
* bitmap (bit list) is created, if @mask is provided, represent a value/mask
|
|
* pair. Bit names are only used in verbose mode and when provided by calller.
|
|
*
|
|
* Return: 0 on success, negative error value on error
|
|
*/
|
|
int ethnl_put_bitset32(struct sk_buff *skb, int attrtype, const u32 *val,
|
|
const u32 *mask, unsigned int nbits,
|
|
ethnl_string_array_t names, bool compact)
|
|
{
|
|
struct nlattr *nest;
|
|
struct nlattr *attr;
|
|
|
|
nest = nla_nest_start(skb, attrtype);
|
|
if (!nest)
|
|
return -EMSGSIZE;
|
|
|
|
if (!mask && nla_put_flag(skb, ETHTOOL_A_BITSET_NOMASK))
|
|
goto nla_put_failure;
|
|
if (nla_put_u32(skb, ETHTOOL_A_BITSET_SIZE, nbits))
|
|
goto nla_put_failure;
|
|
if (compact) {
|
|
unsigned int nwords = DIV_ROUND_UP(nbits, 32);
|
|
unsigned int nbytes = nwords * sizeof(u32);
|
|
u32 *dst;
|
|
|
|
attr = nla_reserve(skb, ETHTOOL_A_BITSET_VALUE, nbytes);
|
|
if (!attr)
|
|
goto nla_put_failure;
|
|
dst = nla_data(attr);
|
|
memcpy(dst, val, nbytes);
|
|
if (nbits % 32)
|
|
dst[nwords - 1] &= ethnl_lower_bits(nbits);
|
|
|
|
if (mask) {
|
|
attr = nla_reserve(skb, ETHTOOL_A_BITSET_MASK, nbytes);
|
|
if (!attr)
|
|
goto nla_put_failure;
|
|
dst = nla_data(attr);
|
|
memcpy(dst, mask, nbytes);
|
|
if (nbits % 32)
|
|
dst[nwords - 1] &= ethnl_lower_bits(nbits);
|
|
}
|
|
} else {
|
|
struct nlattr *bits;
|
|
unsigned int i;
|
|
|
|
bits = nla_nest_start(skb, ETHTOOL_A_BITSET_BITS);
|
|
if (!bits)
|
|
goto nla_put_failure;
|
|
for (i = 0; i < nbits; i++) {
|
|
const char *name = names ? names[i] : NULL;
|
|
|
|
if (!ethnl_bitmap32_test_bit(mask ?: val, i))
|
|
continue;
|
|
attr = nla_nest_start(skb, ETHTOOL_A_BITSET_BITS_BIT);
|
|
if (!attr)
|
|
goto nla_put_failure;
|
|
if (nla_put_u32(skb, ETHTOOL_A_BITSET_BIT_INDEX, i))
|
|
goto nla_put_failure;
|
|
if (name &&
|
|
ethnl_put_strz(skb, ETHTOOL_A_BITSET_BIT_NAME, name))
|
|
goto nla_put_failure;
|
|
if (mask && ethnl_bitmap32_test_bit(val, i) &&
|
|
nla_put_flag(skb, ETHTOOL_A_BITSET_BIT_VALUE))
|
|
goto nla_put_failure;
|
|
nla_nest_end(skb, attr);
|
|
}
|
|
nla_nest_end(skb, bits);
|
|
}
|
|
|
|
nla_nest_end(skb, nest);
|
|
return 0;
|
|
|
|
nla_put_failure:
|
|
nla_nest_cancel(skb, nest);
|
|
return -EMSGSIZE;
|
|
}
|
|
|
|
static const struct nla_policy bitset_policy[] = {
|
|
[ETHTOOL_A_BITSET_NOMASK] = { .type = NLA_FLAG },
|
|
[ETHTOOL_A_BITSET_SIZE] = NLA_POLICY_MAX(NLA_U32,
|
|
ETHNL_MAX_BITSET_SIZE),
|
|
[ETHTOOL_A_BITSET_BITS] = { .type = NLA_NESTED },
|
|
[ETHTOOL_A_BITSET_VALUE] = { .type = NLA_BINARY },
|
|
[ETHTOOL_A_BITSET_MASK] = { .type = NLA_BINARY },
|
|
};
|
|
|
|
static const struct nla_policy bit_policy[] = {
|
|
[ETHTOOL_A_BITSET_BIT_INDEX] = { .type = NLA_U32 },
|
|
[ETHTOOL_A_BITSET_BIT_NAME] = { .type = NLA_NUL_STRING },
|
|
[ETHTOOL_A_BITSET_BIT_VALUE] = { .type = NLA_FLAG },
|
|
};
|
|
|
|
/**
|
|
* ethnl_bitset_is_compact() - check if bitset attribute represents a compact
|
|
* bitset
|
|
* @bitset: nested attribute representing a bitset
|
|
* @compact: pointer for return value
|
|
*
|
|
* Return: 0 on success, negative error code on failure
|
|
*/
|
|
int ethnl_bitset_is_compact(const struct nlattr *bitset, bool *compact)
|
|
{
|
|
struct nlattr *tb[ARRAY_SIZE(bitset_policy)];
|
|
int ret;
|
|
|
|
ret = nla_parse_nested(tb, ARRAY_SIZE(bitset_policy) - 1, bitset,
|
|
bitset_policy, NULL);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (tb[ETHTOOL_A_BITSET_BITS]) {
|
|
if (tb[ETHTOOL_A_BITSET_VALUE] || tb[ETHTOOL_A_BITSET_MASK])
|
|
return -EINVAL;
|
|
*compact = false;
|
|
return 0;
|
|
}
|
|
if (!tb[ETHTOOL_A_BITSET_SIZE] || !tb[ETHTOOL_A_BITSET_VALUE])
|
|
return -EINVAL;
|
|
|
|
*compact = true;
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ethnl_name_to_idx() - look up string index for a name
|
|
* @names: array of ETH_GSTRING_LEN sized strings
|
|
* @n_names: number of strings in the array
|
|
* @name: name to look up
|
|
*
|
|
* Return: index of the string if found, -ENOENT if not found
|
|
*/
|
|
static int ethnl_name_to_idx(ethnl_string_array_t names, unsigned int n_names,
|
|
const char *name)
|
|
{
|
|
unsigned int i;
|
|
|
|
if (!names)
|
|
return -ENOENT;
|
|
|
|
for (i = 0; i < n_names; i++) {
|
|
/* names[i] may not be null terminated */
|
|
if (!strncmp(names[i], name, ETH_GSTRING_LEN) &&
|
|
strlen(name) <= ETH_GSTRING_LEN)
|
|
return i;
|
|
}
|
|
|
|
return -ENOENT;
|
|
}
|
|
|
|
static int ethnl_parse_bit(unsigned int *index, bool *val, unsigned int nbits,
|
|
const struct nlattr *bit_attr, bool no_mask,
|
|
ethnl_string_array_t names,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct nlattr *tb[ARRAY_SIZE(bit_policy)];
|
|
int ret, idx;
|
|
|
|
ret = nla_parse_nested(tb, ARRAY_SIZE(bit_policy) - 1, bit_attr,
|
|
bit_policy, extack);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (tb[ETHTOOL_A_BITSET_BIT_INDEX]) {
|
|
const char *name;
|
|
|
|
idx = nla_get_u32(tb[ETHTOOL_A_BITSET_BIT_INDEX]);
|
|
if (idx >= nbits) {
|
|
NL_SET_ERR_MSG_ATTR(extack,
|
|
tb[ETHTOOL_A_BITSET_BIT_INDEX],
|
|
"bit index too high");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
name = names ? names[idx] : NULL;
|
|
if (tb[ETHTOOL_A_BITSET_BIT_NAME] && name &&
|
|
strncmp(nla_data(tb[ETHTOOL_A_BITSET_BIT_NAME]), name,
|
|
nla_len(tb[ETHTOOL_A_BITSET_BIT_NAME]))) {
|
|
NL_SET_ERR_MSG_ATTR(extack, bit_attr,
|
|
"bit index and name mismatch");
|
|
return -EINVAL;
|
|
}
|
|
} else if (tb[ETHTOOL_A_BITSET_BIT_NAME]) {
|
|
idx = ethnl_name_to_idx(names, nbits,
|
|
nla_data(tb[ETHTOOL_A_BITSET_BIT_NAME]));
|
|
if (idx < 0) {
|
|
NL_SET_ERR_MSG_ATTR(extack,
|
|
tb[ETHTOOL_A_BITSET_BIT_NAME],
|
|
"bit name not found");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
} else {
|
|
NL_SET_ERR_MSG_ATTR(extack, bit_attr,
|
|
"neither bit index nor name specified");
|
|
return -EINVAL;
|
|
}
|
|
|
|
*index = idx;
|
|
*val = no_mask || tb[ETHTOOL_A_BITSET_BIT_VALUE];
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
ethnl_update_bitset32_verbose(u32 *bitmap, unsigned int nbits,
|
|
const struct nlattr *attr, struct nlattr **tb,
|
|
ethnl_string_array_t names,
|
|
struct netlink_ext_ack *extack, bool *mod)
|
|
{
|
|
struct nlattr *bit_attr;
|
|
bool no_mask;
|
|
int rem;
|
|
int ret;
|
|
|
|
if (tb[ETHTOOL_A_BITSET_VALUE]) {
|
|
NL_SET_ERR_MSG_ATTR(extack, tb[ETHTOOL_A_BITSET_VALUE],
|
|
"value only allowed in compact bitset");
|
|
return -EINVAL;
|
|
}
|
|
if (tb[ETHTOOL_A_BITSET_MASK]) {
|
|
NL_SET_ERR_MSG_ATTR(extack, tb[ETHTOOL_A_BITSET_MASK],
|
|
"mask only allowed in compact bitset");
|
|
return -EINVAL;
|
|
}
|
|
|
|
no_mask = tb[ETHTOOL_A_BITSET_NOMASK];
|
|
if (no_mask)
|
|
ethnl_bitmap32_clear(bitmap, 0, nbits, mod);
|
|
|
|
nla_for_each_nested(bit_attr, tb[ETHTOOL_A_BITSET_BITS], rem) {
|
|
bool old_val, new_val;
|
|
unsigned int idx;
|
|
|
|
if (nla_type(bit_attr) != ETHTOOL_A_BITSET_BITS_BIT) {
|
|
NL_SET_ERR_MSG_ATTR(extack, bit_attr,
|
|
"only ETHTOOL_A_BITSET_BITS_BIT allowed in ETHTOOL_A_BITSET_BITS");
|
|
return -EINVAL;
|
|
}
|
|
ret = ethnl_parse_bit(&idx, &new_val, nbits, bit_attr, no_mask,
|
|
names, extack);
|
|
if (ret < 0)
|
|
return ret;
|
|
old_val = bitmap[idx / 32] & ((u32)1 << (idx % 32));
|
|
if (new_val != old_val) {
|
|
if (new_val)
|
|
bitmap[idx / 32] |= ((u32)1 << (idx % 32));
|
|
else
|
|
bitmap[idx / 32] &= ~((u32)1 << (idx % 32));
|
|
*mod = true;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ethnl_compact_sanity_checks(unsigned int nbits,
|
|
const struct nlattr *nest,
|
|
struct nlattr **tb,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
bool no_mask = tb[ETHTOOL_A_BITSET_NOMASK];
|
|
unsigned int attr_nbits, attr_nwords;
|
|
const struct nlattr *test_attr;
|
|
|
|
if (no_mask && tb[ETHTOOL_A_BITSET_MASK]) {
|
|
NL_SET_ERR_MSG_ATTR(extack, tb[ETHTOOL_A_BITSET_MASK],
|
|
"mask not allowed in list bitset");
|
|
return -EINVAL;
|
|
}
|
|
if (!tb[ETHTOOL_A_BITSET_SIZE]) {
|
|
NL_SET_ERR_MSG_ATTR(extack, nest,
|
|
"missing size in compact bitset");
|
|
return -EINVAL;
|
|
}
|
|
if (!tb[ETHTOOL_A_BITSET_VALUE]) {
|
|
NL_SET_ERR_MSG_ATTR(extack, nest,
|
|
"missing value in compact bitset");
|
|
return -EINVAL;
|
|
}
|
|
if (!no_mask && !tb[ETHTOOL_A_BITSET_MASK]) {
|
|
NL_SET_ERR_MSG_ATTR(extack, nest,
|
|
"missing mask in compact nonlist bitset");
|
|
return -EINVAL;
|
|
}
|
|
|
|
attr_nbits = nla_get_u32(tb[ETHTOOL_A_BITSET_SIZE]);
|
|
attr_nwords = DIV_ROUND_UP(attr_nbits, 32);
|
|
if (nla_len(tb[ETHTOOL_A_BITSET_VALUE]) != attr_nwords * sizeof(u32)) {
|
|
NL_SET_ERR_MSG_ATTR(extack, tb[ETHTOOL_A_BITSET_VALUE],
|
|
"bitset value length does not match size");
|
|
return -EINVAL;
|
|
}
|
|
if (tb[ETHTOOL_A_BITSET_MASK] &&
|
|
nla_len(tb[ETHTOOL_A_BITSET_MASK]) != attr_nwords * sizeof(u32)) {
|
|
NL_SET_ERR_MSG_ATTR(extack, tb[ETHTOOL_A_BITSET_MASK],
|
|
"bitset mask length does not match size");
|
|
return -EINVAL;
|
|
}
|
|
if (attr_nbits <= nbits)
|
|
return 0;
|
|
|
|
test_attr = no_mask ? tb[ETHTOOL_A_BITSET_VALUE] :
|
|
tb[ETHTOOL_A_BITSET_MASK];
|
|
if (ethnl_bitmap32_not_zero(nla_data(test_attr), nbits, attr_nbits)) {
|
|
NL_SET_ERR_MSG_ATTR(extack, test_attr,
|
|
"cannot modify bits past kernel bitset size");
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ethnl_update_bitset32() - Apply a bitset nest to a u32 based bitmap
|
|
* @bitmap: bitmap to update
|
|
* @nbits: size of the updated bitmap in bits
|
|
* @attr: nest attribute to parse and apply
|
|
* @names: array of bit names; may be null for compact format
|
|
* @extack: extack for error reporting
|
|
* @mod: set this to true if bitmap is modified, leave as it is if not
|
|
*
|
|
* Apply bitset netsted attribute to a bitmap. If the attribute represents
|
|
* a bit list, @bitmap is set to its contents; otherwise, bits in mask are
|
|
* set to values from value. Bitmaps in the attribute may be longer than
|
|
* @nbits but the message must not request modifying any bits past @nbits.
|
|
*
|
|
* Return: negative error code on failure, 0 on success
|
|
*/
|
|
int ethnl_update_bitset32(u32 *bitmap, unsigned int nbits,
|
|
const struct nlattr *attr, ethnl_string_array_t names,
|
|
struct netlink_ext_ack *extack, bool *mod)
|
|
{
|
|
struct nlattr *tb[ARRAY_SIZE(bitset_policy)];
|
|
unsigned int change_bits;
|
|
bool no_mask;
|
|
int ret;
|
|
|
|
if (!attr)
|
|
return 0;
|
|
ret = nla_parse_nested(tb, ARRAY_SIZE(bitset_policy) - 1, attr,
|
|
bitset_policy, extack);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (tb[ETHTOOL_A_BITSET_BITS])
|
|
return ethnl_update_bitset32_verbose(bitmap, nbits, attr, tb,
|
|
names, extack, mod);
|
|
ret = ethnl_compact_sanity_checks(nbits, attr, tb, extack);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
no_mask = tb[ETHTOOL_A_BITSET_NOMASK];
|
|
change_bits = min_t(unsigned int,
|
|
nla_get_u32(tb[ETHTOOL_A_BITSET_SIZE]), nbits);
|
|
ethnl_bitmap32_update(bitmap, change_bits,
|
|
nla_data(tb[ETHTOOL_A_BITSET_VALUE]),
|
|
no_mask ? NULL :
|
|
nla_data(tb[ETHTOOL_A_BITSET_MASK]),
|
|
mod);
|
|
if (no_mask && change_bits < nbits)
|
|
ethnl_bitmap32_clear(bitmap, change_bits, nbits, mod);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ethnl_parse_bitset() - Compute effective value and mask from bitset nest
|
|
* @val: unsigned long based bitmap to put value into
|
|
* @mask: unsigned long based bitmap to put mask into
|
|
* @nbits: size of @val and @mask bitmaps
|
|
* @attr: nest attribute to parse and apply
|
|
* @names: array of bit names; may be null for compact format
|
|
* @extack: extack for error reporting
|
|
*
|
|
* Provide @nbits size long bitmaps for value and mask so that
|
|
* x = (val & mask) | (x & ~mask) would modify any @nbits sized bitmap x
|
|
* the same way ethnl_update_bitset() with the same bitset attribute would.
|
|
*
|
|
* Return: negative error code on failure, 0 on success
|
|
*/
|
|
int ethnl_parse_bitset(unsigned long *val, unsigned long *mask,
|
|
unsigned int nbits, const struct nlattr *attr,
|
|
ethnl_string_array_t names,
|
|
struct netlink_ext_ack *extack)
|
|
{
|
|
struct nlattr *tb[ARRAY_SIZE(bitset_policy)];
|
|
const struct nlattr *bit_attr;
|
|
bool no_mask;
|
|
int rem;
|
|
int ret;
|
|
|
|
if (!attr)
|
|
return 0;
|
|
ret = nla_parse_nested(tb, ARRAY_SIZE(bitset_policy) - 1, attr,
|
|
bitset_policy, extack);
|
|
if (ret < 0)
|
|
return ret;
|
|
no_mask = tb[ETHTOOL_A_BITSET_NOMASK];
|
|
|
|
if (!tb[ETHTOOL_A_BITSET_BITS]) {
|
|
unsigned int change_bits;
|
|
|
|
ret = ethnl_compact_sanity_checks(nbits, attr, tb, extack);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
change_bits = nla_get_u32(tb[ETHTOOL_A_BITSET_SIZE]);
|
|
bitmap_from_arr32(val, nla_data(tb[ETHTOOL_A_BITSET_VALUE]),
|
|
change_bits);
|
|
if (change_bits < nbits)
|
|
bitmap_clear(val, change_bits, nbits - change_bits);
|
|
if (no_mask) {
|
|
bitmap_fill(mask, nbits);
|
|
} else {
|
|
bitmap_from_arr32(mask,
|
|
nla_data(tb[ETHTOOL_A_BITSET_MASK]),
|
|
change_bits);
|
|
if (change_bits < nbits)
|
|
bitmap_clear(mask, change_bits,
|
|
nbits - change_bits);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
if (tb[ETHTOOL_A_BITSET_VALUE]) {
|
|
NL_SET_ERR_MSG_ATTR(extack, tb[ETHTOOL_A_BITSET_VALUE],
|
|
"value only allowed in compact bitset");
|
|
return -EINVAL;
|
|
}
|
|
if (tb[ETHTOOL_A_BITSET_MASK]) {
|
|
NL_SET_ERR_MSG_ATTR(extack, tb[ETHTOOL_A_BITSET_MASK],
|
|
"mask only allowed in compact bitset");
|
|
return -EINVAL;
|
|
}
|
|
|
|
bitmap_zero(val, nbits);
|
|
if (no_mask)
|
|
bitmap_fill(mask, nbits);
|
|
else
|
|
bitmap_zero(mask, nbits);
|
|
|
|
nla_for_each_nested(bit_attr, tb[ETHTOOL_A_BITSET_BITS], rem) {
|
|
unsigned int idx;
|
|
bool bit_val;
|
|
|
|
ret = ethnl_parse_bit(&idx, &bit_val, nbits, bit_attr, no_mask,
|
|
names, extack);
|
|
if (ret < 0)
|
|
return ret;
|
|
if (bit_val)
|
|
__set_bit(idx, val);
|
|
if (!no_mask)
|
|
__set_bit(idx, mask);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
#if BITS_PER_LONG == 64 && defined(__BIG_ENDIAN)
|
|
|
|
/* 64-bit big endian architectures are the only case when u32 based bitmaps
|
|
* and unsigned long based bitmaps have different memory layout so that we
|
|
* cannot simply cast the latter to the former and need actual wrappers
|
|
* converting the latter to the former.
|
|
*
|
|
* To reduce the number of slab allocations, the wrappers use fixed size local
|
|
* variables for bitmaps up to ETHNL_SMALL_BITMAP_BITS bits which is the
|
|
* majority of bitmaps used by ethtool.
|
|
*/
|
|
#define ETHNL_SMALL_BITMAP_BITS 128
|
|
#define ETHNL_SMALL_BITMAP_WORDS DIV_ROUND_UP(ETHNL_SMALL_BITMAP_BITS, 32)
|
|
|
|
int ethnl_bitset_size(const unsigned long *val, const unsigned long *mask,
|
|
unsigned int nbits, ethnl_string_array_t names,
|
|
bool compact)
|
|
{
|
|
u32 small_mask32[ETHNL_SMALL_BITMAP_WORDS];
|
|
u32 small_val32[ETHNL_SMALL_BITMAP_WORDS];
|
|
u32 *mask32;
|
|
u32 *val32;
|
|
int ret;
|
|
|
|
if (nbits > ETHNL_SMALL_BITMAP_BITS) {
|
|
unsigned int nwords = DIV_ROUND_UP(nbits, 32);
|
|
|
|
val32 = kmalloc_array(2 * nwords, sizeof(u32), GFP_KERNEL);
|
|
if (!val32)
|
|
return -ENOMEM;
|
|
mask32 = val32 + nwords;
|
|
} else {
|
|
val32 = small_val32;
|
|
mask32 = small_mask32;
|
|
}
|
|
|
|
bitmap_to_arr32(val32, val, nbits);
|
|
if (mask)
|
|
bitmap_to_arr32(mask32, mask, nbits);
|
|
else
|
|
mask32 = NULL;
|
|
ret = ethnl_bitset32_size(val32, mask32, nbits, names, compact);
|
|
|
|
if (nbits > ETHNL_SMALL_BITMAP_BITS)
|
|
kfree(val32);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int ethnl_put_bitset(struct sk_buff *skb, int attrtype,
|
|
const unsigned long *val, const unsigned long *mask,
|
|
unsigned int nbits, ethnl_string_array_t names,
|
|
bool compact)
|
|
{
|
|
u32 small_mask32[ETHNL_SMALL_BITMAP_WORDS];
|
|
u32 small_val32[ETHNL_SMALL_BITMAP_WORDS];
|
|
u32 *mask32;
|
|
u32 *val32;
|
|
int ret;
|
|
|
|
if (nbits > ETHNL_SMALL_BITMAP_BITS) {
|
|
unsigned int nwords = DIV_ROUND_UP(nbits, 32);
|
|
|
|
val32 = kmalloc_array(2 * nwords, sizeof(u32), GFP_KERNEL);
|
|
if (!val32)
|
|
return -ENOMEM;
|
|
mask32 = val32 + nwords;
|
|
} else {
|
|
val32 = small_val32;
|
|
mask32 = small_mask32;
|
|
}
|
|
|
|
bitmap_to_arr32(val32, val, nbits);
|
|
if (mask)
|
|
bitmap_to_arr32(mask32, mask, nbits);
|
|
else
|
|
mask32 = NULL;
|
|
ret = ethnl_put_bitset32(skb, attrtype, val32, mask32, nbits, names,
|
|
compact);
|
|
|
|
if (nbits > ETHNL_SMALL_BITMAP_BITS)
|
|
kfree(val32);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int ethnl_update_bitset(unsigned long *bitmap, unsigned int nbits,
|
|
const struct nlattr *attr, ethnl_string_array_t names,
|
|
struct netlink_ext_ack *extack, bool *mod)
|
|
{
|
|
u32 small_bitmap32[ETHNL_SMALL_BITMAP_WORDS];
|
|
u32 *bitmap32 = small_bitmap32;
|
|
bool u32_mod = false;
|
|
int ret;
|
|
|
|
if (nbits > ETHNL_SMALL_BITMAP_BITS) {
|
|
unsigned int dst_words = DIV_ROUND_UP(nbits, 32);
|
|
|
|
bitmap32 = kmalloc_array(dst_words, sizeof(u32), GFP_KERNEL);
|
|
if (!bitmap32)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
bitmap_to_arr32(bitmap32, bitmap, nbits);
|
|
ret = ethnl_update_bitset32(bitmap32, nbits, attr, names, extack,
|
|
&u32_mod);
|
|
if (u32_mod) {
|
|
bitmap_from_arr32(bitmap, bitmap32, nbits);
|
|
*mod = true;
|
|
}
|
|
|
|
if (nbits > ETHNL_SMALL_BITMAP_BITS)
|
|
kfree(bitmap32);
|
|
|
|
return ret;
|
|
}
|
|
|
|
#else
|
|
|
|
/* On little endian 64-bit and all 32-bit architectures, an unsigned long
|
|
* based bitmap can be interpreted as u32 based one using a simple cast.
|
|
*/
|
|
|
|
int ethnl_bitset_size(const unsigned long *val, const unsigned long *mask,
|
|
unsigned int nbits, ethnl_string_array_t names,
|
|
bool compact)
|
|
{
|
|
return ethnl_bitset32_size((const u32 *)val, (const u32 *)mask, nbits,
|
|
names, compact);
|
|
}
|
|
|
|
int ethnl_put_bitset(struct sk_buff *skb, int attrtype,
|
|
const unsigned long *val, const unsigned long *mask,
|
|
unsigned int nbits, ethnl_string_array_t names,
|
|
bool compact)
|
|
{
|
|
return ethnl_put_bitset32(skb, attrtype, (const u32 *)val,
|
|
(const u32 *)mask, nbits, names, compact);
|
|
}
|
|
|
|
int ethnl_update_bitset(unsigned long *bitmap, unsigned int nbits,
|
|
const struct nlattr *attr, ethnl_string_array_t names,
|
|
struct netlink_ext_ack *extack, bool *mod)
|
|
{
|
|
return ethnl_update_bitset32((u32 *)bitmap, nbits, attr, names, extack,
|
|
mod);
|
|
}
|
|
|
|
#endif /* BITS_PER_LONG == 64 && defined(__BIG_ENDIAN) */
|