Keep Only the Highest Set Bit

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

// Complete the function
uint16_t highest_set_bit(uint16_t reg) {
    for(int i=15; i >= 0; --i){
        if(reg & (1 << i)){
            for(int p = i-1; p >= 0; --p){
                reg &= ~(1 << p);
            }
            return reg;
            break;
        }
    }
    return 0;
        
}


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

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