src/bsp/lk/lib/tga/tga.c

/*
 * Copyright (c) 2008-2010 Travis Geiselbrecht
 *
 * 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 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.
 */

/**
 * @file
 * @brief  Parse tga format files
 *
 * @ingroup graphics
 */

#include <debug.h>
#include <trace.h>
#include <assert.h>
#include <compiler.h>
#include <lib/tga.h>

#define LOCAL_TRACE 0

struct tga_header {
    uint8_t  idlength;
    uint8_t  colormaptype;
    uint8_t  datatypecode;
    uint16_t colormaporigin;
    uint16_t colormaplength;
    uint8_t  colormapdepth;
    uint16_t x_origin;
    uint16_t y_origin;
    uint16_t width;
    uint16_t height;
    uint8_t  bitsperpixel;
    uint8_t  imagedescriptor;
} __PACKED;

static void print_tga_info(const struct tga_header *header)
{
    LTRACEF("idlength %hhd\n", header->idlength);
    LTRACEF("colormaptype %hhd\n", header->colormaptype);
    LTRACEF("datatypecode %hhd\n", header->datatypecode);
    LTRACEF("colormaporigin %hd\n", header->colormaporigin);
    LTRACEF("colormaplength %hd\n", header->colormaplength);
    LTRACEF("colormapdepth %hhd\n", header->colormapdepth);
    LTRACEF("x_origin %hd\n", header->x_origin);
    LTRACEF("y_origin %hd\n", header->y_origin);
    LTRACEF("width %hd\n", header->width);
    LTRACEF("height %hd\n", header->height);
    LTRACEF("bitsperpixel %hhd\n", header->bitsperpixel);
    LTRACEF("imagedescriptor %hhd\n", header->imagedescriptor);

}

static void decode_2byte(gfx_surface *surface, uint x, uint y, const void *input)
{
    const uint8_t *in = (const uint8_t *)input;

//  printf("in 0x%hhx 0x%hhx\n", in[0], in[1]);
    uint r,g,b;

    b = (in[0] & 0x1f) << 3;
    g = (((in[0] >> 5) & 0x7) | ((in[1] & 0x3) << 3)) << 3;
    r = ((in[1] >> 2) & 0x1f) << 3;

    gfx_putpixel(surface, x, y, 0xff000000 | r << 16 | g << 8 | b);
}

static void decode_3byte(gfx_surface *surface, uint x, uint y, const void *input)
{
    const uint8_t *in = (const uint8_t *)input;

//  printf("in 0x%hhx 0x%hhx\n", in[0], in[1]);

    gfx_putpixel(surface, x, y, 0xff000000 | in[2] << 16 | in[1] << 8 | in[0]);
}

static void decode_4byte(gfx_surface *surface, uint x, uint y, const void *input)
{
    const uint8_t *in = (const uint8_t *)input;

//  printf("in 0x%hhx 0x%hhx 0x%hhx 0x%hhx\n", in[0], in[1], in[2], in[3]);

    if (in[3] == 0)
        gfx_putpixel(surface, x, y, 0);
    else
        gfx_putpixel(surface, x, y, in[3] << 24 | in[2] << 16 | in[1] << 8 | in[0]);
}

/**
 * @brief  Decode a tga image
 *
 * @param  ptr  Pointer to tga data in memory
 * @param  len  Length of tga data
 * @param  format  Desired format of returned graphics surface
 *
 * @return Graphics surface or NULL on error.
 *
 * @ingroup graphics
 */
gfx_surface *tga_decode(const void *ptr, size_t len, gfx_format format)
{
    const struct tga_header *header = (const struct tga_header *)ptr;

    LTRACEF("ptr %p, len %zu\n", ptr, len);

#if LOCAL_TRACE > 0
    print_tga_info(header);
#endif

    /* do some sanity checks */
    if (header->datatypecode != 2 && header->datatypecode != 10) {
        dprintf(INFO, "tga_decode: unknown data type %d\n", header->datatypecode);
        return NULL;
    }
    if (header->bitsperpixel != 16 && header->bitsperpixel != 24 && header->bitsperpixel != 32) {
        dprintf(INFO, "tga_decode: unsupported bits per pixel %d\n", header->bitsperpixel);
        return NULL;
    }
    if (header->colormaptype != 0) {
        dprintf(INFO, "tga_decode: has colormap, can't handle\n");
        return NULL;
    }

    const void *imagestart = ((const uint8_t *)ptr + sizeof(struct tga_header) + header->idlength);

    /* create a surface to hold the decoded bits */
    gfx_surface *surface = gfx_create_surface(NULL, header->width, header->height, header->width, format);
    DEBUG_ASSERT(surface);

    /* copy the bits out */
    void (*decodefunc)(gfx_surface *, uint x, uint y, const void *) = NULL;

    uint step = 1;
    if (header->bitsperpixel == 16) {
        step = 2;
        decodefunc = decode_2byte;
    } else if (header->bitsperpixel == 24) {
        step = 3;
        decodefunc = decode_3byte;
    } else if (header->bitsperpixel == 32) {
        step = 4;
        decodefunc = decode_4byte;
    }

    if (header->datatypecode == 2) {
        /* no RLE */
        uint pos = 0;
        uint x, y;
        uint surfacey;

        for (y = 0; y < header->height; y++) {

            if ((header->imagedescriptor & (1 << 5)) == 0)
                surfacey = (surface->height - 1) - y;
            else
                surfacey = y;

            for (x = 0; x < header->width; x++) {
                decodefunc(surface, x, surfacey, (const uint8_t *)imagestart + pos);
                pos += step;
            }
        }
    } else if (header->datatypecode == 10) {
        /* RLE compression */
        uint pos = 0;
        uint count = 0;
        uint x, y;

        x = 0;
        if ((header->imagedescriptor & (1 << 5)) == 0)
            y = header->height - 1;
        else
            y = 0;

        while (count < (uint)header->height * (uint)header->width) {
            uint runpos;

            uint8_t run = *((const uint8_t *)imagestart + pos);
            bool repeat_run = (run & 0x80);
            uint runlen = (run & 0x7f) + 1;

//          printf("pos 0x%x count %u run 0x%hhx runtype %d runlen %u\n", pos, count, run, run & 0x80, runlen);

            /* consume the run byte */
            pos++;

            /* start of a run */
            for (runpos = 0; runpos < runlen; runpos++) {
                decodefunc(surface, x, y, (const uint8_t *)imagestart + pos);
                count++;

                x++;
                if (x == surface->width) {
                    if ((header->imagedescriptor & (1 << 5)) == 0)
                        y--;
                    else
                        y++;
                    x = 0;
                }

                /* if a run of raw pixels, consume an input pixel */
                if (!repeat_run)
                    pos += step;
            }
            /* if this was a run of repeated pixels, consume the one input pixel we repeated */
            if (repeat_run)
                pos += step;

        }
//      printf("done with RLE: x %d, y %d, pos %d, count %d\n", x, y, pos, count);
    }

    return surface;
}