]> git.sesse.net Git - qscale/blobdiff - qscale.c
Removed a hard-coded register.
[qscale] / qscale.c
index d5536bc36a359aff34690a0e67485c15561af83c..3bb1b340228ed2172ed779454f261af829c739bb 100644 (file)
--- a/qscale.c
+++ b/qscale.c
@@ -9,11 +9,17 @@
 
 double sinc(double x)
 {
-       // This is bad for very small x, should use power series instead.
-       if (x == 0.0)
-               return 1.0;
-       else
+       static const double cutoff = 1.220703668e-4;  // sqrt(sqrt(eps))
+
+       if (abs(x) < cutoff) {
+               // For small |x|, use Taylor series instead
+               const double x2 = x * x;
+               const double x4 = x2 * x2;
+
+               return 1.0 - x2 / 6.0 + x4 / 120.0;
+       } else {
                return sin(x) / x;
+       }
 }
 
 double lanczos_tap(double x)
@@ -32,13 +38,13 @@ struct pix_desc {
        unsigned startcoeff;
 };
 
-void hscale(float *pix, unsigned char *npix, unsigned w, unsigned h, unsigned nw, unsigned dstride)
+void hscale(float *pix, unsigned char *npix, unsigned w, unsigned h, unsigned nw, unsigned sstride, unsigned dstride)
 {
        struct pix_desc *pd = (struct pix_desc *)malloc(nw * sizeof(struct pix_desc));
        int size_coeffs = 8;
        float *coeffs = (float *)malloc(size_coeffs * sizeof(float));
        int num_coeffs = 0;
-       int x, y, sx;
+       int x, y;
        double sf = (double)w / (double)nw;
        double support = (w > nw) ? (3.0 * sf) : (3.0 / sf);
 
@@ -46,6 +52,7 @@ void hscale(float *pix, unsigned char *npix, unsigned w, unsigned h, unsigned nw
        for (x = 0; x < nw; ++x) {
                int start = ceil(x * sf - support);
                int end = floor(x * sf + support);
+               int sx;
                double sum = 0.0;
 
                if (start < 0) {
@@ -55,6 +62,19 @@ void hscale(float *pix, unsigned char *npix, unsigned w, unsigned h, unsigned nw
                        end = w - 1;
                }
 
+               // round up so we get a multiple of four for the SSE code
+               int num = (end - start + 1);
+               if (num % 4 != 0) {
+                       // prefer aligning it if possible
+                       if (start % 4 != 0 && start % 4 <= num % 4) {
+                               num += start % 4;
+                               start -= start % 4;
+                       }
+                       if (num % 4 != 0) {
+                               end += 4 - (num % 4);
+                       }
+               }
+
                pd[x].start = start;
                pd[x].end = end;
                pd[x].startcoeff = num_coeffs;
@@ -66,7 +86,7 @@ void hscale(float *pix, unsigned char *npix, unsigned w, unsigned h, unsigned nw
                                size_coeffs <<= 1;
                                coeffs = (float *)realloc(coeffs, size_coeffs * sizeof(float));
                        }
-               
+
                        coeffs[num_coeffs++] = f;
                        sum += f;
                }
@@ -75,20 +95,41 @@ void hscale(float *pix, unsigned char *npix, unsigned w, unsigned h, unsigned nw
                        coeffs[pd[x].startcoeff + sx - start] /= sum;
                }
        }
-       
+
        for (y = 0; y < h; ++y) {
-               float *sptr = pix + y*w;
+               float *sptr = pix + y*sstride;
                unsigned char *dptr = npix + y*dstride;
-               unsigned char ch = 0;
+               unsigned char ch;
                for (x = 0; x < nw; ++x) {
-                       float acc = 0.0;
-                       float *cf = &coeffs[pd[x].startcoeff];
-                       unsigned sx;
-                       
-                       for (sx = pd[x].start; sx <= pd[x].end; ++sx) {
-                               acc += sptr[sx] * *cf++;
-                       }
+                       float acc;
+                       int tmp;
+                       static const float low = 0.0, high = 255.0;
+                       asm (
+                               "pxor %0, %0               \n"
+                               "xor %1, %1                \n"
+                               ".lbl2:                    \n"
+                               "movups (%3,%1),%%xmm1     \n"
+                               "movups (%2,%1),%%xmm2     \n"
+                               "mulps %%xmm2,%%xmm1       \n"
+                               "addps %%xmm1,%0           \n"
+                               "addl $16,%1              \n"
+                               "dec %4                    \n"
+                               "jnz .lbl2                 \n"
+                               "haddps %0,%0              \n"
+                               "haddps %0,%0              \n"
+                               "maxss %5,%0               \n"
+                               "minss %6,%0               \n"
+                               : "=&x" (acc),
+                                 "=&r" (tmp)
+                               : "r" (&coeffs[pd[x].startcoeff]),
+                                 "r" (&sptr[pd[x].start]),
+                                 "r" ((pd[x].end - pd[x].start + 1)/4),
+                                 "m" (low),
+                                 "m" (high)
+                               : "xmm1", "xmm2"
+                       );
 
+#if 0
                        if (acc < 0.0)
                                ch = 0;
                        else if (acc > 255.0)
@@ -96,7 +137,10 @@ void hscale(float *pix, unsigned char *npix, unsigned w, unsigned h, unsigned nw
                        else
                                ch = (unsigned char)acc;
                        *dptr++ = ch;
+#endif
+                       *dptr++ = (unsigned char)acc;
                }
+               ch = dptr[-1];
                for ( ; x < dstride; ++x) {
                        *dptr++ = ch;
                }
@@ -240,9 +284,9 @@ void vscale(unsigned char *pix, float *npix, unsigned w, unsigned h, unsigned nh
                                "addps %%xmm6, %%xmm3    \n"
 
                                /* move along, and loop */
-                               "addl $4, %2             \n"
-                               "addl %3, %0             \n"
-                               "decl %1                 \n"
+                               "add $4, %2              \n"
+                               "add %3, %0              \n"
+                               "dec %1                  \n"
                                "jnz .lbl                \n"
 
                                /* store the values */
@@ -310,6 +354,10 @@ int main(int argc, char **argv)
        dinfo.raw_data_out = TRUE;
        jpeg_start_decompress(&dinfo);
 
+       unsigned w0 = dinfo.image_width * samp_h0 / max_samp_h, h0 = dinfo.image_height * samp_v0 / max_samp_v;
+       unsigned w1 = dinfo.image_width * samp_h1 / max_samp_h, h1 = dinfo.image_height * samp_v1 / max_samp_v;
+       unsigned w2 = dinfo.image_width * samp_h2 / max_samp_h, h2 = dinfo.image_height * samp_v2 / max_samp_v;
+
        fprintf(stderr, "Scaling using Lanczos filter:\n");
        fprintf(stderr, "  Y component: %ux%u -> %ux%u\n", dinfo.comp_info[0].width_in_blocks * DCTSIZE, dinfo.comp_info[0].height_in_blocks * DCTSIZE, nw0, nh0);
        fprintf(stderr, "  Cb component: %ux%u -> %ux%u\n", dinfo.comp_info[1].width_in_blocks * DCTSIZE, dinfo.comp_info[1].height_in_blocks * DCTSIZE, nw1, nh1);
@@ -345,23 +393,23 @@ int main(int argc, char **argv)
 
        {
                float *npix = (float*)memalign(16, dinfo.comp_info[0].width_in_blocks * DCTSIZE * nh0 * sizeof(float)); 
-               vscale(data_y, npix, dinfo.comp_info[0].width_in_blocks * DCTSIZE, dinfo.comp_info[0].height_in_blocks * DCTSIZE, nh0, dinfo.comp_info[0].width_in_blocks * DCTSIZE);
+               vscale(data_y, npix, dinfo.comp_info[0].width_in_blocks * DCTSIZE, h0, nh0, dinfo.comp_info[0].width_in_blocks * DCTSIZE);
                data_ny = (unsigned char *)malloc(nw0 * stride0);
-               hscale(npix, data_ny, dinfo.comp_info[0].width_in_blocks * DCTSIZE, nh0, nw0, stride0);
+               hscale(npix, data_ny, w0, nh0, nw0, dinfo.comp_info[0].width_in_blocks * DCTSIZE, stride0);
                free(npix);
        }
        {
                float *npix = (float*)memalign(16, dinfo.comp_info[1].width_in_blocks * DCTSIZE * nh1 * sizeof(float)); 
-               vscale(data_cr, npix, dinfo.comp_info[1].width_in_blocks * DCTSIZE, dinfo.comp_info[1].height_in_blocks * DCTSIZE, nh1, dinfo.comp_info[1].width_in_blocks * DCTSIZE);
+               vscale(data_cr, npix, dinfo.comp_info[1].width_in_blocks * DCTSIZE, h1, nh1, dinfo.comp_info[1].width_in_blocks * DCTSIZE);
                data_ncr = (unsigned char *)malloc(nw1 * stride1);
-               hscale(npix, data_ncr, dinfo.comp_info[1].width_in_blocks * DCTSIZE, nh1, nw1, stride1);
+               hscale(npix, data_ncr, w1, nh1, nw1, dinfo.comp_info[1].width_in_blocks * DCTSIZE, stride1);
                free(npix);
        }
        {
                float *npix = (float*)memalign(16, dinfo.comp_info[2].width_in_blocks * DCTSIZE * nh2 * sizeof(float)); 
-               vscale(data_cb, npix, dinfo.comp_info[2].width_in_blocks * DCTSIZE, dinfo.comp_info[2].height_in_blocks * DCTSIZE, nh2, dinfo.comp_info[2].width_in_blocks * DCTSIZE);
+               vscale(data_cb, npix, dinfo.comp_info[2].width_in_blocks * DCTSIZE, h2, nh2, dinfo.comp_info[2].width_in_blocks * DCTSIZE);
                data_ncb = (unsigned char *)malloc(nw2 * stride2);
-               hscale(npix, data_ncb, dinfo.comp_info[2].width_in_blocks * DCTSIZE, nh2, nw2, stride2);
+               hscale(npix, data_ncb, w2, nh2, nw2, dinfo.comp_info[2].width_in_blocks * DCTSIZE, stride2);
                free(npix);
        }
        jpeg_destroy_decompress(&dinfo);