circuitpython/shared-module/_pixelbuf/PixelBuf.c

/*
 * This file is part of the Circuit Python project, https://github.com/adafruit/circuitpython
 *
 * The MIT License (MIT)
 *
 * Copyright (c) 2018 Roy Hooper
 *
 * 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.
 */


#include "py/obj.h"
#include "py/objarray.h"
#include "py/runtime.h"
#include "PixelBuf.h"
#include <string.h>

void pixelbuf_set_pixel_int(uint8_t *buf, mp_int_t value, pixelbuf_byteorder_details_t *byteorder) {
    buf[byteorder->byteorder.r] = value >> 16 & 0xff;
    buf[byteorder->byteorder.g] = (value >> 8) & 0xff;
    buf[byteorder->byteorder.b] = value & 0xff;
    if (byteorder->bpp == 4 && byteorder->has_white && 
            (buf[byteorder->byteorder.r] == buf[byteorder->byteorder.g] && 
                buf[byteorder->byteorder.r] == buf[byteorder->byteorder.b])) {
        buf[byteorder->byteorder.w] = buf[byteorder->byteorder.r];
        buf[byteorder->byteorder.r] = buf[byteorder->byteorder.g] = buf[byteorder->byteorder.b] = 0;
    }
}

void pixelbuf_set_pixel(uint8_t *buf, uint8_t *rawbuf, float brightness, mp_obj_t *item, pixelbuf_byteorder_details_t *byteorder, bool dotstar) {
    if (MP_OBJ_IS_INT(item)) {
        uint8_t *target = rawbuf ? rawbuf : buf;
        pixelbuf_set_pixel_int(target, mp_obj_get_int_truncated(item), byteorder);
         if (dotstar) {
            buf[0] = DOTSTAR_LED_START_FULL_BRIGHT;
            if (rawbuf) 
                rawbuf[0] = DOTSTAR_LED_START_FULL_BRIGHT;
         }
        if (rawbuf) {
            buf[byteorder->byteorder.r] = rawbuf[byteorder->byteorder.r] * brightness;
            buf[byteorder->byteorder.g] = rawbuf[byteorder->byteorder.g] * brightness;
            buf[byteorder->byteorder.b] = rawbuf[byteorder->byteorder.b] * brightness;
        } else {
            buf[byteorder->byteorder.r] *= brightness;
            buf[byteorder->byteorder.g] *= brightness;
            buf[byteorder->byteorder.b] *= brightness;
        }
    } else {
        mp_obj_t *items;
        size_t len;
        mp_obj_get_array(item, &len, &items);
        if (len != byteorder->bpp && !dotstar) 
            mp_raise_ValueError_varg(translate("Expected tuple of length %d, got %d"), byteorder->bpp, len);

        buf[byteorder->byteorder.r] = mp_obj_get_int_truncated(items[PIXEL_R]) * brightness;
        buf[byteorder->byteorder.g] = mp_obj_get_int_truncated(items[PIXEL_G]) * brightness;
        buf[byteorder->byteorder.b] = mp_obj_get_int_truncated(items[PIXEL_B]) * brightness;
        if (rawbuf) {
            rawbuf[byteorder->byteorder.r] = mp_obj_get_int_truncated(items[PIXEL_R]);
            rawbuf[byteorder->byteorder.g] = mp_obj_get_int_truncated(items[PIXEL_G]);
            rawbuf[byteorder->byteorder.b] = mp_obj_get_int_truncated(items[PIXEL_B]);
        }
        if (len > 3) {
            if (dotstar) {
                buf[byteorder->byteorder.w] = DOTSTAR_LED_START | DOTSTAR_BRIGHTNESS(mp_obj_get_float(items[PIXEL_W]));
                if (rawbuf)
                    rawbuf[byteorder->byteorder.w] = buf[byteorder->byteorder.w];
            } else {
                buf[byteorder->byteorder.w] = mp_obj_get_int_truncated(items[PIXEL_W]) * brightness;
                if (rawbuf)
                    rawbuf[byteorder->byteorder.w] = mp_obj_get_int_truncated(items[PIXEL_W]);
            }
        } else if (dotstar) {
            buf[byteorder->byteorder.w] = DOTSTAR_LED_START_FULL_BRIGHT;
            if (rawbuf)
                rawbuf[byteorder->byteorder.w] = DOTSTAR_LED_START_FULL_BRIGHT;
        }
    }
}

mp_obj_t *pixelbuf_get_pixel_array(uint8_t *buf, uint len, pixelbuf_byteorder_details_t *byteorder, uint8_t step, bool dotstar) {
    mp_obj_t elems[len];
    for (uint i = 0; i < len; i++) {
        elems[i] = pixelbuf_get_pixel(buf + (i * step), byteorder, dotstar);
    }
    return mp_obj_new_tuple(len, elems);
}

mp_obj_t *pixelbuf_get_pixel(uint8_t *buf, pixelbuf_byteorder_details_t *byteorder, bool dotstar) {
    mp_obj_t elems[byteorder->bpp];
   
    elems[0] = mp_obj_new_int(buf[byteorder->byteorder.r]);
    elems[1] = mp_obj_new_int(buf[byteorder->byteorder.g]);
    elems[2] = mp_obj_new_int(buf[byteorder->byteorder.b]);
    if (byteorder->bpp > 3)
    {
        if (dotstar)
            elems[3] = mp_obj_new_float(DOTSTAR_GET_BRIGHTNESS(buf[byteorder->byteorder.w]));
        else
            elems[3] = mp_obj_new_int(buf[byteorder->byteorder.w]);
    }

    return mp_obj_new_tuple(byteorder->bpp, elems);
}