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 new_register = 0;
    if (mode > 0x7) mode = 0x07;
    if (speed > 0x1f) speed = 0x1f;
    if (status > 0x3f) status = 0x3f;

    new_register |= ((mode&0x07)<<0);
    new_register |= ((speed&0x1f) <<3);
    new_register |= ((status&0x3f) <<10);
    return new_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;
}