Read/Write some bits within a number

bits.h

/**
 * Modify some bits within a number
 *
 * @note The lowest index is 0, increasing sequentially
 *
 * @param origin Original data
 * @param offset Offset that needs to be modified
 * @param len Bit length
 * @param value The value to which the specified bit needs to be replaced
 * @return Modified value
 */
static inline unsigned int WriteBits(unsigned int origin, unsigned int offset,
                                     unsigned int len, unsigned int value) {
  if (offset > sizeof(origin) * 8 - 1 || len > sizeof(origin) * 8 - 1)
    return (unsigned int)-1;

  unsigned mask = (1U << len) - 1;
  origin &= ~(mask << offset);        // Empty the location you want to edit
  value &= mask;                      // Intercept value to the specified length
  return origin | (value << offset);  // merge
}

/**
 * Read some bits within a number
 *
 * @note The lowest index is 0, increasing sequentially
 *
 * @param origin Original data
 * @param offset Offset that needs to be read
 * @param len Bit length
 * @return read value
 */
static inline unsigned int ReadBits(unsigned int origin, unsigned int offset,
                                    unsigned int len) {
  if (offset > sizeof(origin) * 8 - 1 || len > sizeof(origin) * 8 - 1)
    return (unsigned int)-1;

  unsigned mask = (1U << len) - 1;
  return (origin >> offset) & mask;  // Intercept value to the specified length
}