Pack Multiple Fields into a 16-bit Control Register

#include <stdio.h>
#include <stdint.h>

uint16_t set_bits(uint8_t reg, uint8_t val, uint8_t msb, uint8_t lsb){
    uint8_t mask = (1U<<(msb-lsb+1))-1 << lsb;
    reg &= ~mask;
    return reg | (val << lsb);
}

uint16_t pack_register(uint8_t mode, uint8_t speed, uint8_t status) {
    uint16_t reg = 0;
    reg = set_bits(reg, mode, 2, 0);
    reg = set_bits(reg, speed, 7, 3);
    reg = set_bits(reg, status, 15, 10);
    return reg;
    /*
    uint16_t reg = 0;
    reg |= mode;
    reg |= (speed << 3);
    reg |= (status << 10);
    return reg;    
    */
}

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