Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * vivid-vbi-gen.c - vbi generator support functions.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright 2014 Cisco Systems, Inc. and/or its affiliates. All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/ktime.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/videodev2.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include "vivid-vbi-gen.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) static void wss_insert(u8 *wss, u32 val, unsigned size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 	while (size--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 		*wss++ = (val & (1 << size)) ? 0xc0 : 0x10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) static void vivid_vbi_gen_wss_raw(const struct v4l2_sliced_vbi_data *data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) 		u8 *buf, unsigned sampling_rate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 	const unsigned rate = 5000000;	/* WSS has a 5 MHz transmission rate */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 	u8 wss[29 + 24 + 24 + 24 + 18 + 18] = { 0 };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	const unsigned zero = 0x07;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	const unsigned one = 0x38;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	unsigned bit = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	u16 wss_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	wss_insert(wss + bit, 0x1f1c71c7, 29); bit += 29;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	wss_insert(wss + bit, 0x1e3c1f, 24); bit += 24;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	wss_data = (data->data[1] << 8) | data->data[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	for (i = 0; i <= 13; i++, bit += 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 		wss_insert(wss + bit, (wss_data & (1 << i)) ? one : zero, 6);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	for (i = 0, bit = 0; bit < sizeof(wss); bit++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 		unsigned n = ((bit + 1) * sampling_rate) / rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 		while (i < n)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 			buf[i++] = wss[bit];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) static void vivid_vbi_gen_teletext_raw(const struct v4l2_sliced_vbi_data *data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 		u8 *buf, unsigned sampling_rate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	const unsigned rate = 6937500 / 10;	/* Teletext has a 6.9375 MHz transmission rate */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	u8 teletext[45] = { 0x55, 0x55, 0x27 };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	unsigned bit = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	memcpy(teletext + 3, data->data, sizeof(teletext) - 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	/* prevents 32 bit overflow */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	sampling_rate /= 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	for (i = 0, bit = 0; bit < sizeof(teletext) * 8; bit++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 		unsigned n = ((bit + 1) * sampling_rate) / rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 		u8 val = (teletext[bit / 8] & (1 << (bit & 7))) ? 0xc0 : 0x10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 		while (i < n)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 			buf[i++] = val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) static void cc_insert(u8 *cc, u8 ch)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	unsigned tot = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	unsigned i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	for (i = 0; i < 7; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 		cc[2 * i] = cc[2 * i + 1] = (ch & (1 << i)) ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 		tot += cc[2 * i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	cc[14] = cc[15] = !(tot & 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) #define CC_PREAMBLE_BITS (14 + 4 + 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) static void vivid_vbi_gen_cc_raw(const struct v4l2_sliced_vbi_data *data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 		u8 *buf, unsigned sampling_rate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	const unsigned rate = 1000000;	/* CC has a 1 MHz transmission rate */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	u8 cc[CC_PREAMBLE_BITS + 2 * 16] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 		/* Clock run-in: 7 cycles */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 		0, 1, 0, 1, 0, 1, 0, 1, 0, 1, 0, 1, 0, 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 		/* 2 cycles of 0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 		0, 0, 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 		/* Start bit of 1 (each bit is two cycles) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 		1, 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	unsigned bit, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	cc_insert(cc + CC_PREAMBLE_BITS, data->data[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	cc_insert(cc + CC_PREAMBLE_BITS + 16, data->data[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	for (i = 0, bit = 0; bit < sizeof(cc); bit++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 		unsigned n = ((bit + 1) * sampling_rate) / rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 		while (i < n)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 			buf[i++] = cc[bit] ? 0xc0 : 0x10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) void vivid_vbi_gen_raw(const struct vivid_vbi_gen_data *vbi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 		const struct v4l2_vbi_format *vbi_fmt, u8 *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	unsigned idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	for (idx = 0; idx < 25; idx++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 		const struct v4l2_sliced_vbi_data *data = vbi->data + idx;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 		unsigned start_2nd_field;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 		unsigned line = data->line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 		u8 *linebuf = buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 		start_2nd_field = (data->id & V4L2_SLICED_VBI_525) ? 263 : 313;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 		if (data->field)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 			line += start_2nd_field;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		line -= vbi_fmt->start[data->field];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 		if (vbi_fmt->flags & V4L2_VBI_INTERLACED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 			linebuf += (line * 2 + data->field) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 				vbi_fmt->samples_per_line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 			linebuf += (line + data->field * vbi_fmt->count[0]) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 				vbi_fmt->samples_per_line;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 		if (data->id == V4L2_SLICED_CAPTION_525)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 			vivid_vbi_gen_cc_raw(data, linebuf, vbi_fmt->sampling_rate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 		else if (data->id == V4L2_SLICED_WSS_625)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 			vivid_vbi_gen_wss_raw(data, linebuf, vbi_fmt->sampling_rate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 		else if (data->id == V4L2_SLICED_TELETEXT_B)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 			vivid_vbi_gen_teletext_raw(data, linebuf, vbi_fmt->sampling_rate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) static const u8 vivid_cc_sequence1[30] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	0x14, 0x20,	/* Resume Caption Loading */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	'H',  'e',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	'l',  'l',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	'o',  ' ',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	'w',  'o',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	'r',  'l',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	'd',  '!',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	0x14, 0x2f,	/* End of Caption */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) static const u8 vivid_cc_sequence2[30] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	0x14, 0x20,	/* Resume Caption Loading */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	'C',  'l',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	'o',  's',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	'e',  'd',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	' ',  'c',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	'a',  'p',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	't',  'i',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	'o',  'n',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	's',  ' ',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	't',  'e',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	's',  't',
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	0x14, 0x2f,	/* End of Caption */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) static u8 calc_parity(u8 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	unsigned i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	unsigned tot = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	for (i = 0; i < 7; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 		tot += (val & (1 << i)) ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	return val | ((tot & 1) ? 0 : 0x80);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) static void vivid_vbi_gen_set_time_of_day(u8 *packet)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	struct tm tm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	u8 checksum, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	time64_to_tm(ktime_get_real_seconds(), 0, &tm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	packet[0] = calc_parity(0x07);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 	packet[1] = calc_parity(0x01);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	packet[2] = calc_parity(0x40 | tm.tm_min);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 	packet[3] = calc_parity(0x40 | tm.tm_hour);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	packet[4] = calc_parity(0x40 | tm.tm_mday);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	if (tm.tm_mday == 1 && tm.tm_mon == 2 &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	    sys_tz.tz_minuteswest > tm.tm_min + tm.tm_hour * 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 		packet[4] = calc_parity(0x60 | tm.tm_mday);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	packet[5] = calc_parity(0x40 | (1 + tm.tm_mon));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	packet[6] = calc_parity(0x40 | (1 + tm.tm_wday));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 	packet[7] = calc_parity(0x40 | ((tm.tm_year - 90) & 0x3f));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	packet[8] = calc_parity(0x0f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	for (checksum = i = 0; i <= 8; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 		checksum += packet[i] & 0x7f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	packet[9] = calc_parity(0x100 - checksum);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	checksum = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 	packet[10] = calc_parity(0x07);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 	packet[11] = calc_parity(0x04);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	if (sys_tz.tz_minuteswest >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 		packet[12] = calc_parity(0x40 | ((sys_tz.tz_minuteswest / 60) & 0x1f));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 		packet[12] = calc_parity(0x40 | ((24 + sys_tz.tz_minuteswest / 60) & 0x1f));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	packet[13] = calc_parity(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 	packet[14] = calc_parity(0x0f);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	for (checksum = 0, i = 10; i <= 14; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 		checksum += packet[i] & 0x7f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	packet[15] = calc_parity(0x100 - checksum);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) static const u8 hamming[16] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 	0x15, 0x02, 0x49, 0x5e, 0x64, 0x73, 0x38, 0x2f,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	0xd0, 0xc7, 0x8c, 0x9b, 0xa1, 0xb6, 0xfd, 0xea
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) static void vivid_vbi_gen_teletext(u8 *packet, unsigned line, unsigned frame)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	unsigned offset = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	unsigned i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 	packet[0] = hamming[1 + ((line & 1) << 3)];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	packet[1] = hamming[line >> 1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 	memset(packet + 2, 0x20, 40);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 	if (line == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 		/* subcode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 		packet[2] = hamming[frame % 10];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 		packet[3] = hamming[frame / 10];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 		packet[4] = hamming[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 		packet[5] = hamming[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 		packet[6] = hamming[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 		packet[7] = hamming[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 		packet[8] = hamming[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 		packet[9] = hamming[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 		offset = 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 	packet += offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 	memcpy(packet, "Page: 100 Row: 10", 17);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	packet[7] = '0' + frame / 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 	packet[8] = '0' + frame % 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	packet[15] = '0' + line / 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	packet[16] = '0' + line % 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	for (i = 0; i < 42 - offset; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 		packet[i] = calc_parity(packet[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) void vivid_vbi_gen_sliced(struct vivid_vbi_gen_data *vbi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 		bool is_60hz, unsigned seqnr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	struct v4l2_sliced_vbi_data *data0 = vbi->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	struct v4l2_sliced_vbi_data *data1 = vbi->data + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	unsigned frame = seqnr % 60;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	memset(vbi->data, 0, sizeof(vbi->data));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	if (!is_60hz) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 		unsigned i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 		for (i = 0; i <= 11; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 			data0->id = V4L2_SLICED_TELETEXT_B;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 			data0->line = 7 + i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 			vivid_vbi_gen_teletext(data0->data, i, frame);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 			data0++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 		data0->id = V4L2_SLICED_WSS_625;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 		data0->line = 23;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 		/* 4x3 video aspect ratio */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 		data0->data[0] = 0x08;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 		data0++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		for (i = 0; i <= 11; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 			data0->id = V4L2_SLICED_TELETEXT_B;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 			data0->field = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 			data0->line = 7 + i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 			vivid_vbi_gen_teletext(data0->data, 12 + i, frame);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 			data0++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 	data0->id = V4L2_SLICED_CAPTION_525;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	data0->line = 21;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 	data1->id = V4L2_SLICED_CAPTION_525;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 	data1->field = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 	data1->line = 21;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	if (frame < 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 		data0->data[0] = calc_parity(vivid_cc_sequence1[2 * frame]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		data0->data[1] = calc_parity(vivid_cc_sequence1[2 * frame + 1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	} else if (frame >= 30 && frame < 45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 		frame -= 30;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 		data0->data[0] = calc_parity(vivid_cc_sequence2[2 * frame]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 		data0->data[1] = calc_parity(vivid_cc_sequence2[2 * frame + 1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 		data0->data[0] = calc_parity(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 		data0->data[1] = calc_parity(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 	frame = seqnr % (30 * 60);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 	switch (frame) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	case 0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 		vivid_vbi_gen_set_time_of_day(vbi->time_of_day_packet);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 		fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	case 1 ... 7:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 		data1->data[0] = vbi->time_of_day_packet[frame * 2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 		data1->data[1] = vbi->time_of_day_packet[frame * 2 + 1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 		data1->data[0] = calc_parity(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 		data1->data[1] = calc_parity(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) }