Extract and Modify Field in a 32-bit Register

Code

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

uint32_t update_register(uint32_t reg) {
    uint8_t CurrentVal = 0,index=0;
    for(int i = 14;i>=10;i--)
    {
        CurrentVal |= (((reg >> i) & 1) << (4 - index));
        index++;
    }
    if(CurrentVal < 31)
    {
      CurrentVal+=1;
      reg &= ~(0x1F << 10);
      reg |= (CurrentVal << 10);
    }
    
    return reg;
}

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

Solving Approach