|  | // SPDX-License-Identifier: GPL-2.0-only | 
|  | /* tnum: tracked (or tristate) numbers | 
|  | * | 
|  | * A tnum tracks knowledge about the bits of a value.  Each bit can be either | 
|  | * known (0 or 1), or unknown (x).  Arithmetic operations on tnums will | 
|  | * propagate the unknown bits such that the tnum result represents all the | 
|  | * possible results for possible values of the operands. | 
|  | */ | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/tnum.h> | 
|  |  | 
|  | #define TNUM(_v, _m)	(struct tnum){.value = _v, .mask = _m} | 
|  | /* A completely unknown value */ | 
|  | const struct tnum tnum_unknown = { .value = 0, .mask = -1 }; | 
|  |  | 
|  | struct tnum tnum_const(u64 value) | 
|  | { | 
|  | return TNUM(value, 0); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_range(u64 min, u64 max) | 
|  | { | 
|  | u64 chi = min ^ max, delta; | 
|  | u8 bits = fls64(chi); | 
|  |  | 
|  | /* special case, needed because 1ULL << 64 is undefined */ | 
|  | if (bits > 63) | 
|  | return tnum_unknown; | 
|  | /* e.g. if chi = 4, bits = 3, delta = (1<<3) - 1 = 7. | 
|  | * if chi = 0, bits = 0, delta = (1<<0) - 1 = 0, so we return | 
|  | *  constant min (since min == max). | 
|  | */ | 
|  | delta = (1ULL << bits) - 1; | 
|  | return TNUM(min & ~delta, delta); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_lshift(struct tnum a, u8 shift) | 
|  | { | 
|  | return TNUM(a.value << shift, a.mask << shift); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_rshift(struct tnum a, u8 shift) | 
|  | { | 
|  | return TNUM(a.value >> shift, a.mask >> shift); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_arshift(struct tnum a, u8 min_shift) | 
|  | { | 
|  | /* if a.value is negative, arithmetic shifting by minimum shift | 
|  | * will have larger negative offset compared to more shifting. | 
|  | * If a.value is nonnegative, arithmetic shifting by minimum shift | 
|  | * will have larger positive offset compare to more shifting. | 
|  | */ | 
|  | return TNUM((s64)a.value >> min_shift, (s64)a.mask >> min_shift); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_add(struct tnum a, struct tnum b) | 
|  | { | 
|  | u64 sm, sv, sigma, chi, mu; | 
|  |  | 
|  | sm = a.mask + b.mask; | 
|  | sv = a.value + b.value; | 
|  | sigma = sm + sv; | 
|  | chi = sigma ^ sv; | 
|  | mu = chi | a.mask | b.mask; | 
|  | return TNUM(sv & ~mu, mu); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_sub(struct tnum a, struct tnum b) | 
|  | { | 
|  | u64 dv, alpha, beta, chi, mu; | 
|  |  | 
|  | dv = a.value - b.value; | 
|  | alpha = dv + a.mask; | 
|  | beta = dv - b.mask; | 
|  | chi = alpha ^ beta; | 
|  | mu = chi | a.mask | b.mask; | 
|  | return TNUM(dv & ~mu, mu); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_and(struct tnum a, struct tnum b) | 
|  | { | 
|  | u64 alpha, beta, v; | 
|  |  | 
|  | alpha = a.value | a.mask; | 
|  | beta = b.value | b.mask; | 
|  | v = a.value & b.value; | 
|  | return TNUM(v, alpha & beta & ~v); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_or(struct tnum a, struct tnum b) | 
|  | { | 
|  | u64 v, mu; | 
|  |  | 
|  | v = a.value | b.value; | 
|  | mu = a.mask | b.mask; | 
|  | return TNUM(v, mu & ~v); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_xor(struct tnum a, struct tnum b) | 
|  | { | 
|  | u64 v, mu; | 
|  |  | 
|  | v = a.value ^ b.value; | 
|  | mu = a.mask | b.mask; | 
|  | return TNUM(v & ~mu, mu); | 
|  | } | 
|  |  | 
|  | /* half-multiply add: acc += (unknown * mask * value). | 
|  | * An intermediate step in the multiply algorithm. | 
|  | */ | 
|  | static struct tnum hma(struct tnum acc, u64 value, u64 mask) | 
|  | { | 
|  | while (mask) { | 
|  | if (mask & 1) | 
|  | acc = tnum_add(acc, TNUM(0, value)); | 
|  | mask >>= 1; | 
|  | value <<= 1; | 
|  | } | 
|  | return acc; | 
|  | } | 
|  |  | 
|  | struct tnum tnum_mul(struct tnum a, struct tnum b) | 
|  | { | 
|  | struct tnum acc; | 
|  | u64 pi; | 
|  |  | 
|  | pi = a.value * b.value; | 
|  | acc = hma(TNUM(pi, 0), a.mask, b.mask | b.value); | 
|  | return hma(acc, b.mask, a.value); | 
|  | } | 
|  |  | 
|  | /* Note that if a and b disagree - i.e. one has a 'known 1' where the other has | 
|  | * a 'known 0' - this will return a 'known 1' for that bit. | 
|  | */ | 
|  | struct tnum tnum_intersect(struct tnum a, struct tnum b) | 
|  | { | 
|  | u64 v, mu; | 
|  |  | 
|  | v = a.value | b.value; | 
|  | mu = a.mask & b.mask; | 
|  | return TNUM(v & ~mu, mu); | 
|  | } | 
|  |  | 
|  | struct tnum tnum_cast(struct tnum a, u8 size) | 
|  | { | 
|  | a.value &= (1ULL << (size * 8)) - 1; | 
|  | a.mask &= (1ULL << (size * 8)) - 1; | 
|  | return a; | 
|  | } | 
|  |  | 
|  | bool tnum_is_aligned(struct tnum a, u64 size) | 
|  | { | 
|  | if (!size) | 
|  | return true; | 
|  | return !((a.value | a.mask) & (size - 1)); | 
|  | } | 
|  |  | 
|  | bool tnum_in(struct tnum a, struct tnum b) | 
|  | { | 
|  | if (b.mask & ~a.mask) | 
|  | return false; | 
|  | b.value &= ~a.mask; | 
|  | return a.value == b.value; | 
|  | } | 
|  |  | 
|  | int tnum_strn(char *str, size_t size, struct tnum a) | 
|  | { | 
|  | return snprintf(str, size, "(%#llx; %#llx)", a.value, a.mask); | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(tnum_strn); | 
|  |  | 
|  | int tnum_sbin(char *str, size_t size, struct tnum a) | 
|  | { | 
|  | size_t n; | 
|  |  | 
|  | for (n = 64; n; n--) { | 
|  | if (n < size) { | 
|  | if (a.mask & 1) | 
|  | str[n - 1] = 'x'; | 
|  | else if (a.value & 1) | 
|  | str[n - 1] = '1'; | 
|  | else | 
|  | str[n - 1] = '0'; | 
|  | } | 
|  | a.mask >>= 1; | 
|  | a.value >>= 1; | 
|  | } | 
|  | str[min(size - 1, (size_t)64)] = 0; | 
|  | return 64; | 
|  | } |