RGB888 в RGB565 / битовый сдвиг

Я хочу объединить три символа в короткий, используя сдвиг битов. Это для реализации цветовой палитры RGB565 (, где 5 бит для красного, 6 для зеленого, 5 для синего ).

Вот мой пример программы, я просто пропустил шаг посередине, я думаю, где мне нужно сделать кое-что.

#include <stdio.h>

int main( ){
        unsigned char r, g, b;
        unsigned short rgb;

        r = 255;        // 0xFF 1111 1111
        g = 100;        // 0x64 0110 0100
        b = 50;         // 0x32 0011 0010

        r = r >> 3;     // 0x31 0001 1111
        g = g >> 2;     // 0x19 0001 1001
        b = b >> 3;     // 0x06 0000 0110

        //r = r & something; //
        //g = g & something; //
        //b = b & something; //

        // Desired result:
        //          R      G     B
        // 0xFB26 11111 011001 00110
        rgb = r | g | b;

        printf( "r 0x%x g 0x%x b 0x%x, rgb 0x%08x\n", r, g, b, rgb );
}

Вы можете увидеть мой желаемый результат в конце. Спасибо за помощь!