sunxi_disp_hwcursor.c

/*
 * Copyright © 2013 Siarhei Siamashka <siarhei.siamashka@gmail.com>
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice (including the next
 * paragraph) shall be included in all copies or substantial portions of the
 * Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
 * DEALINGS IN THE SOFTWARE.
 */

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include "xf86.h"
#include "xf86Cursor.h"
#include "cursorstr.h"

#include "sunxi_disp_hwcursor.h"
#include "sunxi_disp.h"
#include "fbdev_priv.h"

#include "uthash.h"

static void ShowCursor(ScrnInfoPtr pScrn)
{
    sunxi_disp_t *disp = SUNXI_DISP(pScrn);
    sunxi_hw_cursor_show(disp);
}

static void HideCursor(ScrnInfoPtr pScrn)
{
    sunxi_disp_t *disp = SUNXI_DISP(pScrn);
    sunxi_hw_cursor_hide(disp);
}

static void SetCursorPosition(ScrnInfoPtr pScrn, int x, int y)
{
    sunxi_disp_t *disp = SUNXI_DISP(pScrn);
    sunxi_hw_cursor_set_position(disp, x, y);
}

static void SetCursorColors(ScrnInfoPtr pScrn, int bg, int fg)
{
    sunxi_disp_t *disp = SUNXI_DISP(pScrn);
    uint32_t palette[4] = { 0, 0, bg | 0xFF000000, fg | 0xFF000000 };
    sunxi_hw_cursor_load_palette(disp, &palette[0], 4);
}

static void LoadCursorImage(ScrnInfoPtr pScrn, unsigned char *bits)
{
    SunxiDispHardwareCursor *private = SUNXI_DISP_HWC(pScrn);
    sunxi_disp_t *disp = SUNXI_DISP(pScrn);
    sunxi_hw_cursor_load_64x64x2bpp(disp, bits);
    if (private->EnableHWCursor)
        (*private->EnableHWCursor) (pScrn);
}

static Bool UseHWCursorARGB(ScreenPtr pScreen, CursorPtr pCurs)
{
    ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
    SunxiDispHardwareCursor *private = SUNXI_DISP_HWC(pScrn);

    /* We support ARGB cursors up to 32x32 */
    if (pCurs->bits->height <= 32 && pCurs->bits->width <= 32) {
        if (private->EnableHWCursor)
            (*private->EnableHWCursor) (pScrn);
        return TRUE;
    }

    if (private->DisableHWCursor)
        (*private->DisableHWCursor) (pScrn);
    return FALSE;
}

typedef struct {
    uint32_t       color;
    UT_hash_handle hh;
} hashed_color;

static inline uint32_t quantize_color(uint32_t color, int keepbits)
{
    uint32_t bitmask = 0x01010101 * ((1 << (8 - keepbits)) - 1);
    color &= ~bitmask;
    color |= (color >> keepbits) & bitmask;
    return color;
}

static void LoadCursorARGB(ScrnInfoPtr pScrn, CursorPtr pCurs)
{
    sunxi_disp_t *disp = SUNXI_DISP(pScrn);
    int           width  = pCurs->bits->width;
    int           height = pCurs->bits->height;
    int           keepbits, colors_count;
    uint8_t      *cursor_image = calloc(32 * 32, 1);
    uint32_t     *palette = malloc(256 * sizeof(uint32_t));
    hashed_color *colors_array = malloc(width * height * sizeof(hashed_color));

    /* Reduce the number of bits per color until we can fit into 8-bit palette */
    for (keepbits = 8; keepbits > 0; keepbits--) {
        int           x, y;
        uint32_t     *argb = (uint32_t *)pCurs->bits->argb;
        hashed_color *hash = NULL;
        hashed_color *hc;

        /* Always have transparent color at palette index 0 */
        hc = &colors_array[0];
        hc->color = 0;
        palette[0] = 0;
        colors_count = 1;
        HASH_ADD_INT(hash, color, hc);

        /* Generate the rest of the palette */
        for (y = 0; y < height; y++) {
            for (x = 0; x < width; x++) {
                uint32_t color = quantize_color(*argb++, keepbits);
                HASH_FIND_INT(hash, &color, hc);
                if (hc == NULL) {
                    if (colors_count < 256)
                        palette[colors_count] = color;
                    hc = &colors_array[colors_count++];
                    hc->color = color;
                    HASH_ADD_INT(hash, color, hc);
                }
                cursor_image[y * 32 + x] = hc - colors_array;
            }
        }

        HASH_CLEAR(hh, hash);

        if (colors_count <= 256)
            break;
    }

    sunxi_hw_cursor_load_palette(disp, palette, colors_count);
    sunxi_hw_cursor_load_32x32x8bpp(disp, cursor_image);

    free(colors_array);
    free(cursor_image);
    free(palette);
}

SunxiDispHardwareCursor *SunxiDispHardwareCursor_Init(ScreenPtr pScreen)
{
    xf86CursorInfoPtr InfoPtr;
    SunxiDispHardwareCursor *private;
    ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
    sunxi_disp_t *disp = SUNXI_DISP(pScrn);

    if (!disp)
        return NULL;

    if (!(InfoPtr = xf86CreateCursorInfoRec())) {
        ErrorF("SunxiDispHardwareCursor_Init: xf86CreateCursorInfoRec() failed\n");
        return NULL;
    }

    InfoPtr->ShowCursor = ShowCursor;
    InfoPtr->HideCursor = HideCursor;
    InfoPtr->SetCursorPosition = SetCursorPosition;
    InfoPtr->SetCursorColors = SetCursorColors;
    InfoPtr->LoadCursorImage = LoadCursorImage;
    InfoPtr->MaxWidth = InfoPtr->MaxHeight = 64;
    InfoPtr->Flags = HARDWARE_CURSOR_TRUECOLOR_AT_8BPP |
                     HARDWARE_CURSOR_SOURCE_MASK_INTERLEAVE_1 |
                     HARDWARE_CURSOR_ARGB;

    InfoPtr->UseHWCursorARGB = UseHWCursorARGB;
    InfoPtr->LoadCursorARGB = LoadCursorARGB;

    if (!xf86InitCursor(pScreen, InfoPtr)) {
        ErrorF("SunxiDispHardwareCursor_Init: xf86InitCursor(pScreen, InfoPtr) failed\n");
        xf86DestroyCursorInfoRec(InfoPtr);
        return NULL;
    }

    private = calloc(1, sizeof(SunxiDispHardwareCursor));
    if (!private) {
        ErrorF("SunxiDispHardwareCursor_Init: calloc failed\n");
        xf86DestroyCursorInfoRec(InfoPtr);
        return NULL;
    }

    private->hwcursor = InfoPtr;
    return private;
}

void SunxiDispHardwareCursor_Close(ScreenPtr pScreen)
{
    ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
    SunxiDispHardwareCursor *private = SUNXI_DISP_HWC(pScrn);
    if (private) {
        xf86DestroyCursorInfoRec(private->hwcursor);
    }
}