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) {
    // Your logic here
    uint16_t control_register  = 0;
    if(mode >> 7)
        mode = 7;
    if(speed > 31)
        speed = 31;
    if(status > 63)
        status = 63;
        
    control_register |= mode & 0x0007;
    control_register |= (speed << 3) & 0x00F8;
    control_register |= (status << 10) & 0xFC00;

    return control_register;
}

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;
}