From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1756129AbcDDRFL (ORCPT ); Mon, 4 Apr 2016 13:05:11 -0400 Received: from mail-pf0-f194.google.com ([209.85.192.194]:35057 "EHLO mail-pf0-f194.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S932550AbcDDREY (ORCPT ); Mon, 4 Apr 2016 13:04:24 -0400 From: info@are.ma X-Google-Original-From: knightrider@are.ma To: linux-media@vger.kernel.org Cc: =?UTF-8?q?=D0=91=D1=83=D0=B4=D0=B8=20=D0=A0=D0=BE=D0=BC=D0=B0=D0=BD=D1=82=D0=BE=2C=20AreMa=20Inc?= , linux-kernel@vger.kernel.org, crope@iki.fi, m.chehab@samsung.com, mchehab@osg.samsung.com, hdegoede@redhat.com, laurent.pinchart@ideasonboard.com, mkrufky@linuxtv.org, sylvester.nawrocki@gmail.com, g.liakhovetski@gmx.de, peter.senna@gmail.com Subject: [media 3/6] Demodulator for Earthsoft PT3, PLEX PX-Q3PE ISDB-S/T PCIE cards & PX-BCUD ISDB-S USB dongle Date: Tue, 5 Apr 2016 02:04:02 +0900 Message-Id: <22cf1dc77ff6f453765680d1a0383689e9b2b350.1459787898.git.knightrider@are.ma> X-Mailer: git-send-email 2.7.4 In-Reply-To: References: In-Reply-To: References: MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org From: Буди Романто, AreMa Inc Toshiba TC905xx demodulator driver for PT3, PX-Q3PE & PX-BCUD Signed-off-by: Буди Романто, AreMa Inc --- drivers/media/dvb-frontends/tc90522.c | 254 ++++++++++++++++++++++++++++++++++ drivers/media/dvb-frontends/tc90522.h | 18 +++ 2 files changed, 272 insertions(+) create mode 100644 drivers/media/dvb-frontends/tc90522.c create mode 100644 drivers/media/dvb-frontends/tc90522.h diff --git a/drivers/media/dvb-frontends/tc90522.c b/drivers/media/dvb-frontends/tc90522.c new file mode 100644 index 0000000..c1c48e5 --- /dev/null +++ b/drivers/media/dvb-frontends/tc90522.c @@ -0,0 +1,254 @@ +/* + Toshiba TC90522XBG 2ch OFDM(ISDB-T) + 2ch 8PSK(ISDB-S) demodulator + + Copyright (C) Budi Rachmanto, AreMa Inc. + + CHIP CARDS + TC90522XBG Earthsoft PT3, PLEX PX-Q3PE + TC90532 PLEX PX-BCUD + + 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. + */ + +#include "dvb_math.h" +#include "dvb_frontend.h" +#include "tc90522.h" + +bool tc90522_r(struct i2c_client *d, u8 slvadr, u8 *buf, u8 len) +{ + struct i2c_msg msg[] = { + {.addr = d->addr, .flags = 0, .buf = &slvadr, .len = 1,}, + {.addr = d->addr, .flags = I2C_M_RD, .buf = buf, .len = len,}, + }; + return i2c_transfer(d->adapter, msg, 2) == 2; +} + +bool tc90522_w(struct i2c_client *d, u8 slvadr, u8 dat) +{ + u8 buf[] = {slvadr, dat}; + struct i2c_msg msg[] = { + {.addr = d->addr, .flags = 0, .buf = buf, .len = 2,}, + }; + return i2c_transfer(d->adapter, msg, 1) == 1; +} + +u64 tc90522_n2int(const u8 *data, u8 n) /* convert n_bytes data from stream (network byte order) to integer */ +{ /* can't use 's ntoh*() as sometimes n = 3,5,... */ + u32 i, val = 0; + + for (i = 0; i < n; i++) { + val <<= 8; + val |= data[i]; + } + return val; +} + +int tc90522_cn_raw(struct dvb_frontend *fe, u16 *raw) /* for DVBv3 compatibility */ +{ + u8 buf[3], + len = fe->dtv_property_cache.delivery_system == SYS_ISDBS ? 2 : 3, + adr = fe->dtv_property_cache.delivery_system == SYS_ISDBS ? 0xbc : 0x8b; + bool ok = tc90522_r(fe->demodulator_priv, adr, buf, len); + int cn = tc90522_n2int(buf, len); + + if (!ok) + return -EIO; + *raw = cn; + return cn; +} + +int tc90522_status(struct dvb_frontend *fe, enum fe_status *stat) +{ + enum fe_status *festat = i2c_get_clientdata(fe->demodulator_priv); + struct dtv_frontend_properties *c = &fe->dtv_property_cache; + u16 v16; + s64 raw = tc90522_cn_raw(fe, &v16), + x, + y; + + s64 cn_s(void) /* @ .0001 dB */ + { + raw -= 3000; + if (raw < 0) + raw = 0; + x = int_sqrt(raw << 20); + y = 16346ll * x - (143410ll << 16); + y = ((x * y) >> 16) + (502590ll << 16); + y = ((x * y) >> 16) - (889770ll << 16); + y = ((x * y) >> 16) + (895650ll << 16); + y = (588570ll << 16) - ((x * y) >> 16); + return y < 0 ? 0 : y >> 16; + } + + s64 cn_t(void) /* @ .0001 dB */ + { + if (!raw) + return 0; + x = (1130911733ll - 10ll * intlog10(raw)) >> 2; + y = (x >> 2) - (x >> 6) + (x >> 8) + (x >> 9) - (x >> 10) + (x >> 11) + (x >> 12) - (16ll << 22); + y = ((x * y) >> 22) + (398ll << 22); + y = ((x * y) >> 22) + (5491ll << 22); + y = ((x * y) >> 22) + (30965ll << 22); + return y >> 22; + } + + c->cnr.len = 1; + c->cnr.stat[0].svalue = fe->dtv_property_cache.delivery_system == SYS_ISDBS ? cn_s() : cn_t(); + c->cnr.stat[0].scale = FE_SCALE_DECIBEL; + *stat = *festat; + return *festat; +} + +int tc90522_get_frontend_algo(struct dvb_frontend *fe) +{ + return DVBFE_ALGO_HW; +} + +int tc90522_tune(struct dvb_frontend *fe, bool retune, u32 mode_flags, u32 *delay, enum fe_status *stat) +{ + u32 fno2kHz(u32 fno) + { + if (fno < 12) + return 1049480 + 38360 * fno; /* BS */ + else if (fno < 24) + return 1613000 + 40000 * (fno - 12); /* CS110 right */ + return 1593000 + 40000 * (fno - 24); /* CS110 left */ + } + + void s_kHz(u32 *f) + { + *f = *f > 3000000 ? fno2kHz(14) : /* max kHz, CNN */ + *f >= 1049480 ? *f : /* min real kHz */ + *f > 48 ? fno2kHz(4) : /* BS11 etc. */ + fno2kHz(*f - 1); + } + + u32 fno2Hz(u32 fno) + { + return (fno > 112 ? 557 : 93 + 6 * fno + (fno < 12 ? 0 : fno < 17 ? 2 : fno < 63 ? 0 : 2)) * 1000000 + 142857; + } + + void t_Hz(u32 *f) + { + *f = *f >= 90000000 ? *f : /* real_freq Hz */ + *f > 255 ? fno2Hz(77) : /* NHK */ + *f > 127 ? fno2Hz(*f - 128) : /* freqno (IO#) */ + *f > 63 ? (*f -= 64, /* CATV */ + *f > 22 ? fno2Hz(*f - 1) : /* C23-C62 */ + *f > 12 ? fno2Hz(*f - 10) : /* C13-C22 */ + fno2Hz(77)) : + *f > 62 ? fno2Hz(77) : + *f > 12 ? fno2Hz(*f + 50) : /* 13-62 */ + *f > 3 ? fno2Hz(*f + 9) : /* 4-12 */ + *f ? fno2Hz(*f - 1) : /* 1-3 */ + fno2Hz(77); + } + struct i2c_client *d = fe->demodulator_priv; + enum fe_status *festat = i2c_get_clientdata(d); + u16 set_id = fe->dtv_property_cache.stream_id, + i = 999; + u8 data[16]; + + if (!retune) /* once is enough */ + return 0; + *festat = 0; + if (fe->dtv_property_cache.delivery_system == SYS_ISDBT) + goto ISDBT; + + s_kHz(&fe->dtv_property_cache.frequency); + if (fe->ops.tuner_ops.set_params(fe)) + return -EIO; + while (i--) { + if ((tc90522_r(d, 0xC3, data, 1), !(data[0] & 0x10)) && /* locked */ + (tc90522_r(d, 0xCE, data, 2), *(u16 *)data != 0) && /* valid TSID */ + tc90522_r(d, 0xC3, data, 1) && + tc90522_r(d, 0xCE, data, 16)) + break; + msleep_interruptible(5); + } + if (!i) + goto ERR; + for (i = 0; i < 8; i++) { + u16 tsid = tc90522_n2int(data + i*2, 2); + + if ((tsid == set_id || set_id == i) && + tc90522_w(d, 0x8F, tsid >> 8) && + tc90522_w(d, 0x90, tsid & 0xFF) && + tc90522_r(d, 0xE6, data, 2) && + tc90522_n2int(data, 2) == tsid) + goto LOCK; + } + goto ERR; +ISDBT: + t_Hz(&fe->dtv_property_cache.frequency); + if (fe->ops.tuner_ops.set_params(fe)) + return -EIO; + while (i--) { + bool retryov, + lock0, + lock1; + if (!tc90522_r(d, 0x80, data, 1) || !tc90522_r(d, 0xB0, data + 1, 1)) + break; + retryov = data[0] & 0b10000000 ? true : false; + lock0 = data[0] & 0b00001000 ? false : true; + lock1 = data[1] & 0b00001000 ? true : false; + if (lock0 && lock1) { +LOCK: + *festat = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_LOCK; + *stat = *festat; + return 0; + } + if (retryov) + break; + msleep_interruptible(1); + } +ERR: + *stat = *festat; + return -ETIMEDOUT; +} + +static struct dvb_frontend_ops tc90522_ops = { + .info = { + .name = TC90522_MODNAME, + .caps = FE_CAN_INVERSION_AUTO | FE_CAN_FEC_AUTO | FE_CAN_QAM_AUTO | FE_CAN_MULTISTREAM | + FE_CAN_TRANSMISSION_MODE_AUTO | FE_CAN_GUARD_INTERVAL_AUTO | FE_CAN_HIERARCHY_AUTO, + .frequency_min = 1, /* actual limit settings are set by .tune */ + .frequency_max = 770000000, + }, + .get_frontend_algo = tc90522_get_frontend_algo, + .read_snr = tc90522_cn_raw, + .read_status = tc90522_status, + .tune = tc90522_tune, +}; + +int tc90522_probe(struct i2c_client *d, const struct i2c_device_id *id) +{ + struct dvb_frontend *fe = d->dev.platform_data; + static enum fe_status festat; + + memcpy(&fe->ops, &tc90522_ops, sizeof(struct dvb_frontend_ops)); + festat = 0; + i2c_set_clientdata(d, &festat); + return 0; +} + +static struct i2c_device_id tc90522_id[] = { + {TC90522_MODNAME, 0}, + {}, +}; +MODULE_DEVICE_TABLE(i2c, tc90522_id); + +static struct i2c_driver tc90522_driver = { + .driver.name = tc90522_id->name, + .probe = tc90522_probe, + .id_table = tc90522_id, +}; +module_i2c_driver(tc90522_driver); + +MODULE_AUTHOR("Budi Rachmanto, AreMa Inc. "); +MODULE_DESCRIPTION("Toshiba TC90522 8PSK(ISDB-S)/OFDM(ISDB-T) quad demodulator"); +MODULE_LICENSE("GPL"); + diff --git a/drivers/media/dvb-frontends/tc90522.h b/drivers/media/dvb-frontends/tc90522.h new file mode 100644 index 0000000..b6ee014 --- /dev/null +++ b/drivers/media/dvb-frontends/tc90522.h @@ -0,0 +1,18 @@ +/* + * Toshiba TC90522XBG 2ch OFDM(ISDB-T) + 2ch 8PSK(ISDB-S) demodulator + * + * Copyright (C) Budi Rachmanto, AreMa Inc. + * + * 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. + */ + +#ifndef TC90522_H +#define TC90522_H + +#define TC90522_MODNAME "tc90522" + +#endif + -- 2.7.4