mirror of
https://github.com/ByteWelder/Tactility.git
synced 2026-08-18 16:05:05 +00:00
43 lines
1.6 KiB
C++
43 lines
1.6 KiB
C++
// SPDX-License-Identifier: Apache-2.0
|
|
#include <soc/soc_caps.h>
|
|
#if SOC_LCD_RGB_SUPPORTED
|
|
|
|
#include <drivers/software_pixel_mapper.h>
|
|
|
|
#include <esp_heap_caps.h>
|
|
|
|
// RGB332 packs each pixel into one byte: 3 bits red, 3 bits green, 2 bits blue. The byte layout
|
|
// maps straight onto an 8-data-line panel's significant color inputs (R7..R5, G7..G5, B7..B6),
|
|
// so each RGB565 channel's top bits land on the corresponding MSB lines
|
|
static void rgb332_map(SoftwarePixelMapperData data, const uint16_t* src, uint8_t* dst, uint32_t pixel_count) {
|
|
(void)data;
|
|
for (uint32_t i = 0; i < pixel_count; i++) {
|
|
uint16_t px = src[i];
|
|
dst[i] = (uint8_t)(((px >> 13) & 0x07) << 5) | (((px >> 8) & 0x07) << 2) | ((px >> 3) & 0x03);
|
|
}
|
|
}
|
|
|
|
// The destination buffer must hold a whole frame (1 byte/pixel for RGB332). A 1024x600 panel
|
|
// needs ~600KB, which only fits in PSRAM on most boards, prefer SPIRAM and fall back to whatever
|
|
// internal RAM is available. The returned handle is this buffer, passed back as map()'s dst.
|
|
static SoftwarePixelMapperData rgb332_create(uint16_t width, uint16_t height) {
|
|
size_t buffer_size = (size_t)width * height;
|
|
void* buffer = heap_caps_malloc(buffer_size, MALLOC_CAP_SPIRAM | MALLOC_CAP_8BIT);
|
|
if (buffer == nullptr) {
|
|
buffer = heap_caps_malloc(buffer_size, MALLOC_CAP_DEFAULT);
|
|
}
|
|
return buffer;
|
|
}
|
|
|
|
static void rgb332_destroy(SoftwarePixelMapperData data) {
|
|
heap_caps_free(data);
|
|
}
|
|
|
|
const struct SoftwarePixelMapper software_pixel_mapper_rgb332 = {
|
|
.create = rgb332_create,
|
|
.map = rgb332_map,
|
|
.destroy = rgb332_destroy,
|
|
};
|
|
|
|
#endif // SOC_LCD_RGB_SUPPORTED
|