321 lines
11 KiB
C
321 lines
11 KiB
C
/* RetroArch - A frontend for libretro.
|
|
* Copyright (C) 2010-2014 - Hans-Kristian Arntzen
|
|
*
|
|
* RetroArch is free software: you can redistribute it and/or modify it under the terms
|
|
* of the GNU General Public License as published by the Free Software Found-
|
|
* ation, either version 3 of the License, or (at your option) any later version.
|
|
*
|
|
* RetroArch is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY;
|
|
* without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
|
|
* PURPOSE. See the GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with RetroArch.
|
|
* If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
// Compile: gcc -o supertwoxsai.so -shared supertwoxsai.c -std=c99 -O3 -Wall -pedantic -fPIC
|
|
|
|
#include "softfilter.h"
|
|
#include <stdlib.h>
|
|
|
|
#ifdef RARCH_INTERNAL
|
|
#define softfilter_get_implementation supertwoxsai_get_implementation
|
|
#endif
|
|
|
|
#define SUPERTWOXSAI_SCALE 2
|
|
|
|
static unsigned supertwoxsai_generic_input_fmts(void)
|
|
{
|
|
return SOFTFILTER_FMT_RGB565;
|
|
}
|
|
|
|
static unsigned supertwoxsai_generic_output_fmts(unsigned input_fmts)
|
|
{
|
|
return input_fmts;
|
|
}
|
|
|
|
static unsigned supertwoxsai_generic_threads(void *data)
|
|
{
|
|
struct filter_data *filt = (struct filter_data*)data;
|
|
return filt->threads;
|
|
}
|
|
|
|
static void *supertwoxsai_generic_create(unsigned in_fmt, unsigned out_fmt,
|
|
unsigned max_width, unsigned max_height,
|
|
unsigned threads, softfilter_simd_mask_t simd)
|
|
{
|
|
(void)simd;
|
|
|
|
struct filter_data *filt = (struct filter_data*)calloc(1, sizeof(*filt));
|
|
if (!filt)
|
|
return NULL;
|
|
filt->workers = (struct softfilter_thread_data*)calloc(threads, sizeof(struct softfilter_thread_data));
|
|
filt->threads = threads;
|
|
filt->in_fmt = in_fmt;
|
|
if (!filt->workers)
|
|
{
|
|
free(filt);
|
|
return NULL;
|
|
}
|
|
return filt;
|
|
}
|
|
|
|
static void supertwoxsai_generic_output(void *data, unsigned *out_width, unsigned *out_height,
|
|
unsigned width, unsigned height)
|
|
{
|
|
*out_width = width * SUPERTWOXSAI_SCALE;
|
|
*out_height = height * SUPERTWOXSAI_SCALE;
|
|
}
|
|
|
|
static void supertwoxsai_generic_destroy(void *data)
|
|
{
|
|
struct filter_data *filt = (struct filter_data*)data;
|
|
free(filt->workers);
|
|
free(filt);
|
|
}
|
|
|
|
#ifndef result1_body
|
|
#define result1_body(A, B, C, D, x, y) \
|
|
if (A == C) \
|
|
x += 1; \
|
|
else if (B == C) \
|
|
y += 1; \
|
|
if (A == D) \
|
|
x += 1; \
|
|
else if (B == D) \
|
|
y += 1; \
|
|
if (x <= 1) \
|
|
r += 1; \
|
|
if (y <= 1) \
|
|
r -= 1
|
|
#endif
|
|
|
|
#ifndef interpolate_body
|
|
#define interpolate_body(A, B, r, pack_color) \
|
|
A |= (A << 16); /* unpack */ \
|
|
A &= pack_color; \
|
|
B |= (B << 16); \
|
|
B &= pack_color; \
|
|
r = (A + B) >> 1; /* mix */ \
|
|
r &= pack_color /* repack */
|
|
#endif
|
|
|
|
#ifndef interpolate2_body
|
|
#define interpolate2_body(A, B, C, D, r, pack_color) \
|
|
A |= (A << 16); /* unpack */ \
|
|
A &= pack_color; \
|
|
B |= (B << 16); \
|
|
B &= pack_color; \
|
|
C |= (C << 16); \
|
|
C &= pack_color; \
|
|
D |= (D << 16); \
|
|
D &= pack_color; \
|
|
r = (A + B + C + D) >> 2; /* mix */ \
|
|
r &= pack_color /* repack */
|
|
#endif
|
|
|
|
static inline uint16_t supertwoxsai_interpolate_rgb565(uint32_t A, uint32_t B)
|
|
{
|
|
uint32_t r;
|
|
|
|
interpolate_body(A, B, r, 0x7e0f81f);
|
|
|
|
return (r | (r >> 16));
|
|
}
|
|
|
|
|
|
static inline uint16_t supertwoxsai_interpolate2_rgb565(uint32_t A, uint32_t B, uint32_t C, uint32_t D)
|
|
{
|
|
uint32_t r;
|
|
|
|
interpolate2_body(A, B, C, D, r, 0x7e0f81f);
|
|
|
|
return (r | (r >> 16));
|
|
}
|
|
|
|
static inline int supertwoxsai_result1_rgb565(uint16_t A, uint16_t B, uint16_t C, uint16_t D)
|
|
{
|
|
int x, y, r;
|
|
x = 0;
|
|
y = 0;
|
|
r = 0;
|
|
|
|
result1_body(A, B, C, D, x, y);
|
|
|
|
return r;
|
|
}
|
|
|
|
static void supertwoxsai_write2_rgb565(uint16_t *out, uint16_t val0, uint16_t val1)
|
|
{
|
|
*((uint32_t*)out) = ((uint32_t)(val0) | ((uint32_t)(val1) << 16));
|
|
}
|
|
|
|
#ifndef supertwoxsai_declare_variables
|
|
#define supertwoxsai_declare_variables(typename_t, in, nextline) \
|
|
typename_t product1a, product1b, product2a, product2b; \
|
|
const typename_t colorB0 = *(in - nextline - 1); \
|
|
const typename_t colorB1 = *(in - nextline + 0); \
|
|
const typename_t colorB2 = *(in - nextline + 1); \
|
|
const typename_t colorB3 = *(in - nextline + 2); \
|
|
const typename_t color4 = *(in - 1); \
|
|
const typename_t color5 = *(in + 0); \
|
|
const typename_t color6 = *(in + 1); \
|
|
const typename_t colorS2 = *(in + 2); \
|
|
const typename_t color1 = *(in + nextline - 1); \
|
|
const typename_t color2 = *(in + nextline + 0); \
|
|
const typename_t color3 = *(in + nextline + 1); \
|
|
const typename_t colorS1 = *(in + nextline + 2); \
|
|
const typename_t colorA0 = *(in + nextline + nextline - 1); \
|
|
const typename_t colorA1 = *(in + nextline + nextline + 0); \
|
|
const typename_t colorA2 = *(in + nextline + nextline + 1); \
|
|
const typename_t colorA3 = *(in + nextline + nextline + 2)
|
|
#endif
|
|
|
|
#ifndef supertwoxsai_function
|
|
#define supertwoxsai_function(result1_cb, interpolate_cb, interpolate2_cb, write2_cb) \
|
|
if (color2 == color6 && color5 != color3) \
|
|
product2b = product1b = color2; \
|
|
else if (color5 == color3 && color2 != color6) \
|
|
product2b = product1b = color5; \
|
|
else if (color5 == color3 && color2 == color6) \
|
|
{ \
|
|
int r = 0; \
|
|
r += result1_cb(color6, color5, color1, colorA1); \
|
|
r += result1_cb(color6, color5, color4, colorB1); \
|
|
r += result1_cb(color6, color5, colorA2, colorS1); \
|
|
r += result1_cb(color6, color5, colorB2, colorS2); \
|
|
if (r > 0) \
|
|
product2b = product1b = color6; \
|
|
else if (r < 0) \
|
|
product2b = product1b = color5; \
|
|
else \
|
|
product2b = product1b = interpolate_cb(color5, color6); \
|
|
} \
|
|
else \
|
|
{ \
|
|
if (color6 == color3 && color3 == colorA1 && color2 != colorA2 && color3 != colorA0) \
|
|
product2b = interpolate2_cb(color3, color3, color3, color2); \
|
|
else if ((color5 == color2 && color2 == colorA2) & (colorA1 != color3 && color2 != colorA3)) \
|
|
product2b = interpolate2_cb(color2, color2, color2, color3); \
|
|
else \
|
|
product2b = interpolate_cb(color2, color3); \
|
|
if (color6 == color3 && color6 == colorB1 && color5 != colorB2 && color6 != colorB0) \
|
|
product1b = interpolate2_cb(color6, color6, color6, color5); \
|
|
else if (color5 == color2 && color5 == colorB2 && colorB1 != color6 && color5 != colorB3) \
|
|
product1b = interpolate2_cb(color6, color5, color5, color5); \
|
|
else \
|
|
product1b = interpolate_cb(color5, color6); \
|
|
} \
|
|
if (color5 == color3 && color2 != color6 && color4 == color5 && color5 != colorA2) \
|
|
product2a = interpolate_cb(color2, color5); \
|
|
else if (color5 == color1 && color6 == color5 && color4 != color2 && color5 != colorA0) \
|
|
product2a = interpolate_cb(color2, color5); \
|
|
else \
|
|
product2a = color2; \
|
|
if (color2 == color6 && color5 != color3 && color1 == color2 && color2 != colorB2) \
|
|
product1a = interpolate_cb(color2, color5); \
|
|
else if (color4 == color2 && color3 == color2 && color1 != color5 && color2 != colorB0) \
|
|
product1a = interpolate_cb(color2, color5); \
|
|
else \
|
|
product1a = color5; \
|
|
write2_cb(out, product1a, product1b); \
|
|
write2_cb(out + dst_stride, product2a, product2b); \
|
|
++in; \
|
|
out += 2
|
|
#endif
|
|
|
|
static void supertwoxsai_generic_rgb565(unsigned width, unsigned height,
|
|
int first, int last, uint16_t *src,
|
|
unsigned src_stride, uint16_t *dst, unsigned dst_stride)
|
|
{
|
|
const unsigned nextline = (last) ? 0 : src_stride;
|
|
|
|
for (; height; height--)
|
|
{
|
|
uint16_t *in = (uint16_t*)src;
|
|
uint16_t *out = (uint16_t*)dst;
|
|
|
|
for (unsigned finish = width; finish; finish -= 1)
|
|
{
|
|
supertwoxsai_declare_variables(uint16_t, in, nextline);
|
|
|
|
//--------------------------- B1 B2
|
|
// 4 5 6 S2
|
|
// 1 2 3 S1
|
|
// A1 A2
|
|
//--------------------------------------
|
|
|
|
supertwoxsai_function(supertwoxsai_result1_rgb565, supertwoxsai_interpolate_rgb565, supertwoxsai_interpolate2_rgb565, supertwoxsai_write2_rgb565);
|
|
}
|
|
|
|
src += src_stride;
|
|
dst += 2 * dst_stride;
|
|
}
|
|
}
|
|
|
|
static void supertwoxsai_work_cb_rgb565(void *data, void *thread_data)
|
|
{
|
|
struct softfilter_thread_data *thr = (struct softfilter_thread_data*)thread_data;
|
|
uint16_t *input = (uint16_t*)thr->in_data;
|
|
uint16_t *output = (uint16_t*)thr->out_data;
|
|
unsigned width = thr->width;
|
|
unsigned height = thr->height;
|
|
|
|
supertwoxsai_generic_rgb565(width, height,
|
|
thr->first, thr->last, input, thr->in_pitch / SOFTFILTER_BPP_RGB565, output, thr->out_pitch / SOFTFILTER_BPP_RGB565);
|
|
}
|
|
|
|
static void supertwoxsai_generic_packets(void *data,
|
|
struct softfilter_work_packet *packets,
|
|
void *output, size_t output_stride,
|
|
const void *input, unsigned width, unsigned height, size_t input_stride)
|
|
{
|
|
struct filter_data *filt = (struct filter_data*)data;
|
|
unsigned i;
|
|
for (i = 0; i < filt->threads; i++)
|
|
{
|
|
struct softfilter_thread_data *thr = (struct softfilter_thread_data*)&filt->workers[i];
|
|
|
|
unsigned y_start = (height * i) / filt->threads;
|
|
unsigned y_end = (height * (i + 1)) / filt->threads;
|
|
thr->out_data = (uint8_t*)output + y_start * SUPERTWOXSAI_SCALE * output_stride;
|
|
thr->in_data = (const uint8_t*)input + y_start * input_stride;
|
|
thr->out_pitch = output_stride;
|
|
thr->in_pitch = input_stride;
|
|
thr->width = width;
|
|
thr->height = y_end - y_start;
|
|
|
|
// Workers need to know if they can access pixels outside their given buffer.
|
|
thr->first = y_start;
|
|
thr->last = y_end == height;
|
|
|
|
if (filt->in_fmt == SOFTFILTER_FMT_RGB565)
|
|
packets[i].work = supertwoxsai_work_cb_rgb565;
|
|
packets[i].thread_data = thr;
|
|
}
|
|
}
|
|
|
|
static const struct softfilter_implementation supertwoxsai_generic = {
|
|
supertwoxsai_generic_input_fmts,
|
|
supertwoxsai_generic_output_fmts,
|
|
|
|
supertwoxsai_generic_create,
|
|
supertwoxsai_generic_destroy,
|
|
|
|
supertwoxsai_generic_threads,
|
|
supertwoxsai_generic_output,
|
|
supertwoxsai_generic_packets,
|
|
"Super2xSaI",
|
|
SOFTFILTER_API_VERSION,
|
|
};
|
|
|
|
const struct softfilter_implementation *softfilter_get_implementation(softfilter_simd_mask_t simd)
|
|
{
|
|
(void)simd;
|
|
return &supertwoxsai_generic;
|
|
}
|
|
|
|
#ifdef RARCH_INTERNAL
|
|
#undef softfilter_get_implementation
|
|
#endif
|