mirror of
https://github.com/pocketpy/pocketpy
synced 2026-05-21 01:23:37 +00:00
338 lines
13 KiB
C
338 lines
13 KiB
C
#include "pocketpy.h"
|
|
#include <stdio.h>
|
|
|
|
#define CUTE_PNG_IMPLEMENTATION
|
|
#include "cute_png.h"
|
|
|
|
#if PY_SYS_PLATFORM == 5
|
|
#include <unistd.h>
|
|
#include <fcntl.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/mman.h>
|
|
#include <linux/fb.h>
|
|
#endif
|
|
|
|
static bool cute_png_loads(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(1);
|
|
PY_CHECK_ARG_TYPE(0, tp_bytes);
|
|
int size;
|
|
unsigned char* data = py_tobytes(argv, &size);
|
|
cp_image_t image = cp_load_png_mem(data, size);
|
|
if(image.pix == NULL) return ValueError("cp_load_png_mem() failed");
|
|
py_newarray2d(py_retval(), image.w, image.h);
|
|
for(int y = 0; y < image.h; y++) {
|
|
for(int x = 0; x < image.w; x++) {
|
|
cp_pixel_t pixel = image.pix[y * image.w + x];
|
|
py_ObjectRef slot = py_array2d_getitem(py_retval(), x, y);
|
|
c11_color32 color;
|
|
color.r = pixel.r;
|
|
color.g = pixel.g;
|
|
color.b = pixel.b;
|
|
color.a = pixel.a;
|
|
py_newcolor32(slot, color);
|
|
}
|
|
}
|
|
cp_free_png(&image);
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_dumps(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(1);
|
|
PY_CHECK_ARG_TYPE(0, tp_array2d);
|
|
int width = py_array2d_getwidth(argv);
|
|
int height = py_array2d_getheight(argv);
|
|
cp_image_t image = cp_load_blank(width, height);
|
|
for(int y = 0; y < height; y++) {
|
|
for(int x = 0; x < width; x++) {
|
|
py_ObjectRef slot = py_array2d_getitem(argv, x, y);
|
|
if(!py_checktype(slot, tp_color32)) return false;
|
|
c11_color32 color = py_tocolor32(slot);
|
|
cp_pixel_t pixel = cp_make_pixel_a(color.r, color.g, color.b, color.a);
|
|
image.pix[y * width + x] = pixel;
|
|
}
|
|
}
|
|
cp_saved_png_t saved_image = cp_save_png_to_memory(&image);
|
|
assert(saved_image.data != NULL);
|
|
unsigned char* data = py_newbytes(py_retval(), saved_image.size);
|
|
memcpy(data, saved_image.data, saved_image.size);
|
|
CUTE_PNG_FREE(saved_image.data);
|
|
cp_free_png(&image);
|
|
return true;
|
|
}
|
|
|
|
static void cute_png_Image__dtor(void* ud) {
|
|
cp_image_t* image = (cp_image_t*)ud;
|
|
cp_free_png(image);
|
|
}
|
|
|
|
static bool cute_png_Image__new__(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(3);
|
|
PY_CHECK_ARG_TYPE(1, tp_int);
|
|
PY_CHECK_ARG_TYPE(2, tp_int);
|
|
int width = py_toint(py_arg(1));
|
|
int height = py_toint(py_arg(2));
|
|
cp_image_t* ud = py_newobject(py_retval(), py_totype(argv), 0, sizeof(cp_image_t));
|
|
*ud = cp_load_blank(width, height);
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__from_bytes_STATIC(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(1);
|
|
PY_CHECK_ARG_TYPE(0, tp_bytes);
|
|
int size;
|
|
unsigned char* data = py_tobytes(argv, &size);
|
|
cp_image_t image = cp_load_png_mem(data, size);
|
|
if(image.pix == NULL) return ValueError("cp_load_png_mem() failed");
|
|
cp_image_t* ud =
|
|
py_newobject(py_retval(), py_gettype("cute_png", py_name("Image")), 0, sizeof(cp_image_t));
|
|
*ud = image;
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__from_file_STATIC(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(1);
|
|
PY_CHECK_ARG_TYPE(0, tp_str);
|
|
const char* path = py_tostr(argv);
|
|
cp_image_t image = cp_load_png(path);
|
|
if(image.pix == NULL) return ValueError("cp_load_png() failed");
|
|
cp_image_t* ud =
|
|
py_newobject(py_retval(), py_gettype("cute_png", py_name("Image")), 0, sizeof(cp_image_t));
|
|
*ud = image;
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__width(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(1);
|
|
cp_image_t* image = py_touserdata(argv);
|
|
py_newint(py_retval(), image->w);
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__height(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(1);
|
|
cp_image_t* image = py_touserdata(argv);
|
|
py_newint(py_retval(), image->h);
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__setpixel(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(4);
|
|
cp_image_t* image = py_touserdata(argv);
|
|
PY_CHECK_ARG_TYPE(1, tp_int);
|
|
PY_CHECK_ARG_TYPE(2, tp_int);
|
|
PY_CHECK_ARG_TYPE(3, tp_color32);
|
|
int x = py_toint(py_arg(1));
|
|
int y = py_toint(py_arg(2));
|
|
c11_color32 color = py_tocolor32(py_arg(3));
|
|
if(x < 0 || x >= image->w || y < 0 || y >= image->h) {
|
|
return IndexError("cute_png.Image: index out of range");
|
|
}
|
|
cp_pixel_t pixel = cp_make_pixel_a(color.r, color.g, color.b, color.a);
|
|
image->pix[y * image->w + x] = pixel;
|
|
py_newnone(py_retval());
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__getpixel(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(3);
|
|
cp_image_t* image = py_touserdata(argv);
|
|
PY_CHECK_ARG_TYPE(1, tp_int);
|
|
PY_CHECK_ARG_TYPE(2, tp_int);
|
|
int x = py_toint(py_arg(1));
|
|
int y = py_toint(py_arg(2));
|
|
if(x < 0 || x >= image->w || y < 0 || y >= image->h) {
|
|
return IndexError("cute_png.Image: index out of range");
|
|
}
|
|
cp_pixel_t pixel = image->pix[y * image->w + x];
|
|
c11_color32 color;
|
|
color.r = pixel.r;
|
|
color.g = pixel.g;
|
|
color.b = pixel.b;
|
|
color.a = pixel.a;
|
|
py_newcolor32(py_retval(), color);
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__clear(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(2);
|
|
cp_image_t* image = py_touserdata(argv);
|
|
PY_CHECK_ARG_TYPE(1, tp_color32);
|
|
c11_color32 color = py_tocolor32(py_arg(1));
|
|
cp_pixel_t pixel = cp_make_pixel_a(color.r, color.g, color.b, color.a);
|
|
for(int y = 0; y < image->h; y++) {
|
|
for(int x = 0; x < image->w; x++) {
|
|
image->pix[y * image->w + x] = pixel;
|
|
}
|
|
}
|
|
py_newnone(py_retval());
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__to_png_bytes(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(1);
|
|
cp_image_t* image = py_touserdata(argv);
|
|
cp_saved_png_t saved_image = cp_save_png_to_memory(image);
|
|
assert(saved_image.data != NULL);
|
|
unsigned char* data = py_newbytes(py_retval(), saved_image.size);
|
|
memcpy(data, saved_image.data, saved_image.size);
|
|
CUTE_PNG_FREE(saved_image.data);
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__to_png_file(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(2);
|
|
PY_CHECK_ARG_TYPE(1, tp_str);
|
|
cp_image_t* image = py_touserdata(argv);
|
|
const char* path = py_tostr(py_arg(1));
|
|
FILE* fp = fopen(path, "wb");
|
|
if(fp == NULL) return OSError("cannot open file '%s' for writing", path);
|
|
cp_saved_png_t saved_image = cp_save_png_to_memory(image);
|
|
assert(saved_image.data != NULL);
|
|
size_t size = fwrite(saved_image.data, saved_image.size, 1, fp);
|
|
CUTE_PNG_FREE(saved_image.data);
|
|
fclose(fp);
|
|
py_newint(py_retval(), size);
|
|
return true;
|
|
}
|
|
|
|
static bool cute_png_Image__to_rgb565_file(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(2);
|
|
PY_CHECK_ARG_TYPE(1, tp_str);
|
|
cp_image_t* image = py_touserdata(argv);
|
|
const char* path = py_tostr(py_arg(1));
|
|
|
|
#define CONVERT_TO_RGB565(__block) \
|
|
size_t size = 0; \
|
|
for(int y = 0; y < image->h; y++) { \
|
|
for(int x = 0; x < image->w; x++) { \
|
|
size_t idx = y * image->w + x; \
|
|
cp_pixel_t pixel = image->pix[idx]; \
|
|
uint16_t r = (pixel.r >> 3) & 0x1F; \
|
|
uint16_t g = (pixel.g >> 2) & 0x3F; \
|
|
uint16_t b = (pixel.b >> 3) & 0x1F; \
|
|
uint16_t rgb565 = (r << 11) | (g << 5) | b; \
|
|
__block \
|
|
} \
|
|
}
|
|
|
|
#if PY_SYS_PLATFORM == 5
|
|
if(strcmp(path, "/dev/fb0") == 0) {
|
|
static struct fb_fix_screeninfo finfo;
|
|
static uint8_t* vmem_base;
|
|
if(vmem_base == NULL) {
|
|
int fbdev_fd = open(path, O_RDWR);
|
|
if(fbdev_fd < 0) return OSError("open() '/dev/fb0' failed");
|
|
fcntl(fbdev_fd, F_SETFD, fcntl(fbdev_fd, F_GETFD) | FD_CLOEXEC);
|
|
if(ioctl(fbdev_fd, FBIOGET_FSCREENINFO, &finfo) < 0) {
|
|
close(fbdev_fd);
|
|
return OSError("ioctl() '/dev/fb0' failed");
|
|
}
|
|
vmem_base = mmap(0, finfo.smem_len, PROT_READ | PROT_WRITE, MAP_SHARED, fbdev_fd, 0);
|
|
if(vmem_base == MAP_FAILED) {
|
|
vmem_base = NULL;
|
|
close(fbdev_fd);
|
|
return OSError("mmap() '/dev/fb0' failed");
|
|
}
|
|
close(fbdev_fd);
|
|
}
|
|
CONVERT_TO_RGB565(
|
|
// use little endian
|
|
if(size + 2 > finfo.smem_len) {
|
|
py_newint(py_retval(), size);
|
|
return true;
|
|
} memcpy(vmem_base + size, &rgb565, 2);
|
|
size += 2;)
|
|
py_newint(py_retval(), size);
|
|
return true;
|
|
}
|
|
#endif
|
|
|
|
FILE* fp = fopen(path, "wb");
|
|
if(fp == NULL) return OSError("cannot open file '%s' for writing", path);
|
|
CONVERT_TO_RGB565(
|
|
// use little endian
|
|
size += fwrite(&rgb565, 1, 2, fp);)
|
|
fclose(fp);
|
|
py_newint(py_retval(), size);
|
|
return true;
|
|
#undef CONVERT_TO_RGB565
|
|
}
|
|
|
|
static bool cute_png_Image__paste(int argc, py_Ref argv) {
|
|
PY_CHECK_ARGC(8);
|
|
PY_CHECK_ARG_TYPE(1, py_gettype("cute_png", py_name("Image"))); // src_img
|
|
PY_CHECK_ARG_TYPE(2, tp_vec2i); // src_pos
|
|
PY_CHECK_ARG_TYPE(3, tp_vec2i); // dst_pos
|
|
PY_CHECK_ARG_TYPE(4, tp_int); // width
|
|
PY_CHECK_ARG_TYPE(5, tp_int); // height
|
|
PY_CHECK_ARG_TYPE(6, tp_color32); // fg
|
|
PY_CHECK_ARG_TYPE(7, tp_color32); // bg
|
|
|
|
cp_image_t* dst_image = py_touserdata(argv);
|
|
cp_image_t* src_image = py_touserdata(py_arg(1));
|
|
c11_vec2i src_pos = py_tovec2i(py_arg(2));
|
|
c11_vec2i dst_pos = py_tovec2i(py_arg(3));
|
|
int width = py_toint(py_arg(4));
|
|
int height = py_toint(py_arg(5));
|
|
c11_color32 fg = py_tocolor32(py_arg(6));
|
|
c11_color32 bg = py_tocolor32(py_arg(7));
|
|
|
|
for(int y = 0; y < height; y++) {
|
|
for(int x = 0; x < width; x++) {
|
|
int src_x = src_pos.x + x;
|
|
int src_y = src_pos.y + y;
|
|
int dst_x = dst_pos.x + x;
|
|
int dst_y = dst_pos.y + y;
|
|
|
|
if(src_x >= src_image->w || src_y >= src_image->h) continue;
|
|
if(dst_x >= dst_image->w || dst_y >= dst_image->h) continue;
|
|
|
|
// fill with bg color first
|
|
cp_pixel_t dst_pixel = cp_make_pixel_a(bg.r, bg.g, bg.b, 255);
|
|
|
|
// override with fg * src_pixel
|
|
cp_pixel_t src_pixel = src_image->pix[src_y * src_image->w + src_x];
|
|
src_pixel.r = (src_pixel.r * (int)fg.r) / 255;
|
|
src_pixel.g = (src_pixel.g * (int)fg.g) / 255;
|
|
src_pixel.b = (src_pixel.b * (int)fg.b) / 255;
|
|
|
|
// alpha blend
|
|
if(src_pixel.a > 0) {
|
|
float alpha = src_pixel.a / 255.0f;
|
|
dst_pixel.r = (uint8_t)(src_pixel.r * alpha + dst_pixel.r * (1.0f - alpha));
|
|
dst_pixel.g = (uint8_t)(src_pixel.g * alpha + dst_pixel.g * (1.0f - alpha));
|
|
dst_pixel.b = (uint8_t)(src_pixel.b * alpha + dst_pixel.b * (1.0f - alpha));
|
|
}
|
|
|
|
dst_image->pix[dst_y * dst_image->w + dst_x] = dst_pixel;
|
|
}
|
|
}
|
|
py_newnone(py_retval());
|
|
return true;
|
|
}
|
|
|
|
void pk__add_module_cute_png() {
|
|
py_GlobalRef mod = py_newmodule("cute_png");
|
|
py_Type tp_image = py_newtype("Image", tp_object, mod, cute_png_Image__dtor);
|
|
py_tpsetfinal(tp_image);
|
|
|
|
py_bindfunc(mod, "loads", cute_png_loads);
|
|
py_bindfunc(mod, "dumps", cute_png_dumps);
|
|
|
|
py_bindmethod(tp_image, "__new__", cute_png_Image__new__);
|
|
py_bindstaticmethod(tp_image, "from_bytes", cute_png_Image__from_bytes_STATIC);
|
|
py_bindstaticmethod(tp_image, "from_file", cute_png_Image__from_file_STATIC);
|
|
|
|
py_bindproperty(tp_image, "width", cute_png_Image__width, NULL);
|
|
py_bindproperty(tp_image, "height", cute_png_Image__height, NULL);
|
|
|
|
py_bindmethod(tp_image, "setpixel", cute_png_Image__setpixel);
|
|
py_bindmethod(tp_image, "getpixel", cute_png_Image__getpixel);
|
|
py_bindmethod(tp_image, "clear", cute_png_Image__clear);
|
|
|
|
py_bindmethod(tp_image, "paste", cute_png_Image__paste);
|
|
|
|
py_bindmethod(tp_image, "to_png_bytes", cute_png_Image__to_png_bytes);
|
|
py_bindmethod(tp_image, "to_png_file", cute_png_Image__to_png_file);
|
|
py_bindmethod(tp_image, "to_rgb565_file", cute_png_Image__to_rgb565_file);
|
|
} |