1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
|
// Copyright (C) 1999-2016
// Smithsonian Astrophysical Observatory, Cambridge, MA, USA
// For conditions of distribution and use, see copyright notice in "copyright"
#include "truecolor16.h"
#include "util.h"
TrueColor16::TrueColor16(Visual* visual)
{
#if !(_WIN32)
rx_ = visual->red_mask;
gx_ = visual->green_mask;
bx_ = visual->blue_mask;
#endif
#if _WIN32
// windows masks are plain wrong
rx_ = 0x7C00;
gx_ = 0x03E0;
bx_ = 0x001F;
#endif
rm_ = decodeMask((unsigned short)rx_, &rs_);
gm_ = decodeMask((unsigned short)gx_, &gs_);
bm_ = decodeMask((unsigned short)bx_, &bs_);
}
unsigned short TrueColor16::decodeMask(unsigned short mask, int* s)
{
// first calc ffs for mask
unsigned short m1 = mask;
int m1s;
for (m1s=0; m1s<16; m1s++) {
if (m1 & 0x1)
break;
m1 >>= 1;
}
// then shift mask to mask a char
for (int i=0; i<16; i++) {
if (mask & 0x8000)
break;
mask <<= 1;
}
mask >>= 8;
// now calc ffs for new mask
unsigned short m2 = mask;
int m2s;
for (m2s=0; m2s<16; m2s++) {
if (m2 & 0x1)
break;
m2 >>= 1;
}
*s = m1s-m2s;
return mask;
}
void TrueColor16::encodeTrueColor(XColor* src, char* dest, XImage* ximage)
{
if (!ximage)
return;
int msb = ximage->byte_order;
unsigned short r = (unsigned char)src->red;
unsigned short g = (unsigned char)src->green;
unsigned short b = (unsigned char)src->blue;
unsigned short v = 0;
v |= rs_>0 ? ((r & rm_) << rs_) : ((r & rm_) >> -rs_);
v |= gs_>0 ? ((g & gm_) << gs_) : ((g & gm_) >> -gs_);
v |= bs_>0 ? ((b & bm_) << bs_) : ((b & bm_) >> -bs_);
if ((!msb && lsb()) || (msb && !lsb()))
memcpy(dest, &v, 2);
else {
unsigned char* rr = (unsigned char*)(&v);
*(dest) = *(rr+1);
*(dest+1) = *(rr);
}
}
void TrueColor16::decodeTrueColor(char* src, XColor* dest, XImage* ximage)
{
if (!ximage)
return;
int msb = ximage->byte_order;
unsigned short v = 0;
if ((!msb && lsb()) || (msb && !lsb()))
memcpy(dest, &v, 2);
else {
unsigned char* rr = (unsigned char*)(&v);
*(rr+1) = *(src+0);
*(rr+0) = *(src+1);
}
dest->red = (unsigned short)((v & rx_) >> rs_);
dest->green = (unsigned short)((v & gx_) >> gs_);
dest->blue = (unsigned short)((v & bx_) >> bs_);
}
void TrueColor16::encodeTrueColor(unsigned char* src, XImage* ximage)
{
int& width = ximage->width;
int& height = ximage->height;
char* data = ximage->data;
int msb = ximage->byte_order;
const unsigned char* ptr = src;
if ((!msb && lsb()) || (msb && !lsb())) {
for (int jj=0; jj<height; jj++) {
char* dest = data + jj*ximage->bytes_per_line; // may be padded at the end
for (int ii=0; ii<width; ii++, dest+=2, ptr+=3) {
unsigned short r = ptr[0];
unsigned short g = ptr[1];
unsigned short b = ptr[2];
unsigned short v = 0;
v |= rs_>0 ? ((r & rm_) << rs_) : ((r & rm_) >> -rs_);
v |= gs_>0 ? ((g & gm_) << gs_) : ((g & gm_) >> -gs_);
v |= bs_>0 ? ((b & bm_) << bs_) : ((b & bm_) >> -bs_);
memcpy(dest, &v, 2);
}
}
}
else {
for (int jj=0; jj<height; jj++) {
char* dest = data + jj*ximage->bytes_per_line;
for (int ii=0; ii<width; ii++, dest+=2, ptr+=3) {
unsigned short r = ptr[0];
unsigned short g = ptr[1];
unsigned short b = ptr[2];
unsigned short v = 0;
v |= rs_>0 ? ((r & rm_) << rs_) : ((r & rm_) >> -rs_);
v |= gs_>0 ? ((g & gm_) << gs_) : ((g & gm_) >> -gs_);
v |= bs_>0 ? ((b & bm_) << bs_) : ((b & bm_) >> -bs_);
unsigned char* rr = (unsigned char*)(&v);
*(dest) = *(rr+1);
*(dest+1) = *(rr);
}
}
}
}
|
