From patchwork Wed Jul 25 17:44:00 2012 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Konke Radlow X-Patchwork-Id: 1238561 Return-Path: X-Original-To: patchwork-linux-media@patchwork.kernel.org Delivered-To: patchwork-process-083081@patchwork1.kernel.org Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by patchwork1.kernel.org (Postfix) with ESMTP id DE5F73FDFB for ; Wed, 25 Jul 2012 15:54:44 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1755288Ab2GYPym (ORCPT ); Wed, 25 Jul 2012 11:54:42 -0400 Received: from ams-iport-4.cisco.com ([144.254.224.147]:9226 "EHLO ams-iport-4.cisco.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1755070Ab2GYPyl (ORCPT ); Wed, 25 Jul 2012 11:54:41 -0400 X-Greylist: delayed 588 seconds by postgrey-1.27 at vger.kernel.org; Wed, 25 Jul 2012 11:54:39 EDT DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=cisco.com; i=kradlow@cisco.com; l=35085; q=dns/txt; s=iport; t=1343231679; x=1344441279; h=from:to:cc:subject:date:message-id:in-reply-to: references; bh=o+4ROqp4MLBjxMhzKVV/LqAojy1EdFg2qDT+LOCvFpE=; b=mIaEcbD1oWMKsXvOiUfm5Os1x2V4+bPQKqHFy0khuU9TOBu8GYD/FTor 5DoiNdGPxQl0qRtVxGQnKWP+TfV5qYxzSlnFsRiUK7vhUlhYihVteAYbL oE8gnJyTrj4kr1Jgw56h9cPF4JCu6Ni97hArvGI1PWOnfnBLCPUKBFDzx I=; X-IronPort-Anti-Spam-Filtered: true X-IronPort-Anti-Spam-Result: Av0EAJcTEFCQ/khM/2dsb2JhbABFuWOBB4IhAQEEEgEHAQxAEhBGCyE2GRUBBAiHXAMMmyKPFodcDYlOimVoIIZUA5N1gVSBFIl2gx2BZoJfgVcBIw X-IronPort-AV: E=Sophos;i="4.77,653,1336348800"; d="scan'208";a="6891631" Received: from ams-core-3.cisco.com ([144.254.72.76]) by ams-iport-4.cisco.com with ESMTP; 25 Jul 2012 15:44:50 +0000 Received: from rds-testing-box.rd.tandberg.com ([10.47.19.80]) by ams-core-3.cisco.com (8.14.5/8.14.5) with ESMTP id q6PFinvh025935; Wed, 25 Jul 2012 15:44:49 GMT From: Konke Radlow To: linux-media@vger.kernel.org Cc: hverkuil@xs4all.nl, hdegoede@redhat.com Subject: [RFC PATCH 1/2] Initial version of the RDS-decoder library Signed-off-by: Konke Radlow Date: Wed, 25 Jul 2012 17:44:00 +0000 Message-Id: X-Mailer: git-send-email 1.7.10.4 In-Reply-To: <1343238241-26772-1-git-send-email-kradlow@cisco.com> References: <1343238241-26772-1-git-send-email-kradlow@cisco.com> Sender: linux-media-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-media@vger.kernel.org --- Makefile.am | 3 +- configure.ac | 10 +- lib/libv4l2rds/Makefile.am | 11 + lib/libv4l2rds/libv4l2rds.c | 871 +++++++++++++++++++++++++++++++++++++++ lib/libv4l2rds/libv4l2rds.pc.in | 11 + 5 files changed, 904 insertions(+), 2 deletions(-) create mode 100644 lib/libv4l2rds/Makefile.am create mode 100644 lib/libv4l2rds/libv4l2rds.c create mode 100644 lib/libv4l2rds/libv4l2rds.pc.in diff --git a/Makefile.am b/Makefile.am index b7b356c..6707f5f 100644 --- a/Makefile.am +++ b/Makefile.am @@ -5,7 +5,8 @@ SUBDIRS = \ lib/libv4lconvert \ lib/libv4l2 \ lib/libv4l1 \ - lib/libdvbv5 + lib/libdvbv5 \ + lib/libv4l2rds if WITH_V4LUTILS SUBDIRS += \ diff --git a/configure.ac b/configure.ac index 8ddcc9d..1d7eb29 100644 --- a/configure.ac +++ b/configure.ac @@ -14,6 +14,7 @@ AC_CONFIG_FILES([Makefile lib/libv4l2/Makefile lib/libv4l1/Makefile lib/libdvbv5/Makefile + lib/libv4l2rds/Makefile utils/libv4l2util/Makefile utils/libmedia_dev/Makefile @@ -36,6 +37,7 @@ AC_CONFIG_FILES([Makefile lib/libv4l1/libv4l1.pc lib/libv4l2/libv4l2.pc lib/libdvbv5/libdvbv5.pc + lib/libv4l2rds/libv4l2rds.pc ]) AM_INIT_AUTOMAKE([1.9 no-dist-gzip dist-bzip2 -Wno-portability]) # 1.10 is needed for target_LIBTOOLFLAGS @@ -146,13 +148,17 @@ AC_ARG_WITH(libv4l2subdir, AS_HELP_STRING(--with-libv4l2subdir=DIR,set libv4l2 l AC_ARG_WITH(libv4lconvertsubdir, AS_HELP_STRING(--with-libv4lconvertsubdir=DIR,set libv4lconvert library subdir [default=libv4l]), libv4lconvertsubdir=$withval, libv4lconvertsubdir="libv4l") +AC_ARG_WITH(libv4l2rdssubdir, AS_HELP_STRING(--with-libv4l2rdssubdir=DIR,set libv4l2rds library subdir [default=libv4l]), + libv4l2rdssubdir=$withval, libv4l2rdssubdir="libv4l") + AC_ARG_WITH(udevdir, AS_HELP_STRING(--with-udevdir=DIR,set udev directory [default=/lib/udev]), udevdir=$withval, udevdir="/lib/udev") - + libv4l1privdir="$libdir/$libv4l1subdir" libv4l2privdir="$libdir/$libv4l2subdir" libv4l2plugindir="$libv4l2privdir/plugins" libv4lconvertprivdir="$libdir/$libv4lconvertsubdir" +libv4l2rdsprivdir="$libdir/$libv4l2rdssubdir" keytablesystemdir="$udevdir/rc_keymaps" keytableuserdir="$sysconfdir/rc_keymaps" @@ -166,6 +172,7 @@ AC_SUBST(libv4lconvertprivdir) AC_SUBST(keytablesystemdir) AC_SUBST(keytableuserdir) AC_SUBST(udevrulesdir) +AC_SUBST(libv4l2rdsprivdir) AC_SUBST(pkgconfigdir) AC_DEFINE_UNQUOTED([V4L_UTILS_VERSION], ["$PACKAGE_VERSION"], [v4l-utils version string]) @@ -173,6 +180,7 @@ AC_DEFINE_DIR([LIBV4L1_PRIV_DIR], [libv4l1privdir], [libv4l1 private lib directo AC_DEFINE_DIR([LIBV4L2_PRIV_DIR], [libv4l2privdir], [libv4l2 private lib directory]) AC_DEFINE_DIR([LIBV4L2_PLUGIN_DIR], [libv4l2plugindir], [libv4l2 plugin directory]) AC_DEFINE_DIR([LIBV4LCONVERT_PRIV_DIR], [libv4lconvertprivdir], [libv4lconvert private lib directory]) +AC_DEFINE_DIR([LIBV4L2RDS_PRIV_DIR], [libv4l2rdsprivdir], [libv4l2rds private lib directory]) AC_DEFINE_DIR([IR_KEYTABLE_SYSTEM_DIR], [keytablesystemdir], [ir-keytable preinstalled tables directory]) AC_DEFINE_DIR([IR_KEYTABLE_USER_DIR], [keytableuserdir], [ir-keytable user defined tables directory]) diff --git a/lib/libv4l2rds/Makefile.am b/lib/libv4l2rds/Makefile.am new file mode 100644 index 0000000..5796890 --- /dev/null +++ b/lib/libv4l2rds/Makefile.am @@ -0,0 +1,11 @@ +if WITH_LIBV4L +lib_LTLIBRARIES = libv4l2rds.la +include_HEADERS = ../include/libv4l2rds.h +pkgconfig_DATA = libv4l2rds.pc +else +noinst_LTLIBRARIES = libv4l2rds.la +endif + +libv4l2rds_la_SOURCES = libv4l2rds.c +libv4l2rds_la_CPPFLAGS = -fvisibility=hidden $(ENFORCE_LIBV4L_STATIC) -std=c99 +libv4l2rds_la_LDFLAGS = -version-info 0 -lpthread $(DLOPEN_LIBS) $(ENFORCE_LIBV4L_STATIC) diff --git a/lib/libv4l2rds/libv4l2rds.c b/lib/libv4l2rds/libv4l2rds.c new file mode 100644 index 0000000..0bacaa2 --- /dev/null +++ b/lib/libv4l2rds/libv4l2rds.c @@ -0,0 +1,871 @@ +/* + * Copyright 2012 Cisco Systems, Inc. and/or its affiliates. All rights reserved. + * Author: Konke Radlow + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU Lesser General Public License as published by + * the Free Software Foundation; either version 2.1 of the License, or + * (at your option) any later version. + * + * This program 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 this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin Street, Suite 500, Boston, MA 02110-1335 USA + */ + +#include + +#include "../include/libv4l2rds.h" + +/* struct to encapsulate the private state information of the decoding process */ +struct rds_private_state { + /* v4l2_rds has to be in first position, to allow typecasting between + * v4l2_rds and rds_private_state pointers */ + struct v4l2_rds handle; + + uint8_t decode_state; + uint16_t new_pi; + uint8_t new_ps[8]; + uint8_t new_ps_valid[8]; + uint8_t new_pty; + uint8_t new_ptyn[2][4]; + bool new_ptyn_valid[2]; + uint8_t new_rt[64]; + uint8_t new_rt_pos; + uint8_t new_ecc; + uint8_t new_lc; + uint8_t new_di; + uint8_t new_di_pos; + struct v4l2_rds_group rds_group; + struct v4l2_rds_data rds_data_raw[4]; +}; + +/* states of the RDS block into group decoding state machine */ +enum rds_state { + RDS_EMPTY, + RDS_A_RECEIVED, + RDS_B_RECEIVED, + RDS_C_RECEIVED, +}; + +static inline uint8_t set_bit(uint8_t input, uint8_t bitmask, bool bitvalue) +{ + return bitvalue ? input | bitmask : input & ~bitmask; +} + +/* rds_decode_a-d(..): group of functions to decode different RDS blocks + * into the RDS group that's currently being received + * + * block A of RDS group always contains PI code of program */ +static uint32_t rds_decode_a(struct rds_private_state *priv_state, struct v4l2_rds_data *rds_data) +{ + struct v4l2_rds *handle = &priv_state->handle; + uint32_t updated_fields = 0x00; + uint16_t pi = (rds_data->msb << 8) | rds_data->lsb; + + /* data in RDS group is uninterpreted */ + priv_state->rds_group.pi = pi; + + /* compare PI values to detect PI update (Channel Switch) + * --> new PI is only accepted, if the same PI is received + * at least 2 times in a row */ + if (pi != handle->pi && pi == priv_state->new_pi) { + handle->pi = pi; + handle->valid_fields |= V4L2_RDS_PI; + updated_fields |= V4L2_RDS_PI; + } else if (pi != handle->pi && pi != priv_state->new_pi) { + priv_state->new_pi = pi; + } + + return updated_fields; +} + +/* block B of RDS group always contains Group Type Code, Group Type information + * Traffic Program Code and Program Type Code as well as 5 bits of Group Type + * depending information */ +static uint32_t rds_decode_b(struct rds_private_state *priv_state, struct v4l2_rds_data *rds_data) +{ + struct v4l2_rds *handle = &priv_state->handle; + struct v4l2_rds_group *grp = &priv_state->rds_group; + uint32_t updated_fields = 0x00; + + /* bits 12-15 (4-7 of msb) contain the Group Type Code */ + grp->group_id = rds_data->msb >> 4 ; + + /* bit 11 (3 of msb) defines Group Type info: 0 = A, 1 = B */ + grp->group_version = (rds_data->msb & 0x08) ? 'B' : 'A'; + + /* bit 10 (2 of msb) defines Traffic program Code */ + grp->traffic_prog = rds_data->msb & 0x04; + if (handle->tp != grp->traffic_prog) { + handle->tp = grp->traffic_prog; + updated_fields |= V4L2_RDS_TP; + } + handle->valid_fields |= V4L2_RDS_TP; + + /* bits 0-4 contains Group Type depending information */ + grp->data_b_lsb = (rds_data->lsb & 0x1f); + + /* bits 5-9 contain the PTY code */ + grp->pty = (rds_data->msb << 3) | (rds_data->lsb >> 5); + grp->pty &= 0x1f; /* mask out 3 irrelevant bits */ + /* only accept new PTY if same PTY is received twice in a row + * and filter out cases where the PTY is already known */ + if (handle->pty == grp->pty) { + priv_state->new_pty = grp->pty; + return updated_fields; + } + + if (priv_state->new_pty == grp->pty) { + handle->pty = priv_state->new_pty; + updated_fields |= V4L2_RDS_PTY; + handle->valid_fields |= V4L2_RDS_PTY; + } else { + priv_state->new_pty = grp->pty; + } + + return updated_fields; +} + +/* block C of RDS group contains either data or the PI code, depending + * on the Group Type - store the raw data for later decoding */ +static void rds_decode_c(struct rds_private_state *priv_state, struct v4l2_rds_data *rds_data) +{ + struct v4l2_rds_group *grp = &priv_state->rds_group; + + grp->data_c_msb = rds_data->msb; + grp->data_c_lsb = rds_data->lsb; + /* we could decode the PI code here, because we already know if the + * group is of type A or B, but it doesn't give any advantage because + * we only get here after the PI code has been decoded in the first + * state of the state machine */ +} + +/* block D of RDS group contains data - store the raw data for later decoding */ +static void rds_decode_d(struct rds_private_state *priv_state, struct v4l2_rds_data *rds_data) +{ + struct v4l2_rds_group *grp = &priv_state->rds_group; + + grp->data_d_msb = rds_data->msb; + grp->data_d_lsb = rds_data->lsb; +} + +static bool rds_add_oda(struct rds_private_state *priv_state, struct v4l2_rds_oda oda) +{ + struct v4l2_rds *handle = &priv_state->handle; + + /* check if there was already an ODA announced for this group type */ + for (int i = 0; i < handle->rds_oda.size; i++) { + if (handle->rds_oda.oda[i].group_id == oda.group_id) + /* update the AID for this ODA */ + handle->rds_oda.oda[i].aid = oda.aid; + return false; + } + /* add the new ODA */ + if (handle->rds_oda.size >= MAX_ODA_CNT) + return false; + handle->rds_oda.oda[handle->rds_oda.size++] = oda; + return true; +} + +/* add a new AF to the list, if it doesn't exist yet */ +static bool rds_add_af_to_list(struct v4l2_rds_af_set *af_set, uint8_t af, bool is_vhf) +{ + uint32_t freq = 0; + + /* AF0 -> "Not to be used" */ + if (af == 0) + return false; + + /* calculate the AF values in HZ */ + if (is_vhf) + freq = 87500000 + af * 100000; + else if (freq <= 15) + freq = 152000 + af * 9000; + else + freq = 531000 + af * 9000; + + /* prevent buffer overflows */ + if (af_set->size >= MAX_AF_CNT || af_set->size >= af_set->announced_af) + return false; + /* check if AF already exists */ + for (int i = 0; i < af_set->size; i++) { + if (af_set->af[i] == freq) + return false; + } + /* it's a new AF, add it to the list */ + af_set->af[(af_set->size)++] = freq; + return true; +} + +static bool rds_add_af(struct rds_private_state *priv_state) +{ + struct v4l2_rds *handle = &priv_state->handle; + + /* AFs are submitted in Block 3 of type 0A groups */ + uint8_t c_msb = priv_state->rds_group.data_c_msb; + uint8_t c_lsb = priv_state->rds_group.data_c_lsb; + bool updated_af = false; + struct v4l2_rds_af_set *af_set = &handle->rds_af; + + /* LF / MF frequency follows */ + if (c_msb == 250) { + updated_af = (rds_add_af_to_list(af_set, c_lsb, false)) ? + true : updated_af; + c_lsb = 0; /* invalidate */ + } + /* announcement of AF count */ + if (c_msb >= 225 && c_msb <= 249) + af_set->announced_af = c_msb - 224; + /* check if the data represents an AF */ + if (c_msb < 205) + updated_af = (rds_add_af_to_list(af_set, c_msb, true)) ? + true : updated_af; + if (c_lsb < 205) + updated_af = (rds_add_af_to_list(af_set, c_lsb, true)) ? + true : updated_af; + /* did we receive all announced AFs?*/ + if (af_set->size >= af_set->announced_af && af_set->announced_af != 0) + handle->valid_fields |= V4L2_RDS_AF; + return updated_af; +} + +/* adds one char of the ps name to temporal storage, the value is validated + * if it is received twice in a row + * @pos: position of the char within the PS name (0..7) + * @ps_char: the new character to be added + * @return: true, if all 8 temporal ps chars have been validated */ +static bool rds_add_ps(struct rds_private_state *priv_state, uint8_t pos, uint8_t ps_char) +{ + if (ps_char == priv_state->new_ps[pos]) { + priv_state->new_ps_valid[pos] = 1; + } else { + priv_state->new_ps[pos] = ps_char; + memset(priv_state->new_ps_valid, 0, 8); + } + + /* check if all ps positions have been validated */ + for (int i = 0; i < 8; i++) + if (priv_state->new_ps_valid[i] != 1) + return false; + return true; +} + +/* group of functions to decode successfully received RDS groups into + * easily accessible data fields + * + * group 0: basic tuning and switching */ +static uint32_t rds_decode_group0(struct rds_private_state *priv_state) +{ + struct v4l2_rds *handle = &priv_state->handle; + struct v4l2_rds_group *grp = &priv_state->rds_group; + bool new_ps = false; + bool tmp; + uint32_t updated_fields = 0x00; + + /* bit 4 of block B contains the TA flag */ + tmp = grp->data_b_lsb & 0x10; + if (handle->ta != tmp) { + handle->ta = tmp; + updated_fields |= V4L2_RDS_TA; + } + handle->valid_fields |= V4L2_RDS_TA; + + /* bit 3 of block B contains the Music/Speech flag */ + tmp = grp->data_b_lsb & 0x08; + if (handle->ms != tmp) { + handle->ms = tmp; + updated_fields |= V4L2_RDS_MS; + } + handle->valid_fields |= V4L2_RDS_MS; + + /* bit 0-1 of block b contain program service name and decoder + * control segment address */ + uint8_t segment = (grp->data_b_lsb & 0x03); + + /* put the received station-name characters into the correct position + * of the station name, and check if the new PS is validated */ + rds_add_ps(priv_state, segment * 2, grp->data_d_msb); + new_ps = rds_add_ps(priv_state, segment * 2 + 1, grp->data_d_lsb); + if (new_ps) { + /* check if new PS is the same as the old one */ + if (memcmp(priv_state->new_ps, handle->ps, 8) != 0) { + memcpy(handle->ps, priv_state->new_ps, 8); + updated_fields |= V4L2_RDS_PS; + } + handle->valid_fields |= V4L2_RDS_PS; + } + + /* bit 2 of block B contains 1 bit of the Decoder Control Information (DI) + * the segment number defines the bit position + * New bits are only accepted the segments arrive in the correct order */ + bool bit2 = grp->data_b_lsb & 0x04; + if (segment == 0 || segment == priv_state->new_di_pos + 1) { + switch (segment) { + case 0: + priv_state->new_di = set_bit(priv_state->new_di, + V4L2_RDS_FLAG_STEREO, bit2); + break; + case 1: + priv_state->new_di = set_bit(priv_state->new_di, + V4L2_RDS_FLAG_ARTIFICIAL_HEAD, bit2); + priv_state->new_di_pos = segment; + break; + case 2: + priv_state->new_di = set_bit(priv_state->new_di, + V4L2_RDS_FLAG_COMPRESSED, bit2); + priv_state->new_di_pos = segment; + break; + case 3: + priv_state->new_di = set_bit(priv_state->new_di, + V4L2_RDS_FLAG_STATIC_PTY, bit2); + if (handle->di != priv_state->new_di) + updated_fields |= V4L2_RDS_DI; + handle->di = priv_state->new_di; + handle->valid_fields |= V4L2_RDS_DI; + break; + } + } else { + /* wrong order of DI segments -> restart */ + priv_state->new_di_pos = 0; + priv_state->new_di = 0x00; + } + + /* version A groups contain AFs in block C */ + if (grp->group_version == 'A') + if (rds_add_af(priv_state)) + updated_fields |= V4L2_RDS_AF; + + return updated_fields; +} + +/* group 1: slow labeling codes & program item number */ +static uint32_t rds_decode_group1(struct rds_private_state *priv_state) +{ + struct v4l2_rds *handle = &priv_state->handle; + struct v4l2_rds_group *grp = &priv_state->rds_group; + uint32_t updated_fields = 0x00; + uint8_t variant_code = 0x00; + + /* version A groups contain slow labeling codes, + * version B groups only contain program item number which is a + * very uncommonly used feature */ + if (grp->group_version != 'A') + return 0x00; + + /* bit 14-12 of block c contain the variant code */ + variant_code = (grp->data_c_msb >> 4) & 0x07; + if (variant_code == 0x00) { + /* var 0x00 -> ECC, only accept if same lc is + * received twice */ + if (grp->data_c_lsb == priv_state->new_ecc) { + handle->valid_fields |= V4L2_RDS_ECC; + if (handle->ecc != grp->data_c_lsb) + updated_fields |= V4L2_RDS_ECC; + handle->ecc = grp->data_c_lsb; + } else { + priv_state->new_ecc = grp->data_c_lsb; + } + } else if (variant_code == 0x03) { + /* var 0x03 -> Language Code, only accept if same lc is + * received twice */ + if (grp->data_c_lsb == priv_state->new_lc) { + handle->valid_fields |= V4L2_RDS_LC; + updated_fields |= V4L2_RDS_LC; + handle->lc = grp->data_c_lsb; + } else { + priv_state->new_lc = grp->data_c_lsb; + } + } + return updated_fields; +} + +/* group 2: radio text */ +static uint32_t rds_decode_group2(struct rds_private_state *priv_state) +{ + struct v4l2_rds *handle = &priv_state->handle; + struct v4l2_rds_group *grp = &priv_state->rds_group; + uint32_t updated_fields = 0x00; + + /* bit 0-3 of block B contain the segment code */ + uint8_t segment = grp->data_b_lsb & 0x0f; + /* bit 4 of block b contains the A/B text flag (new radio text + * will be transmitted) */ + bool rt_ab_flag_n = grp->data_b_lsb & 0x10; + + /* new Radio Text will be transmitted */ + if (rt_ab_flag_n != handle->rt_ab_flag) { + handle->rt_ab_flag = rt_ab_flag_n; + memset(handle->rt, 0x00, 64); + handle->valid_fields &= ~V4L2_RDS_RT; + updated_fields |= V4L2_RDS_RT; + } + + /* further decoding of data depends on type of message (A or B) + * Type A allows RTs with a max length of 64 chars + * Type B allows RTs with a max length of 32 chars */ + if (grp->group_version == 'A') { + if (segment == 0 || segment == priv_state->new_rt_pos + 1) { + priv_state->new_rt[segment * 4] = grp->data_c_msb; + priv_state->new_rt[segment * 4 + 1] = grp->data_c_lsb; + priv_state->new_rt[segment * 4 + 2] = grp->data_d_msb; + priv_state->new_rt[segment * 4 + 3] = grp->data_d_lsb; + priv_state->new_rt_pos = segment; + if (segment == 0x0f) { + handle->rt_length = 64; + handle->valid_fields |= V4L2_RDS_RT; + if (memcmp(handle->rt, priv_state->new_rt, 64)) { + memcpy(handle->rt, priv_state->new_rt, 64); + updated_fields |= V4L2_RDS_RT; + } + } + } + } else { + if (segment == 0 || segment == priv_state->new_rt_pos + 1) { + priv_state->new_rt[segment * 2] = grp->data_d_msb; + priv_state->new_rt[segment * 2 + 1] = grp->data_d_lsb; + /* PI code in block C will be ignored */ + priv_state->new_rt_pos = segment; + if (segment == 0x0f) { + handle->rt_length = 32; + handle->valid_fields |= V4L2_RDS_RT; + updated_fields |= V4L2_RDS_RT; + if (memcmp(handle->rt, priv_state->new_rt, 32)) { + memcpy(handle->rt, priv_state->new_rt, 32); + updated_fields |= V4L2_RDS_RT; + } + } + } + } + + /* determine if complete rt was received + * a carriage return (0x0d) can end a message early */ + for (int i = 0; i < 64; i++) { + if (priv_state->new_rt[i] == 0x0d) { + handle->rt_length = i + 1; + handle->valid_fields |= V4L2_RDS_RT; + if (memcmp(handle->rt, priv_state->new_rt, handle->rt_length)) { + memcpy(handle->rt, priv_state->new_rt, + handle->rt_length); + updated_fields |= V4L2_RDS_RT; + } + } + } + return updated_fields; +} + +/* group 3: Open Data Announcements */ +static uint32_t rds_decode_group3(struct rds_private_state *priv_state) +{ + struct v4l2_rds *handle = &priv_state->handle; + struct v4l2_rds_group *grp = &priv_state->rds_group; + struct v4l2_rds_oda new_oda; + uint32_t updated_fields = 0x00; + + if (grp->group_version != 'A') + return 0x00; + + /* 0th bit of block b contains Group Type Info version of announced ODA + * Group Type info: 0 = A, 1 = B */ + new_oda.group_version = (grp->data_b_lsb & 0x01) ? 'B' : 'A'; + /* 1st to 4th bit contain Group ID of announced ODA */ + new_oda.group_id = (grp->data_b_lsb & 0x1e) >> 1; + /* block D contains the 16bit Application Identification Code */ + new_oda.aid = (grp->data_d_msb << 8) | grp->data_d_lsb; + + /* try to add the new ODA to the set of defined ODAs */ + if (rds_add_oda(priv_state, new_oda)) { + handle->decode_information |= V4L2_RDS_ODA; + updated_fields |= V4L2_RDS_ODA; + } + return updated_fields; +} + +/* group 4: Date and Time */ +static uint32_t rds_decode_group4(struct rds_private_state *priv_state) +{ + struct v4l2_rds *handle = &priv_state->handle; + struct v4l2_rds_group *grp = &priv_state->rds_group; + uint32_t julian_date; + uint8_t utc_hour; + uint8_t utc_minute; + uint8_t utc_offset; + uint32_t updated_fields = 0x00; + + if (grp->group_version != 'A') + return 0x00; + + /* bits 0-1 of block b lsb contain bits 15 and 16 of Julian date + * bits 0-7 of block c msb contain bits 7 to 14 of Julian date + * bits 1-7 of block c lsb contain bits 0 to 6 of Julian date */ + julian_date = ((grp->data_b_lsb & 0x03) << 15) | + (grp->data_c_msb << 7) | (grp->data_c_lsb >> 1); + if (handle->julian_date != julian_date) { + handle->julian_date = julian_date; + updated_fields |= V4L2_RDS_TIME; + } + + /* bit 0 of block c lsb contains bit 4 of utc_hour + * bits 4-7 of block d contains bits 0 to 3 of utc_hour */ + utc_hour = ((grp->data_c_lsb & 0x01) << 4) | (grp->data_d_msb >> 4); + if (handle->utc_hour != utc_hour) { + handle->utc_hour = utc_hour; + updated_fields |= V4L2_RDS_TIME; + } + + /* bits 0-3 of block d msb contain bits 2 to 5 of utc_minute + * bits 6-7 of block d lsb contain bits 0 and 1 utc_minute */ + utc_minute = ((grp->data_d_msb & 0x0f) << 2) | (grp->data_d_lsb >> 6); + if (handle->utc_minute != utc_minute) { + handle->utc_minute = utc_minute; + updated_fields |= V4L2_RDS_TIME; + } + + /* bits 0-5 of block d lsb contain bits 0 to 5 of local time offset */ + utc_offset = grp->data_d_lsb & 0x3f; + if (handle->utc_offset != utc_offset) { + handle->utc_offset = utc_offset; + updated_fields |= V4L2_RDS_TIME; + } + + handle->valid_fields |= V4L2_RDS_TIME; + return updated_fields; +} + +/* group 10: Program Type Name */ +static uint32_t rds_decode_group10(struct rds_private_state *priv_state) +{ + struct v4l2_rds *handle = &priv_state->handle; + struct v4l2_rds_group *grp = &priv_state->rds_group; + uint32_t updated_fields = 0x00; + uint8_t ptyn_tmp[4]; + + /* bit 0 of block B contain the segment code */ + uint8_t segment_code = grp->data_b_lsb & 0x01; + /* bit 4 of block b contains the A/B text flag (new ptyn + * will be transmitted) */ + bool ptyn_ab_flag_n = grp->data_b_lsb & 0x10; + + if (grp->group_version != 'A') + return 0x00; + + /* new Program Type Text will be transmitted */ + if (ptyn_ab_flag_n != handle->ptyn_ab_flag) { + handle->ptyn_ab_flag = ptyn_ab_flag_n; + memset(handle->ptyn, 0, 8 * sizeof(char)); + memset(priv_state->new_ptyn, 0, 8 * sizeof(char)); + memset(priv_state->new_ptyn_valid, 0, 2 * sizeof(bool)); + handle->valid_fields &= ~V4L2_RDS_PTYN; + updated_fields |= V4L2_RDS_PTYN; + } + /* copy chars to designated position within temp text field */ + ptyn_tmp[0] = grp->data_c_msb; + ptyn_tmp[1] = grp->data_c_lsb; + ptyn_tmp[2] = grp->data_d_msb; + ptyn_tmp[3] = grp->data_d_lsb; + + /* only validate ptyn segment if the same data is received twice */ + if (memcmp(ptyn_tmp, priv_state->new_ptyn[segment_code], 4) == 0) { + priv_state->new_ptyn_valid[segment_code] = true; + } else { + for (int i = 0; i < 4; i++) + priv_state->new_ptyn[segment_code][i] = ptyn_tmp[i]; + priv_state->new_ptyn_valid[segment_code] = false; + } + + /* if both ptyn segments have been validated, accept the new ptyn */ + if (priv_state->new_ptyn_valid[0] && priv_state->new_ptyn_valid[1]) { + for (int i = 0; i < 4; i++) { + handle->ptyn[i] = priv_state->new_ptyn[0][i]; + handle->ptyn[4 + i] = priv_state->new_ptyn[1][i]; + } + handle->valid_fields |= V4L2_RDS_PTYN; + updated_fields |= V4L2_RDS_PTYN; + } + return updated_fields; +} + +typedef uint32_t (*decode_group_func)(struct rds_private_state *); + +/* array of function pointers to contain all group specific decoding functions */ +static const decode_group_func decode_group[16] = { + [0] = rds_decode_group0, + [1] = rds_decode_group1, + [2] = rds_decode_group2, + [3] = rds_decode_group3, + [4] = rds_decode_group4, + [10] = rds_decode_group10, +}; + +static uint32_t rds_decode_group(struct rds_private_state *priv_state) +{ + struct v4l2_rds *handle = &priv_state->handle; + uint8_t group_id = priv_state->rds_group.group_id; + + /* count the group type, and decode it if it is supported */ + handle->rds_statistics.group_type_cnt[group_id]++; + if (decode_group[group_id]) + return (*decode_group[group_id])(priv_state); + return 0x00; +} + +struct v4l2_rds *v4l2_rds_create(bool is_rbds) +{ + struct rds_private_state *internal_handle = + calloc(1, sizeof(struct rds_private_state)); + internal_handle->handle.version = V4L2_RDS_VERSION; + internal_handle->handle.is_rbds = is_rbds; + + return (struct v4l2_rds *)internal_handle; +} + +void v4l2_rds_destroy(struct v4l2_rds *handle) +{ + if (handle) + free(handle); +} + +void v4l2_rds_reset(struct v4l2_rds *handle, bool reset_statistics) +{ + /* treat the private & the public part of the handle */ + struct rds_private_state *priv_state = (struct rds_private_state *) handle; + + /* store members of handle that shouldn't be affected by reset*/ + bool is_rbds = handle->is_rbds; + struct v4l2_rds_statistics rds_statistics = handle->rds_statistics; + + /* reset the handle */ + memset(priv_state, 0, sizeof(*priv_state)); + /* re-initialize members */ + handle->is_rbds = is_rbds; + if (!reset_statistics) + handle->rds_statistics = rds_statistics; +} + +/* function decodes raw RDS data blocks into complete groups. Once a full group is + * successfully received, the group is decoded into the fields of the RDS handle. + * Decoding is only done once a complete group was received. This is slower compared + * to decoding the group type independent information up front, but adds a barrier + * against corrupted data (happens regularly when reception is weak) */ +uint32_t v4l2_rds_add(struct v4l2_rds *handle, struct v4l2_rds_data *rds_data) +{ + struct rds_private_state *priv_state = (struct rds_private_state *) handle; + struct v4l2_rds_data *rds_data_raw = priv_state->rds_data_raw; + struct v4l2_rds_statistics *rds_stats = &handle->rds_statistics; + uint32_t updated_fields = 0x00; + uint8_t *decode_state = &(priv_state->decode_state); + + /* get the block id by masking out irrelevant bits */ + int block_id = rds_data->block & V4L2_RDS_BLOCK_MSK; + + rds_stats->block_cnt++; + /* check for corrected / uncorrectable errors in the data */ + if (rds_data->block & V4L2_RDS_BLOCK_ERROR) { + block_id = -1; + rds_stats->block_error_cnt++; + } else if (rds_data->block & V4L2_RDS_BLOCK_CORRECTED) { + rds_stats->block_corrected_cnt++; + } + + switch (*decode_state) { + case RDS_EMPTY: + if (block_id == 0) { + *decode_state = RDS_A_RECEIVED; + /* begin reception of a new data group, reset raw buffer to 0 */ + memset(rds_data_raw, 0, sizeof(rds_data_raw)); + rds_data_raw[0] = *rds_data; + } else { + /* ignore block if it is not the first block of a group */ + rds_stats->group_error_cnt++; + } + break; + + case RDS_A_RECEIVED: + if (block_id == 1) { + *decode_state = RDS_B_RECEIVED; + rds_data_raw[1] = *rds_data; + } else { + /* received block with unexpected block id, reset state machine */ + rds_stats->group_error_cnt++; + *decode_state = RDS_EMPTY; + } + break; + + case RDS_B_RECEIVED: + /* handle type C and C' blocks alike */ + if (block_id == 2 || block_id == 4) { + *decode_state = RDS_C_RECEIVED; + rds_data_raw[2] = *rds_data; + } else { + rds_stats->group_error_cnt++; + *decode_state = RDS_EMPTY; + } + break; + + case RDS_C_RECEIVED: + if (block_id == 3) { + *decode_state = RDS_EMPTY; + rds_data_raw[3] = *rds_data; + /* a full group was received */ + rds_stats->group_cnt++; + /* decode group type independent fields */ + memset(&priv_state->rds_group, 0, sizeof(priv_state->rds_group)); + updated_fields |= rds_decode_a(priv_state, &rds_data_raw[0]); + updated_fields |= rds_decode_b(priv_state, &rds_data_raw[1]); + rds_decode_c(priv_state, &rds_data_raw[2]); + rds_decode_d(priv_state, &rds_data_raw[3]); + /* decode group type dependent fields */ + updated_fields |= rds_decode_group(priv_state); + return updated_fields; + } + rds_stats->group_error_cnt++; + *decode_state = RDS_EMPTY; + break; + + default: + /* every unexpected block leads to a reset of the sm */ + rds_stats->group_error_cnt++; + *decode_state = RDS_EMPTY; + } + /* if we reach here, no RDS group was completed */ + return 0x00; +} + +const char *v4l2_rds_get_pty_str(const struct v4l2_rds *handle) +{ + const uint8_t pty = handle->pty; + + if (pty >= 32) + return NULL; + + static const char *rds_lut[32] = { + "None", "News", "Affairs", "Info", "Sport", "Education", "Drama", + "Culture", "Science", "Varied Speech", "Pop Music", + "Rock Music", "Easy Listening", "Light Classics M", + "Serious Classics", "Other Music", "Weather", "Finance", + "Children", "Social Affairs", "Religion", "Phone In", + "Travel & Touring", "Leisure & Hobby", "Jazz Music", + "Country Music", "National Music", "Oldies Music", "Folk Music", + "Documentary", "Alarm Test", "Alarm!" + }; + static const char *rbds_lut[32] = { + "None", "News", "Information", "Sports", "Talk", "Rock", + "Classic Rock", "Adult Hits", "Soft Rock", "Top 40", "Country", + "Oldies", "Soft", "Nostalgia", "Jazz", "Classical", + "R&B", "Soft R&B", "Foreign Language", "Religious Music", + "Religious Talk", "Personality", "Public", "College", + "Spanish Talk", "Spanish Music", "Hip-Hop", "Unassigned", + "Unassigned", "Weather", "Emergency Test", "Emergency" + }; + + return handle->is_rbds ? rbds_lut[pty] : rds_lut[pty]; +} + +const char *v4l2_rds_get_country_str(const struct v4l2_rds *handle) +{ + /* defines the region of the world + * 0x0e = Europe, 0x0d = Africa, 0x0a = ITU Region 2, + * 0x0f = ITU Region 3*/ + uint8_t ecc_h = handle->ecc >> 4; + /* sub identifier for the region, valid range 0..4 */ + uint8_t ecc_l = handle->ecc & 0x0f; + /* bits 12-15 pi contain the country code */ + uint8_t country_code = handle->pi >> 12; + + /* LUT for European countries + * the standard doesn't define every possible value but leaves some + * undefined. An exception is e4-7 which is defines as a dash ("-") */ + static const char *e_lut[5][16] = { + { + NULL, "DE", "DZ", "AD", "IL", "IT", "BE", "RU", "PS", "AL", + "AT", "HU", "MT", "DE", NULL, "EG" + }, { + NULL, "GR", "CY", "SM", "CH", "JO", "FI", "LU", "BG", "DK", + "GI", "IQ", "GB", "LY", "RO", "FR" + }, { + " ", "MA", "CZ", "PL", "VA", "SK", "SY", "TN", NULL, "LI", + "IS", "MC", "LT", "RS", "ES", "NO" + }, { + NULL, "ME", "IE", "TR", "MK", NULL, NULL, NULL, "NL", "LV", + "LB", "AZ", "HR", "KZ", "SE", "BY" + }, { + NULL, "MD", "EE", "KG", NULL, NULL, "UA", "-", "PT", "SI", + "AM", NULL, "GE", NULL, NULL, "BA" + } + }; + + /* for now only European countries are supported -> ECC E0 - E4 + * but the standard defines country codes for the whole world, + * that's the reason for returning "unknown" instead of a NULL + * pointer until all defined countries are supported */ + if (ecc_h == 0x0e && ecc_l <= 0x04) + return e_lut[ecc_l][country_code]; + return "Unknown"; +} + +static const char *rds_language_lut(const uint8_t lc) +{ + const uint8_t max_lc = 127; + static const char *language_lut[128] = { + "Unknown", "Albanian", "Breton", "Catalan", + "Croatian", "Welsh", "Czech", "Danish", + "German", "English", "Spanish", "Esperanto", + "Estonian", "Basque", "Faroese", "French", + "Frisian", "Irish", "Gaelic", "Galician", + "Icelandic", "Italian", "Lappish", "Latin", + "Latvian", "Luxembourgian", "Lithuanian", "Hungarian", + "Maltese", "Dutch", "Norwegian", "Occitan", + "Polish", "Portuguese", "Romanian", "Ramansh", + "Serbian", "Slovak", "Slovene", "Finnish", + "Swedish", "Turkish", "Flemish", "Walloon", + " ", " ", " ", " ", " ", " ", " ", " ", + " ", " ", " ", " ", " ", " ", " ", " ", + " ", " ", " ", " ", " ", " ", " ", " ", + " ", "Zulu", "Vietnamese", "Uzbek", + "Urdu", "Ukrainian", "Thai", "Telugu", + "Tatar", "Tamil", "Tadzhik", "Swahili", + "Sranan Tongo", "Somali", "Sinhalese", "Shona", + "Serbo-Croat", "Ruthenian", "Russian", "Quechua", + "Pushtu", "Punjabi", "Persian", "Papamiento", + "Oriya", "Nepali", "Ndebele", "Marathi", + "Moldavian", "Malaysian", "Malagasay", "Macedonian", + "Laotian", "Korean", "Khmer", "Kazahkh", + "Kannada", "Japanese", "Indonesian", "Hindi", + "Hebrew", "Hausa", "Gurani", "Gujurati", + "Greek", "Georgian", "Fulani", "Dani", + "Churash", "Chinese", "Burmese", "Bulgarian", + "Bengali", "Belorussian", "Bambora", "Azerbijani", + "Assamese", "Armenian", "Arabic", "Amharic" + }; + return (lc > max_lc) ? "Unknown" : language_lut[lc]; +} + +const char *v4l2_rds_get_language_str(const struct v4l2_rds *handle) +{ + return rds_language_lut(handle->lc); +} + +const char *v4l2_rds_get_coverage_str(const struct v4l2_rds *handle) +{ + /* bits 8-11 contain the area coverage code */ + uint8_t coverage = (handle->pi >> 8) & 0X0f; + static const char *coverage_lut[16] = { + "Local", "International", "National", "Supra-Regional", + "Regional 1", "Regional 2", "Regional 3", "Regional 4", + "Regional 5", "Regional 6", "Regional 7", "Regional 8", + "Regional 9", "Regional 10", "Regional 11", "Regional 12" + }; + + return coverage_lut[coverage]; +} + +const struct v4l2_rds_group *v4l2_rds_get_group + (const struct v4l2_rds *handle) +{ + struct rds_private_state *priv_state = (struct rds_private_state *) handle; + return &priv_state->rds_group; +} diff --git a/lib/libv4l2rds/libv4l2rds.pc.in b/lib/libv4l2rds/libv4l2rds.pc.in new file mode 100644 index 0000000..cc1d5f6 --- /dev/null +++ b/lib/libv4l2rds/libv4l2rds.pc.in @@ -0,0 +1,11 @@ +prefix=@prefix@ +exec_prefix=@exec_prefix@ +includedir=@includedir@ +libdir=@libdir@ + +Name: libv4l2rds +Description: v4l2 RDS decode library +Version: @PACKAGE_VERSION@ +Libs: -L${libdir} -lv4l2rds +Libs.private: -lpthread +Cflags: -I${includedir}