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
    for(int i=16; i>=0; i--)
    {
        // printf("%d %d %d \n",reg,i,(reg>>i)&0x01);
        if((reg>>i)&0x01)
        {
            reg = 0x00;
            reg |= (1<<i);
            break;
        }        
    }
    return reg;
}

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

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