25. Pack Multiple Fields into a 16-bit Control Register

#include <stdio.h>
#include <stdint.h>
 
uint16_t pack_register(uint8_t mode, uint8_t speed, uint8_t status)
{
    uint16_t result = 0;
    for (int i = 2; i >= 0; i--)
    {
        result |= ((mode >> i) & 1) << i;
    }
    for (int i = 4; i >= 0; i--)
    {
        result |= ((speed >> i) & 1) << i+3;
    }
    for (int i = 5; i >= 0; i--)
    {
        result |= ((status >> i) & 1) << i+10;
    }
   
    return result;
}
 
int main() {
    uint8_t mode, speed, status;
    scanf("%hhu %hhu %hhu", &mode, &speed, &status);
 
    uint16_t reg = pack_register(mode, speed, status);
    printf("%u", reg);
    return 0;
}