gstreamer/ext/tarkin/wavelet_xform.c

422 lines
9.9 KiB
C
Raw Normal View History

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include "mem.h"
#include <assert.h>
#include "wavelet.h"
static void
fwd_analyze_1 (const TYPE * x, TYPE * d, int stride, int n)
{
int i, k = n / 2;
for (i = 0; i < k; i++)
d[i] = x[(2 * i + 1) * stride] - x[2 * i * stride];
}
static void
fwd_synthesize_1 (const TYPE * x, TYPE * s, const TYPE * d, int stride, int n)
{
int i, k = n / 2;
for (i = 0; i < k; i++)
s[i * stride] = x[2 * i * stride] + d[i] / 2;
if (n & 1)
s[k * stride] = x[2 * k * stride] + d[k - 1] / 2;
}
static void
inv_analyze_1 (TYPE * x, const TYPE * d, int stride, int n)
{
int i, k = n / 2;
for (i = 0; i < k; i++)
x[(2 * i + 1) * stride] = d[i] + x[2 * i * stride];
}
static void
inv_synthesize_1 (TYPE * x, const TYPE * s, const TYPE * d, int stride, int n)
{
int i, k = n / 2;
for (i = 0; i < k; i++)
x[2 * i * stride] = s[i] - d[i] / 2;
if (n & 1)
x[2 * k * stride] = s[k] - d[k - 1] / 2;
}
static void
fwd_analyze_2 (const TYPE * x, TYPE * d, int stride, int n)
{
int i, k = n / 2;
if (n & 1) {
for (i = 0; i < k; i++)
d[i] =
x[(2 * i + 1) * stride] - (x[2 * i * stride] + x[(2 * i +
2) * stride]) / 2;
} else {
for (i = 0; i < k - 1; i++)
d[i] =
x[(2 * i + 1) * stride] - (x[2 * i * stride] + x[(2 * i +
2) * stride]) / 2;
d[k - 1] = x[(n - 1) * stride] - x[(n - 2) * stride];
}
}
static void
fwd_synthesize_2 (const TYPE * x, TYPE * s, const TYPE * d, int stride, int n)
{
int i, k = n / 2;
s[0] = x[0] + d[1] / 2;
for (i = 1; i < k; i++)
s[i * stride] = x[2 * i * stride] + (d[i - 1] + d[i]) / 4;
if (n & 1)
s[k * stride] = x[2 * k * stride] + d[k - 1] / 2;
}
static inline void
inv_analyze_2 (TYPE * x, const TYPE * d, int stride, int n)
{
int i, k = n / 2;
if (n & 1) {
for (i = 0; i < k; i++)
x[(2 * i + 1) * stride] =
d[i] + (x[2 * i * stride] + x[(2 * i + 2) * stride]) / 2;
} else {
for (i = 0; i < k - 1; i++)
x[(2 * i + 1) * stride] =
d[i] + (x[2 * i * stride] + x[(2 * i + 2) * stride]) / 2;
x[(n - 1) * stride] = d[k - 1] + x[(n - 2) * stride];
}
}
static inline void
inv_synthesize_2 (TYPE * x, const TYPE * s, const TYPE * d, int stride, int n)
{
int i, k = n / 2;
x[0] = s[0] - d[1] / 2;
for (i = 1; i < k; i++)
x[2 * i * stride] = s[i] - (d[i - 1] + d[i]) / 4;
if (n & 1)
x[2 * k * stride] = s[k] - d[k - 1] / 2;
}
static void
fwd_analyze_4 (const TYPE * x, TYPE * d, int stride, int n)
{
int i, k = n / 2;
d[0] = x[stride] - (x[0] + x[2 * stride]) / 2;
if (n & 1) {
for (i = 1; i < k - 1; i++)
d[i] = x[(2 * i + 1) * stride]
- ((uint32_t) 9 * (x[2 * i * stride] + x[(2 * i + 2) * stride])
- (x[(2 * i - 2) * stride] + x[(2 * i + 4) * stride])) / 16;
if (k > 1)
d[k - 1] =
x[(2 * k - 1) * stride] - (x[(2 * k - 2) * stride] +
x[2 * k * stride]) / 2;
} else {
for (i = 1; i < k - 2; i++)
d[i] = x[(2 * i + 1) * stride]
- ((uint32_t) 9 * (x[2 * i * stride] + x[(2 * i + 2) * stride])
- (x[(2 * i - 2) * stride] + x[(2 * i + 4) * stride])) / 16;
if (k > 2)
d[k - 2] = x[(2 * k - 3) * stride] - (x[(2 * k - 4) * stride]
+ x[(2 * k - 2) * stride]) / 2;
if (k > 1)
d[k - 1] = x[(n - 1) * stride] - x[(n - 2) * stride];
}
}
static void
fwd_synthesize_4 (const TYPE * x, TYPE * s, const TYPE * d, int stride, int n)
{
int i, k = n / 2;
s[0] = x[0] + d[1] / 2;
if (k > 1)
s[stride] = x[2 * stride] + (d[0] + d[1]) / 4;
for (i = 2; i < k - 1; i++)
s[i * stride] = x[2 * i * stride]
+ ((uint32_t) 9 * (d[i - 1] + d[i]) - (d[i - 2] + d[i + 1])) / 32;
if (k > 2)
s[(k - 1) * stride] = x[(2 * k - 2) * stride] + (d[k - 2] + d[k - 1]) / 4;
if (n & 1)
s[k * stride] = x[2 * k * stride] + d[k - 1] / 2;
}
static void
inv_analyze_4 (TYPE * x, const TYPE * d, int stride, int n)
{
int i, k = n / 2;
x[stride] = d[0] + (x[0] + x[2 * stride]) / 2;
if (n & 1) {
for (i = 1; i < k - 1; i++)
x[(2 * i + 1) * stride] = d[i]
+ ((uint32_t) 9 * (x[2 * i * stride] + x[(2 * i + 2) * stride])
- (x[(2 * i - 2) * stride] + x[(2 * i + 4) * stride])) / 16;
if (k > 1)
x[(2 * k - 1) * stride] =
d[k - 1] + (x[(2 * k - 2) * stride] + x[2 * k * stride]) / 2;
} else {
for (i = 1; i < k - 2; i++)
x[(2 * i + 1) * stride] = d[i]
+ (9 * (x[2 * i * stride] + x[(2 * i + 2) * stride])
- (x[(2 * i - 2) * stride] + x[(2 * i + 4) * stride])) / 16;
if (k > 2)
x[(2 * k - 3) * stride] = d[k - 2] + (x[(2 * k - 4) * stride]
+ x[(2 * k - 2) * stride]) / 2;
if (k > 1)
x[(n - 1) * stride] = d[k - 1] + x[(n - 2) * stride];
}
}
static void
inv_synthesize_4 (TYPE * x, const TYPE * s, const TYPE * d, int stride, int n)
{
int i, k = n / 2;
x[0] = s[0] - d[1] / 2;
if (k > 1)
x[2 * stride] = s[1] - (d[0] + d[1]) / 4;
for (i = 2; i < k - 1; i++)
x[2 * i * stride] = s[i] - ((uint32_t) 9 * (d[i - 1] + d[i])
- (d[i - 2] + d[i + 1])) / 32;
if (k > 2)
x[(2 * k - 2) * stride] = s[k - 1] - (d[k - 2] + d[k - 1]) / 4;
if (n & 1)
x[2 * k * stride] = s[k] - d[k - 1] / 2;
}
static inline void
copyback_d (TYPE * x, const TYPE * d, int stride, int n)
{
int i, j, k = n / 2;
for (i = n - k, j = 0; i < n; i++, j++)
x[i * stride] = d[j];
}
static inline void
copy_s_d (const TYPE * x, TYPE * s_d, int stride, int n)
{
int i;
for (i = 0; i < n; i++)
s_d[i] = x[i * stride];
}
typedef
void (*FwdSFnc) (const TYPE * x, TYPE * s, const TYPE * d, int stride,
int n);
typedef void (*FwdAFnc) (const TYPE * x, TYPE * d, int stride, int n);
typedef
void (*InvSFnc) (TYPE * x, const TYPE * s, const TYPE * d, int stride,
int n);
typedef void (*InvAFnc) (TYPE * x, const TYPE * d, int stride, int n);
static FwdSFnc fwd_synthesize[] = { NULL, fwd_synthesize_1, fwd_synthesize_2,
NULL, fwd_synthesize_4
};
static FwdAFnc fwd_analyze[] = { NULL, fwd_analyze_1, fwd_analyze_2,
NULL, fwd_analyze_4
};
static InvSFnc inv_synthesize[] = { NULL, inv_synthesize_1, inv_synthesize_2,
NULL, inv_synthesize_4
};
static InvAFnc inv_analyze[] = { NULL, inv_analyze_1, inv_analyze_2,
NULL, inv_analyze_4
};
static inline void
fwd_xform (TYPE * scratchbuf, TYPE * data, int stride, int n,
int a_moments, int s_moments)
{
TYPE *x = data;
TYPE *d = scratchbuf;
TYPE *s = data;
assert (a_moments == 1 || a_moments == 2 || a_moments == 4);
assert (s_moments == 1 || s_moments == 2 || s_moments == 4);
/* XXX FIXME: Ugly hack to work around */
/* the short-row bug in high */
/* order xform functions */
if (n < 9)
a_moments = s_moments = 2;
if (n < 5)
a_moments = s_moments = 1;
fwd_analyze[a_moments] (x, d, stride, n);
fwd_synthesize[s_moments] (x, s, d, stride, n);
copyback_d (x, d, stride, n);
}
static inline void
inv_xform (TYPE * scratchbuf, TYPE * data, int stride, int n,
int a_moments, int s_moments)
{
int k = n / 2;
TYPE *x = data;
TYPE *s = scratchbuf;
TYPE *d = scratchbuf + n - k;
assert (a_moments == 1 || a_moments == 2 || a_moments == 4);
assert (s_moments == 1 || s_moments == 2 || s_moments == 4);
/* XXX FIXME: Ugly hack to work around */
/* the short-row bug in high */
/* order xform functions */
if (n < 9)
a_moments = s_moments = 2;
if (n < 5)
a_moments = s_moments = 1;
copy_s_d (data, scratchbuf, stride, n);
inv_synthesize[s_moments] (x, s, d, stride, n);
inv_analyze[a_moments] (x, d, stride, n);
}
void
wavelet_3d_buf_fwd_xform (Wavelet3DBuf * buf, int a_moments, int s_moments)
{
int level;
for (level = buf->scales - 1; level > 0; level--) {
uint32_t w = buf->w[level];
uint32_t h = buf->h[level];
uint32_t f = buf->f[level];
if (w > 1) {
int row, frame;
for (frame = 0; frame < f; frame++) {
for (row = 0; row < h; row++) {
TYPE *data = buf->data + (frame * buf->height + row) * buf->width;
fwd_xform (buf->scratchbuf, data, 1, w, a_moments, s_moments);
}
}
}
if (h > 1) {
int col, frame;
for (frame = 0; frame < f; frame++) {
for (col = 0; col < w; col++) {
TYPE *data = buf->data + frame * buf->width * buf->height + col;
fwd_xform (buf->scratchbuf, data, buf->width, h,
a_moments, s_moments);
}
}
}
if (f > 1) {
int i, j;
for (j = 0; j < h; j++) {
for (i = 0; i < w; i++) {
TYPE *data = buf->data + j * buf->width + i;
fwd_xform (buf->scratchbuf, data, buf->width * buf->height, f,
a_moments, s_moments);
}
}
}
}
}
void
wavelet_3d_buf_inv_xform (Wavelet3DBuf * buf, int a_moments, int s_moments)
{
int level;
for (level = 1; level < buf->scales; level++) {
uint32_t w = buf->w[level];
uint32_t h = buf->h[level];
uint32_t f = buf->f[level];
if (f > 1) {
int i, j;
for (j = 0; j < h; j++) {
for (i = 0; i < w; i++) {
TYPE *data = buf->data + j * buf->width + i;
inv_xform (buf->scratchbuf, data, buf->width * buf->height, f,
a_moments, s_moments);
}
}
}
if (h > 1) {
int col, frame;
for (frame = 0; frame < f; frame++) {
for (col = 0; col < w; col++) {
TYPE *data = buf->data + frame * buf->width * buf->height + col;
inv_xform (buf->scratchbuf, data, buf->width, h,
a_moments, s_moments);
}
}
}
if (w > 1) {
int row, frame;
for (frame = 0; frame < f; frame++) {
for (row = 0; row < h; row++) {
TYPE *data = buf->data + (frame * buf->height + row) * buf->width;
inv_xform (buf->scratchbuf, data, 1, w, a_moments, s_moments);
}
}
}
}
}