mmsfb_blit_blend_argb_to_bgr555.cpp

Go to the documentation of this file.

/***************************************************************************
 *   Copyright (C) 2005-2007 Stefan Schwarzer, Jens Schneider,             *
 *                           Matthias Hardt, Guido Madaus                  *
 *                                                                         *
 *   Copyright (C) 2007-2008 BerLinux Solutions GbR                        *
 *                           Stefan Schwarzer & Guido Madaus               *
 *                                                                         *
 *   Copyright (C) 2009-2013 BerLinux Solutions GmbH                       *
 *                                                                         *
 *   Authors:                                                              *
 *      Stefan Schwarzer   <stefan.schwarzer@diskohq.org>,                 *
 *      Matthias Hardt     <matthias.hardt@diskohq.org>,                   *
 *      Jens Schneider     <jens.schneider@diskohq.org>,                   *
 *      Guido Madaus       <guido.madaus@diskohq.org>,                     *
 *      Patrick Helterhoff <patrick.helterhoff@diskohq.org>,               *
 *      René Bählkow       <rene.baehlkow@diskohq.org>                     *
 *                                                                         *
 *   This library is free software; you can redistribute it and/or         *
 *   modify it under the terms of the GNU Lesser General Public            *
 *   License version 2.1 as published by the Free Software Foundation.     *
 *                                                                         *
 *   This library is distributed in the hope that it will be useful,       *
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU     *
 *   Lesser General Public License for more details.                       *
 *                                                                         *
 *   You should have received a copy of the GNU Lesser General Public      *
 *   License along with this library; if not, write to the                 *
 *   Free Software Foundation, Inc.,                                       *
 *   51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA            *
 **************************************************************************/

#include "mmsgui/fb/mmsfbconv.h"

#ifdef __HAVE_PF_ARGB__
#ifdef __HAVE_PF_BGR555__

#include "mmstools/mmstools.h"

void mmsfb_blit_blend_argb_to_bgr555(MMSFBSurfacePlanes *src_planes, int src_height, int sx, int sy, int sw, int sh,
                                     MMSFBSurfacePlanes *dst_planes, int dst_height, int dx, int dy) {
    // first time?
    static bool firsttime = true;
    if (firsttime) {
        printf("DISKO: Using accelerated blend ARGB to BGR555.\n");
        firsttime = false;
    }

    // get the first source ptr/pitch
    unsigned int *src = (unsigned int *)src_planes->ptr;
    int src_pitch = src_planes->pitch;

    // get the first destination ptr/pitch
    unsigned short int *dst = (unsigned short int *)dst_planes->ptr;
    int dst_pitch = dst_planes->pitch;

    // prepare...
    int src_pitch_pix = src_pitch >> 2;
    int dst_pitch_pix = dst_pitch >> 1;
    src+= sx + sy * src_pitch_pix;
    dst+= dx + dy * dst_pitch_pix;

    // check the surface range
    if (dst_pitch_pix - dx < sw - sx)
        sw = dst_pitch_pix - dx - sx;
    if (dst_height - dy < sh - sy)
        sh = dst_height - dy - sy;
    if ((sw <= 0)||(sh <= 0))
        return;

    unsigned short int OLDDST = (*dst) + 1;
    unsigned int OLDSRC  = (*src) + 1;
    unsigned int *src_end = src + src_pitch_pix * sh;
    int src_pitch_diff = src_pitch_pix - sw;
    int dst_pitch_diff = dst_pitch_pix - sw;
    register unsigned short int d;


    // for all lines
    while (src < src_end) {
        // for all pixels in the line
        unsigned int *line_end = src + sw;
        while (src < line_end) {
            // load pixel from memory and check if the previous pixel is the same
            register unsigned int SRC  = *src;

            // is the source alpha channel 0x00 or 0xff?
            register unsigned int A = SRC >> 24;
            if (A == 0xff) {
                // source pixel is not transparent, copy it directly to the destination
                unsigned int r = (SRC << 8) >> 27;
                unsigned int g = (SRC << 16) >> 27;
                unsigned int b = (SRC & 0xff) >> 3;
                *dst =    (b << 10)
                        | (g << 5)
                        | r;
            }
            else
            if (A) {
                // source alpha is > 0x00 and < 0xff
                register unsigned short int DST = *dst;

                if ((DST==OLDDST)&&(SRC==OLDSRC)) {
                    // same pixel, use the previous value
                    *dst = d;
                    dst++;
                    src++;
                    continue;
                }
                OLDDST = DST;
                OLDSRC = SRC;

                register unsigned int SA= 0x100 - A;
                unsigned int b = DST >> 10;
                unsigned int g = DST & 0x03e0;
                unsigned int r = DST & 0x1f;

                // invert src alpha
                b = SA * b;
                g = SA * g;
                r = (SA * r) >> 5;

                // add src to dst
                b += (A*(SRC & 0xf8)) >> 13;
                g += (A*(SRC & 0xf800)) >> 6;
                r += (A*(SRC & 0xf80000)) >> 24;
                d =   ((b & 0xffe0)     ? 0x3c00 : (b << 10))
                    | ((g & 0xfffc0000) ? 0x03e0 : ((g >> 13) << 5))
                    | ((r & 0xff00)     ? 0x1f   : (r >> 3));
                *dst = d;
            }

            dst++;
            src++;
        }

        // go to the next line
        src+= src_pitch_diff;
        dst+= dst_pitch_diff;
    }
}

#endif
#endif

---