1711615dfSAntti Palosaari /* 2711615dfSAntti Palosaari * Silicon Labs Si2168 DVB-T/T2/C demodulator driver 3711615dfSAntti Palosaari * 4711615dfSAntti Palosaari * Copyright (C) 2014 Antti Palosaari <crope@iki.fi> 5711615dfSAntti Palosaari * 6711615dfSAntti Palosaari * This program is free software; you can redistribute it and/or modify 7711615dfSAntti Palosaari * it under the terms of the GNU General Public License as published by 8711615dfSAntti Palosaari * the Free Software Foundation; either version 2 of the License, or 9711615dfSAntti Palosaari * (at your option) any later version. 10711615dfSAntti Palosaari * 11711615dfSAntti Palosaari * This program is distributed in the hope that it will be useful, 12711615dfSAntti Palosaari * but WITHOUT ANY WARRANTY; without even the implied warranty of 13711615dfSAntti Palosaari * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14711615dfSAntti Palosaari * GNU General Public License for more details. 15711615dfSAntti Palosaari */ 16711615dfSAntti Palosaari 17845f3505SAntti Palosaari #include "si2168_priv.h" 18845f3505SAntti Palosaari 19845f3505SAntti Palosaari static const struct dvb_frontend_ops si2168_ops; 20845f3505SAntti Palosaari 21845f3505SAntti Palosaari /* execute firmware command */ 22845f3505SAntti Palosaari static int si2168_cmd_execute(struct si2168 *s, struct si2168_cmd *cmd) 23845f3505SAntti Palosaari { 24845f3505SAntti Palosaari int ret; 25845f3505SAntti Palosaari unsigned long timeout; 26845f3505SAntti Palosaari 27845f3505SAntti Palosaari mutex_lock(&s->i2c_mutex); 28845f3505SAntti Palosaari 29845f3505SAntti Palosaari if (cmd->wlen) { 30845f3505SAntti Palosaari /* write cmd and args for firmware */ 31845f3505SAntti Palosaari ret = i2c_master_send(s->client, cmd->args, cmd->wlen); 32845f3505SAntti Palosaari if (ret < 0) { 33845f3505SAntti Palosaari goto err_mutex_unlock; 34845f3505SAntti Palosaari } else if (ret != cmd->wlen) { 35845f3505SAntti Palosaari ret = -EREMOTEIO; 36845f3505SAntti Palosaari goto err_mutex_unlock; 37845f3505SAntti Palosaari } 38845f3505SAntti Palosaari } 39845f3505SAntti Palosaari 40845f3505SAntti Palosaari if (cmd->rlen) { 41845f3505SAntti Palosaari /* wait cmd execution terminate */ 42845f3505SAntti Palosaari #define TIMEOUT 50 43845f3505SAntti Palosaari timeout = jiffies + msecs_to_jiffies(TIMEOUT); 44845f3505SAntti Palosaari while (!time_after(jiffies, timeout)) { 45845f3505SAntti Palosaari ret = i2c_master_recv(s->client, cmd->args, cmd->rlen); 46845f3505SAntti Palosaari if (ret < 0) { 47845f3505SAntti Palosaari goto err_mutex_unlock; 48845f3505SAntti Palosaari } else if (ret != cmd->rlen) { 49845f3505SAntti Palosaari ret = -EREMOTEIO; 50845f3505SAntti Palosaari goto err_mutex_unlock; 51845f3505SAntti Palosaari } 52845f3505SAntti Palosaari 53845f3505SAntti Palosaari /* firmware ready? */ 54845f3505SAntti Palosaari if ((cmd->args[0] >> 7) & 0x01) 55845f3505SAntti Palosaari break; 56845f3505SAntti Palosaari } 57845f3505SAntti Palosaari 58845f3505SAntti Palosaari dev_dbg(&s->client->dev, "%s: cmd execution took %d ms\n", 59845f3505SAntti Palosaari __func__, 60845f3505SAntti Palosaari jiffies_to_msecs(jiffies) - 61845f3505SAntti Palosaari (jiffies_to_msecs(timeout) - TIMEOUT)); 62845f3505SAntti Palosaari 63845f3505SAntti Palosaari if (!(cmd->args[0] >> 7) & 0x01) { 64845f3505SAntti Palosaari ret = -ETIMEDOUT; 65845f3505SAntti Palosaari goto err_mutex_unlock; 66845f3505SAntti Palosaari } 67845f3505SAntti Palosaari } 68845f3505SAntti Palosaari 69845f3505SAntti Palosaari ret = 0; 70845f3505SAntti Palosaari 71845f3505SAntti Palosaari err_mutex_unlock: 72845f3505SAntti Palosaari mutex_unlock(&s->i2c_mutex); 73845f3505SAntti Palosaari if (ret) 74845f3505SAntti Palosaari goto err; 75845f3505SAntti Palosaari 76845f3505SAntti Palosaari return 0; 77845f3505SAntti Palosaari err: 78845f3505SAntti Palosaari dev_dbg(&s->client->dev, "%s: failed=%d\n", __func__, ret); 79845f3505SAntti Palosaari return ret; 80845f3505SAntti Palosaari } 81845f3505SAntti Palosaari 82845f3505SAntti Palosaari static int si2168_read_status(struct dvb_frontend *fe, fe_status_t *status) 83845f3505SAntti Palosaari { 84845f3505SAntti Palosaari struct si2168 *s = fe->demodulator_priv; 85bffab93cSAntti Palosaari struct dtv_frontend_properties *c = &fe->dtv_property_cache; 86845f3505SAntti Palosaari int ret; 87845f3505SAntti Palosaari struct si2168_cmd cmd; 88845f3505SAntti Palosaari 89845f3505SAntti Palosaari *status = 0; 90845f3505SAntti Palosaari 91845f3505SAntti Palosaari if (!s->active) { 92845f3505SAntti Palosaari ret = -EAGAIN; 93845f3505SAntti Palosaari goto err; 94845f3505SAntti Palosaari } 95845f3505SAntti Palosaari 96bffab93cSAntti Palosaari switch (c->delivery_system) { 97bffab93cSAntti Palosaari case SYS_DVBT: 98888680ffSAntti Palosaari memcpy(cmd.args, "\xa0\x01", 2); 99845f3505SAntti Palosaari cmd.wlen = 2; 100845f3505SAntti Palosaari cmd.rlen = 13; 101bffab93cSAntti Palosaari break; 102c790885bSAntti Palosaari case SYS_DVBC_ANNEX_A: 103888680ffSAntti Palosaari memcpy(cmd.args, "\x90\x01", 2); 104c790885bSAntti Palosaari cmd.wlen = 2; 105c790885bSAntti Palosaari cmd.rlen = 9; 106c790885bSAntti Palosaari break; 107bffab93cSAntti Palosaari case SYS_DVBT2: 108888680ffSAntti Palosaari memcpy(cmd.args, "\x50\x01", 2); 109bffab93cSAntti Palosaari cmd.wlen = 2; 110bffab93cSAntti Palosaari cmd.rlen = 14; 111bffab93cSAntti Palosaari break; 112bffab93cSAntti Palosaari default: 113bffab93cSAntti Palosaari ret = -EINVAL; 114bffab93cSAntti Palosaari goto err; 115bffab93cSAntti Palosaari } 116bffab93cSAntti Palosaari 117845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 118845f3505SAntti Palosaari if (ret) 119845f3505SAntti Palosaari goto err; 120845f3505SAntti Palosaari 121845f3505SAntti Palosaari /* 122845f3505SAntti Palosaari * Possible values seen, in order from strong signal to weak: 123845f3505SAntti Palosaari * 16 0001 0110 full lock 124845f3505SAntti Palosaari * 1e 0001 1110 partial lock 125845f3505SAntti Palosaari * 1a 0001 1010 partial lock 126845f3505SAntti Palosaari * 18 0001 1000 no lock 127845f3505SAntti Palosaari * 128845f3505SAntti Palosaari * [b3:b1] lock bits 129845f3505SAntti Palosaari * [b4] statistics ready? Set in a few secs after lock is gained. 130845f3505SAntti Palosaari */ 131845f3505SAntti Palosaari 132722a042dSAntti Palosaari switch ((cmd.args[2] >> 1) & 0x03) { 133722a042dSAntti Palosaari case 0x01: 134845f3505SAntti Palosaari *status = FE_HAS_SIGNAL | FE_HAS_CARRIER; 135845f3505SAntti Palosaari break; 136722a042dSAntti Palosaari case 0x03: 137845f3505SAntti Palosaari *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_VITERBI | 138845f3505SAntti Palosaari FE_HAS_SYNC | FE_HAS_LOCK; 139845f3505SAntti Palosaari break; 140845f3505SAntti Palosaari } 141845f3505SAntti Palosaari 142845f3505SAntti Palosaari s->fe_status = *status; 143845f3505SAntti Palosaari 144845f3505SAntti Palosaari dev_dbg(&s->client->dev, "%s: status=%02x args=%*ph\n", 145845f3505SAntti Palosaari __func__, *status, cmd.rlen, cmd.args); 146845f3505SAntti Palosaari 147845f3505SAntti Palosaari return 0; 148845f3505SAntti Palosaari err: 149845f3505SAntti Palosaari dev_dbg(&s->client->dev, "%s: failed=%d\n", __func__, ret); 150845f3505SAntti Palosaari return ret; 151845f3505SAntti Palosaari } 152845f3505SAntti Palosaari 153845f3505SAntti Palosaari static int si2168_set_frontend(struct dvb_frontend *fe) 154845f3505SAntti Palosaari { 155845f3505SAntti Palosaari struct si2168 *s = fe->demodulator_priv; 156845f3505SAntti Palosaari struct dtv_frontend_properties *c = &fe->dtv_property_cache; 157845f3505SAntti Palosaari int ret; 158845f3505SAntti Palosaari struct si2168_cmd cmd; 159bffab93cSAntti Palosaari u8 bandwidth, delivery_system; 160845f3505SAntti Palosaari 161845f3505SAntti Palosaari dev_dbg(&s->client->dev, 162845f3505SAntti Palosaari "%s: delivery_system=%u modulation=%u frequency=%u bandwidth_hz=%u symbol_rate=%u inversion=%u\n", 163845f3505SAntti Palosaari __func__, c->delivery_system, c->modulation, 164845f3505SAntti Palosaari c->frequency, c->bandwidth_hz, c->symbol_rate, 165845f3505SAntti Palosaari c->inversion); 166845f3505SAntti Palosaari 167845f3505SAntti Palosaari if (!s->active) { 168845f3505SAntti Palosaari ret = -EAGAIN; 169845f3505SAntti Palosaari goto err; 170845f3505SAntti Palosaari } 171845f3505SAntti Palosaari 172bffab93cSAntti Palosaari switch (c->delivery_system) { 173bffab93cSAntti Palosaari case SYS_DVBT: 174bffab93cSAntti Palosaari delivery_system = 0x20; 175bffab93cSAntti Palosaari break; 176c790885bSAntti Palosaari case SYS_DVBC_ANNEX_A: 177c790885bSAntti Palosaari delivery_system = 0x30; 178c790885bSAntti Palosaari break; 179bffab93cSAntti Palosaari case SYS_DVBT2: 180bffab93cSAntti Palosaari delivery_system = 0x70; 181bffab93cSAntti Palosaari break; 182bffab93cSAntti Palosaari default: 183bffab93cSAntti Palosaari ret = -EINVAL; 184bffab93cSAntti Palosaari goto err; 185bffab93cSAntti Palosaari } 186bffab93cSAntti Palosaari 187c790885bSAntti Palosaari if (c->bandwidth_hz <= 5000000) 188bffab93cSAntti Palosaari bandwidth = 0x05; 189c790885bSAntti Palosaari else if (c->bandwidth_hz <= 6000000) 190bffab93cSAntti Palosaari bandwidth = 0x06; 191c790885bSAntti Palosaari else if (c->bandwidth_hz <= 7000000) 192bffab93cSAntti Palosaari bandwidth = 0x07; 193c790885bSAntti Palosaari else if (c->bandwidth_hz <= 8000000) 194bffab93cSAntti Palosaari bandwidth = 0x08; 195c790885bSAntti Palosaari else if (c->bandwidth_hz <= 9000000) 196c790885bSAntti Palosaari bandwidth = 0x09; 197c790885bSAntti Palosaari else if (c->bandwidth_hz <= 10000000) 198c790885bSAntti Palosaari bandwidth = 0x0a; 199c790885bSAntti Palosaari else 200c790885bSAntti Palosaari bandwidth = 0x0f; 201845f3505SAntti Palosaari 202845f3505SAntti Palosaari /* program tuner */ 203845f3505SAntti Palosaari if (fe->ops.tuner_ops.set_params) { 204845f3505SAntti Palosaari ret = fe->ops.tuner_ops.set_params(fe); 205845f3505SAntti Palosaari if (ret) 206845f3505SAntti Palosaari goto err; 207845f3505SAntti Palosaari } 208845f3505SAntti Palosaari 209845f3505SAntti Palosaari memcpy(cmd.args, "\x88\x02\x02\x02\x02", 5); 210845f3505SAntti Palosaari cmd.wlen = 5; 211845f3505SAntti Palosaari cmd.rlen = 5; 212845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 213845f3505SAntti Palosaari if (ret) 214845f3505SAntti Palosaari goto err; 215845f3505SAntti Palosaari 216bffab93cSAntti Palosaari /* that has no big effect */ 217bffab93cSAntti Palosaari if (c->delivery_system == SYS_DVBT) 218845f3505SAntti Palosaari memcpy(cmd.args, "\x89\x21\x06\x11\xff\x98", 6); 219c790885bSAntti Palosaari else if (c->delivery_system == SYS_DVBC_ANNEX_A) 220c790885bSAntti Palosaari memcpy(cmd.args, "\x89\x21\x06\x11\x89\xf0", 6); 221bffab93cSAntti Palosaari else if (c->delivery_system == SYS_DVBT2) 222bffab93cSAntti Palosaari memcpy(cmd.args, "\x89\x21\x06\x11\x89\x20", 6); 223845f3505SAntti Palosaari cmd.wlen = 6; 224845f3505SAntti Palosaari cmd.rlen = 3; 225845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 226845f3505SAntti Palosaari if (ret) 227845f3505SAntti Palosaari goto err; 228845f3505SAntti Palosaari 229845f3505SAntti Palosaari memcpy(cmd.args, "\x51\x03", 2); 230845f3505SAntti Palosaari cmd.wlen = 2; 231845f3505SAntti Palosaari cmd.rlen = 12; 232845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 233845f3505SAntti Palosaari if (ret) 234845f3505SAntti Palosaari goto err; 235845f3505SAntti Palosaari 236845f3505SAntti Palosaari memcpy(cmd.args, "\x12\x08\x04", 3); 237845f3505SAntti Palosaari cmd.wlen = 3; 238845f3505SAntti Palosaari cmd.rlen = 3; 239845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 240845f3505SAntti Palosaari if (ret) 241845f3505SAntti Palosaari goto err; 242845f3505SAntti Palosaari 243845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x01\x04\x00\x00", 6); 244845f3505SAntti Palosaari cmd.wlen = 6; 245845f3505SAntti Palosaari cmd.rlen = 1; 246845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 247845f3505SAntti Palosaari if (ret) 248845f3505SAntti Palosaari goto err; 249845f3505SAntti Palosaari 250845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x03\x10\x17\x00", 6); 251845f3505SAntti Palosaari cmd.wlen = 6; 252845f3505SAntti Palosaari cmd.rlen = 1; 253845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 254845f3505SAntti Palosaari if (ret) 255845f3505SAntti Palosaari goto err; 256845f3505SAntti Palosaari 257845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x02\x10\x15\x00", 6); 258845f3505SAntti Palosaari cmd.wlen = 6; 259845f3505SAntti Palosaari cmd.rlen = 1; 260845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 261845f3505SAntti Palosaari if (ret) 262845f3505SAntti Palosaari goto err; 263845f3505SAntti Palosaari 264845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x0c\x10\x12\x00", 6); 265845f3505SAntti Palosaari cmd.wlen = 6; 266845f3505SAntti Palosaari cmd.rlen = 1; 267845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 268845f3505SAntti Palosaari if (ret) 269845f3505SAntti Palosaari goto err; 270845f3505SAntti Palosaari 271845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x06\x10\x24\x00", 6); 272845f3505SAntti Palosaari cmd.wlen = 6; 273845f3505SAntti Palosaari cmd.rlen = 1; 274845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 275845f3505SAntti Palosaari if (ret) 276845f3505SAntti Palosaari goto err; 277845f3505SAntti Palosaari 278845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x0b\x10\x88\x13", 6); 279845f3505SAntti Palosaari cmd.wlen = 6; 280845f3505SAntti Palosaari cmd.rlen = 1; 281845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 282845f3505SAntti Palosaari if (ret) 283845f3505SAntti Palosaari goto err; 284845f3505SAntti Palosaari 285845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x07\x10\x00\x24", 6); 286845f3505SAntti Palosaari cmd.wlen = 6; 287845f3505SAntti Palosaari cmd.rlen = 1; 288845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 289845f3505SAntti Palosaari if (ret) 290845f3505SAntti Palosaari goto err; 291845f3505SAntti Palosaari 292845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x0a\x10\x00\x00", 6); 293bffab93cSAntti Palosaari cmd.args[4] = delivery_system | bandwidth; 294845f3505SAntti Palosaari cmd.wlen = 6; 295845f3505SAntti Palosaari cmd.rlen = 1; 296845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 297845f3505SAntti Palosaari if (ret) 298845f3505SAntti Palosaari goto err; 299845f3505SAntti Palosaari 300845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x04\x10\x15\x00", 6); 301845f3505SAntti Palosaari cmd.wlen = 6; 302845f3505SAntti Palosaari cmd.rlen = 1; 303845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 304845f3505SAntti Palosaari if (ret) 305845f3505SAntti Palosaari goto err; 306845f3505SAntti Palosaari 307845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x05\x10\xa1\x00", 6); 308845f3505SAntti Palosaari cmd.wlen = 6; 309845f3505SAntti Palosaari cmd.rlen = 1; 310845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 311845f3505SAntti Palosaari if (ret) 312845f3505SAntti Palosaari goto err; 313845f3505SAntti Palosaari 314845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x0f\x10\x10\x00", 6); 315845f3505SAntti Palosaari cmd.wlen = 6; 316845f3505SAntti Palosaari cmd.rlen = 1; 317845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 318845f3505SAntti Palosaari if (ret) 319845f3505SAntti Palosaari goto err; 320845f3505SAntti Palosaari 321845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x0d\x10\xd0\x02", 6); 322845f3505SAntti Palosaari cmd.wlen = 6; 323845f3505SAntti Palosaari cmd.rlen = 1; 324845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 325845f3505SAntti Palosaari if (ret) 326845f3505SAntti Palosaari goto err; 327845f3505SAntti Palosaari 328845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x01\x10\x00\x00", 6); 329845f3505SAntti Palosaari cmd.wlen = 6; 330845f3505SAntti Palosaari cmd.rlen = 1; 331845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 332845f3505SAntti Palosaari if (ret) 333845f3505SAntti Palosaari goto err; 334845f3505SAntti Palosaari 335845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x09\x10\xe3\x18", 6); 336845f3505SAntti Palosaari cmd.wlen = 6; 337845f3505SAntti Palosaari cmd.rlen = 1; 338845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 339845f3505SAntti Palosaari if (ret) 340845f3505SAntti Palosaari goto err; 341845f3505SAntti Palosaari 342845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x08\x10\xd7\x15", 6); 343845f3505SAntti Palosaari cmd.wlen = 6; 344845f3505SAntti Palosaari cmd.rlen = 1; 345845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 346845f3505SAntti Palosaari if (ret) 347845f3505SAntti Palosaari goto err; 348845f3505SAntti Palosaari 349845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x04\x03\x00\x00", 6); 350845f3505SAntti Palosaari cmd.wlen = 6; 351845f3505SAntti Palosaari cmd.rlen = 1; 352845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 353845f3505SAntti Palosaari if (ret) 354845f3505SAntti Palosaari goto err; 355845f3505SAntti Palosaari 356845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x03\x03\x00\x00", 6); 357845f3505SAntti Palosaari cmd.wlen = 6; 358845f3505SAntti Palosaari cmd.rlen = 1; 359845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 360845f3505SAntti Palosaari if (ret) 361845f3505SAntti Palosaari goto err; 362845f3505SAntti Palosaari 363845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x08\x03\x00\x00", 6); 364845f3505SAntti Palosaari cmd.wlen = 6; 365845f3505SAntti Palosaari cmd.rlen = 1; 366845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 367845f3505SAntti Palosaari if (ret) 368845f3505SAntti Palosaari goto err; 369845f3505SAntti Palosaari 370845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x07\x03\x01\x02", 6); 371845f3505SAntti Palosaari cmd.wlen = 6; 372845f3505SAntti Palosaari cmd.rlen = 1; 373845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 374845f3505SAntti Palosaari if (ret) 375845f3505SAntti Palosaari goto err; 376845f3505SAntti Palosaari 377845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x06\x03\x00\x00", 6); 378845f3505SAntti Palosaari cmd.wlen = 6; 379845f3505SAntti Palosaari cmd.rlen = 1; 380845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 381845f3505SAntti Palosaari if (ret) 382845f3505SAntti Palosaari goto err; 383845f3505SAntti Palosaari 384845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x05\x03\x00\x00", 6); 385845f3505SAntti Palosaari cmd.wlen = 6; 386845f3505SAntti Palosaari cmd.rlen = 1; 387845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 388845f3505SAntti Palosaari if (ret) 389845f3505SAntti Palosaari goto err; 390845f3505SAntti Palosaari 391845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x01\x03\x0c\x40", 6); 392845f3505SAntti Palosaari cmd.wlen = 6; 393845f3505SAntti Palosaari cmd.rlen = 1; 394845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 395845f3505SAntti Palosaari if (ret) 396845f3505SAntti Palosaari goto err; 397845f3505SAntti Palosaari 398845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x01\x10\x16\x00", 6); 399845f3505SAntti Palosaari cmd.wlen = 6; 400845f3505SAntti Palosaari cmd.rlen = 1; 401845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 402845f3505SAntti Palosaari if (ret) 403845f3505SAntti Palosaari goto err; 404845f3505SAntti Palosaari 405845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x01\x12\x00\x00", 6); 406845f3505SAntti Palosaari cmd.wlen = 6; 407845f3505SAntti Palosaari cmd.rlen = 1; 408845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 409845f3505SAntti Palosaari if (ret) 410845f3505SAntti Palosaari goto err; 411845f3505SAntti Palosaari 412888680ffSAntti Palosaari memcpy(cmd.args, "\x85", 1); 413845f3505SAntti Palosaari cmd.wlen = 1; 414845f3505SAntti Palosaari cmd.rlen = 1; 415845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 416845f3505SAntti Palosaari if (ret) 417845f3505SAntti Palosaari goto err; 418845f3505SAntti Palosaari 419845f3505SAntti Palosaari s->delivery_system = c->delivery_system; 420845f3505SAntti Palosaari 421845f3505SAntti Palosaari return 0; 422845f3505SAntti Palosaari err: 423845f3505SAntti Palosaari dev_dbg(&s->client->dev, "%s: failed=%d\n", __func__, ret); 424845f3505SAntti Palosaari return ret; 425845f3505SAntti Palosaari } 426845f3505SAntti Palosaari 427845f3505SAntti Palosaari static int si2168_init(struct dvb_frontend *fe) 428845f3505SAntti Palosaari { 429845f3505SAntti Palosaari struct si2168 *s = fe->demodulator_priv; 430845f3505SAntti Palosaari int ret, len, remaining; 431845f3505SAntti Palosaari const struct firmware *fw = NULL; 432845f3505SAntti Palosaari u8 *fw_file = SI2168_FIRMWARE; 433845f3505SAntti Palosaari const unsigned int i2c_wr_max = 8; 434845f3505SAntti Palosaari struct si2168_cmd cmd; 435845f3505SAntti Palosaari 436845f3505SAntti Palosaari dev_dbg(&s->client->dev, "%s:\n", __func__); 437845f3505SAntti Palosaari 438888680ffSAntti Palosaari memcpy(cmd.args, "\xc0\x12\x00\x0c\x00\x0d\x16\x00\x00\x00\x00\x00\x00", 13); 439845f3505SAntti Palosaari cmd.wlen = 13; 440845f3505SAntti Palosaari cmd.rlen = 0; 441845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 442845f3505SAntti Palosaari if (ret) 443845f3505SAntti Palosaari goto err; 444845f3505SAntti Palosaari 445888680ffSAntti Palosaari memcpy(cmd.args, "\xc0\x06\x01\x0f\x00\x20\x20\x01", 8); 446845f3505SAntti Palosaari cmd.wlen = 8; 447845f3505SAntti Palosaari cmd.rlen = 1; 448845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 449845f3505SAntti Palosaari if (ret) 450845f3505SAntti Palosaari goto err; 451845f3505SAntti Palosaari 452888680ffSAntti Palosaari memcpy(cmd.args, "\x02", 1); 453845f3505SAntti Palosaari cmd.wlen = 1; 454845f3505SAntti Palosaari cmd.rlen = 13; 455845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 456845f3505SAntti Palosaari if (ret) 457845f3505SAntti Palosaari goto err; 458845f3505SAntti Palosaari 459845f3505SAntti Palosaari cmd.args[0] = 0x05; 460845f3505SAntti Palosaari cmd.args[1] = 0x00; 461845f3505SAntti Palosaari cmd.args[2] = 0xaa; 462845f3505SAntti Palosaari cmd.args[3] = 0x4d; 463845f3505SAntti Palosaari cmd.args[4] = 0x56; 464845f3505SAntti Palosaari cmd.args[5] = 0x40; 465845f3505SAntti Palosaari cmd.args[6] = 0x00; 466845f3505SAntti Palosaari cmd.args[7] = 0x00; 467845f3505SAntti Palosaari cmd.wlen = 8; 468845f3505SAntti Palosaari cmd.rlen = 1; 469845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 470845f3505SAntti Palosaari if (ret) 471845f3505SAntti Palosaari goto err; 472845f3505SAntti Palosaari 473845f3505SAntti Palosaari /* cold state - try to download firmware */ 474845f3505SAntti Palosaari dev_info(&s->client->dev, "%s: found a '%s' in cold state\n", 475845f3505SAntti Palosaari KBUILD_MODNAME, si2168_ops.info.name); 476845f3505SAntti Palosaari 477845f3505SAntti Palosaari /* request the firmware, this will block and timeout */ 478845f3505SAntti Palosaari ret = request_firmware(&fw, fw_file, &s->client->dev); 479845f3505SAntti Palosaari if (ret) { 480845f3505SAntti Palosaari dev_err(&s->client->dev, "%s: firmare file '%s' not found\n", 481845f3505SAntti Palosaari KBUILD_MODNAME, fw_file); 482845f3505SAntti Palosaari goto err; 483845f3505SAntti Palosaari } 484845f3505SAntti Palosaari 485845f3505SAntti Palosaari dev_info(&s->client->dev, "%s: downloading firmware from file '%s'\n", 486845f3505SAntti Palosaari KBUILD_MODNAME, fw_file); 487845f3505SAntti Palosaari 488845f3505SAntti Palosaari for (remaining = fw->size; remaining > 0; remaining -= i2c_wr_max) { 489845f3505SAntti Palosaari len = remaining; 490845f3505SAntti Palosaari if (len > i2c_wr_max) 491845f3505SAntti Palosaari len = i2c_wr_max; 492845f3505SAntti Palosaari 493845f3505SAntti Palosaari memcpy(cmd.args, &fw->data[fw->size - remaining], len); 494845f3505SAntti Palosaari cmd.wlen = len; 495845f3505SAntti Palosaari cmd.rlen = 1; 496845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 497845f3505SAntti Palosaari if (ret) { 498845f3505SAntti Palosaari dev_err(&s->client->dev, 499845f3505SAntti Palosaari "%s: firmware download failed=%d\n", 500845f3505SAntti Palosaari KBUILD_MODNAME, ret); 501845f3505SAntti Palosaari goto err; 502845f3505SAntti Palosaari } 503845f3505SAntti Palosaari } 504845f3505SAntti Palosaari 505845f3505SAntti Palosaari release_firmware(fw); 506845f3505SAntti Palosaari fw = NULL; 507845f3505SAntti Palosaari 508888680ffSAntti Palosaari memcpy(cmd.args, "\x01\x01", 2); 509845f3505SAntti Palosaari cmd.wlen = 2; 510845f3505SAntti Palosaari cmd.rlen = 1; 511845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 512845f3505SAntti Palosaari if (ret) 513845f3505SAntti Palosaari goto err; 514845f3505SAntti Palosaari 515845f3505SAntti Palosaari dev_info(&s->client->dev, "%s: found a '%s' in warm state\n", 516845f3505SAntti Palosaari KBUILD_MODNAME, si2168_ops.info.name); 517845f3505SAntti Palosaari 518845f3505SAntti Palosaari s->active = true; 519845f3505SAntti Palosaari 520845f3505SAntti Palosaari return 0; 521845f3505SAntti Palosaari err: 522845f3505SAntti Palosaari if (fw) 523845f3505SAntti Palosaari release_firmware(fw); 524845f3505SAntti Palosaari 525845f3505SAntti Palosaari dev_dbg(&s->client->dev, "%s: failed=%d\n", __func__, ret); 526845f3505SAntti Palosaari return ret; 527845f3505SAntti Palosaari } 528845f3505SAntti Palosaari 529845f3505SAntti Palosaari static int si2168_sleep(struct dvb_frontend *fe) 530845f3505SAntti Palosaari { 531845f3505SAntti Palosaari struct si2168 *s = fe->demodulator_priv; 5324de0ed7cSAntti Palosaari int ret; 5334de0ed7cSAntti Palosaari struct si2168_cmd cmd; 534845f3505SAntti Palosaari 535845f3505SAntti Palosaari dev_dbg(&s->client->dev, "%s:\n", __func__); 536845f3505SAntti Palosaari 537845f3505SAntti Palosaari s->active = false; 538845f3505SAntti Palosaari 5394de0ed7cSAntti Palosaari memcpy(cmd.args, "\x13", 1); 5404de0ed7cSAntti Palosaari cmd.wlen = 1; 5414de0ed7cSAntti Palosaari cmd.rlen = 0; 5424de0ed7cSAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 5434de0ed7cSAntti Palosaari if (ret) 5444de0ed7cSAntti Palosaari goto err; 5454de0ed7cSAntti Palosaari 546845f3505SAntti Palosaari return 0; 5474de0ed7cSAntti Palosaari err: 5484de0ed7cSAntti Palosaari dev_dbg(&s->client->dev, "%s: failed=%d\n", __func__, ret); 5494de0ed7cSAntti Palosaari return ret; 550845f3505SAntti Palosaari } 551845f3505SAntti Palosaari 552845f3505SAntti Palosaari static int si2168_get_tune_settings(struct dvb_frontend *fe, 553845f3505SAntti Palosaari struct dvb_frontend_tune_settings *s) 554845f3505SAntti Palosaari { 555845f3505SAntti Palosaari s->min_delay_ms = 900; 556845f3505SAntti Palosaari 557845f3505SAntti Palosaari return 0; 558845f3505SAntti Palosaari } 559845f3505SAntti Palosaari 560845f3505SAntti Palosaari /* 561845f3505SAntti Palosaari * I2C gate logic 562845f3505SAntti Palosaari * We must use unlocked i2c_transfer() here because I2C lock is already taken 563845f3505SAntti Palosaari * by tuner driver. 564845f3505SAntti Palosaari */ 565845f3505SAntti Palosaari static int si2168_select(struct i2c_adapter *adap, void *mux_priv, u32 chan) 566845f3505SAntti Palosaari { 567845f3505SAntti Palosaari struct si2168 *s = mux_priv; 568845f3505SAntti Palosaari int ret; 569845f3505SAntti Palosaari struct i2c_msg gate_open_msg = { 570845f3505SAntti Palosaari .addr = s->client->addr, 571845f3505SAntti Palosaari .flags = 0, 572845f3505SAntti Palosaari .len = 3, 573845f3505SAntti Palosaari .buf = "\xc0\x0d\x01", 574845f3505SAntti Palosaari }; 575845f3505SAntti Palosaari 576845f3505SAntti Palosaari mutex_lock(&s->i2c_mutex); 577845f3505SAntti Palosaari 578845f3505SAntti Palosaari /* open tuner I2C gate */ 579845f3505SAntti Palosaari ret = __i2c_transfer(s->client->adapter, &gate_open_msg, 1); 580845f3505SAntti Palosaari if (ret != 1) { 581845f3505SAntti Palosaari dev_warn(&s->client->dev, "%s: i2c write failed=%d\n", 582845f3505SAntti Palosaari KBUILD_MODNAME, ret); 583845f3505SAntti Palosaari if (ret >= 0) 584845f3505SAntti Palosaari ret = -EREMOTEIO; 585845f3505SAntti Palosaari } else { 586845f3505SAntti Palosaari ret = 0; 587845f3505SAntti Palosaari } 588845f3505SAntti Palosaari 589845f3505SAntti Palosaari return ret; 590845f3505SAntti Palosaari } 591845f3505SAntti Palosaari 592845f3505SAntti Palosaari static int si2168_deselect(struct i2c_adapter *adap, void *mux_priv, u32 chan) 593845f3505SAntti Palosaari { 594845f3505SAntti Palosaari struct si2168 *s = mux_priv; 595845f3505SAntti Palosaari int ret; 596845f3505SAntti Palosaari struct i2c_msg gate_close_msg = { 597845f3505SAntti Palosaari .addr = s->client->addr, 598845f3505SAntti Palosaari .flags = 0, 599845f3505SAntti Palosaari .len = 3, 600845f3505SAntti Palosaari .buf = "\xc0\x0d\x00", 601845f3505SAntti Palosaari }; 602845f3505SAntti Palosaari 603845f3505SAntti Palosaari /* close tuner I2C gate */ 604845f3505SAntti Palosaari ret = __i2c_transfer(s->client->adapter, &gate_close_msg, 1); 605845f3505SAntti Palosaari if (ret != 1) { 606845f3505SAntti Palosaari dev_warn(&s->client->dev, "%s: i2c write failed=%d\n", 607845f3505SAntti Palosaari KBUILD_MODNAME, ret); 608845f3505SAntti Palosaari if (ret >= 0) 609845f3505SAntti Palosaari ret = -EREMOTEIO; 610845f3505SAntti Palosaari } else { 611845f3505SAntti Palosaari ret = 0; 612845f3505SAntti Palosaari } 613845f3505SAntti Palosaari 614845f3505SAntti Palosaari mutex_unlock(&s->i2c_mutex); 615845f3505SAntti Palosaari 616845f3505SAntti Palosaari return ret; 617845f3505SAntti Palosaari } 618845f3505SAntti Palosaari 619845f3505SAntti Palosaari static const struct dvb_frontend_ops si2168_ops = { 620c790885bSAntti Palosaari .delsys = {SYS_DVBT, SYS_DVBT2, SYS_DVBC_ANNEX_A}, 621845f3505SAntti Palosaari .info = { 622845f3505SAntti Palosaari .name = "Silicon Labs Si2168", 623845f3505SAntti Palosaari .caps = FE_CAN_FEC_1_2 | 624845f3505SAntti Palosaari FE_CAN_FEC_2_3 | 625845f3505SAntti Palosaari FE_CAN_FEC_3_4 | 626845f3505SAntti Palosaari FE_CAN_FEC_5_6 | 627845f3505SAntti Palosaari FE_CAN_FEC_7_8 | 628845f3505SAntti Palosaari FE_CAN_FEC_AUTO | 629845f3505SAntti Palosaari FE_CAN_QPSK | 630845f3505SAntti Palosaari FE_CAN_QAM_16 | 631845f3505SAntti Palosaari FE_CAN_QAM_32 | 632845f3505SAntti Palosaari FE_CAN_QAM_64 | 633845f3505SAntti Palosaari FE_CAN_QAM_128 | 634845f3505SAntti Palosaari FE_CAN_QAM_256 | 635845f3505SAntti Palosaari FE_CAN_QAM_AUTO | 636845f3505SAntti Palosaari FE_CAN_TRANSMISSION_MODE_AUTO | 637845f3505SAntti Palosaari FE_CAN_GUARD_INTERVAL_AUTO | 638845f3505SAntti Palosaari FE_CAN_HIERARCHY_AUTO | 639845f3505SAntti Palosaari FE_CAN_MUTE_TS | 640845f3505SAntti Palosaari FE_CAN_2G_MODULATION 641845f3505SAntti Palosaari }, 642845f3505SAntti Palosaari 643845f3505SAntti Palosaari .get_tune_settings = si2168_get_tune_settings, 644845f3505SAntti Palosaari 645845f3505SAntti Palosaari .init = si2168_init, 646845f3505SAntti Palosaari .sleep = si2168_sleep, 647845f3505SAntti Palosaari 648845f3505SAntti Palosaari .set_frontend = si2168_set_frontend, 649845f3505SAntti Palosaari 650845f3505SAntti Palosaari .read_status = si2168_read_status, 651845f3505SAntti Palosaari }; 652845f3505SAntti Palosaari 653845f3505SAntti Palosaari static int si2168_probe(struct i2c_client *client, 654845f3505SAntti Palosaari const struct i2c_device_id *id) 655845f3505SAntti Palosaari { 656845f3505SAntti Palosaari struct si2168_config *config = client->dev.platform_data; 657845f3505SAntti Palosaari struct si2168 *s; 658845f3505SAntti Palosaari int ret; 659845f3505SAntti Palosaari struct si2168_cmd cmd; 660845f3505SAntti Palosaari 661845f3505SAntti Palosaari dev_dbg(&client->dev, "%s:\n", __func__); 662845f3505SAntti Palosaari 663845f3505SAntti Palosaari s = kzalloc(sizeof(struct si2168), GFP_KERNEL); 664845f3505SAntti Palosaari if (!s) { 665845f3505SAntti Palosaari ret = -ENOMEM; 666845f3505SAntti Palosaari dev_err(&client->dev, "%s: kzalloc() failed\n", KBUILD_MODNAME); 667845f3505SAntti Palosaari goto err; 668845f3505SAntti Palosaari } 669845f3505SAntti Palosaari 670845f3505SAntti Palosaari s->client = client; 671845f3505SAntti Palosaari mutex_init(&s->i2c_mutex); 672845f3505SAntti Palosaari 673845f3505SAntti Palosaari /* check if the demod is there */ 674845f3505SAntti Palosaari cmd.wlen = 0; 675845f3505SAntti Palosaari cmd.rlen = 1; 676845f3505SAntti Palosaari ret = si2168_cmd_execute(s, &cmd); 677845f3505SAntti Palosaari if (ret) 678845f3505SAntti Palosaari goto err; 679845f3505SAntti Palosaari 680845f3505SAntti Palosaari /* create mux i2c adapter for tuner */ 681845f3505SAntti Palosaari s->adapter = i2c_add_mux_adapter(client->adapter, &client->dev, s, 682845f3505SAntti Palosaari 0, 0, 0, si2168_select, si2168_deselect); 683845f3505SAntti Palosaari if (s->adapter == NULL) 684845f3505SAntti Palosaari goto err; 685845f3505SAntti Palosaari 686845f3505SAntti Palosaari /* create dvb_frontend */ 687845f3505SAntti Palosaari memcpy(&s->fe.ops, &si2168_ops, sizeof(struct dvb_frontend_ops)); 688845f3505SAntti Palosaari s->fe.demodulator_priv = s; 689845f3505SAntti Palosaari 690845f3505SAntti Palosaari *config->i2c_adapter = s->adapter; 691845f3505SAntti Palosaari *config->fe = &s->fe; 692845f3505SAntti Palosaari 693845f3505SAntti Palosaari i2c_set_clientdata(client, s); 694845f3505SAntti Palosaari 695845f3505SAntti Palosaari dev_info(&s->client->dev, 696845f3505SAntti Palosaari "%s: Silicon Labs Si2168 successfully attached\n", 697845f3505SAntti Palosaari KBUILD_MODNAME); 698845f3505SAntti Palosaari return 0; 699845f3505SAntti Palosaari err: 700845f3505SAntti Palosaari kfree(s); 701845f3505SAntti Palosaari dev_dbg(&client->dev, "%s: failed=%d\n", __func__, ret); 702845f3505SAntti Palosaari return ret; 703845f3505SAntti Palosaari } 704845f3505SAntti Palosaari 705845f3505SAntti Palosaari static int si2168_remove(struct i2c_client *client) 706845f3505SAntti Palosaari { 707845f3505SAntti Palosaari struct si2168 *s = i2c_get_clientdata(client); 708845f3505SAntti Palosaari 709845f3505SAntti Palosaari dev_dbg(&client->dev, "%s:\n", __func__); 710845f3505SAntti Palosaari 711845f3505SAntti Palosaari i2c_del_mux_adapter(s->adapter); 712845f3505SAntti Palosaari 713845f3505SAntti Palosaari s->fe.ops.release = NULL; 714845f3505SAntti Palosaari s->fe.demodulator_priv = NULL; 715845f3505SAntti Palosaari 716845f3505SAntti Palosaari kfree(s); 717845f3505SAntti Palosaari 718845f3505SAntti Palosaari return 0; 719845f3505SAntti Palosaari } 720845f3505SAntti Palosaari 721845f3505SAntti Palosaari static const struct i2c_device_id si2168_id[] = { 722845f3505SAntti Palosaari {"si2168", 0}, 723845f3505SAntti Palosaari {} 724845f3505SAntti Palosaari }; 725845f3505SAntti Palosaari MODULE_DEVICE_TABLE(i2c, si2168_id); 726845f3505SAntti Palosaari 727845f3505SAntti Palosaari static struct i2c_driver si2168_driver = { 728845f3505SAntti Palosaari .driver = { 729845f3505SAntti Palosaari .owner = THIS_MODULE, 730845f3505SAntti Palosaari .name = "si2168", 731845f3505SAntti Palosaari }, 732845f3505SAntti Palosaari .probe = si2168_probe, 733845f3505SAntti Palosaari .remove = si2168_remove, 734845f3505SAntti Palosaari .id_table = si2168_id, 735845f3505SAntti Palosaari }; 736845f3505SAntti Palosaari 737845f3505SAntti Palosaari module_i2c_driver(si2168_driver); 738845f3505SAntti Palosaari 739845f3505SAntti Palosaari MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>"); 740845f3505SAntti Palosaari MODULE_DESCRIPTION("Silicon Labs Si2168 DVB-T/T2/C demodulator driver"); 741845f3505SAntti Palosaari MODULE_LICENSE("GPL"); 742845f3505SAntti Palosaari MODULE_FIRMWARE(SI2168_FIRMWARE); 743