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 */ 226307b560SAntti Palosaari static int si2168_cmd_execute(struct i2c_client *client, struct si2168_cmd *cmd) 23845f3505SAntti Palosaari { 246307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 25845f3505SAntti Palosaari int ret; 26845f3505SAntti Palosaari unsigned long timeout; 27845f3505SAntti Palosaari 28bd01c766SAntti Palosaari mutex_lock(&dev->i2c_mutex); 29845f3505SAntti Palosaari 30845f3505SAntti Palosaari if (cmd->wlen) { 31845f3505SAntti Palosaari /* write cmd and args for firmware */ 323de35835SAntti Palosaari ret = i2c_master_send(client, cmd->args, cmd->wlen); 33845f3505SAntti Palosaari if (ret < 0) { 34845f3505SAntti Palosaari goto err_mutex_unlock; 35845f3505SAntti Palosaari } else if (ret != cmd->wlen) { 36845f3505SAntti Palosaari ret = -EREMOTEIO; 37845f3505SAntti Palosaari goto err_mutex_unlock; 38845f3505SAntti Palosaari } 39845f3505SAntti Palosaari } 40845f3505SAntti Palosaari 41845f3505SAntti Palosaari if (cmd->rlen) { 42845f3505SAntti Palosaari /* wait cmd execution terminate */ 43551c33e7SJurgen Kramer #define TIMEOUT 70 44845f3505SAntti Palosaari timeout = jiffies + msecs_to_jiffies(TIMEOUT); 45845f3505SAntti Palosaari while (!time_after(jiffies, timeout)) { 463de35835SAntti Palosaari ret = i2c_master_recv(client, cmd->args, cmd->rlen); 47845f3505SAntti Palosaari if (ret < 0) { 48845f3505SAntti Palosaari goto err_mutex_unlock; 49845f3505SAntti Palosaari } else if (ret != cmd->rlen) { 50845f3505SAntti Palosaari ret = -EREMOTEIO; 51845f3505SAntti Palosaari goto err_mutex_unlock; 52845f3505SAntti Palosaari } 53845f3505SAntti Palosaari 54845f3505SAntti Palosaari /* firmware ready? */ 55845f3505SAntti Palosaari if ((cmd->args[0] >> 7) & 0x01) 56845f3505SAntti Palosaari break; 57845f3505SAntti Palosaari } 58845f3505SAntti Palosaari 593de35835SAntti Palosaari dev_dbg(&client->dev, "cmd execution took %d ms\n", 60845f3505SAntti Palosaari jiffies_to_msecs(jiffies) - 61845f3505SAntti Palosaari (jiffies_to_msecs(timeout) - TIMEOUT)); 62845f3505SAntti Palosaari 63eefae30aSAntti Palosaari if (!((cmd->args[0] >> 7) & 0x01)) { 64845f3505SAntti Palosaari ret = -ETIMEDOUT; 65845f3505SAntti Palosaari goto err_mutex_unlock; 66845f3505SAntti Palosaari } 67845f3505SAntti Palosaari } 68845f3505SAntti Palosaari 694affbe1dSAntti Palosaari mutex_unlock(&dev->i2c_mutex); 704affbe1dSAntti Palosaari return 0; 71845f3505SAntti Palosaari 72845f3505SAntti Palosaari err_mutex_unlock: 73bd01c766SAntti Palosaari mutex_unlock(&dev->i2c_mutex); 743de35835SAntti Palosaari dev_dbg(&client->dev, "failed=%d\n", ret); 75845f3505SAntti Palosaari return ret; 76845f3505SAntti Palosaari } 77845f3505SAntti Palosaari 78845f3505SAntti Palosaari static int si2168_read_status(struct dvb_frontend *fe, fe_status_t *status) 79845f3505SAntti Palosaari { 806307b560SAntti Palosaari struct i2c_client *client = fe->demodulator_priv; 816307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 82bffab93cSAntti Palosaari struct dtv_frontend_properties *c = &fe->dtv_property_cache; 83845f3505SAntti Palosaari int ret; 84845f3505SAntti Palosaari struct si2168_cmd cmd; 85845f3505SAntti Palosaari 86845f3505SAntti Palosaari *status = 0; 87845f3505SAntti Palosaari 88bd01c766SAntti Palosaari if (!dev->active) { 89845f3505SAntti Palosaari ret = -EAGAIN; 90845f3505SAntti Palosaari goto err; 91845f3505SAntti Palosaari } 92845f3505SAntti Palosaari 93bffab93cSAntti Palosaari switch (c->delivery_system) { 94bffab93cSAntti Palosaari case SYS_DVBT: 95888680ffSAntti Palosaari memcpy(cmd.args, "\xa0\x01", 2); 96845f3505SAntti Palosaari cmd.wlen = 2; 97845f3505SAntti Palosaari cmd.rlen = 13; 98bffab93cSAntti Palosaari break; 99c790885bSAntti Palosaari case SYS_DVBC_ANNEX_A: 100888680ffSAntti Palosaari memcpy(cmd.args, "\x90\x01", 2); 101c790885bSAntti Palosaari cmd.wlen = 2; 102c790885bSAntti Palosaari cmd.rlen = 9; 103c790885bSAntti Palosaari break; 104bffab93cSAntti Palosaari case SYS_DVBT2: 105888680ffSAntti Palosaari memcpy(cmd.args, "\x50\x01", 2); 106bffab93cSAntti Palosaari cmd.wlen = 2; 107bffab93cSAntti Palosaari cmd.rlen = 14; 108bffab93cSAntti Palosaari break; 109bffab93cSAntti Palosaari default: 110bffab93cSAntti Palosaari ret = -EINVAL; 111bffab93cSAntti Palosaari goto err; 112bffab93cSAntti Palosaari } 113bffab93cSAntti Palosaari 1146307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 115845f3505SAntti Palosaari if (ret) 116845f3505SAntti Palosaari goto err; 117845f3505SAntti Palosaari 118722a042dSAntti Palosaari switch ((cmd.args[2] >> 1) & 0x03) { 119722a042dSAntti Palosaari case 0x01: 120845f3505SAntti Palosaari *status = FE_HAS_SIGNAL | FE_HAS_CARRIER; 121845f3505SAntti Palosaari break; 122722a042dSAntti Palosaari case 0x03: 123845f3505SAntti Palosaari *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_VITERBI | 124845f3505SAntti Palosaari FE_HAS_SYNC | FE_HAS_LOCK; 125845f3505SAntti Palosaari break; 126845f3505SAntti Palosaari } 127845f3505SAntti Palosaari 128bd01c766SAntti Palosaari dev->fe_status = *status; 129845f3505SAntti Palosaari 13088ac8f86SAntti Palosaari if (*status & FE_HAS_LOCK) { 13188ac8f86SAntti Palosaari c->cnr.len = 1; 13288ac8f86SAntti Palosaari c->cnr.stat[0].scale = FE_SCALE_DECIBEL; 13388ac8f86SAntti Palosaari c->cnr.stat[0].svalue = cmd.args[3] * 1000 / 4; 13488ac8f86SAntti Palosaari } else { 13588ac8f86SAntti Palosaari c->cnr.len = 1; 13688ac8f86SAntti Palosaari c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE; 13788ac8f86SAntti Palosaari } 13888ac8f86SAntti Palosaari 1393de35835SAntti Palosaari dev_dbg(&client->dev, "status=%02x args=%*ph\n", 14037b4e43dSOlli Salonen *status, cmd.rlen, cmd.args); 141845f3505SAntti Palosaari 142845f3505SAntti Palosaari return 0; 143845f3505SAntti Palosaari err: 1443de35835SAntti Palosaari dev_dbg(&client->dev, "failed=%d\n", ret); 145845f3505SAntti Palosaari return ret; 146845f3505SAntti Palosaari } 147845f3505SAntti Palosaari 148845f3505SAntti Palosaari static int si2168_set_frontend(struct dvb_frontend *fe) 149845f3505SAntti Palosaari { 1506307b560SAntti Palosaari struct i2c_client *client = fe->demodulator_priv; 1516307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 152845f3505SAntti Palosaari struct dtv_frontend_properties *c = &fe->dtv_property_cache; 153845f3505SAntti Palosaari int ret; 154845f3505SAntti Palosaari struct si2168_cmd cmd; 155bffab93cSAntti Palosaari u8 bandwidth, delivery_system; 156845f3505SAntti Palosaari 1573de35835SAntti Palosaari dev_dbg(&client->dev, 158e395e573SCrazyCat "delivery_system=%u modulation=%u frequency=%u bandwidth_hz=%u symbol_rate=%u inversion=%u, stream_id=%d\n", 15937b4e43dSOlli Salonen c->delivery_system, c->modulation, 160845f3505SAntti Palosaari c->frequency, c->bandwidth_hz, c->symbol_rate, 161e395e573SCrazyCat c->inversion, c->stream_id); 162845f3505SAntti Palosaari 163bd01c766SAntti Palosaari if (!dev->active) { 164845f3505SAntti Palosaari ret = -EAGAIN; 165845f3505SAntti Palosaari goto err; 166845f3505SAntti Palosaari } 167845f3505SAntti Palosaari 168bffab93cSAntti Palosaari switch (c->delivery_system) { 169bffab93cSAntti Palosaari case SYS_DVBT: 170bffab93cSAntti Palosaari delivery_system = 0x20; 171bffab93cSAntti Palosaari break; 172c790885bSAntti Palosaari case SYS_DVBC_ANNEX_A: 173c790885bSAntti Palosaari delivery_system = 0x30; 174c790885bSAntti Palosaari break; 175bffab93cSAntti Palosaari case SYS_DVBT2: 176bffab93cSAntti Palosaari delivery_system = 0x70; 177bffab93cSAntti Palosaari break; 178bffab93cSAntti Palosaari default: 179bffab93cSAntti Palosaari ret = -EINVAL; 180bffab93cSAntti Palosaari goto err; 181bffab93cSAntti Palosaari } 182bffab93cSAntti Palosaari 183c790885bSAntti Palosaari if (c->bandwidth_hz <= 5000000) 184bffab93cSAntti Palosaari bandwidth = 0x05; 185c790885bSAntti Palosaari else if (c->bandwidth_hz <= 6000000) 186bffab93cSAntti Palosaari bandwidth = 0x06; 187c790885bSAntti Palosaari else if (c->bandwidth_hz <= 7000000) 188bffab93cSAntti Palosaari bandwidth = 0x07; 189c790885bSAntti Palosaari else if (c->bandwidth_hz <= 8000000) 190bffab93cSAntti Palosaari bandwidth = 0x08; 191c790885bSAntti Palosaari else if (c->bandwidth_hz <= 9000000) 192c790885bSAntti Palosaari bandwidth = 0x09; 193c790885bSAntti Palosaari else if (c->bandwidth_hz <= 10000000) 194c790885bSAntti Palosaari bandwidth = 0x0a; 195c790885bSAntti Palosaari else 196c790885bSAntti Palosaari bandwidth = 0x0f; 197845f3505SAntti Palosaari 198845f3505SAntti Palosaari /* program tuner */ 199845f3505SAntti Palosaari if (fe->ops.tuner_ops.set_params) { 200845f3505SAntti Palosaari ret = fe->ops.tuner_ops.set_params(fe); 201845f3505SAntti Palosaari if (ret) 202845f3505SAntti Palosaari goto err; 203845f3505SAntti Palosaari } 204845f3505SAntti Palosaari 205845f3505SAntti Palosaari memcpy(cmd.args, "\x88\x02\x02\x02\x02", 5); 206845f3505SAntti Palosaari cmd.wlen = 5; 207845f3505SAntti Palosaari cmd.rlen = 5; 2086307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 209845f3505SAntti Palosaari if (ret) 210845f3505SAntti Palosaari goto err; 211845f3505SAntti Palosaari 212bffab93cSAntti Palosaari /* that has no big effect */ 213bffab93cSAntti Palosaari if (c->delivery_system == SYS_DVBT) 214845f3505SAntti Palosaari memcpy(cmd.args, "\x89\x21\x06\x11\xff\x98", 6); 215c790885bSAntti Palosaari else if (c->delivery_system == SYS_DVBC_ANNEX_A) 216c790885bSAntti Palosaari memcpy(cmd.args, "\x89\x21\x06\x11\x89\xf0", 6); 217bffab93cSAntti Palosaari else if (c->delivery_system == SYS_DVBT2) 218bffab93cSAntti Palosaari memcpy(cmd.args, "\x89\x21\x06\x11\x89\x20", 6); 219845f3505SAntti Palosaari cmd.wlen = 6; 220845f3505SAntti Palosaari cmd.rlen = 3; 2216307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 222845f3505SAntti Palosaari if (ret) 223845f3505SAntti Palosaari goto err; 224845f3505SAntti Palosaari 225e395e573SCrazyCat if (c->delivery_system == SYS_DVBT2) { 226e395e573SCrazyCat /* select PLP */ 227e395e573SCrazyCat cmd.args[0] = 0x52; 228e395e573SCrazyCat cmd.args[1] = c->stream_id & 0xff; 229e395e573SCrazyCat cmd.args[2] = c->stream_id == NO_STREAM_ID_FILTER ? 0 : 1; 230e395e573SCrazyCat cmd.wlen = 3; 231e395e573SCrazyCat cmd.rlen = 1; 2326307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 233e395e573SCrazyCat if (ret) 234e395e573SCrazyCat goto err; 235e395e573SCrazyCat } 236e395e573SCrazyCat 237845f3505SAntti Palosaari memcpy(cmd.args, "\x51\x03", 2); 238845f3505SAntti Palosaari cmd.wlen = 2; 239845f3505SAntti Palosaari cmd.rlen = 12; 2406307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 241845f3505SAntti Palosaari if (ret) 242845f3505SAntti Palosaari goto err; 243845f3505SAntti Palosaari 244845f3505SAntti Palosaari memcpy(cmd.args, "\x12\x08\x04", 3); 245845f3505SAntti Palosaari cmd.wlen = 3; 246845f3505SAntti Palosaari cmd.rlen = 3; 2476307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 248845f3505SAntti Palosaari if (ret) 249845f3505SAntti Palosaari goto err; 250845f3505SAntti Palosaari 251845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x0c\x10\x12\x00", 6); 252845f3505SAntti Palosaari cmd.wlen = 6; 2531d518c27SAntti Palosaari cmd.rlen = 4; 2546307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 255845f3505SAntti Palosaari if (ret) 256845f3505SAntti Palosaari goto err; 257845f3505SAntti Palosaari 258845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x06\x10\x24\x00", 6); 259845f3505SAntti Palosaari cmd.wlen = 6; 2601d518c27SAntti Palosaari cmd.rlen = 4; 2616307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 262845f3505SAntti Palosaari if (ret) 263845f3505SAntti Palosaari goto err; 264845f3505SAntti Palosaari 265845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x07\x10\x00\x24", 6); 266845f3505SAntti Palosaari cmd.wlen = 6; 2671d518c27SAntti Palosaari cmd.rlen = 4; 2686307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 269845f3505SAntti Palosaari if (ret) 270845f3505SAntti Palosaari goto err; 271845f3505SAntti Palosaari 272845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x0a\x10\x00\x00", 6); 273bffab93cSAntti Palosaari cmd.args[4] = delivery_system | bandwidth; 274845f3505SAntti Palosaari cmd.wlen = 6; 2751d518c27SAntti Palosaari cmd.rlen = 4; 2766307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 277845f3505SAntti Palosaari if (ret) 278845f3505SAntti Palosaari goto err; 279845f3505SAntti Palosaari 28032bf8818SLuis Alves /* set DVB-C symbol rate */ 28132bf8818SLuis Alves if (c->delivery_system == SYS_DVBC_ANNEX_A) { 28232bf8818SLuis Alves memcpy(cmd.args, "\x14\x00\x02\x11", 4); 283346d4900SAntti Palosaari cmd.args[4] = ((c->symbol_rate / 1000) >> 0) & 0xff; 28432bf8818SLuis Alves cmd.args[5] = ((c->symbol_rate / 1000) >> 8) & 0xff; 28532bf8818SLuis Alves cmd.wlen = 6; 28632bf8818SLuis Alves cmd.rlen = 4; 2876307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 28832bf8818SLuis Alves if (ret) 28932bf8818SLuis Alves goto err; 29032bf8818SLuis Alves } 29132bf8818SLuis Alves 292845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x0f\x10\x10\x00", 6); 293845f3505SAntti Palosaari cmd.wlen = 6; 2941d518c27SAntti Palosaari cmd.rlen = 4; 2956307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 296845f3505SAntti Palosaari if (ret) 297845f3505SAntti Palosaari goto err; 298845f3505SAntti Palosaari 29952791979SCrazyCat memcpy(cmd.args, "\x14\x00\x09\x10\xe3\x08", 6); 300bd01c766SAntti Palosaari cmd.args[5] |= dev->ts_clock_inv ? 0x00 : 0x10; 301845f3505SAntti Palosaari cmd.wlen = 6; 3021d518c27SAntti Palosaari cmd.rlen = 4; 3036307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 304845f3505SAntti Palosaari if (ret) 305845f3505SAntti Palosaari goto err; 306845f3505SAntti Palosaari 30752791979SCrazyCat memcpy(cmd.args, "\x14\x00\x08\x10\xd7\x05", 6); 308bd01c766SAntti Palosaari cmd.args[5] |= dev->ts_clock_inv ? 0x00 : 0x10; 309845f3505SAntti Palosaari cmd.wlen = 6; 3101d518c27SAntti Palosaari cmd.rlen = 4; 3116307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 312845f3505SAntti Palosaari if (ret) 313845f3505SAntti Palosaari goto err; 314845f3505SAntti Palosaari 315845f3505SAntti Palosaari memcpy(cmd.args, "\x14\x00\x01\x12\x00\x00", 6); 316845f3505SAntti Palosaari cmd.wlen = 6; 3171d518c27SAntti Palosaari cmd.rlen = 4; 3186307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 319845f3505SAntti Palosaari if (ret) 320845f3505SAntti Palosaari goto err; 321845f3505SAntti Palosaari 32243911776SOlli Salonen memcpy(cmd.args, "\x14\x00\x01\x03\x0c\x00", 6); 32343911776SOlli Salonen cmd.wlen = 6; 32443911776SOlli Salonen cmd.rlen = 4; 3256307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 32643911776SOlli Salonen if (ret) 32743911776SOlli Salonen goto err; 32843911776SOlli Salonen 329888680ffSAntti Palosaari memcpy(cmd.args, "\x85", 1); 330845f3505SAntti Palosaari cmd.wlen = 1; 331845f3505SAntti Palosaari cmd.rlen = 1; 3326307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 333845f3505SAntti Palosaari if (ret) 334845f3505SAntti Palosaari goto err; 335845f3505SAntti Palosaari 336bd01c766SAntti Palosaari dev->delivery_system = c->delivery_system; 337845f3505SAntti Palosaari 338845f3505SAntti Palosaari return 0; 339845f3505SAntti Palosaari err: 3403de35835SAntti Palosaari dev_dbg(&client->dev, "failed=%d\n", ret); 341845f3505SAntti Palosaari return ret; 342845f3505SAntti Palosaari } 343845f3505SAntti Palosaari 344845f3505SAntti Palosaari static int si2168_init(struct dvb_frontend *fe) 345845f3505SAntti Palosaari { 3466307b560SAntti Palosaari struct i2c_client *client = fe->demodulator_priv; 3476307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 348845f3505SAntti Palosaari int ret, len, remaining; 349845f3505SAntti Palosaari const struct firmware *fw = NULL; 350c9cb0820SOlli Salonen u8 *fw_file; 351845f3505SAntti Palosaari const unsigned int i2c_wr_max = 8; 352845f3505SAntti Palosaari struct si2168_cmd cmd; 353b6b6fd6fSAntti Palosaari unsigned int chip_id; 354845f3505SAntti Palosaari 3553de35835SAntti Palosaari dev_dbg(&client->dev, "\n"); 356845f3505SAntti Palosaari 3578e417224SOlli Salonen /* initialize */ 358888680ffSAntti Palosaari memcpy(cmd.args, "\xc0\x12\x00\x0c\x00\x0d\x16\x00\x00\x00\x00\x00\x00", 13); 359845f3505SAntti Palosaari cmd.wlen = 13; 360845f3505SAntti Palosaari cmd.rlen = 0; 3616307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 362845f3505SAntti Palosaari if (ret) 363845f3505SAntti Palosaari goto err; 364845f3505SAntti Palosaari 365bd01c766SAntti Palosaari if (dev->fw_loaded) { 3668e417224SOlli Salonen /* resume */ 3678e417224SOlli Salonen memcpy(cmd.args, "\xc0\x06\x08\x0f\x00\x20\x21\x01", 8); 3688e417224SOlli Salonen cmd.wlen = 8; 3698e417224SOlli Salonen cmd.rlen = 1; 3706307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 3718e417224SOlli Salonen if (ret) 3728e417224SOlli Salonen goto err; 3738e417224SOlli Salonen 3748e417224SOlli Salonen memcpy(cmd.args, "\x85", 1); 3758e417224SOlli Salonen cmd.wlen = 1; 3768e417224SOlli Salonen cmd.rlen = 1; 3776307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 3788e417224SOlli Salonen if (ret) 3798e417224SOlli Salonen goto err; 3808e417224SOlli Salonen 3818e417224SOlli Salonen goto warm; 3828e417224SOlli Salonen } 3838e417224SOlli Salonen 3848e417224SOlli Salonen /* power up */ 385888680ffSAntti Palosaari memcpy(cmd.args, "\xc0\x06\x01\x0f\x00\x20\x20\x01", 8); 386845f3505SAntti Palosaari cmd.wlen = 8; 387845f3505SAntti Palosaari cmd.rlen = 1; 3886307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 389845f3505SAntti Palosaari if (ret) 390845f3505SAntti Palosaari goto err; 391845f3505SAntti Palosaari 392c9cb0820SOlli Salonen /* query chip revision */ 393888680ffSAntti Palosaari memcpy(cmd.args, "\x02", 1); 394845f3505SAntti Palosaari cmd.wlen = 1; 395845f3505SAntti Palosaari cmd.rlen = 13; 3966307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 397845f3505SAntti Palosaari if (ret) 398845f3505SAntti Palosaari goto err; 399845f3505SAntti Palosaari 400b6b6fd6fSAntti Palosaari chip_id = cmd.args[1] << 24 | cmd.args[2] << 16 | cmd.args[3] << 8 | 401b6b6fd6fSAntti Palosaari cmd.args[4] << 0; 402b6b6fd6fSAntti Palosaari 403635a90cfSLuis Alves #define SI2168_A20 ('A' << 24 | 68 << 16 | '2' << 8 | '0' << 0) 404b6b6fd6fSAntti Palosaari #define SI2168_A30 ('A' << 24 | 68 << 16 | '3' << 8 | '0' << 0) 405b6b6fd6fSAntti Palosaari #define SI2168_B40 ('B' << 24 | 68 << 16 | '4' << 8 | '0' << 0) 406b6b6fd6fSAntti Palosaari 407b6b6fd6fSAntti Palosaari switch (chip_id) { 408635a90cfSLuis Alves case SI2168_A20: 409635a90cfSLuis Alves fw_file = SI2168_A20_FIRMWARE; 410635a90cfSLuis Alves break; 411b6b6fd6fSAntti Palosaari case SI2168_A30: 412c9cb0820SOlli Salonen fw_file = SI2168_A30_FIRMWARE; 413b6b6fd6fSAntti Palosaari break; 414b6b6fd6fSAntti Palosaari case SI2168_B40: 415b6b6fd6fSAntti Palosaari fw_file = SI2168_B40_FIRMWARE; 416b6b6fd6fSAntti Palosaari break; 417b6b6fd6fSAntti Palosaari default: 4183de35835SAntti Palosaari dev_err(&client->dev, 41937b4e43dSOlli Salonen "unknown chip version Si21%d-%c%c%c\n", 42037b4e43dSOlli Salonen cmd.args[2], cmd.args[1], 421b6b6fd6fSAntti Palosaari cmd.args[3], cmd.args[4]); 422c9cb0820SOlli Salonen ret = -EINVAL; 423c9cb0820SOlli Salonen goto err; 424c9cb0820SOlli Salonen } 425c9cb0820SOlli Salonen 426845f3505SAntti Palosaari /* cold state - try to download firmware */ 4273de35835SAntti Palosaari dev_info(&client->dev, "found a '%s' in cold state\n", 42837b4e43dSOlli Salonen si2168_ops.info.name); 429845f3505SAntti Palosaari 430845f3505SAntti Palosaari /* request the firmware, this will block and timeout */ 4313de35835SAntti Palosaari ret = request_firmware(&fw, fw_file, &client->dev); 432845f3505SAntti Palosaari if (ret) { 433b6b6fd6fSAntti Palosaari /* fallback mechanism to handle old name for Si2168 B40 fw */ 434b6b6fd6fSAntti Palosaari if (chip_id == SI2168_B40) { 435c9cb0820SOlli Salonen fw_file = SI2168_B40_FIRMWARE_FALLBACK; 4363de35835SAntti Palosaari ret = request_firmware(&fw, fw_file, &client->dev); 437c9cb0820SOlli Salonen } 438b6b6fd6fSAntti Palosaari 439b6b6fd6fSAntti Palosaari if (ret == 0) { 4403de35835SAntti Palosaari dev_notice(&client->dev, 44137b4e43dSOlli Salonen "please install firmware file '%s'\n", 44237b4e43dSOlli Salonen SI2168_B40_FIRMWARE); 443b6b6fd6fSAntti Palosaari } else { 4443de35835SAntti Palosaari dev_err(&client->dev, 44537b4e43dSOlli Salonen "firmware file '%s' not found\n", 44637b4e43dSOlli Salonen fw_file); 447346d4900SAntti Palosaari goto err_release_firmware; 448845f3505SAntti Palosaari } 449c9cb0820SOlli Salonen } 450845f3505SAntti Palosaari 4513de35835SAntti Palosaari dev_info(&client->dev, "downloading firmware from file '%s'\n", 45237b4e43dSOlli Salonen fw_file); 453845f3505SAntti Palosaari 4541b97dc98SOlli Salonen if ((fw->size % 17 == 0) && (fw->data[0] > 5)) { 4551b97dc98SOlli Salonen /* firmware is in the new format */ 4561b97dc98SOlli Salonen for (remaining = fw->size; remaining > 0; remaining -= 17) { 4571b97dc98SOlli Salonen len = fw->data[fw->size - remaining]; 4581b97dc98SOlli Salonen memcpy(cmd.args, &fw->data[(fw->size - remaining) + 1], len); 4591b97dc98SOlli Salonen cmd.wlen = len; 4601b97dc98SOlli Salonen cmd.rlen = 1; 4616307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 4621b97dc98SOlli Salonen if (ret) { 4633de35835SAntti Palosaari dev_err(&client->dev, 4641b97dc98SOlli Salonen "firmware download failed=%d\n", 4651b97dc98SOlli Salonen ret); 466346d4900SAntti Palosaari goto err_release_firmware; 4671b97dc98SOlli Salonen } 4681b97dc98SOlli Salonen } 4691b97dc98SOlli Salonen } else { 4701b97dc98SOlli Salonen /* firmware is in the old format */ 471845f3505SAntti Palosaari for (remaining = fw->size; remaining > 0; remaining -= i2c_wr_max) { 472845f3505SAntti Palosaari len = remaining; 473845f3505SAntti Palosaari if (len > i2c_wr_max) 474845f3505SAntti Palosaari len = i2c_wr_max; 475845f3505SAntti Palosaari 476845f3505SAntti Palosaari memcpy(cmd.args, &fw->data[fw->size - remaining], len); 477845f3505SAntti Palosaari cmd.wlen = len; 478845f3505SAntti Palosaari cmd.rlen = 1; 4796307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 480845f3505SAntti Palosaari if (ret) { 4813de35835SAntti Palosaari dev_err(&client->dev, 48237b4e43dSOlli Salonen "firmware download failed=%d\n", 48337b4e43dSOlli Salonen ret); 484346d4900SAntti Palosaari goto err_release_firmware; 485845f3505SAntti Palosaari } 486845f3505SAntti Palosaari } 4871b97dc98SOlli Salonen } 488845f3505SAntti Palosaari 489845f3505SAntti Palosaari release_firmware(fw); 490845f3505SAntti Palosaari fw = NULL; 491845f3505SAntti Palosaari 492888680ffSAntti Palosaari memcpy(cmd.args, "\x01\x01", 2); 493845f3505SAntti Palosaari cmd.wlen = 2; 494845f3505SAntti Palosaari cmd.rlen = 1; 4956307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 496845f3505SAntti Palosaari if (ret) 497845f3505SAntti Palosaari goto err; 498845f3505SAntti Palosaari 499a594cf21SOlli Salonen /* query firmware version */ 500a594cf21SOlli Salonen memcpy(cmd.args, "\x11", 1); 501a594cf21SOlli Salonen cmd.wlen = 1; 502a594cf21SOlli Salonen cmd.rlen = 10; 5036307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 504a594cf21SOlli Salonen if (ret) 505a594cf21SOlli Salonen goto err; 506a594cf21SOlli Salonen 507955e0ab8SAntti Palosaari dev_info(&client->dev, "firmware version: %c.%c.%d\n", 508a594cf21SOlli Salonen cmd.args[6], cmd.args[7], cmd.args[8]); 509a594cf21SOlli Salonen 510389ce398SOlli Salonen /* set ts mode */ 511389ce398SOlli Salonen memcpy(cmd.args, "\x14\x00\x01\x10\x10\x00", 6); 512bd01c766SAntti Palosaari cmd.args[4] |= dev->ts_mode; 513389ce398SOlli Salonen cmd.wlen = 6; 514389ce398SOlli Salonen cmd.rlen = 4; 5156307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 516389ce398SOlli Salonen if (ret) 517389ce398SOlli Salonen goto err; 518389ce398SOlli Salonen 519bd01c766SAntti Palosaari dev->fw_loaded = true; 5208e417224SOlli Salonen 5213de35835SAntti Palosaari dev_info(&client->dev, "found a '%s' in warm state\n", 5228e417224SOlli Salonen si2168_ops.info.name); 52345c3cbb1SAntti Palosaari warm: 524bd01c766SAntti Palosaari dev->active = true; 525845f3505SAntti Palosaari 526845f3505SAntti Palosaari return 0; 527346d4900SAntti Palosaari err_release_firmware: 528034e1ec0SMarkus Elfring release_firmware(fw); 529034e1ec0SMarkus Elfring err: 5303de35835SAntti Palosaari dev_dbg(&client->dev, "failed=%d\n", ret); 531845f3505SAntti Palosaari return ret; 532845f3505SAntti Palosaari } 533845f3505SAntti Palosaari 534845f3505SAntti Palosaari static int si2168_sleep(struct dvb_frontend *fe) 535845f3505SAntti Palosaari { 5366307b560SAntti Palosaari struct i2c_client *client = fe->demodulator_priv; 5376307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 5384de0ed7cSAntti Palosaari int ret; 5394de0ed7cSAntti Palosaari struct si2168_cmd cmd; 540845f3505SAntti Palosaari 5413de35835SAntti Palosaari dev_dbg(&client->dev, "\n"); 542845f3505SAntti Palosaari 543bd01c766SAntti Palosaari dev->active = false; 544845f3505SAntti Palosaari 5454de0ed7cSAntti Palosaari memcpy(cmd.args, "\x13", 1); 5464de0ed7cSAntti Palosaari cmd.wlen = 1; 5474de0ed7cSAntti Palosaari cmd.rlen = 0; 5486307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 5494de0ed7cSAntti Palosaari if (ret) 5504de0ed7cSAntti Palosaari goto err; 5514de0ed7cSAntti Palosaari 552845f3505SAntti Palosaari return 0; 5534de0ed7cSAntti Palosaari err: 5543de35835SAntti Palosaari dev_dbg(&client->dev, "failed=%d\n", ret); 5554de0ed7cSAntti Palosaari return ret; 556845f3505SAntti Palosaari } 557845f3505SAntti Palosaari 558845f3505SAntti Palosaari static int si2168_get_tune_settings(struct dvb_frontend *fe, 559845f3505SAntti Palosaari struct dvb_frontend_tune_settings *s) 560845f3505SAntti Palosaari { 561845f3505SAntti Palosaari s->min_delay_ms = 900; 562845f3505SAntti Palosaari 563845f3505SAntti Palosaari return 0; 564845f3505SAntti Palosaari } 565845f3505SAntti Palosaari 566845f3505SAntti Palosaari /* 567845f3505SAntti Palosaari * I2C gate logic 568845f3505SAntti Palosaari * We must use unlocked i2c_transfer() here because I2C lock is already taken 569845f3505SAntti Palosaari * by tuner driver. 570845f3505SAntti Palosaari */ 571845f3505SAntti Palosaari static int si2168_select(struct i2c_adapter *adap, void *mux_priv, u32 chan) 572845f3505SAntti Palosaari { 5736307b560SAntti Palosaari struct i2c_client *client = mux_priv; 5746307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 575845f3505SAntti Palosaari int ret; 576845f3505SAntti Palosaari struct i2c_msg gate_open_msg = { 5773de35835SAntti Palosaari .addr = client->addr, 578845f3505SAntti Palosaari .flags = 0, 579845f3505SAntti Palosaari .len = 3, 580845f3505SAntti Palosaari .buf = "\xc0\x0d\x01", 581845f3505SAntti Palosaari }; 582845f3505SAntti Palosaari 583bd01c766SAntti Palosaari mutex_lock(&dev->i2c_mutex); 584845f3505SAntti Palosaari 585845f3505SAntti Palosaari /* open tuner I2C gate */ 5863de35835SAntti Palosaari ret = __i2c_transfer(client->adapter, &gate_open_msg, 1); 587845f3505SAntti Palosaari if (ret != 1) { 5883de35835SAntti Palosaari dev_warn(&client->dev, "i2c write failed=%d\n", ret); 589845f3505SAntti Palosaari if (ret >= 0) 590845f3505SAntti Palosaari ret = -EREMOTEIO; 591845f3505SAntti Palosaari } else { 592845f3505SAntti Palosaari ret = 0; 593845f3505SAntti Palosaari } 594845f3505SAntti Palosaari 595845f3505SAntti Palosaari return ret; 596845f3505SAntti Palosaari } 597845f3505SAntti Palosaari 598845f3505SAntti Palosaari static int si2168_deselect(struct i2c_adapter *adap, void *mux_priv, u32 chan) 599845f3505SAntti Palosaari { 6006307b560SAntti Palosaari struct i2c_client *client = mux_priv; 6016307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 602845f3505SAntti Palosaari int ret; 603845f3505SAntti Palosaari struct i2c_msg gate_close_msg = { 6043de35835SAntti Palosaari .addr = client->addr, 605845f3505SAntti Palosaari .flags = 0, 606845f3505SAntti Palosaari .len = 3, 607845f3505SAntti Palosaari .buf = "\xc0\x0d\x00", 608845f3505SAntti Palosaari }; 609845f3505SAntti Palosaari 610845f3505SAntti Palosaari /* close tuner I2C gate */ 6113de35835SAntti Palosaari ret = __i2c_transfer(client->adapter, &gate_close_msg, 1); 612845f3505SAntti Palosaari if (ret != 1) { 6133de35835SAntti Palosaari dev_warn(&client->dev, "i2c write failed=%d\n", ret); 614845f3505SAntti Palosaari if (ret >= 0) 615845f3505SAntti Palosaari ret = -EREMOTEIO; 616845f3505SAntti Palosaari } else { 617845f3505SAntti Palosaari ret = 0; 618845f3505SAntti Palosaari } 619845f3505SAntti Palosaari 620bd01c766SAntti Palosaari mutex_unlock(&dev->i2c_mutex); 621845f3505SAntti Palosaari 622845f3505SAntti Palosaari return ret; 623845f3505SAntti Palosaari } 624845f3505SAntti Palosaari 625845f3505SAntti Palosaari static const struct dvb_frontend_ops si2168_ops = { 626c790885bSAntti Palosaari .delsys = {SYS_DVBT, SYS_DVBT2, SYS_DVBC_ANNEX_A}, 627845f3505SAntti Palosaari .info = { 628845f3505SAntti Palosaari .name = "Silicon Labs Si2168", 629f1ecc5d1SAntti Palosaari .symbol_rate_min = 1000000, 630f1ecc5d1SAntti Palosaari .symbol_rate_max = 7200000, 631845f3505SAntti Palosaari .caps = FE_CAN_FEC_1_2 | 632845f3505SAntti Palosaari FE_CAN_FEC_2_3 | 633845f3505SAntti Palosaari FE_CAN_FEC_3_4 | 634845f3505SAntti Palosaari FE_CAN_FEC_5_6 | 635845f3505SAntti Palosaari FE_CAN_FEC_7_8 | 636845f3505SAntti Palosaari FE_CAN_FEC_AUTO | 637845f3505SAntti Palosaari FE_CAN_QPSK | 638845f3505SAntti Palosaari FE_CAN_QAM_16 | 639845f3505SAntti Palosaari FE_CAN_QAM_32 | 640845f3505SAntti Palosaari FE_CAN_QAM_64 | 641845f3505SAntti Palosaari FE_CAN_QAM_128 | 642845f3505SAntti Palosaari FE_CAN_QAM_256 | 643845f3505SAntti Palosaari FE_CAN_QAM_AUTO | 644845f3505SAntti Palosaari FE_CAN_TRANSMISSION_MODE_AUTO | 645845f3505SAntti Palosaari FE_CAN_GUARD_INTERVAL_AUTO | 646845f3505SAntti Palosaari FE_CAN_HIERARCHY_AUTO | 647845f3505SAntti Palosaari FE_CAN_MUTE_TS | 648327eeb3aSOlli Salonen FE_CAN_2G_MODULATION | 649327eeb3aSOlli Salonen FE_CAN_MULTISTREAM 650845f3505SAntti Palosaari }, 651845f3505SAntti Palosaari 652845f3505SAntti Palosaari .get_tune_settings = si2168_get_tune_settings, 653845f3505SAntti Palosaari 654845f3505SAntti Palosaari .init = si2168_init, 655845f3505SAntti Palosaari .sleep = si2168_sleep, 656845f3505SAntti Palosaari 657845f3505SAntti Palosaari .set_frontend = si2168_set_frontend, 658845f3505SAntti Palosaari 659845f3505SAntti Palosaari .read_status = si2168_read_status, 660845f3505SAntti Palosaari }; 661845f3505SAntti Palosaari 662845f3505SAntti Palosaari static int si2168_probe(struct i2c_client *client, 663845f3505SAntti Palosaari const struct i2c_device_id *id) 664845f3505SAntti Palosaari { 665845f3505SAntti Palosaari struct si2168_config *config = client->dev.platform_data; 666bd01c766SAntti Palosaari struct si2168_dev *dev; 667845f3505SAntti Palosaari int ret; 668845f3505SAntti Palosaari 66937b4e43dSOlli Salonen dev_dbg(&client->dev, "\n"); 670845f3505SAntti Palosaari 671bd01c766SAntti Palosaari dev = kzalloc(sizeof(*dev), GFP_KERNEL); 672bd01c766SAntti Palosaari if (!dev) { 673845f3505SAntti Palosaari ret = -ENOMEM; 67437b4e43dSOlli Salonen dev_err(&client->dev, "kzalloc() failed\n"); 675346d4900SAntti Palosaari goto err_kfree; 676845f3505SAntti Palosaari } 677845f3505SAntti Palosaari 678bd01c766SAntti Palosaari mutex_init(&dev->i2c_mutex); 679845f3505SAntti Palosaari 680845f3505SAntti Palosaari /* create mux i2c adapter for tuner */ 6816307b560SAntti Palosaari dev->adapter = i2c_add_mux_adapter(client->adapter, &client->dev, 6826307b560SAntti Palosaari client, 0, 0, 0, si2168_select, si2168_deselect); 683bd01c766SAntti Palosaari if (dev->adapter == NULL) { 6844d6efc7aSLuis Alves ret = -ENODEV; 685346d4900SAntti Palosaari goto err_kfree; 6864d6efc7aSLuis Alves } 687845f3505SAntti Palosaari 688845f3505SAntti Palosaari /* create dvb_frontend */ 689bd01c766SAntti Palosaari memcpy(&dev->fe.ops, &si2168_ops, sizeof(struct dvb_frontend_ops)); 6906307b560SAntti Palosaari dev->fe.demodulator_priv = client; 691bd01c766SAntti Palosaari *config->i2c_adapter = dev->adapter; 692bd01c766SAntti Palosaari *config->fe = &dev->fe; 693bd01c766SAntti Palosaari dev->ts_mode = config->ts_mode; 694bd01c766SAntti Palosaari dev->ts_clock_inv = config->ts_clock_inv; 695bd01c766SAntti Palosaari dev->fw_loaded = false; 696845f3505SAntti Palosaari 697bd01c766SAntti Palosaari i2c_set_clientdata(client, dev); 698845f3505SAntti Palosaari 699346d4900SAntti Palosaari dev_info(&client->dev, "Silicon Labs Si2168 successfully attached\n"); 700845f3505SAntti Palosaari return 0; 701346d4900SAntti Palosaari err_kfree: 702bd01c766SAntti Palosaari kfree(dev); 70337b4e43dSOlli Salonen dev_dbg(&client->dev, "failed=%d\n", ret); 704845f3505SAntti Palosaari return ret; 705845f3505SAntti Palosaari } 706845f3505SAntti Palosaari 707845f3505SAntti Palosaari static int si2168_remove(struct i2c_client *client) 708845f3505SAntti Palosaari { 709bd01c766SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 710845f3505SAntti Palosaari 71137b4e43dSOlli Salonen dev_dbg(&client->dev, "\n"); 712845f3505SAntti Palosaari 713bd01c766SAntti Palosaari i2c_del_mux_adapter(dev->adapter); 714845f3505SAntti Palosaari 715bd01c766SAntti Palosaari dev->fe.ops.release = NULL; 716bd01c766SAntti Palosaari dev->fe.demodulator_priv = NULL; 717845f3505SAntti Palosaari 718bd01c766SAntti Palosaari kfree(dev); 719845f3505SAntti Palosaari 720845f3505SAntti Palosaari return 0; 721845f3505SAntti Palosaari } 722845f3505SAntti Palosaari 723346d4900SAntti Palosaari static const struct i2c_device_id si2168_id_table[] = { 724845f3505SAntti Palosaari {"si2168", 0}, 725845f3505SAntti Palosaari {} 726845f3505SAntti Palosaari }; 727346d4900SAntti Palosaari MODULE_DEVICE_TABLE(i2c, si2168_id_table); 728845f3505SAntti Palosaari 729845f3505SAntti Palosaari static struct i2c_driver si2168_driver = { 730845f3505SAntti Palosaari .driver = { 731845f3505SAntti Palosaari .owner = THIS_MODULE, 732845f3505SAntti Palosaari .name = "si2168", 733845f3505SAntti Palosaari }, 734845f3505SAntti Palosaari .probe = si2168_probe, 735845f3505SAntti Palosaari .remove = si2168_remove, 736346d4900SAntti Palosaari .id_table = si2168_id_table, 737845f3505SAntti Palosaari }; 738845f3505SAntti Palosaari 739845f3505SAntti Palosaari module_i2c_driver(si2168_driver); 740845f3505SAntti Palosaari 741845f3505SAntti Palosaari MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>"); 742845f3505SAntti Palosaari MODULE_DESCRIPTION("Silicon Labs Si2168 DVB-T/T2/C demodulator driver"); 743845f3505SAntti Palosaari MODULE_LICENSE("GPL"); 744635a90cfSLuis Alves MODULE_FIRMWARE(SI2168_A20_FIRMWARE); 745668aa63cSAntti Palosaari MODULE_FIRMWARE(SI2168_A30_FIRMWARE); 746c9cb0820SOlli Salonen MODULE_FIRMWARE(SI2168_B40_FIRMWARE); 747