blob: 987e11001a2f5b5a45b007fed43bf83be0522426 [file] [log] [blame]
Gerd Hoffmannd6d94fc2010-06-14 09:54:27 +02001/*
2 * PixelFormat conversion library.
3 *
4 * Author: Gerd Hoffmann <kraxel@redhat.com>
5 *
6 * This work is licensed under the terms of the GNU GPL, version 2. See
7 * the COPYING file in the top-level directory.
8 *
Paolo Bonzini6b620ca2012-01-13 17:44:23 +01009 * Contributions after 2012-01-13 are licensed under the terms of the
10 * GNU GPL, version 2 or (at your option) any later version.
Gerd Hoffmannd6d94fc2010-06-14 09:54:27 +020011 */
12#include "qemu-common.h"
13#include "console.h"
14#include "pflib.h"
15
16typedef struct QemuPixel QemuPixel;
17
18typedef void (*pf_convert)(QemuPfConv *conv,
19 void *dst, void *src, uint32_t cnt);
20typedef void (*pf_convert_from)(PixelFormat *pf,
21 QemuPixel *dst, void *src, uint32_t cnt);
22typedef void (*pf_convert_to)(PixelFormat *pf,
23 void *dst, QemuPixel *src, uint32_t cnt);
24
25struct QemuPfConv {
26 pf_convert convert;
27 PixelFormat src;
28 PixelFormat dst;
29
30 /* for copy_generic() */
31 pf_convert_from conv_from;
32 pf_convert_to conv_to;
33 QemuPixel *conv_buf;
34 uint32_t conv_cnt;
35};
36
37struct QemuPixel {
38 uint8_t red;
39 uint8_t green;
40 uint8_t blue;
41 uint8_t alpha;
42};
43
44/* ----------------------------------------------------------------------- */
45/* PixelFormat -> QemuPixel conversions */
46
47static void conv_16_to_pixel(PixelFormat *pf,
48 QemuPixel *dst, void *src, uint32_t cnt)
49{
50 uint16_t *src16 = src;
51
52 while (cnt > 0) {
53 dst->red = ((*src16 & pf->rmask) >> pf->rshift) << (8 - pf->rbits);
54 dst->green = ((*src16 & pf->gmask) >> pf->gshift) << (8 - pf->gbits);
55 dst->blue = ((*src16 & pf->bmask) >> pf->bshift) << (8 - pf->bbits);
56 dst->alpha = ((*src16 & pf->amask) >> pf->ashift) << (8 - pf->abits);
57 dst++, src16++, cnt--;
58 }
59}
60
61/* assumes pf->{r,g,b,a}bits == 8 */
62static void conv_32_to_pixel_fast(PixelFormat *pf,
63 QemuPixel *dst, void *src, uint32_t cnt)
64{
65 uint32_t *src32 = src;
66
67 while (cnt > 0) {
68 dst->red = (*src32 & pf->rmask) >> pf->rshift;
69 dst->green = (*src32 & pf->gmask) >> pf->gshift;
70 dst->blue = (*src32 & pf->bmask) >> pf->bshift;
71 dst->alpha = (*src32 & pf->amask) >> pf->ashift;
72 dst++, src32++, cnt--;
73 }
74}
75
76static void conv_32_to_pixel_generic(PixelFormat *pf,
77 QemuPixel *dst, void *src, uint32_t cnt)
78{
79 uint32_t *src32 = src;
80
81 while (cnt > 0) {
82 if (pf->rbits < 8) {
83 dst->red = ((*src32 & pf->rmask) >> pf->rshift) << (8 - pf->rbits);
84 } else {
85 dst->red = ((*src32 & pf->rmask) >> pf->rshift) >> (pf->rbits - 8);
86 }
87 if (pf->gbits < 8) {
88 dst->green = ((*src32 & pf->gmask) >> pf->gshift) << (8 - pf->gbits);
89 } else {
90 dst->green = ((*src32 & pf->gmask) >> pf->gshift) >> (pf->gbits - 8);
91 }
92 if (pf->bbits < 8) {
93 dst->blue = ((*src32 & pf->bmask) >> pf->bshift) << (8 - pf->bbits);
94 } else {
95 dst->blue = ((*src32 & pf->bmask) >> pf->bshift) >> (pf->bbits - 8);
96 }
97 if (pf->abits < 8) {
98 dst->alpha = ((*src32 & pf->amask) >> pf->ashift) << (8 - pf->abits);
99 } else {
100 dst->alpha = ((*src32 & pf->amask) >> pf->ashift) >> (pf->abits - 8);
101 }
102 dst++, src32++, cnt--;
103 }
104}
105
106/* ----------------------------------------------------------------------- */
107/* QemuPixel -> PixelFormat conversions */
108
109static void conv_pixel_to_16(PixelFormat *pf,
110 void *dst, QemuPixel *src, uint32_t cnt)
111{
112 uint16_t *dst16 = dst;
113
114 while (cnt > 0) {
115 *dst16 = ((uint16_t)src->red >> (8 - pf->rbits)) << pf->rshift;
116 *dst16 |= ((uint16_t)src->green >> (8 - pf->gbits)) << pf->gshift;
117 *dst16 |= ((uint16_t)src->blue >> (8 - pf->bbits)) << pf->bshift;
118 *dst16 |= ((uint16_t)src->alpha >> (8 - pf->abits)) << pf->ashift;
119 dst16++, src++, cnt--;
120 }
121}
122
123static void conv_pixel_to_32(PixelFormat *pf,
124 void *dst, QemuPixel *src, uint32_t cnt)
125{
126 uint32_t *dst32 = dst;
127
128 while (cnt > 0) {
129 *dst32 = ((uint32_t)src->red >> (8 - pf->rbits)) << pf->rshift;
130 *dst32 |= ((uint32_t)src->green >> (8 - pf->gbits)) << pf->gshift;
131 *dst32 |= ((uint32_t)src->blue >> (8 - pf->bbits)) << pf->bshift;
132 *dst32 |= ((uint32_t)src->alpha >> (8 - pf->abits)) << pf->ashift;
133 dst32++, src++, cnt--;
134 }
135}
136
137/* ----------------------------------------------------------------------- */
138/* PixelFormat -> PixelFormat conversions */
139
140static void convert_copy(QemuPfConv *conv, void *dst, void *src, uint32_t cnt)
141{
142 uint32_t bytes = cnt * conv->src.bytes_per_pixel;
143 memcpy(dst, src, bytes);
144}
145
146static void convert_generic(QemuPfConv *conv, void *dst, void *src, uint32_t cnt)
147{
148 if (conv->conv_cnt < cnt) {
149 conv->conv_cnt = cnt;
Anthony Liguori7267c092011-08-20 22:09:37 -0500150 conv->conv_buf = g_realloc(conv->conv_buf, sizeof(QemuPixel) * conv->conv_cnt);
Gerd Hoffmannd6d94fc2010-06-14 09:54:27 +0200151 }
152 conv->conv_from(&conv->src, conv->conv_buf, src, cnt);
153 conv->conv_to(&conv->dst, dst, conv->conv_buf, cnt);
154}
155
156/* ----------------------------------------------------------------------- */
157/* public interface */
158
159QemuPfConv *qemu_pf_conv_get(PixelFormat *dst, PixelFormat *src)
160{
Anthony Liguori7267c092011-08-20 22:09:37 -0500161 QemuPfConv *conv = g_malloc0(sizeof(QemuPfConv));
Gerd Hoffmannd6d94fc2010-06-14 09:54:27 +0200162
163 conv->src = *src;
164 conv->dst = *dst;
165
166 if (memcmp(&conv->src, &conv->dst, sizeof(PixelFormat)) == 0) {
167 /* formats identical, can simply copy */
168 conv->convert = convert_copy;
169 } else {
170 /* generic two-step conversion: src -> QemuPixel -> dst */
171 switch (conv->src.bytes_per_pixel) {
172 case 2:
173 conv->conv_from = conv_16_to_pixel;
174 break;
175 case 4:
176 if (conv->src.rbits == 8 && conv->src.gbits == 8 && conv->src.bbits == 8) {
177 conv->conv_from = conv_32_to_pixel_fast;
178 } else {
179 conv->conv_from = conv_32_to_pixel_generic;
180 }
181 break;
182 default:
183 goto err;
184 }
185 switch (conv->dst.bytes_per_pixel) {
186 case 2:
187 conv->conv_to = conv_pixel_to_16;
188 break;
189 case 4:
190 conv->conv_to = conv_pixel_to_32;
191 break;
192 default:
193 goto err;
194 }
195 conv->convert = convert_generic;
196 }
197 return conv;
198
199err:
Anthony Liguori7267c092011-08-20 22:09:37 -0500200 g_free(conv);
Gerd Hoffmannd6d94fc2010-06-14 09:54:27 +0200201 return NULL;
202}
203
204void qemu_pf_conv_run(QemuPfConv *conv, void *dst, void *src, uint32_t cnt)
205{
206 conv->convert(conv, dst, src, cnt);
207}
208
209void qemu_pf_conv_put(QemuPfConv *conv)
210{
211 if (conv) {
Anthony Liguori7267c092011-08-20 22:09:37 -0500212 g_free(conv->conv_buf);
213 g_free(conv);
Gerd Hoffmannd6d94fc2010-06-14 09:54:27 +0200214 }
215}