Complete batch 20261016-C-embedded-2: 45 verified GLM/Pi samples, independent regrades and archives; preserve difficulty misses and Salty blockage.
121 lines
2.9 KiB
C
121 lines
2.9 KiB
C
#include "image.h"
|
|
#include <string.h>
|
|
|
|
static void remove_prefix(ImageStream *stream, size_t count)
|
|
{
|
|
if (count >= stream->used) {
|
|
stream->used = 0;
|
|
return;
|
|
}
|
|
memmove(stream->bytes, stream->bytes + count, stream->used - count);
|
|
stream->used -= count;
|
|
}
|
|
|
|
static size_t find_magic(const ImageStream *stream)
|
|
{
|
|
for (size_t index = 0; index + 4 <= stream->used; ++index) {
|
|
if (codec_magic(stream->bytes + index, stream->used - index)) {
|
|
return index;
|
|
}
|
|
}
|
|
return stream->used;
|
|
}
|
|
|
|
static int preserve_prefix(ImageStream *stream)
|
|
{
|
|
size_t start = find_magic(stream);
|
|
if (start == stream->used) {
|
|
size_t keep = codec_magic_suffix(stream->bytes, stream->used);
|
|
remove_prefix(stream, stream->used - keep);
|
|
return 0;
|
|
}
|
|
if (start > 0) {
|
|
remove_prefix(stream, start);
|
|
}
|
|
return 1;
|
|
}
|
|
|
|
static int prefix_dimensions(const ImageStream *stream, size_t *total)
|
|
{
|
|
const uint8_t *bytes = stream->bytes;
|
|
if (stream->used < IMAGE_HEADER_MIN) {
|
|
return 0;
|
|
}
|
|
ImageHeader header;
|
|
if (!image_read_header(bytes, stream->used, &header)) {
|
|
return -1;
|
|
}
|
|
*total = header.total_size;
|
|
return 1;
|
|
}
|
|
|
|
static void process_available(ImageStream *stream)
|
|
{
|
|
for (;;) {
|
|
if (!preserve_prefix(stream)) {
|
|
return;
|
|
}
|
|
size_t total = 0;
|
|
int dimensions = prefix_dimensions(stream, &total);
|
|
if (dimensions == 0) {
|
|
return;
|
|
}
|
|
if (dimensions < 0) {
|
|
remove_prefix(stream, 1);
|
|
continue;
|
|
}
|
|
if (stream->used < total) {
|
|
return;
|
|
}
|
|
ImageView view;
|
|
if (!image_validate(stream->bytes, total, stream->board,
|
|
stream->floor, &view)) {
|
|
remove_prefix(stream, 1);
|
|
continue;
|
|
}
|
|
if (stream->sink != NULL) {
|
|
stream->sink(stream->opaque, &view);
|
|
}
|
|
++stream->accepted;
|
|
remove_prefix(stream, total);
|
|
}
|
|
}
|
|
|
|
void image_init(ImageStream *stream, uint16_t board, uint32_t floor,
|
|
image_sink sink, void *opaque)
|
|
{
|
|
memset(stream, 0, sizeof(*stream));
|
|
stream->board = board;
|
|
stream->floor = floor;
|
|
stream->sink = sink;
|
|
stream->opaque = opaque;
|
|
}
|
|
|
|
void image_reset(ImageStream *stream, uint32_t floor)
|
|
{
|
|
stream->used = 0;
|
|
stream->floor = floor;
|
|
}
|
|
|
|
void image_feed(ImageStream *stream, const uint8_t *bytes, size_t count)
|
|
{
|
|
for (size_t index = 0; index < count; ++index) {
|
|
if (stream->used == sizeof(stream->bytes)) {
|
|
remove_prefix(stream, 1);
|
|
}
|
|
stream->bytes[stream->used] = bytes[index];
|
|
++stream->used;
|
|
process_available(stream);
|
|
}
|
|
}
|
|
|
|
size_t image_pending(const ImageStream *stream)
|
|
{
|
|
return stream->used;
|
|
}
|
|
|
|
uint64_t image_accepted(const ImageStream *stream)
|
|
{
|
|
return stream->accepted;
|
|
}
|