mmsfb_fillrectangle_argb3565.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_ARGB3565__

#include <cstring>
#include "mmstools/mmstools.h"

void mmsfb_fillrectangle_argb3565(MMSFBSurfacePlanes *dst_planes, int dst_height,
                                  int dx, int dy, int dw, int dh, MMSFBColor color) {
    // first time?
    static bool firsttime = true;
    if (firsttime) {
        printf("DISKO: Using accelerated fill rectangle to ARGB3565.\n");
        firsttime = false;
    }

    // fill first plane (RGB16/RGB565 format)
    /////////////////////////////////////////
    unsigned short int *dst = (unsigned short int *)dst_planes->ptr;
    int dst_pitch = dst_planes->pitch;

    // prepare...
    int dst_pitch_pix = dst_pitch >> 1;
    dst+= dx + dy * dst_pitch_pix;

    unsigned short int *dst_end = dst + dst_pitch_pix * dh;
#ifndef __HAVE_SSE__
    int dst_pitch_diff = dst_pitch_pix - dw;
#endif

    // prepare the color
    register unsigned short int SRC;
    unsigned int r = color.r >> 3;
    unsigned int g = color.g >> 2;
    unsigned int b = color.b >> 3;
    SRC =     (r << 11)
            | (g << 5)
            | b;

    // copy pixel directly to the destination
    // for all lines
    while (dst < dst_end) {
        // for all pixels in the line
#ifdef __HAVE_SSE__
        // fill memory 2-byte-wise (much faster than loop see below)
//      __asm__ __volatile__ ( "\trep stosw\n" : : "D" (dst), "a" (SRC), "c" (dw));
        short d0, d1, d2;
        __asm__ __volatile__ ( "\tcld\n\trep stosw" \
                : "=&D" (d0), "=&a" (d1), "=&c" (d2) \
                : "0" (dst), "1" (SRC), "2" (dw) \
                : "memory", "cc");

        // go to the next line
        dst+= dst_pitch_pix;
#else
        unsigned short int *line_end = dst + dw;
        while (dst < line_end) {
            *dst = SRC;
            dst++;
        }

        // go to the next line
        dst+= dst_pitch_diff;
#endif
    }


    // fill second plane (3 bit alpha (2 pixels per byte, 4 bit per pixel))
    ///////////////////////////////////////////////////////////////////////
    unsigned char *dst_a;
    int dst_a_pitch;
    if (dst_planes->ptr2) {
        // plane pointer given
        dst_a = (unsigned char *)dst_planes->ptr2;
        dst_a_pitch = dst_planes->pitch2;
    }
    else {
        // calc plane pointer (after the first plane)
        dst_a = (unsigned char *)(((unsigned char *)dst_planes->ptr) + dst_planes->pitch * dst_height);
        dst_a_pitch = dst_planes->pitch / 4;
    }
    dst_a+= (dx >> 1) + dy * dst_a_pitch;

    // check odd/even
    bool odd_left   = (dx & 0x01);
    bool odd_right  = ((dx + dw) & 0x01);

    //TODO: not even...



    // calc even positions...
    if (odd_left) {
        // odd left
        dx++;
        dw--;
        dst_a++;
    }

    if (odd_right) {
        // odd right
        dw--;
    }

    // now we are even aligned and can go through a optimized loop
    ////////////////////////////////////////////////////////////////////////
    dst_end = (unsigned short int *)(dst_a + dst_a_pitch * dh);

    // set two alpha values into one byte
    SRC = color.a >> 29;
    SRC|= SRC << 4;

    // for all lines
    while (dst_a < (unsigned char *)dst_end) {
        // for all pixels in the line
        memset(dst_a, SRC, dw >> 1);

        // go to the next line
        dst_a+= dst_a_pitch;
    }
}

#endif

---