Extract and Modify Field in a 32-bit Register

Code

#include <stdio.h>
#include <stdint.h>

#define BIT_POS 10
#define BIT_MASK (0x1F << BIT_POS)

uint32_t update_register(uint32_t reg) {
    uint32_t field = ((reg >> BIT_POS) & 0x1F);  // Extract 5 bits value

    if(field < 31){
        field++;
    }

    reg &= ~(0x1F << BIT_POS);
    reg |= (field << BIT_POS) & BIT_MASK; // Write Updated field 

    return reg;
}

int main() {
    uint32_t reg;
    scanf("%u", &reg);
    uint32_t updated = update_register(reg);
    printf("%u", updated);
    return 0;
}

Solving Approach