Сдвигайте R и B на 1 влево, и если их старший (5) бит равен 1 - добавляйте еще 1.
черный останется черным, а белый - белым.
0b000000 -> 0b000000
0b011111 -> 0b111110
0b100000 -> 0b100001
0b111111 -> 0b111111

Смело умножайте R и B на 2. Можно, с коррекцией младшего разряда, как предлагал _pv.
Формат 5-6-5 используется исключительно для экономии, позволяя вписаться в 16 разрядов. Человеческий глаз более восприимчив к зеленому цвету, поэтому он цифруется с большей точностью.

Да - фиг с ней с коррекцией младшего бита.

Во, быть одна очень важная деталь, о которой забыли:
если мы пишем в видеобуфер с камеры и одновременно выводим на монитор из этого же буфера, то получаем при динамической картинке помеху в виде горизонтальной полосы (ползущей по вертикали).
Это вполне логично, ведь когда мы читаем из буфера для вывода на монитор, то в один прекрасный момент мы доходим до строки, где в данный момент идет запись с камеры. Т.е. в верхней части монитора выводится новый кадр, а внизу - еще предыдущей. Именно поэтому этой помехи не видно на статической картинке. Похожий эффект возникает и при использовании черезсстрочной развертки...

Методы борьбы:
- синхронизировать вывод и ввод картинки. Подходит только если частоты ввода/вывода кратны.
- использовать две страницы памяти. В одну пишем новый кадр, из другой пока выводим, после меняем местами... Этот способ проверил - порядок...

Ну это-то логично но только если rates записи и чтения в/из буфера не равны. Иначе, если они равны и есть задержка чтения относительно записи, то чтение всегда по идее должно запаздывать ан постоянное тау, и тогда не должно быть помехи.
Есть задержки записи и чтения в/из буфера за счет того что физическиая длинна строки (в клоках) больше чем длинна видео данных, посему даже если скорость чтения у меня будет чуть ниже скорости записи, все равно поинтеры записи/чтения не должны пересекаться.
Все это пока рассчетные теории, буду проверять на практике в симуляции...

Все правильно. При равных кадровых и строчных частотах, т.е. если развертка одинаковая, никаких помех не будет, главное, чтобы чтение не опередило запись. Тем более, что есть кадровое гашение, когда запись кадра закончено, и можно спокойно дочитывать буфер, не опасаясь, что запись нового кадра его испортит.

Мы же эту тему обсуждали в другой теме...

Да, так и есть, обсуждали с вами. В данной ветке оно как-то палвно переросло в схожее русло...

У меня как раз вывод на дисплей 60 кадров/с, а с камеры идет 15...30 кадров/с. Потому синхронизация не всегда возможно, гораздо проще сделать 2 страницы...

Значит выводим на дисплей каждый кадр по нескольку раз после накопление очередного кадра в выходном буфере ? (если входная кадровая - кратна 60 конечно..)

Ага