Extract the Nibble from an 8-bit Register

Code

#include <stdio.h>

unsigned char extractNibble(unsigned char reg, int pos) {
    // Write your code here
    unsigned char mask = 0x0F;
    unsigned char res;
    
    if(pos){
        mask <<= 4;
        res = reg & mask;
        res >>= 4;    
    }
    else{
        res = reg & mask;
    }
    return res;
}

int main() {
    unsigned char reg;
    int pos;
    scanf("%hhu %d", &reg, &pos);
    printf("%d", extractNibble(reg, pos));
    return 0;
}

Solving Approach