mirror of
https://gitlab.freedesktop.org/gstreamer/gstreamer.git
synced 2024-12-23 16:50:47 +00:00
1146 lines
33 KiB
C
1146 lines
33 KiB
C
/*
|
|
* libzvbi -- VBI device simulation
|
|
*
|
|
* Copyright (C) 2004, 2007 Michael H. Schimek
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Library General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2 of the License, or (at your option) any later version.
|
|
*
|
|
* This library 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
|
|
* Library General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Library General Public
|
|
* License along with this library; if not, write to the
|
|
* Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
|
|
* Boston, MA 02110-1301 USA.
|
|
*/
|
|
|
|
/* $Id: io-sim.c,v 1.18 2009-12-14 23:43:40 mschimek Exp $ */
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
# include "config.h"
|
|
#endif
|
|
|
|
#ifdef _MSC_VER
|
|
#define _USE_MATH_DEFINES /* Needed for M_PI and M_LN2 */
|
|
#endif
|
|
#include <math.h> /* sin(), log() */
|
|
#include <errno.h>
|
|
#include <ctype.h> /* isspace() */
|
|
#include <limits.h> /* INT_MAX */
|
|
|
|
#include "misc.h"
|
|
#include "sliced.h"
|
|
#include "sampling_par.h"
|
|
#include "raw_decoder.h"
|
|
#include "hamm.h"
|
|
|
|
# define sp_sample_format sampling_format
|
|
# define SAMPLES_PER_LINE(sp) \
|
|
((sp)->bytes_per_line / VBI_PIXFMT_BPP ((sp)->sampling_format))
|
|
# define SYSTEM_525(sp) \
|
|
(525 == (sp)->scanning)
|
|
|
|
#include "io-sim.h"
|
|
|
|
/*
|
|
* @addtogroup Rawenc Raw VBI encoder
|
|
* @ingroup Raw
|
|
* @brief Converting sliced VBI data to raw VBI images.
|
|
*
|
|
* These are functions converting sliced VBI data to raw VBI images as
|
|
* transmitted in the vertical blanking interval of analog video standards.
|
|
* They are mainly intended for tests of the libzvbi bit slicer and
|
|
* raw VBI decoder.
|
|
*/
|
|
|
|
# define VBI_PIXFMT_RGB24_LE VBI_PIXFMT_RGB24
|
|
# define VBI_PIXFMT_BGR24_LE VBI_PIXFMT_BGR24
|
|
# define VBI_PIXFMT_RGBA24_LE VBI_PIXFMT_RGBA32_LE
|
|
# define VBI_PIXFMT_BGRA24_LE VBI_PIXFMT_BGRA32_LE
|
|
# define VBI_PIXFMT_RGBA24_BE VBI_PIXFMT_RGBA32_BE
|
|
# define VBI_PIXFMT_BGRA24_BE VBI_PIXFMT_BGRA32_BE
|
|
# define vbi_pixfmt_bytes_per_pixel VBI_PIXFMT_BPP
|
|
|
|
#define PI 3.1415926535897932384626433832795029
|
|
|
|
#define PULSE(zero_level) \
|
|
do { \
|
|
if (0 == seq) { \
|
|
raw[i] = SATURATE (zero_level, 0, 255); \
|
|
} else if (3 == seq) { \
|
|
raw[i] = SATURATE (zero_level + (int) signal_amp, \
|
|
0, 255); \
|
|
} else if ((seq ^ bit) & 1) { /* down */ \
|
|
double r = sin (q * tr - (PI / 2.0)); \
|
|
r = r * r * signal_amp; \
|
|
raw[i] = SATURATE (zero_level + (int) r, 0, 255); \
|
|
} else { /* up */ \
|
|
double r = sin (q * tr); \
|
|
r = r * r * signal_amp; \
|
|
raw[i] = SATURATE (zero_level + (int) r, 0, 255); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define PULSE_SEQ(zero_level) \
|
|
do { \
|
|
double tr; \
|
|
unsigned int bit; \
|
|
unsigned int byte; \
|
|
unsigned int seq; \
|
|
\
|
|
tr = t - t1; \
|
|
bit = tr * bit_rate; \
|
|
byte = bit >> 3; \
|
|
bit &= 7; \
|
|
seq = (buf[byte] >> 7) + buf[byte + 1] * 2; \
|
|
seq = (seq >> bit) & 3; \
|
|
PULSE (zero_level); \
|
|
} while (0)
|
|
|
|
_vbi_inline void
|
|
vbi_sincos (double x, double *sinx, double *cosx)
|
|
{
|
|
*sinx = sin (x);
|
|
*cosx = cos (x);
|
|
}
|
|
|
|
#define vbi_log2(x) (log (x) / M_LN2)
|
|
|
|
static void
|
|
signal_teletext (uint8_t * raw,
|
|
const vbi_sampling_par * sp,
|
|
int black_level,
|
|
double signal_amp,
|
|
double bit_rate,
|
|
unsigned int frc, unsigned int payload, const vbi_sliced * sliced)
|
|
{
|
|
double bit_period = 1.0 / bit_rate;
|
|
/* Teletext System B: Sixth CRI pulse at 12 us
|
|
(+.5 b/c we start with a 0 bit). */
|
|
double t1 = 12e-6 - 13 * bit_period;
|
|
double t2 = t1 + (payload * 8 + 24 + 1) * bit_period;
|
|
double q = (PI / 2.0) * bit_rate;
|
|
double sample_period = 1.0 / sp->sampling_rate;
|
|
unsigned int samples_per_line;
|
|
uint8_t buf[64];
|
|
unsigned int i;
|
|
double t;
|
|
|
|
buf[0] = 0x00;
|
|
buf[1] = 0x55; /* clock run-in */
|
|
buf[2] = 0x55;
|
|
buf[3] = frc;
|
|
|
|
memcpy (buf + 4, sliced->data, payload);
|
|
|
|
buf[payload + 4] = 0x00;
|
|
|
|
t = sp->offset / (double) sp->sampling_rate;
|
|
|
|
samples_per_line = SAMPLES_PER_LINE (sp);
|
|
|
|
for (i = 0; i < samples_per_line; ++i) {
|
|
if (t >= t1 && t < t2)
|
|
PULSE_SEQ (black_level);
|
|
|
|
t += sample_period;
|
|
}
|
|
}
|
|
|
|
static void
|
|
signal_vps (uint8_t * raw,
|
|
const vbi_sampling_par * sp,
|
|
int black_level, int white_level, const vbi_sliced * sliced)
|
|
{
|
|
static const uint8_t biphase[] = {
|
|
0xAA, 0x6A, 0x9A, 0x5A,
|
|
0xA6, 0x66, 0x96, 0x56,
|
|
0xA9, 0x69, 0x99, 0x59,
|
|
0xA5, 0x65, 0x95, 0x55
|
|
};
|
|
double bit_rate = 15625 * 160 * 2;
|
|
double t1 = 12.5e-6 - .5 / bit_rate;
|
|
double t4 = t1 + ((4 + 13 * 2) * 8) / bit_rate;
|
|
double q = (PI / 2.0) * bit_rate;
|
|
double sample_period = 1.0 / sp->sampling_rate;
|
|
unsigned int samples_per_line;
|
|
double signal_amp = (0.5 / 0.7) * (white_level - black_level);
|
|
uint8_t buf[32];
|
|
unsigned int i;
|
|
double t;
|
|
|
|
CLEAR (buf);
|
|
|
|
buf[1] = 0x55; /* 0101 0101 */
|
|
buf[2] = 0x55; /* 0101 0101 */
|
|
buf[3] = 0x51; /* 0101 0001 */
|
|
buf[4] = 0x99; /* 1001 1001 */
|
|
|
|
for (i = 0; i < 13; ++i) {
|
|
unsigned int b = sliced->data[i];
|
|
|
|
buf[5 + i * 2] = biphase[b >> 4];
|
|
buf[6 + i * 2] = biphase[b & 15];
|
|
}
|
|
|
|
buf[6 + 12 * 2] &= 0x7F;
|
|
|
|
t = sp->offset / (double) sp->sampling_rate;
|
|
|
|
samples_per_line = SAMPLES_PER_LINE (sp);
|
|
|
|
for (i = 0; i < samples_per_line; ++i) {
|
|
if (t >= t1 && t < t4)
|
|
PULSE_SEQ (black_level);
|
|
|
|
t += sample_period;
|
|
}
|
|
}
|
|
|
|
static void
|
|
wss_biphase (uint8_t buf[32], const vbi_sliced * sliced)
|
|
{
|
|
unsigned int bit;
|
|
unsigned int data;
|
|
unsigned int i;
|
|
|
|
/* 29 bit run-in and 24 bit start code, lsb first. */
|
|
|
|
buf[0] = 0x00;
|
|
buf[1] = 0x1F; /* 0001 1111 */
|
|
buf[2] = 0xC7; /* 1100 0111 */
|
|
buf[3] = 0x71; /* 0111 0001 */
|
|
buf[4] = 0x1C; /* 000 | 1 1100 */
|
|
buf[5] = 0x8F; /* 1000 1111 */
|
|
buf[6] = 0x07; /* 0000 0111 */
|
|
buf[7] = 0x1F; /* 1 1111 */
|
|
|
|
bit = 8 + 29 + 24;
|
|
data = sliced->data[0] + sliced->data[1] * 256;
|
|
|
|
for (i = 0; i < 14; ++i) {
|
|
static const unsigned int biphase[] = { 0x38, 0x07 };
|
|
unsigned int byte;
|
|
unsigned int shift;
|
|
unsigned int seq;
|
|
|
|
byte = bit >> 3;
|
|
shift = bit & 7;
|
|
bit += 6;
|
|
|
|
seq = biphase[data & 1] << shift;
|
|
data >>= 1;
|
|
|
|
assert (byte < 31);
|
|
|
|
buf[byte] |= seq;
|
|
buf[byte + 1] = seq >> 8;
|
|
}
|
|
}
|
|
|
|
static void
|
|
signal_wss_625 (uint8_t * raw,
|
|
const vbi_sampling_par * sp,
|
|
int black_level, int white_level, const vbi_sliced * sliced)
|
|
{
|
|
double bit_rate = 15625 * 320;
|
|
double t1 = 11.0e-6 - .5 / bit_rate;
|
|
double t4 = t1 + (29 + 24 + 14 * 6 + 1) / bit_rate;
|
|
double q = (PI / 2.0) * bit_rate;
|
|
double sample_period = 1.0 / sp->sampling_rate;
|
|
double signal_amp = (0.5 / 0.7) * (white_level - black_level);
|
|
unsigned int samples_per_line;
|
|
uint8_t buf[32];
|
|
unsigned int i;
|
|
double t;
|
|
|
|
CLEAR (buf);
|
|
|
|
wss_biphase (buf, sliced);
|
|
|
|
t = sp->offset / (double) sp->sampling_rate;
|
|
|
|
samples_per_line = SAMPLES_PER_LINE (sp);
|
|
|
|
for (i = 0; i < samples_per_line; ++i) {
|
|
if (t >= t1 && t < t4)
|
|
PULSE_SEQ (black_level);
|
|
|
|
t += sample_period;
|
|
}
|
|
}
|
|
|
|
static void
|
|
signal_closed_caption (uint8_t * raw,
|
|
const vbi_sampling_par * sp,
|
|
int blank_level,
|
|
int white_level,
|
|
unsigned int flags, double bit_rate, const vbi_sliced * sliced)
|
|
{
|
|
double D = 1.0 / bit_rate;
|
|
double t0 = 10.5e-6; /* CRI start half amplitude (EIA 608-B) */
|
|
double t1 = t0 - .25 * D; /* CRI start, blanking level */
|
|
double t2 = t1 + 7 * D; /* CRI 7 cycles */
|
|
/* First start bit, left edge half amplitude, minus rise time. */
|
|
double t3 = t0 + 6.5 * D - 120e-9;
|
|
double q1 = PI * bit_rate * 2;
|
|
/* Max. rise/fall time 240 ns (EIA 608-B). */
|
|
double q2 = PI / 120e-9;
|
|
double signal_mean;
|
|
double signal_high;
|
|
double sample_period = 1.0 / sp->sampling_rate;
|
|
unsigned int samples_per_line;
|
|
double t;
|
|
unsigned int data;
|
|
unsigned int i;
|
|
|
|
/* Twice 7 data + odd parity, start bit 0 -> 1 */
|
|
|
|
data = (sliced->data[1] << 12) + (sliced->data[0] << 4) + 8;
|
|
|
|
t = sp->offset / (double) sp->sampling_rate;
|
|
|
|
samples_per_line = SAMPLES_PER_LINE (sp);
|
|
|
|
if (flags & _VBI_RAW_SHIFT_CC_CRI) {
|
|
/* Wrong signal shape found by Rich Kadel,
|
|
zapping-misc@lists.sourceforge.net 2006-07-16. */
|
|
t0 += D / 2;
|
|
t1 += D / 2;
|
|
t2 += D / 2;
|
|
}
|
|
|
|
if (flags & _VBI_RAW_LOW_AMP_CC) {
|
|
/* Low amplitude signal found by Rich Kadel,
|
|
zapping-misc@lists.sourceforge.net 2007-08-15. */
|
|
white_level = white_level * 6 / 10;
|
|
}
|
|
|
|
signal_mean = (white_level - blank_level) * .25; /* 25 IRE */
|
|
signal_high = blank_level + (white_level - blank_level) * .5;
|
|
|
|
for (i = 0; i < samples_per_line; ++i) {
|
|
if (t >= t1 && t < t2) {
|
|
raw[i] = SATURATE (blank_level + (1.0 - cos (q1 * (t - t1)))
|
|
* signal_mean, 0, 255);
|
|
} else {
|
|
unsigned int bit;
|
|
unsigned int seq;
|
|
double d;
|
|
|
|
d = t - t3;
|
|
bit = d * bit_rate;
|
|
seq = (data >> bit) & 3;
|
|
|
|
d -= bit * D;
|
|
if ((1 == seq || 2 == seq)
|
|
&& fabs (d) < .120e-6) {
|
|
int level;
|
|
|
|
if (1 == seq)
|
|
level = blank_level + (1.0 + cos (q2 * d))
|
|
* signal_mean;
|
|
else
|
|
level = blank_level + (1.0 - cos (q2 * d))
|
|
* signal_mean;
|
|
raw[i] = SATURATE (level, 0, 255);
|
|
} else if (data & (2 << bit)) {
|
|
raw[i] = SATURATE (signal_high, 0, 255);
|
|
} else {
|
|
raw[i] = SATURATE (blank_level, 0, 255);
|
|
}
|
|
}
|
|
|
|
t += sample_period;
|
|
}
|
|
}
|
|
|
|
static void
|
|
clear_image (uint8_t * p,
|
|
unsigned int value,
|
|
unsigned int width, unsigned int height, unsigned int bytes_per_line)
|
|
{
|
|
if (width == bytes_per_line) {
|
|
memset (p, value, height * bytes_per_line);
|
|
} else {
|
|
while (height-- > 0) {
|
|
memset (p, value, width);
|
|
p += bytes_per_line;
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* @param raw Noise will be added to this raw VBI image.
|
|
* @param sp Describes the raw VBI data in the buffer. @a sp->sampling_format
|
|
* must be @c VBI_PIXFMT_Y8 (@c VBI_PIXFMT_YUV420 in libzvbi 0.2.x).
|
|
* Note for compatibility in libzvbi 0.2.x vbi_sampling_par is a
|
|
* synonym of vbi_raw_decoder, but the (private) decoder fields in
|
|
* this structure are ignored.
|
|
* @param min_freq Minimum frequency of the noise in Hz.
|
|
* @param max_freq Maximum frequency of the noise in Hz. @a min_freq and
|
|
* @a max_freq define the cut off frequency at the half power points
|
|
* (gain -3 dB).
|
|
* @param amplitude Maximum amplitude of the noise, should lie in range
|
|
* 0 to 256.
|
|
* @param seed Seed for the pseudo random number generator built into
|
|
* this function. Given the same @a seed value the function will add
|
|
* the same noise, which can be useful for tests.
|
|
*
|
|
* This function adds white noise to a raw VBI image.
|
|
*
|
|
* To produce realistic noise @a min_freq = 0, @a max_freq = 5e6 and
|
|
* @a amplitude = 20 to 50 seems appropriate.
|
|
*
|
|
* @returns
|
|
* FALSE if the @a sp sampling parameters are invalid.
|
|
*
|
|
* @since 0.2.26
|
|
*/
|
|
vbi_bool
|
|
vbi_raw_add_noise (uint8_t * raw,
|
|
const vbi_sampling_par * sp,
|
|
unsigned int min_freq,
|
|
unsigned int max_freq, unsigned int amplitude, unsigned int seed)
|
|
{
|
|
double f0, w0, sn, cs, bw, alpha, a0;
|
|
float a1, a2, b0, b1, z0, z1, z2;
|
|
unsigned int n_lines;
|
|
unsigned long samples_per_line;
|
|
unsigned long padding;
|
|
uint32_t seed32;
|
|
|
|
assert (NULL != raw);
|
|
assert (NULL != sp);
|
|
|
|
if (unlikely (!_vbi_sampling_par_valid_log (sp, /* log */ NULL)))
|
|
return FALSE;
|
|
|
|
switch (sp->sp_sample_format) {
|
|
case VBI_PIXFMT_YUV420:
|
|
break;
|
|
|
|
default:
|
|
return FALSE;
|
|
}
|
|
|
|
if (unlikely (sp->sampling_rate <= 0))
|
|
return FALSE;
|
|
|
|
/* Biquad bandpass filter.
|
|
http://www.musicdsp.org/files/Audio-EQ-Cookbook.txt */
|
|
|
|
f0 = ((double) min_freq + max_freq) * 0.5;
|
|
|
|
if (f0 <= 0.0)
|
|
return TRUE;
|
|
|
|
w0 = 2 * M_PI * f0 / sp->sampling_rate;
|
|
vbi_sincos (w0, &sn, &cs);
|
|
bw = fabs (vbi_log2 (MAX (min_freq, max_freq) / f0));
|
|
alpha = sn * sinh (log (2) / 2 * bw * w0 / sn);
|
|
a0 = 1 + alpha;
|
|
a1 = 2 * cs / a0;
|
|
a2 = (alpha - 1) / a0;
|
|
b0 = sn / (2 * a0);
|
|
b1 = 0;
|
|
|
|
if (amplitude > 256)
|
|
amplitude = 256;
|
|
|
|
n_lines = sp->count[0] + sp->count[1];
|
|
|
|
if (unlikely (0 == amplitude || 0 == n_lines || 0 == sp->bytes_per_line))
|
|
return TRUE;
|
|
|
|
samples_per_line = sp->bytes_per_line;
|
|
padding = 0;
|
|
|
|
seed32 = seed;
|
|
|
|
z1 = 0;
|
|
z2 = 0;
|
|
|
|
do {
|
|
uint8_t *raw_end = raw + samples_per_line;
|
|
|
|
do {
|
|
int noise;
|
|
|
|
/* We use our own simple PRNG to produce
|
|
predictable results for tests. */
|
|
seed32 = seed32 * 1103515245u + 12345;
|
|
noise = ((seed32 / 65536) % (amplitude * 2 + 1))
|
|
- amplitude;
|
|
|
|
z0 = noise + a1 * z1 + a2 * z2;
|
|
noise = (int) (b0 * (z0 - z2) + b1 * z1);
|
|
z2 = z1;
|
|
z1 = z0;
|
|
|
|
*raw++ = SATURATE (*raw + noise, 0, 255);
|
|
} while (raw < raw_end);
|
|
|
|
raw += padding;
|
|
} while (--n_lines > 0);
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
static vbi_bool
|
|
signal_u8 (uint8_t * raw,
|
|
const vbi_sampling_par * sp,
|
|
int blank_level,
|
|
int black_level,
|
|
int white_level,
|
|
unsigned int flags,
|
|
const vbi_sliced * sliced, unsigned int n_sliced_lines, const char *caller)
|
|
{
|
|
unsigned int n_scan_lines;
|
|
unsigned int samples_per_line;
|
|
|
|
n_scan_lines = sp->count[0] + sp->count[1];
|
|
samples_per_line = SAMPLES_PER_LINE (sp);
|
|
|
|
clear_image (raw,
|
|
SATURATE (blank_level, 0, 255),
|
|
samples_per_line, n_scan_lines, sp->bytes_per_line);
|
|
|
|
for (; n_sliced_lines-- > 0; ++sliced) {
|
|
unsigned int row;
|
|
uint8_t *raw1;
|
|
|
|
if (0 == sliced->line) {
|
|
goto bounds;
|
|
} else if (0 != sp->start[1]
|
|
&& sliced->line >= (unsigned int) sp->start[1]) {
|
|
row = sliced->line - sp->start[1];
|
|
if (row >= (unsigned int) sp->count[1])
|
|
goto bounds;
|
|
|
|
if (sp->interlaced) {
|
|
row = row * 2 + !(flags & _VBI_RAW_SWAP_FIELDS);
|
|
} else if (0 == (flags & _VBI_RAW_SWAP_FIELDS)) {
|
|
row += sp->count[0];
|
|
}
|
|
} else if (0 != sp->start[0]
|
|
&& sliced->line >= (unsigned int) sp->start[0]) {
|
|
row = sliced->line - sp->start[0];
|
|
if (row >= (unsigned int) sp->count[0])
|
|
goto bounds;
|
|
|
|
if (sp->interlaced) {
|
|
row *= 2 + ! !(flags & _VBI_RAW_SWAP_FIELDS);
|
|
} else if (flags & _VBI_RAW_SWAP_FIELDS) {
|
|
row += sp->count[0];
|
|
}
|
|
} else {
|
|
bounds:
|
|
warning (caller, "Sliced line %u out of bounds.", sliced->line);
|
|
return FALSE;
|
|
}
|
|
|
|
raw1 = raw + row * sp->bytes_per_line;
|
|
|
|
switch (sliced->id) {
|
|
case VBI_SLICED_TELETEXT_A: /* ok? */
|
|
signal_teletext (raw1, sp, black_level,
|
|
/* amplitude */ .7 * (white_level
|
|
- black_level),
|
|
/* bit_rate */ 25 * 625 * 397,
|
|
/* FRC */ 0xE7,
|
|
/* payload */ 37,
|
|
sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_TELETEXT_B_L10_625:
|
|
case VBI_SLICED_TELETEXT_B_L25_625:
|
|
case VBI_SLICED_TELETEXT_B:
|
|
signal_teletext (raw1, sp, black_level,
|
|
.66 * (white_level - black_level),
|
|
25 * 625 * 444, 0x27, 42, sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_TELETEXT_C_625:
|
|
signal_teletext (raw1, sp, black_level,
|
|
.7 * (white_level - black_level), 25 * 625 * 367, 0xE7, 33, sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_TELETEXT_D_625:
|
|
signal_teletext (raw1, sp, black_level,
|
|
.7 * (white_level - black_level), 5642787, 0xA7, 34, sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_CAPTION_625_F1:
|
|
case VBI_SLICED_CAPTION_625_F2:
|
|
case VBI_SLICED_CAPTION_625:
|
|
signal_closed_caption (raw1, sp,
|
|
blank_level, white_level, flags, 25 * 625 * 32, sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_VPS:
|
|
case VBI_SLICED_VPS_F2:
|
|
signal_vps (raw1, sp, black_level, white_level, sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_WSS_625:
|
|
signal_wss_625 (raw1, sp, black_level, white_level, sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_TELETEXT_B_525:
|
|
signal_teletext (raw1, sp, black_level,
|
|
/* amplitude */ .7 * (white_level
|
|
- black_level),
|
|
/* bit_rate */ 5727272,
|
|
/* FRC */ 0x27,
|
|
/* payload */ 34,
|
|
sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_TELETEXT_C_525:
|
|
signal_teletext (raw1, sp, black_level,
|
|
.7 * (white_level - black_level), 5727272, 0xE7, 33, sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_TELETEXT_D_525:
|
|
signal_teletext (raw1, sp, black_level,
|
|
.7 * (white_level - black_level), 5727272, 0xA7, 34, sliced);
|
|
break;
|
|
|
|
case VBI_SLICED_CAPTION_525_F1:
|
|
case VBI_SLICED_CAPTION_525_F2:
|
|
case VBI_SLICED_CAPTION_525:
|
|
signal_closed_caption (raw1, sp,
|
|
blank_level, white_level, flags, 30000 * 525 * 32 / 1001, sliced);
|
|
break;
|
|
|
|
default:
|
|
warning (caller,
|
|
"Service 0x%08x (%s) not supported.",
|
|
sliced->id, vbi_sliced_name (sliced->id));
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
vbi_bool
|
|
_vbi_raw_vbi_image (uint8_t * raw,
|
|
unsigned long raw_size,
|
|
const vbi_sampling_par * sp,
|
|
int blank_level,
|
|
int white_level,
|
|
unsigned int flags, const vbi_sliced * sliced, unsigned int n_sliced_lines)
|
|
{
|
|
unsigned int n_scan_lines;
|
|
unsigned int black_level;
|
|
|
|
if (unlikely (!_vbi_sampling_par_valid_log (sp, NULL)))
|
|
return FALSE;
|
|
|
|
n_scan_lines = sp->count[0] + sp->count[1];
|
|
if (unlikely (n_scan_lines * sp->bytes_per_line > raw_size)) {
|
|
warning (__FUNCTION__,
|
|
"(%u + %u lines) * %lu bytes_per_line "
|
|
"> %lu raw_size.",
|
|
sp->count[0], sp->count[1],
|
|
(unsigned long) sp->bytes_per_line, raw_size);
|
|
return FALSE;
|
|
}
|
|
|
|
if (unlikely (0 != white_level && blank_level > white_level)) {
|
|
warning (__FUNCTION__,
|
|
"Invalid blanking %d or peak white level %d.",
|
|
blank_level, white_level);
|
|
}
|
|
|
|
if (SYSTEM_525 (sp)) {
|
|
/* Observed value. */
|
|
const unsigned int peak = 200; /* 255 */
|
|
|
|
if (0 == white_level) {
|
|
blank_level = (int) (40.0 * peak / 140);
|
|
black_level = (int) (47.5 * peak / 140);
|
|
white_level = peak;
|
|
} else {
|
|
black_level = (int) (blank_level + 7.5 * (white_level - blank_level));
|
|
}
|
|
} else {
|
|
const unsigned int peak = 200; /* 255 */
|
|
|
|
if (0 == white_level) {
|
|
blank_level = (int) (43.0 * peak / 140);
|
|
white_level = peak;
|
|
}
|
|
|
|
black_level = blank_level;
|
|
}
|
|
|
|
return signal_u8 (raw, sp,
|
|
blank_level, black_level, white_level,
|
|
flags, sliced, n_sliced_lines, __FUNCTION__);
|
|
}
|
|
|
|
#define RGBA_TO_RGB16(value) \
|
|
(+(((value) & 0xF8) >> (3 - 0)) \
|
|
+(((value) & 0xFC00) >> (10 - 5)) \
|
|
+(((value) & 0xF80000) >> (19 - 11)))
|
|
|
|
#define RGBA_TO_RGBA15(value) \
|
|
(+(((value) & 0xF8) >> (3 - 0)) \
|
|
+(((value) & 0xF800) >> (11 - 5)) \
|
|
+(((value) & 0xF80000) >> (19 - 10)) \
|
|
+(((value) & 0x80000000) >> (31 - 15)))
|
|
|
|
#define RGBA_TO_ARGB15(value) \
|
|
(+(((value) & 0xF8) >> (3 - 1)) \
|
|
+(((value) & 0xF800) >> (11 - 6)) \
|
|
+(((value) & 0xF80000) >> (19 - 11)) \
|
|
+(((value) & 0x80000000) >> (31 - 0)))
|
|
|
|
#define RGBA_TO_RGBA12(value) \
|
|
(+(((value) & 0xF0) >> (4 - 0)) \
|
|
+(((value) & 0xF000) >> (12 - 4)) \
|
|
+(((value) & 0xF00000) >> (20 - 8)) \
|
|
+(((value) & 0xF0000000) >> (28 - 12)))
|
|
|
|
#define RGBA_TO_ARGB12(value) \
|
|
(+(((value) & 0xF0) << -(4 - 12)) \
|
|
+(((value) & 0xF000) >> (12 - 8)) \
|
|
+(((value) & 0xF00000) >> (20 - 4)) \
|
|
+(((value) & 0xF0000000) >> (28 - 0)))
|
|
|
|
#define RGBA_TO_RGB8(value) \
|
|
(+(((value) & 0xE0) >> (5 - 0)) \
|
|
+(((value) & 0xE000) >> (13 - 3)) \
|
|
+(((value) & 0xC00000) >> (22 - 6)))
|
|
|
|
#define RGBA_TO_BGR8(value) \
|
|
(+(((value) & 0xE0) >> (5 - 5)) \
|
|
+(((value) & 0xE000) >> (13 - 2)) \
|
|
+(((value) & 0xC00000) >> (22 - 0)))
|
|
|
|
#define RGBA_TO_RGBA7(value) \
|
|
(+(((value) & 0xC0) >> (6 - 0)) \
|
|
+(((value) & 0xE000) >> (13 - 2)) \
|
|
+(((value) & 0xC00000) >> (22 - 5)) \
|
|
+(((value) & 0x80000000) >> (31 - 7)))
|
|
|
|
#define RGBA_TO_ARGB7(value) \
|
|
(+(((value) & 0xC0) >> (6 - 6)) \
|
|
+(((value) & 0xE000) >> (13 - 3)) \
|
|
+(((value) & 0xC00000) >> (22 - 1)) \
|
|
+(((value) & 0x80000000) >> (31 - 0)))
|
|
|
|
#define MST1(d, val, mask) (d) = ((d) & ~(mask)) | ((val) & (mask))
|
|
#define MST2(d, val, mask) (d) = ((d) & (mask)) | (val)
|
|
|
|
#define SCAN_LINE_TO_N(conv, n) \
|
|
do { \
|
|
for (i = 0; i < samples_per_line; ++i) { \
|
|
uint8_t *dd = d + i * (n); \
|
|
unsigned int value = s[i] * 0x01010101; \
|
|
unsigned int mask = ~pixel_mask; \
|
|
\
|
|
value = conv (value) & pixel_mask; \
|
|
MST2 (dd[0], value >> 0, mask >> 0); \
|
|
if (n >= 2) \
|
|
MST2 (dd[1], value >> 8, mask >> 8); \
|
|
if (n >= 3) \
|
|
MST2 (dd[2], value >> 16, mask >> 16); \
|
|
if (n >= 4) \
|
|
MST2 (dd[3], value >> 24, mask >> 24); \
|
|
} \
|
|
} while (0)
|
|
|
|
#define SCAN_LINE_TO_RGB2(conv, endian) \
|
|
do { \
|
|
for (i = 0; i < samples_per_line; ++i) { \
|
|
uint8_t *dd = d + i * 2; \
|
|
unsigned int value = s[i] * 0x01010101; \
|
|
unsigned int mask; \
|
|
\
|
|
value = conv (value) & pixel_mask; \
|
|
mask = ~pixel_mask; \
|
|
MST2 (dd[0 + endian], value >> 0, mask >> 0); \
|
|
MST2 (dd[1 - endian], value >> 8, mask >> 8); \
|
|
} \
|
|
} while (0)
|
|
|
|
vbi_bool
|
|
_vbi_raw_video_image (uint8_t * raw,
|
|
unsigned long raw_size,
|
|
const vbi_sampling_par * sp,
|
|
int blank_level,
|
|
int black_level,
|
|
int white_level,
|
|
unsigned int pixel_mask,
|
|
unsigned int flags, const vbi_sliced * sliced, unsigned int n_sliced_lines)
|
|
{
|
|
unsigned int n_scan_lines;
|
|
unsigned int samples_per_line;
|
|
vbi_sampling_par sp8;
|
|
unsigned int size;
|
|
uint8_t *buf;
|
|
uint8_t *s;
|
|
uint8_t *d;
|
|
|
|
if (unlikely (!_vbi_sampling_par_valid_log (sp, NULL)))
|
|
return FALSE;
|
|
|
|
n_scan_lines = sp->count[0] + sp->count[1];
|
|
if (unlikely (n_scan_lines * sp->bytes_per_line > raw_size)) {
|
|
warning (__FUNCTION__,
|
|
"%u + %u lines * %lu bytes_per_line > %lu raw_size.",
|
|
sp->count[0], sp->count[1],
|
|
(unsigned long) sp->bytes_per_line, raw_size);
|
|
return FALSE;
|
|
}
|
|
|
|
if (unlikely (0 != white_level
|
|
&& (blank_level > black_level || black_level > white_level))) {
|
|
warning (__FUNCTION__,
|
|
"Invalid blanking %d, black %d or peak "
|
|
"white level %d.", blank_level, black_level, white_level);
|
|
}
|
|
|
|
switch (sp->sp_sample_format) {
|
|
case VBI_PIXFMT_YVYU:
|
|
case VBI_PIXFMT_VYUY: /* 0xAAUUVVYY */
|
|
pixel_mask = (+((pixel_mask & 0xFF00) << 8)
|
|
+ ((pixel_mask & 0xFF0000) >> 8)
|
|
+ ((pixel_mask & 0xFF0000FF)));
|
|
break;
|
|
|
|
case VBI_PIXFMT_RGBA24_BE: /* 0xRRGGBBAA */
|
|
pixel_mask = SWAB32 (pixel_mask);
|
|
break;
|
|
|
|
case VBI_PIXFMT_BGR24_LE: /* 0x00RRGGBB */
|
|
case VBI_PIXFMT_BGRA15_LE:
|
|
case VBI_PIXFMT_BGRA15_BE:
|
|
case VBI_PIXFMT_ABGR15_LE:
|
|
case VBI_PIXFMT_ABGR15_BE:
|
|
pixel_mask = (+((pixel_mask & 0xFF) << 16)
|
|
+ ((pixel_mask & 0xFF0000) >> 16)
|
|
+ ((pixel_mask & 0xFF00FF00)));
|
|
break;
|
|
|
|
case VBI_PIXFMT_BGRA24_BE: /* 0xBBGGRRAA */
|
|
pixel_mask = (+((pixel_mask & 0xFFFFFF) << 8)
|
|
+ ((pixel_mask & 0xFF000000) >> 24));
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
switch (sp->sp_sample_format) {
|
|
case VBI_PIXFMT_RGB16_LE:
|
|
case VBI_PIXFMT_RGB16_BE:
|
|
case VBI_PIXFMT_BGR16_LE:
|
|
case VBI_PIXFMT_BGR16_BE:
|
|
pixel_mask = RGBA_TO_RGB16 (pixel_mask);
|
|
break;
|
|
|
|
case VBI_PIXFMT_RGBA15_LE:
|
|
case VBI_PIXFMT_RGBA15_BE:
|
|
case VBI_PIXFMT_BGRA15_LE:
|
|
case VBI_PIXFMT_BGRA15_BE:
|
|
pixel_mask = RGBA_TO_RGBA15 (pixel_mask);
|
|
break;
|
|
|
|
case VBI_PIXFMT_ARGB15_LE:
|
|
case VBI_PIXFMT_ARGB15_BE:
|
|
case VBI_PIXFMT_ABGR15_LE:
|
|
case VBI_PIXFMT_ABGR15_BE:
|
|
pixel_mask = RGBA_TO_ARGB15 (pixel_mask);
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
if (0 == pixel_mask) {
|
|
/* Done! :-) */
|
|
return TRUE;
|
|
}
|
|
|
|
/* ITU-R BT.601 sampling assumed. */
|
|
|
|
if (SYSTEM_525 (sp)) {
|
|
if (0 == white_level) {
|
|
/* Cutting off the bottom of the signal
|
|
confuses the vbi_bit_slicer (can't adjust
|
|
the threshold fast enough), probably other
|
|
decoders as well. */
|
|
blank_level = 5; /* 16 - 40 * 220 / 100; */
|
|
black_level = 16;
|
|
white_level = 16 + 219;
|
|
}
|
|
} else {
|
|
if (0 == white_level) {
|
|
/* Observed values: 30-30-280 (WSS PAL) -? */
|
|
blank_level = 5; /* 16 - 43 * 220 / 100; */
|
|
black_level = 16;
|
|
white_level = 16 + 219;
|
|
}
|
|
}
|
|
|
|
sp8 = *sp;
|
|
|
|
samples_per_line = SAMPLES_PER_LINE (sp);
|
|
|
|
sp8.sampling_format = VBI_PIXFMT_YUV420;
|
|
|
|
sp8.bytes_per_line = samples_per_line * 1 /* bpp */ ;
|
|
|
|
size = n_scan_lines * samples_per_line;
|
|
buf = vbi_malloc (size);
|
|
if (NULL == buf) {
|
|
error (NULL, "Out of memory.");
|
|
errno = ENOMEM;
|
|
return FALSE;
|
|
}
|
|
|
|
if (!signal_u8 (buf, &sp8,
|
|
blank_level, black_level, white_level,
|
|
flags, sliced, n_sliced_lines, __FUNCTION__)) {
|
|
vbi_free (buf);
|
|
return FALSE;
|
|
}
|
|
|
|
s = buf;
|
|
d = raw;
|
|
|
|
while (n_scan_lines-- > 0) {
|
|
unsigned int i;
|
|
|
|
switch (sp->sp_sample_format) {
|
|
case VBI_PIXFMT_PAL8:
|
|
case VBI_PIXFMT_YUV420:
|
|
for (i = 0; i < samples_per_line; ++i)
|
|
MST1 (d[i], s[i], pixel_mask);
|
|
break;
|
|
|
|
case VBI_PIXFMT_RGBA24_LE:
|
|
case VBI_PIXFMT_RGBA24_BE:
|
|
case VBI_PIXFMT_BGRA24_LE:
|
|
case VBI_PIXFMT_BGRA24_BE:
|
|
SCAN_LINE_TO_N (+, 4);
|
|
break;
|
|
|
|
case VBI_PIXFMT_RGB24_LE:
|
|
case VBI_PIXFMT_BGR24_LE:
|
|
SCAN_LINE_TO_N (+, 3);
|
|
break;
|
|
|
|
case VBI_PIXFMT_YUYV:
|
|
case VBI_PIXFMT_YVYU:
|
|
for (i = 0; i < samples_per_line; i += 2) {
|
|
uint8_t *dd = d + i * 2;
|
|
unsigned int uv = (s[i] + s[i + 1] + 1) >> 1;
|
|
|
|
MST1 (dd[0], s[i], pixel_mask);
|
|
MST1 (dd[1], uv, pixel_mask >> 8);
|
|
MST1 (dd[2], s[i + 1], pixel_mask);
|
|
MST1 (dd[3], uv, pixel_mask >> 16);
|
|
}
|
|
break;
|
|
|
|
case VBI_PIXFMT_UYVY:
|
|
case VBI_PIXFMT_VYUY:
|
|
for (i = 0; i < samples_per_line; i += 2) {
|
|
uint8_t *dd = d + i * 2;
|
|
unsigned int uv = (s[i] + s[i + 1] + 1) >> 1;
|
|
|
|
MST1 (dd[0], uv, pixel_mask >> 8);
|
|
MST1 (dd[1], s[i], pixel_mask);
|
|
MST1 (dd[2], uv, pixel_mask >> 16);
|
|
MST1 (dd[3], s[i + 1], pixel_mask);
|
|
}
|
|
break;
|
|
|
|
case VBI_PIXFMT_RGB16_LE:
|
|
case VBI_PIXFMT_BGR16_LE:
|
|
SCAN_LINE_TO_RGB2 (RGBA_TO_RGB16, 0);
|
|
break;
|
|
|
|
case VBI_PIXFMT_RGB16_BE:
|
|
case VBI_PIXFMT_BGR16_BE:
|
|
SCAN_LINE_TO_RGB2 (RGBA_TO_RGB16, 1);
|
|
break;
|
|
|
|
case VBI_PIXFMT_RGBA15_LE:
|
|
case VBI_PIXFMT_BGRA15_LE:
|
|
SCAN_LINE_TO_RGB2 (RGBA_TO_RGBA15, 0);
|
|
break;
|
|
|
|
case VBI_PIXFMT_RGBA15_BE:
|
|
case VBI_PIXFMT_BGRA15_BE:
|
|
SCAN_LINE_TO_RGB2 (RGBA_TO_RGBA15, 1);
|
|
break;
|
|
|
|
case VBI_PIXFMT_ARGB15_LE:
|
|
case VBI_PIXFMT_ABGR15_LE:
|
|
SCAN_LINE_TO_RGB2 (RGBA_TO_ARGB15, 0);
|
|
break;
|
|
|
|
case VBI_PIXFMT_ARGB15_BE:
|
|
case VBI_PIXFMT_ABGR15_BE:
|
|
SCAN_LINE_TO_RGB2 (RGBA_TO_ARGB15, 1);
|
|
break;
|
|
|
|
}
|
|
|
|
s += sp8.bytes_per_line;
|
|
d += sp->bytes_per_line;
|
|
}
|
|
|
|
vbi_free (buf);
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
/*
|
|
* @example examples/rawout.c
|
|
* Raw VBI output example.
|
|
*/
|
|
|
|
/*
|
|
* @param raw A raw VBI image will be stored here.
|
|
* @param raw_size Size of the @a raw buffer in bytes. The buffer
|
|
* must be large enough for @a sp->count[0] + count[1] lines
|
|
* of @a sp->bytes_per_line each, with @a sp->samples_per_line
|
|
* (in libzvbi 0.2.x @a sp->bytes_per_line) bytes actually written.
|
|
* @param sp Describes the raw VBI data to generate. @a sp->sampling_format
|
|
* must be @c VBI_PIXFMT_Y8 (@c VBI_PIXFMT_YUV420 with libzvbi 0.2.x).
|
|
* @a sp->synchronous is ignored. Note for compatibility in libzvbi
|
|
* 0.2.x vbi_sampling_par is a synonym of vbi_raw_decoder, but the
|
|
* (private) decoder fields in this structure are ignored.
|
|
* @param blank_level The level of the horizontal blanking in the raw
|
|
* VBI image. Must be <= @a white_level.
|
|
* @param white_level The peak white level in the raw VBI image. Set to
|
|
* zero to get the default blanking and white level.
|
|
* @param swap_fields If @c TRUE the second field will be stored first
|
|
* in the @c raw buffer. Note you can also get an interlaced image
|
|
* by setting @a sp->interlaced to @c TRUE. @a sp->synchronous is
|
|
* ignored.
|
|
* @param sliced Pointer to an array of vbi_sliced containing the
|
|
* VBI data to be encoded.
|
|
* @param n_sliced_lines Number of elements in the @a sliced array.
|
|
*
|
|
* This function basically reverses the operation of the vbi_raw_decoder,
|
|
* taking sliced VBI data and generating a raw VBI image similar to those
|
|
* you would get from raw VBI sampling hardware. The following data services
|
|
* are currently supported: All Teletext services, VPS, WSS 625, Closed
|
|
* Caption 525 and 625.
|
|
*
|
|
* The function encodes sliced data as is, e.g. without adding or
|
|
* checking parity bits, without checking if the line number is correct
|
|
* for the respective data service, or if the signal will fit completely
|
|
* in the given space (@a sp->offset and @a sp->samples_per_line at
|
|
* @a sp->sampling_rate).
|
|
*
|
|
* Apart of the payload the generated video signal is invariable and
|
|
* attempts to be faithful to related standards. You can only change the
|
|
* characteristics of the assumed capture device. Sync pulses and color
|
|
* bursts and not generated if the sampling parameters extend to this area.
|
|
*
|
|
* @note
|
|
* This function is mainly intended for testing purposes. It is optimized
|
|
* for accuracy, not for speed.
|
|
*
|
|
* @returns
|
|
* @c FALSE if the @a raw_size is too small, if the @a sp sampling
|
|
* parameters are invalid, if the signal levels are invalid,
|
|
* if the @a sliced array contains unsupported services or line numbers
|
|
* outside the @a sp sampling parameters.
|
|
*
|
|
* @since 0.2.22
|
|
*/
|
|
vbi_bool
|
|
vbi_raw_vbi_image (uint8_t * raw,
|
|
unsigned long raw_size,
|
|
const vbi_sampling_par * sp,
|
|
int blank_level,
|
|
int white_level,
|
|
vbi_bool swap_fields,
|
|
const vbi_sliced * sliced, unsigned int n_sliced_lines)
|
|
{
|
|
return _vbi_raw_vbi_image (raw, raw_size, sp,
|
|
blank_level, white_level,
|
|
swap_fields ? _VBI_RAW_SWAP_FIELDS : 0, sliced, n_sliced_lines);
|
|
}
|
|
|
|
/*
|
|
* @param raw A raw VBI image will be stored here.
|
|
* @param raw_size Size of the @a raw buffer in bytes. The buffer
|
|
* must be large enough for @a sp->count[0] + count[1] lines
|
|
* of @a sp->bytes_per_line each, with @a sp->samples_per_line
|
|
* times bytes per pixel (in libzvbi 0.2.x @a sp->bytes_per_line)
|
|
* actually written.
|
|
* @param sp Describes the raw VBI data to generate. Note for
|
|
* compatibility in libzvbi 0.2.x vbi_sampling_par is a synonym of
|
|
* vbi_raw_decoder, but the (private) decoder fields in this
|
|
* structure are ignored.
|
|
* @param blank_level The level of the horizontal blanking in the raw
|
|
* VBI image. Must be <= @a black_level.
|
|
* @param black_level The black level in the raw VBI image. Must be
|
|
* <= @a white_level.
|
|
* @param white_level The peak white level in the raw VBI image. Set to
|
|
* zero to get the default blanking, black and white level.
|
|
* @param pixel_mask This mask selects which color or alpha channel
|
|
* shall contain VBI data. Depending on @a sp->sampling_format it is
|
|
* interpreted as 0xAABBGGRR or 0xAAVVUUYY. A value of 0x000000FF
|
|
* for example writes data in "red bits", not changing other
|
|
* bits in the @a raw buffer. When the @a sp->sampling_format is a
|
|
* planar YUV the function writes the Y plane only.
|
|
* @param swap_fields If @c TRUE the second field will be stored first
|
|
* in the @c raw buffer. Note you can also get an interlaced image
|
|
* by setting @a sp->interlaced to @c TRUE. @a sp->synchronous is
|
|
* ignored.
|
|
* @param sliced Pointer to an array of vbi_sliced containing the
|
|
* VBI data to be encoded.
|
|
* @param n_sliced_lines Number of elements in the @a sliced array.
|
|
*
|
|
* Generates a raw VBI image similar to those you get from video
|
|
* capture hardware. Otherwise identical to vbi_raw_vbi_image().
|
|
*
|
|
* @returns
|
|
* @c FALSE if the @a raw_size is too small, if the @a sp sampling
|
|
* parameters are invalid, if the signal levels are invalid,
|
|
* if the @a sliced array contains unsupported services or line numbers
|
|
* outside the @a sp sampling parameters.
|
|
*
|
|
* @since 0.2.22
|
|
*/
|
|
vbi_bool
|
|
vbi_raw_video_image (uint8_t * raw,
|
|
unsigned long raw_size,
|
|
const vbi_sampling_par * sp,
|
|
int blank_level,
|
|
int black_level,
|
|
int white_level,
|
|
unsigned int pixel_mask,
|
|
vbi_bool swap_fields,
|
|
const vbi_sliced * sliced, unsigned int n_sliced_lines)
|
|
{
|
|
return _vbi_raw_video_image (raw, raw_size, sp,
|
|
blank_level, black_level,
|
|
white_level, pixel_mask,
|
|
swap_fields ? _VBI_RAW_SWAP_FIELDS : 0, sliced, n_sliced_lines);
|
|
}
|
|
|
|
/*
|
|
Local variables:
|
|
c-set-style: K&R
|
|
c-basic-offset: 8
|
|
End:
|
|
*/
|