Keep Only the Highest Set Bit

Code

#include <stdio.h>
#include <stdint.h>
uint16_t highest_set_bit(uint16_t reg) 
{
    int h=0,cnt=0;
    for(int i=0;i<=15;i++)
    {
        if(((reg>>i)&1)==1)
        {
            if(cnt==0)
            {
                h=i;
                cnt++;
            }
            else
            {
                if(h<i)
                {
                    reg &=~(1<<h);
                    h=i;
                }
            }
        }
    }
    return reg;
}

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

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

Solving Approach