1e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint/* 2e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * 3e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * Stereo and SAP detection for cx88 4e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * 5e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * Copyright (c) 2009 Marton Balint <cus@fazekas.hu> 6e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * 7e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * This program is free software; you can redistribute it and/or modify 8e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * it under the terms of the GNU General Public License as published by 9e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * the Free Software Foundation; either version 2 of the License, or 10e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * (at your option) any later version. 11e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * 12e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * This program is distributed in the hope that it will be useful, 13e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * but WITHOUT ANY WARRANTY; without even the implied warranty of 14e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * GNU General Public License for more details. 16e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * 17e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * You should have received a copy of the GNU General Public License 18e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * along with this program; if not, write to the Free Software 19e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 20e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint */ 21e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 225a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 23e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#include <linux/kernel.h> 24e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#include <linux/module.h> 25e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#include <linux/jiffies.h> 267561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek#include <asm/div64.h> 27e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 28e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#include "cx88.h" 29e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#include "cx88-reg.h" 30e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 31e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define INT_PI ((s32)(3.141592653589 * 32768.0)) 32e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 33e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define compat_remainder(a, b) \ 34e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint ((float)(((s32)((a)*100))%((s32)((b)*100)))/100.0) 35e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 36e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define baseband_freq(carrier, srate, tone) ((s32)( \ 37e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (compat_remainder(carrier + tone, srate)) / srate * 2 * INT_PI)) 38e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 39e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint/* We calculate the baseband frequencies of the carrier and the pilot tones 40e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * based on the the sampling rate of the audio rds fifo. */ 41e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 42e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_A2_CARRIER baseband_freq(54687.5, 2689.36, 0.0) 43e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_A2_DUAL baseband_freq(54687.5, 2689.36, 274.1) 44e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_A2_STEREO baseband_freq(54687.5, 2689.36, 117.5) 45e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 46e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint/* The frequencies below are from the reference driver. They probably need 47e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * further adjustments, because they are not tested at all. You may even need 48e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * to play a bit with the registers of the chip to select the proper signal 49e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * for the input of the audio rds fifo, and measure it's sampling rate to 50e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * calculate the proper baseband frequencies... */ 51e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 52e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_A2M_CARRIER ((s32)(2.114516 * 32768.0)) 53e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_A2M_DUAL ((s32)(2.754916 * 32768.0)) 54e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_A2M_STEREO ((s32)(2.462326 * 32768.0)) 55e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 56e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_EIAJ_CARRIER ((s32)(1.963495 * 32768.0)) /* 5pi/8 */ 57e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_EIAJ_DUAL ((s32)(2.562118 * 32768.0)) 58e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_EIAJ_STEREO ((s32)(2.601053 * 32768.0)) 59e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 60e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_BTSC_DUAL ((s32)(1.963495 * 32768.0)) /* 5pi/8 */ 61e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_BTSC_DUAL_REF ((s32)(1.374446 * 32768.0)) /* 7pi/16 */ 62e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 63e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_BTSC_SAP ((s32)(2.471532 * 32768.0)) 64e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_BTSC_SAP_REF ((s32)(1.730072 * 32768.0)) 65e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 66e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint/* The spectrum of the signal should be empty between these frequencies. */ 67e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_NOISE_START ((s32)(0.100000 * 32768.0)) 68e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define FREQ_NOISE_END ((s32)(1.200000 * 32768.0)) 69e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 70e878cf3a47a5d99635edc564423a9a4469c17810Marton Balintstatic unsigned int dsp_debug; 71e878cf3a47a5d99635edc564423a9a4469c17810Marton Balintmodule_param(dsp_debug, int, 0644); 72e878cf3a47a5d99635edc564423a9a4469c17810Marton BalintMODULE_PARM_DESC(dsp_debug, "enable audio dsp debug messages"); 73e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 74e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint#define dprintk(level, fmt, arg...) if (dsp_debug >= level) \ 75e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint printk(KERN_DEBUG "%s/0: " fmt, core->name , ## arg) 76e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 77e878cf3a47a5d99635edc564423a9a4469c17810Marton Balintstatic s32 int_cos(u32 x) 78e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint{ 79e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint u32 t2, t4, t6, t8; 80e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 ret; 81e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint u16 period = x / INT_PI; 82e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (period % 2) 83e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return -int_cos(x - INT_PI); 84e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint x = x % INT_PI; 85e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (x > INT_PI/2) 86e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return -int_cos(INT_PI/2 - (x % (INT_PI/2))); 87e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint /* Now x is between 0 and INT_PI/2. 88e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * To calculate cos(x) we use it's Taylor polinom. */ 89e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint t2 = x*x/32768/2; 90e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint t4 = t2*x/32768*x/32768/3/4; 91e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint t6 = t4*x/32768*x/32768/5/6; 92e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint t8 = t6*x/32768*x/32768/7/8; 93e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint ret = 32768-t2+t4-t6+t8; 94e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return ret; 95e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint} 96e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 97e878cf3a47a5d99635edc564423a9a4469c17810Marton Balintstatic u32 int_goertzel(s16 x[], u32 N, u32 freq) 98e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint{ 99e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint /* We use the Goertzel algorithm to determine the power of the 100e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint * given frequency in the signal */ 101e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 s_prev = 0; 102e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 s_prev2 = 0; 103e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 coeff = 2*int_cos(freq); 104e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint u32 i; 1057561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek 1067561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek u64 tmp; 1077561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek u32 divisor; 1087561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek 109e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint for (i = 0; i < N; i++) { 110e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 s = x[i] + ((s64)coeff*s_prev/32768) - s_prev2; 111e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s_prev2 = s_prev; 112e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s_prev = s; 113e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 1147561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek 1157561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek tmp = (s64)s_prev2 * s_prev2 + (s64)s_prev * s_prev - 1167561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek (s64)coeff * s_prev2 * s_prev / 32768; 1177561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek 1187561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek /* XXX: N must be low enough so that N*N fits in s32. 1197561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek * Else we need two divisions. */ 1207561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek divisor = N * N; 1217561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek do_div(tmp, divisor); 1227561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek 1237561300a7cea56b61fa28b36d40cdfab22af38bdMiroslav Sustek return (u32) tmp; 124e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint} 125e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 126e878cf3a47a5d99635edc564423a9a4469c17810Marton Balintstatic u32 freq_magnitude(s16 x[], u32 N, u32 freq) 127e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint{ 128e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint u32 sum = int_goertzel(x, N, freq); 129e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return (u32)int_sqrt(sum); 130e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint} 131e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 132e878cf3a47a5d99635edc564423a9a4469c17810Marton Balintstatic u32 noise_magnitude(s16 x[], u32 N, u32 freq_start, u32 freq_end) 133e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint{ 134e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint int i; 135e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint u32 sum = 0; 136e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint u32 freq_step; 137e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint int samples = 5; 138e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 139e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (N > 192) { 140e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint /* The last 192 samples are enough for noise detection */ 141e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint x += (N-192); 142e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint N = 192; 143e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 144e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 145e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint freq_step = (freq_end - freq_start) / (samples - 1); 146e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 147e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint for (i = 0; i < samples; i++) { 148e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint sum += int_goertzel(x, N, freq_start); 149e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint freq_start += freq_step; 150e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 151e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 152e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return (u32)int_sqrt(sum / samples); 153e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint} 154e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 155e878cf3a47a5d99635edc564423a9a4469c17810Marton Balintstatic s32 detect_a2_a2m_eiaj(struct cx88_core *core, s16 x[], u32 N) 156e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint{ 157e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 carrier, stereo, dual, noise; 158e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 carrier_freq, stereo_freq, dual_freq; 159e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 ret; 160e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 161e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint switch (core->tvaudio) { 162e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint case WW_BG: 163e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint case WW_DK: 164e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint carrier_freq = FREQ_A2_CARRIER; 165e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint stereo_freq = FREQ_A2_STEREO; 166e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint dual_freq = FREQ_A2_DUAL; 167e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint break; 168e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint case WW_M: 169e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint carrier_freq = FREQ_A2M_CARRIER; 170e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint stereo_freq = FREQ_A2M_STEREO; 171e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint dual_freq = FREQ_A2M_DUAL; 172e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint break; 173e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint case WW_EIAJ: 174e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint carrier_freq = FREQ_EIAJ_CARRIER; 175e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint stereo_freq = FREQ_EIAJ_STEREO; 176e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint dual_freq = FREQ_EIAJ_DUAL; 177e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint break; 178b6b85ff87b6232ba89fba303b7b7b93c893d3523Mauro Carvalho Chehab default: 179e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint printk(KERN_WARNING "%s/0: unsupported audio mode %d for %s\n", 180e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint core->name, core->tvaudio, __func__); 181e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return UNSET; 182e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 183e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 184e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint carrier = freq_magnitude(x, N, carrier_freq); 185e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint stereo = freq_magnitude(x, N, stereo_freq); 186e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint dual = freq_magnitude(x, N, dual_freq); 187e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint noise = noise_magnitude(x, N, FREQ_NOISE_START, FREQ_NOISE_END); 188e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 189e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint dprintk(1, "detect a2/a2m/eiaj: carrier=%d, stereo=%d, dual=%d, " 190e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint "noise=%d\n", carrier, stereo, dual, noise); 191e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 192e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (stereo > dual) 193e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint ret = V4L2_TUNER_SUB_STEREO; 194e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint else 195e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint ret = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2; 196e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 197e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (core->tvaudio == WW_EIAJ) { 198e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint /* EIAJ checks may need adjustments */ 199e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if ((carrier > max(stereo, dual)*2) && 200e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (carrier < max(stereo, dual)*6) && 201e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (carrier > 20 && carrier < 200) && 202e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (max(stereo, dual) > min(stereo, dual))) { 203e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint /* For EIAJ the carrier is always present, 204e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint so we probably don't need noise detection */ 205e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return ret; 206e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 207e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } else { 208e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if ((carrier > max(stereo, dual)*2) && 209e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (carrier < max(stereo, dual)*8) && 210e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (carrier > 20 && carrier < 200) && 211e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (noise < 10) && 212e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (max(stereo, dual) > min(stereo, dual)*2)) { 213e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return ret; 214e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 215e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 216e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return V4L2_TUNER_SUB_MONO; 217e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint} 218e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 219e878cf3a47a5d99635edc564423a9a4469c17810Marton Balintstatic s32 detect_btsc(struct cx88_core *core, s16 x[], u32 N) 220e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint{ 221e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 sap_ref = freq_magnitude(x, N, FREQ_BTSC_SAP_REF); 222e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 sap = freq_magnitude(x, N, FREQ_BTSC_SAP); 223e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 dual_ref = freq_magnitude(x, N, FREQ_BTSC_DUAL_REF); 224e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 dual = freq_magnitude(x, N, FREQ_BTSC_DUAL); 225e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint dprintk(1, "detect btsc: dual_ref=%d, dual=%d, sap_ref=%d, sap=%d" 226e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint "\n", dual_ref, dual, sap_ref, sap); 227e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint /* FIXME: Currently not supported */ 228e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return UNSET; 229e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint} 230e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 231e878cf3a47a5d99635edc564423a9a4469c17810Marton Balintstatic s16 *read_rds_samples(struct cx88_core *core, u32 *N) 232e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint{ 2332e4e98e788d8fbe30892bee3375067a4937155dalawrence rust const struct sram_channel *srch = &cx88_sram_channels[SRAM_CH27]; 234e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s16 *samples; 235e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 236e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint unsigned int i; 237e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint unsigned int bpl = srch->fifo_size/AUD_RDS_LINES; 238e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint unsigned int spl = bpl/4; 239e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint unsigned int sample_count = spl*(AUD_RDS_LINES-1); 240e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 241e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint u32 current_address = cx_read(srch->ptr1_reg); 242e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint u32 offset = (current_address - srch->fifo_start + bpl); 243e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 244e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint dprintk(1, "read RDS samples: current_address=%08x (offset=%08x), " 245e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint "sample_count=%d, aud_intstat=%08x\n", current_address, 246e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint current_address - srch->fifo_start, sample_count, 247e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint cx_read(MO_AUD_INTSTAT)); 248e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 249e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint samples = kmalloc(sizeof(s16)*sample_count, GFP_KERNEL); 250e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (!samples) 251e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return NULL; 252e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 253e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint *N = sample_count; 254e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 255e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint for (i = 0; i < sample_count; i++) { 256e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint offset = offset % (AUD_RDS_LINES*bpl); 257e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint samples[i] = cx_read(srch->fifo_start + offset); 258e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint offset += 4; 259e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 260e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 261e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (dsp_debug >= 2) { 262e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint dprintk(2, "RDS samples dump: "); 263e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint for (i = 0; i < sample_count; i++) 264e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint printk("%hd ", samples[i]); 265e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint printk(".\n"); 266e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 267e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 268e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return samples; 269e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint} 270e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 271e878cf3a47a5d99635edc564423a9a4469c17810Marton Balints32 cx88_dsp_detect_stereo_sap(struct cx88_core *core) 272e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint{ 273e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s16 *samples; 274e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint u32 N = 0; 275e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint s32 ret = UNSET; 276e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 277e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint /* If audio RDS fifo is disabled, we can't read the samples */ 278e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (!(cx_read(MO_AUD_DMACNTRL) & 0x04)) 279e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return ret; 280e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (!(cx_read(AUD_CTL) & EN_FMRADIO_EN_RDS)) 281e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return ret; 282e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 283e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint /* Wait at least 500 ms after an audio standard change */ 284e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (time_before(jiffies, core->last_change + msecs_to_jiffies(500))) 285e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return ret; 286e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 287e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint samples = read_rds_samples(core, &N); 288e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 289e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (!samples) 290e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return ret; 291e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 292e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint switch (core->tvaudio) { 293e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint case WW_BG: 294e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint case WW_DK: 295d06b49ed18736d32530067e2cad5a18d3482a2b9lawrence rust case WW_EIAJ: 296d06b49ed18736d32530067e2cad5a18d3482a2b9lawrence rust case WW_M: 297e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint ret = detect_a2_a2m_eiaj(core, samples, N); 298e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint break; 299e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint case WW_BTSC: 300e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint ret = detect_btsc(core, samples, N); 301e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint break; 302d06b49ed18736d32530067e2cad5a18d3482a2b9lawrence rust case WW_NONE: 303d06b49ed18736d32530067e2cad5a18d3482a2b9lawrence rust case WW_I: 304d06b49ed18736d32530067e2cad5a18d3482a2b9lawrence rust case WW_L: 305d06b49ed18736d32530067e2cad5a18d3482a2b9lawrence rust case WW_I2SPT: 306d06b49ed18736d32530067e2cad5a18d3482a2b9lawrence rust case WW_FM: 307d06b49ed18736d32530067e2cad5a18d3482a2b9lawrence rust case WW_I2SADC: 308d06b49ed18736d32530067e2cad5a18d3482a2b9lawrence rust break; 309e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint } 310e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 311e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint kfree(samples); 312e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 313e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint if (UNSET != ret) 314e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint dprintk(1, "stereo/sap detection result:%s%s%s\n", 315e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (ret & V4L2_TUNER_SUB_MONO) ? " mono" : "", 316e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (ret & V4L2_TUNER_SUB_STEREO) ? " stereo" : "", 317e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint (ret & V4L2_TUNER_SUB_LANG2) ? " dual" : ""); 318e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 319e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint return ret; 320e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint} 321e878cf3a47a5d99635edc564423a9a4469c17810Marton BalintEXPORT_SYMBOL(cx88_dsp_detect_stereo_sap); 322e878cf3a47a5d99635edc564423a9a4469c17810Marton Balint 323