Keep Only the Highest Set Bit

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

// Complete the function
uint16_t highest_set_bit(uint16_t reg) {
    // Your logic here
    //Find MSB
    int MSB = 0;
    for (int i = 15; i > 0; i --){
        if ((reg & (1 << i)) > 0){
            MSB = i;
            break;
        }
        else{
            continue;
        }
    }
    //printf("%i\n", MSB);
    if (MSB == 0){
        return reg;
    }
    else{
        //remove everything else
        for (int i = 0; i < MSB; i++){
            reg &= ~(1 << i);
        }
    }

    return reg;
}

int main() {
    uint16_t reg;
    scanf("%hu", &reg);

    uint16_t result = highest_set_bit(reg);
    printf("%hu", result);
    return 0;
}