1 1785490b 2012-12-01 rsc #include <u.h>
2 1785490b 2012-12-01 rsc #include <libc.h>
3 1785490b 2012-12-01 rsc #include <draw.h>
4 1785490b 2012-12-01 rsc #include <memdraw.h>
5 1785490b 2012-12-01 rsc #include "a.h"
7 1785490b 2012-12-01 rsc uchar pjw[] = {
8 1785490b 2012-12-01 rsc 0x63, 0x6f, 0x6d, 0x70, 0x72, 0x65, 0x73, 0x73,
9 1785490b 2012-12-01 rsc 0x65, 0x64, 0x0a, 0x20, 0x20, 0x20, 0x20, 0x20,
10 1785490b 2012-12-01 rsc 0x20, 0x20, 0x20, 0x20, 0x6b, 0x32, 0x20, 0x20,
11 1785490b 2012-12-01 rsc 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
12 1785490b 2012-12-01 rsc 0x20, 0x30, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
13 1785490b 2012-12-01 rsc 0x20, 0x20, 0x20, 0x20, 0x20, 0x30, 0x20, 0x20,
14 1785490b 2012-12-01 rsc 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
15 1785490b 2012-12-01 rsc 0x34, 0x38, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
16 1785490b 2012-12-01 rsc 0x20, 0x20, 0x20, 0x20, 0x34, 0x38, 0x20, 0x20,
17 1785490b 2012-12-01 rsc 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
18 1785490b 2012-12-01 rsc 0x34, 0x38, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
19 1785490b 2012-12-01 rsc 0x20, 0x20, 0x20, 0x35, 0x34, 0x31, 0x20, 0x80,
20 1785490b 2012-12-01 rsc 0xff, 0x20, 0x00, 0x08, 0x00, 0x82, 0xc0, 0x16,
21 1785490b 2012-12-01 rsc 0x7f, 0x04, 0x06, 0x04, 0x00, 0x83, 0xfc, 0x01,
22 1785490b 2012-12-01 rsc 0x04, 0x06, 0x04, 0x07, 0x04, 0x00, 0x83, 0xf1,
23 1785490b 2012-12-01 rsc 0x00, 0x50, 0x11, 0x04, 0x18, 0x04, 0x00, 0x84,
24 1785490b 2012-12-01 rsc 0xd4, 0x40, 0x48, 0x04, 0x05, 0x00, 0x07, 0x04,
25 1785490b 2012-12-01 rsc 0x00, 0x87, 0xc1, 0x44, 0x11, 0x04, 0x51, 0xbf,
26 1785490b 2012-12-01 rsc 0xff, 0xff, 0x04, 0x00, 0x87, 0x16, 0xfe, 0x81,
27 1785490b 2012-12-01 rsc 0x01, 0x40, 0x5f, 0xff, 0xff, 0x04, 0x00, 0x87,
28 1785490b 2012-12-01 rsc 0x5f, 0xff, 0xe4, 0x00, 0x40, 0x01, 0x1f, 0xff,
29 1785490b 2012-12-01 rsc 0x00, 0x00, 0x88, 0xfd, 0x7f, 0xff, 0xfd, 0x11,
30 1785490b 2012-12-01 rsc 0x11, 0x00, 0x3f, 0xff, 0x00, 0x00, 0x80, 0xe5,
31 1785490b 2012-12-01 rsc 0x00, 0x03, 0x84, 0x50, 0x04, 0x10, 0x42, 0xff,
32 1785490b 2012-12-01 rsc 0x00, 0x00, 0x80, 0x97, 0x00, 0x03, 0x84, 0x51,
33 1785490b 2012-12-01 rsc 0x00, 0x00, 0x07, 0xff, 0x00, 0x00, 0x80, 0x67,
34 1785490b 2012-12-01 rsc 0x00, 0x03, 0x84, 0xc4, 0x40, 0x41, 0x11, 0x3f,
35 1785490b 2012-12-01 rsc 0x00, 0x75, 0x80, 0x4f, 0x00, 0x0b, 0x84, 0xd0,
36 1785490b 2012-12-01 rsc 0x40, 0x00, 0x11, 0x1b, 0x82, 0xff, 0xff, 0xf5,
37 1785490b 2012-12-01 rsc 0x04, 0x40, 0x84, 0xf0, 0x00, 0x00, 0x04, 0x5f,
38 1785490b 2012-12-01 rsc 0x82, 0xff, 0xff, 0xe1, 0x04, 0x40, 0x84, 0xf4,
39 1785490b 2012-12-01 rsc 0x00, 0x00, 0x01, 0x5b, 0x00, 0x1e, 0x80, 0x2f,
40 1785490b 2012-12-01 rsc 0x04, 0x9e, 0x83, 0x00, 0x00, 0x00, 0x17, 0x82,
41 1785490b 2012-12-01 rsc 0xff, 0xff, 0x40, 0x04, 0x96, 0x84, 0xfe, 0x40,
42 1785490b 2012-12-01 rsc 0x00, 0x00, 0x0f, 0x82, 0xff, 0xfd, 0x00, 0x08,
43 1785490b 2012-12-01 rsc 0xa2, 0x00, 0x0b, 0x80, 0x5f, 0x8b, 0xff, 0xf9,
44 1785490b 2012-12-01 rsc 0x00, 0xb5, 0x11, 0x5f, 0xff, 0xa5, 0x64, 0x00,
45 1785490b 2012-12-01 rsc 0x00, 0x1f, 0x85, 0xff, 0xf4, 0x01, 0x0a, 0xf5,
46 1785490b 2012-12-01 rsc 0x42, 0x04, 0x2e, 0x81, 0x00, 0x2b, 0x87, 0xff,
47 1785490b 2012-12-01 rsc 0xf0, 0x01, 0x0f, 0xe4, 0x54, 0xf0, 0x3f, 0x00,
48 1785490b 2012-12-01 rsc 0x23, 0x80, 0x1f, 0x88, 0xff, 0xe0, 0x00, 0x4e,
49 1785490b 2012-12-01 rsc 0x00, 0x04, 0x00, 0x00, 0x14, 0x00, 0x0b, 0x85,
50 1785490b 2012-12-01 rsc 0xff, 0xd0, 0x00, 0x4c, 0x50, 0x44, 0x04, 0x22,
51 1785490b 2012-12-01 rsc 0x81, 0x00, 0x0b, 0x00, 0x0b, 0x82, 0x49, 0xa6,
52 1785490b 2012-12-01 rsc 0x6c, 0x00, 0x76, 0x00, 0x17, 0x00, 0x7d, 0x88,
53 1785490b 2012-12-01 rsc 0x5e, 0xd6, 0xf9, 0xf1, 0x51, 0x11, 0x00, 0x00,
54 1785490b 2012-12-01 rsc 0x3f, 0x88, 0xff, 0xf1, 0x02, 0x2e, 0xff, 0xf3,
55 1785490b 2012-12-01 rsc 0xf4, 0x6a, 0x98, 0x00, 0x0b, 0x8b, 0xff, 0xf3,
56 1785490b 2012-12-01 rsc 0x06, 0x2f, 0xff, 0xeb, 0xf8, 0xba, 0xa5, 0x04,
57 1785490b 2012-12-01 rsc 0x00, 0xbf, 0x8b, 0xff, 0xf5, 0x42, 0x9f, 0xff,
58 1785490b 2012-12-01 rsc 0xcf, 0xf9, 0x2b, 0xa5, 0xc0, 0x08, 0xff, 0x8b,
59 1785490b 2012-12-01 rsc 0xff, 0xfc, 0xc5, 0xfd, 0x40, 0x3f, 0xfe, 0x0b,
60 1785490b 2012-12-01 rsc 0xfb, 0x00, 0x0e, 0xff, 0x00, 0xae, 0x88, 0xfa,
61 1785490b 2012-12-01 rsc 0x96, 0xff, 0xfa, 0x81, 0x54, 0x40, 0x1b, 0xff,
62 1785490b 2012-12-01 rsc 0x00, 0x0b, 0x88, 0xfe, 0xaa, 0x96, 0x50, 0x59,
63 1785490b 2012-12-01 rsc 0x41, 0x00, 0x7b, 0xff, 0x88, 0xff, 0xff, 0x53,
64 1785490b 2012-12-01 rsc 0xff, 0xab, 0xc0, 0x00, 0x16, 0x54, 0x00, 0xba,
65 1785490b 2012-12-01 rsc 0x8b, 0xff, 0xff, 0x43, 0xfe, 0xaf, 0xe8, 0x00,
66 1785490b 2012-12-01 rsc 0x5a, 0x61, 0x41, 0xbf, 0xff, 0x8b, 0xff, 0xff,
67 1785490b 2012-12-01 rsc 0xc2, 0xfe, 0xbf, 0xfd, 0x01, 0x59, 0x94, 0x51,
68 1785490b 2012-12-01 rsc 0x1b, 0xff, 0x00, 0xef, 0x88, 0xfe, 0xeb, 0xed,
69 1785490b 2012-12-01 rsc 0x95, 0x56, 0x51, 0x40, 0x0f, 0xff, 0x8b, 0xff,
70 1785490b 2012-12-01 rsc 0xff, 0xe0, 0xfa, 0x92, 0xa6, 0x91, 0x11, 0x54,
71 1785490b 2012-12-01 rsc 0x54, 0x0f, 0xff, 0x00, 0x0b, 0x84, 0xff, 0xa9,
72 1785490b 2012-12-01 rsc 0xa4, 0x00, 0x01, 0x04, 0x17, 0x00, 0x6c, 0x88,
73 1785490b 2012-12-01 rsc 0xba, 0xaf, 0xff, 0xfd, 0x96, 0x45, 0x40, 0x3f,
74 1785490b 2012-12-01 rsc 0xff, 0x00, 0x00, 0x88, 0x2a, 0xbf, 0x6a, 0xa4,
75 1785490b 2012-12-01 rsc 0x15, 0x54, 0x60, 0xbf, 0xff, 0x00, 0x00, 0x88,
76 1785490b 2012-12-01 rsc 0xfa, 0xeb, 0x90, 0x00, 0x95, 0x41, 0xae, 0xff,
77 1785490b 2012-12-01 rsc 0xff, 0x04, 0x0b, 0x84, 0xaa, 0xa5, 0x11, 0x45,
78 1785490b 2012-12-01 rsc 0x05, 0x01, 0x49, 0x05, 0x27, 0x87, 0xae, 0xff,
79 1785490b 2012-12-01 rsc 0xf9, 0x54, 0x11, 0x6e, 0xff, 0xff, 0x0c, 0x0b,
80 1785490b 2012-12-01 rsc 0x85, 0xfa, 0x54, 0x56, 0xbb, 0xff, 0xff, 0x04,
81 1785490b 2012-12-01 rsc 0x0b, 0x87, 0xab, 0xbf, 0xf6, 0x54, 0x43, 0xaf,
82 1785490b 2012-12-01 rsc 0xff, 0xff, 0x04, 0x00, 0x87, 0x5a, 0xaa, 0x95,
83 1785490b 2012-12-01 rsc 0x11, 0x46, 0xfb, 0xff, 0xff, 0x04, 0x00, 0x84,
84 1785490b 2012-12-01 rsc 0xaa, 0x55, 0x10, 0x45, 0x07, 0x00, 0x17, 0x04,
85 1785490b 2012-12-01 rsc 0x00, 0x84, 0x95, 0x54, 0x45, 0x14, 0x06, 0x00,
86 1785490b 2012-12-01 rsc 0x5e, 0x04, 0x00, 0x87, 0xa5, 0x55, 0x50, 0x40,
87 1785490b 2012-12-01 rsc 0x12, 0xff, 0xbf, 0xff,
90 1785490b 2012-12-01 rsc static Memimage* resample(int, int, Memimage*);
93 1785490b 2012-12-01 rsc drawpjw(Memimage *m, Fontchar *fc, int x, int width, int height, int ascent)
96 1785490b 2012-12-01 rsc Memimage *pm, *pm1, *pm2;
102 1785490b 2012-12-01 rsc // assume margin below baseline is
103 1785490b 2012-12-01 rsc // approximately how much room we should preserve at top above peter too
104 1785490b 2012-12-01 rsc margin = height - ascent;
105 1785490b 2012-12-01 rsc if(w > ascent-margin)
106 1785490b 2012-12-01 rsc w = ascent-margin;
110 1785490b 2012-12-01 rsc fc->width = w;
113 1785490b 2012-12-01 rsc write(p[1], pjw, sizeof pjw);
114 1785490b 2012-12-01 rsc close(p[1]);
115 1785490b 2012-12-01 rsc pm = readmemimage(p[0]);
116 1785490b 2012-12-01 rsc close(p[0]);
117 1785490b 2012-12-01 rsc if(pm == nil)
120 1785490b 2012-12-01 rsc pm1 = allocmemimage(pm->r, GREY8);
121 1785490b 2012-12-01 rsc memimagedraw(pm1, pm1->r, pm, pm->r.min, nil, ZP, S);
122 1785490b 2012-12-01 rsc pm2 = resample(w, w, pm1);
123 1785490b 2012-12-01 rsc memimagedraw(m, Rect(x, ascent-w, x+w, ascent), memwhite, ZP, nil, ZP, SoverD);
124 1785490b 2012-12-01 rsc memimagedraw(m, Rect(x, ascent-w, x+w, ascent), memblack, ZP, pm2, pm2->r.min, SoverD);
125 1785490b 2012-12-01 rsc freememimage(pm2);
126 1785490b 2012-12-01 rsc freememimage(pm1);
127 1785490b 2012-12-01 rsc freememimage(pm);
131 1785490b 2012-12-01 rsc // draw a box
132 1785490b 2012-12-01 rsc r = Rect(x, 0, x+width, height);
133 1785490b 2012-12-01 rsc memimagedraw(m, r, memwhite, ZP, nil, ZP, S);
134 1785490b 2012-12-01 rsc memimagedraw(m, insetrect(r, 3), memblack, ZP, nil, ZP, S);
138 1785490b 2012-12-01 rsc #define K2 7 /* from -.7 to +.7 inclusive, meaning .2 into each adjacent pixel */
139 1785490b 2012-12-01 rsc #define NK (2*K2+1)
140 1785490b 2012-12-01 rsc static double K[NK];
143 1785490b 2012-12-01 rsc resamplex(uchar *in, int off, int d, int inx, uchar *out, int outx)
145 1785490b 2012-12-01 rsc int i, x, k;
146 1785490b 2012-12-01 rsc double X, xx, v, rat;
149 1785490b 2012-12-01 rsc rat = (double)inx/(double)outx;
150 1785490b 2012-12-01 rsc for(x=0; x<outx; x++){
151 1785490b 2012-12-01 rsc if(inx == outx){
152 1785490b 2012-12-01 rsc /* don't resample if size unchanged */
153 1785490b 2012-12-01 rsc out[off+x*d] = in[off+x*d];
158 1785490b 2012-12-01 rsc for(k=-K2; k<=K2; k++){
159 1785490b 2012-12-01 rsc xx = X + rat*k/10.;
163 1785490b 2012-12-01 rsc if(i >= inx)
165 1785490b 2012-12-01 rsc v += in[off+i*d] * K[K2+k];
167 1785490b 2012-12-01 rsc out[off+x*d] = v;
172 1785490b 2012-12-01 rsc resampley(uchar **in, int off, int iny, uchar **out, int outy)
174 1785490b 2012-12-01 rsc int y, i, k;
175 1785490b 2012-12-01 rsc double Y, yy, v, rat;
177 1785490b 2012-12-01 rsc rat = (double)iny/(double)outy;
178 1785490b 2012-12-01 rsc for(y=0; y<outy; y++){
179 1785490b 2012-12-01 rsc if(iny == outy){
180 1785490b 2012-12-01 rsc /* don't resample if size unchanged */
181 1785490b 2012-12-01 rsc out[y][off] = in[y][off];
186 1785490b 2012-12-01 rsc for(k=-K2; k<=K2; k++){
187 1785490b 2012-12-01 rsc yy = Y + rat*k/10.;
191 1785490b 2012-12-01 rsc if(i >= iny)
193 1785490b 2012-12-01 rsc v += in[i][off] * K[K2+k];
195 1785490b 2012-12-01 rsc out[y][off] = v;
201 1785490b 2012-12-01 rsc max(int a, int b)
208 1785490b 2012-12-01 rsc static double
214 1785490b 2012-12-01 rsc for(i=L; i>1; --i)
220 1785490b 2012-12-01 rsc * i0(x) is the modified Bessel function, Σ (x/2)^2L / (L!)²
221 1785490b 2012-12-01 rsc * There are faster ways to calculate this, but we precompute
222 1785490b 2012-12-01 rsc * into a table so let's keep it simple.
224 1785490b 2012-12-01 rsc static double
225 1785490b 2012-12-01 rsc i0(double x)
231 1785490b 2012-12-01 rsc for(L=1; L<10; L++)
232 1785490b 2012-12-01 rsc v += pow(x/2., 2*L)/pow(fac(L), 2);
236 1785490b 2012-12-01 rsc static double
237 1785490b 2012-12-01 rsc kaiser(double x, double tau, double alpha)
239 1785490b 2012-12-01 rsc if(fabs(x) > tau)
241 1785490b 2012-12-01 rsc return i0(alpha*sqrt(1-(x*x/(tau*tau))))/i0(alpha);
245 1785490b 2012-12-01 rsc static Memimage*
246 1785490b 2012-12-01 rsc resample(int xsize, int ysize, Memimage *m)
248 1785490b 2012-12-01 rsc int i, j, bpl, nchan;
249 1785490b 2012-12-01 rsc Memimage *new;
250 1785490b 2012-12-01 rsc uchar **oscan, **nscan;
253 1785490b 2012-12-01 rsc for(i=-K2; i<=K2; i++){
254 1785490b 2012-12-01 rsc K[K2+i] = kaiser(i/10., K2/10., 4.);
255 1785490b 2012-12-01 rsc /* print("%g %g\n", i/10., K[K2+i]); */
258 1785490b 2012-12-01 rsc /* normalize */
260 1785490b 2012-12-01 rsc for(i=0; i<NK; i++)
262 1785490b 2012-12-01 rsc for(i=0; i<NK; i++)
265 1785490b 2012-12-01 rsc new = allocmemimage(Rect(0, 0, xsize, ysize), m->chan);
266 1785490b 2012-12-01 rsc if(new == nil)
267 1785490b 2012-12-01 rsc sysfatal("can't allocate new image: %r");
269 1785490b 2012-12-01 rsc oscan = malloc(Dy(m->r)*sizeof(uchar*));
270 1785490b 2012-12-01 rsc nscan = malloc(max(ysize, Dy(m->r))*sizeof(uchar*));
271 1785490b 2012-12-01 rsc if(oscan == nil || nscan == nil)
272 1785490b 2012-12-01 rsc sysfatal("can't allocate: %r");
274 1785490b 2012-12-01 rsc /* unload original image into scan lines */
275 1785490b 2012-12-01 rsc bpl = bytesperline(m->r, m->depth);
276 1785490b 2012-12-01 rsc for(i=0; i<Dy(m->r); i++){
277 1785490b 2012-12-01 rsc oscan[i] = malloc(bpl);
278 1785490b 2012-12-01 rsc if(oscan[i] == nil)
279 1785490b 2012-12-01 rsc sysfatal("can't allocate: %r");
280 1785490b 2012-12-01 rsc j = unloadmemimage(m, Rect(m->r.min.x, m->r.min.y+i, m->r.max.x, m->r.min.y+i+1), oscan[i], bpl);
281 1785490b 2012-12-01 rsc if(j != bpl)
282 1785490b 2012-12-01 rsc sysfatal("unloadmemimage");
285 1785490b 2012-12-01 rsc /* allocate scan lines for destination. we do y first, so need at least Dy(m->r) lines */
286 1785490b 2012-12-01 rsc bpl = bytesperline(Rect(0, 0, xsize, Dy(m->r)), m->depth);
287 1785490b 2012-12-01 rsc for(i=0; i<max(ysize, Dy(m->r)); i++){
288 1785490b 2012-12-01 rsc nscan[i] = malloc(bpl);
289 1785490b 2012-12-01 rsc if(nscan[i] == nil)
290 1785490b 2012-12-01 rsc sysfatal("can't allocate: %r");
293 1785490b 2012-12-01 rsc /* resample in X */
294 1785490b 2012-12-01 rsc nchan = m->depth/8;
295 1785490b 2012-12-01 rsc for(i=0; i<Dy(m->r); i++){
296 1785490b 2012-12-01 rsc for(j=0; j<nchan; j++){
297 1785490b 2012-12-01 rsc if(j==0 && m->chan==XRGB32)
299 1785490b 2012-12-01 rsc resamplex(oscan[i], j, nchan, Dx(m->r), nscan[i], xsize);
301 1785490b 2012-12-01 rsc free(oscan[i]);
302 1785490b 2012-12-01 rsc oscan[i] = nscan[i];
303 1785490b 2012-12-01 rsc nscan[i] = malloc(bpl);
304 1785490b 2012-12-01 rsc if(nscan[i] == nil)
305 1785490b 2012-12-01 rsc sysfatal("can't allocate: %r");
308 1785490b 2012-12-01 rsc /* resample in Y */
309 1785490b 2012-12-01 rsc for(i=0; i<xsize; i++)
310 1785490b 2012-12-01 rsc for(j=0; j<nchan; j++)
311 1785490b 2012-12-01 rsc resampley(oscan, nchan*i+j, Dy(m->r), nscan, ysize);
313 1785490b 2012-12-01 rsc /* pack data into destination */
314 1785490b 2012-12-01 rsc bpl = bytesperline(new->r, m->depth);
315 1785490b 2012-12-01 rsc for(i=0; i<ysize; i++){
316 1785490b 2012-12-01 rsc j = loadmemimage(new, Rect(0, i, xsize, i+1), nscan[i], bpl);
317 1785490b 2012-12-01 rsc if(j != bpl)
318 1785490b 2012-12-01 rsc sysfatal("loadmemimage: %r");
