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, 158e5dd1100SAntti Palosaari "delivery_system=%u modulation=%u frequency=%u bandwidth_hz=%u symbol_rate=%u inversion=%u stream_id=%u\n", 159e5dd1100SAntti Palosaari c->delivery_system, c->modulation, c->frequency, 160e5dd1100SAntti Palosaari c->bandwidth_hz, c->symbol_rate, c->inversion, 161e5dd1100SAntti Palosaari 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 struct si2168_cmd cmd; 352b6b6fd6fSAntti Palosaari unsigned int chip_id; 353845f3505SAntti Palosaari 3543de35835SAntti Palosaari dev_dbg(&client->dev, "\n"); 355845f3505SAntti Palosaari 3568e417224SOlli Salonen /* initialize */ 357888680ffSAntti Palosaari memcpy(cmd.args, "\xc0\x12\x00\x0c\x00\x0d\x16\x00\x00\x00\x00\x00\x00", 13); 358845f3505SAntti Palosaari cmd.wlen = 13; 359845f3505SAntti Palosaari cmd.rlen = 0; 3606307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 361845f3505SAntti Palosaari if (ret) 362845f3505SAntti Palosaari goto err; 363845f3505SAntti Palosaari 364bd01c766SAntti Palosaari if (dev->fw_loaded) { 3658e417224SOlli Salonen /* resume */ 3668e417224SOlli Salonen memcpy(cmd.args, "\xc0\x06\x08\x0f\x00\x20\x21\x01", 8); 3678e417224SOlli Salonen cmd.wlen = 8; 3688e417224SOlli Salonen cmd.rlen = 1; 3696307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 3708e417224SOlli Salonen if (ret) 3718e417224SOlli Salonen goto err; 3728e417224SOlli Salonen 3738e417224SOlli Salonen memcpy(cmd.args, "\x85", 1); 3748e417224SOlli Salonen cmd.wlen = 1; 3758e417224SOlli Salonen cmd.rlen = 1; 3766307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 3778e417224SOlli Salonen if (ret) 3788e417224SOlli Salonen goto err; 3798e417224SOlli Salonen 3808e417224SOlli Salonen goto warm; 3818e417224SOlli Salonen } 3828e417224SOlli Salonen 3838e417224SOlli Salonen /* power up */ 384888680ffSAntti Palosaari memcpy(cmd.args, "\xc0\x06\x01\x0f\x00\x20\x20\x01", 8); 385845f3505SAntti Palosaari cmd.wlen = 8; 386845f3505SAntti Palosaari cmd.rlen = 1; 3876307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 388845f3505SAntti Palosaari if (ret) 389845f3505SAntti Palosaari goto err; 390845f3505SAntti Palosaari 391c9cb0820SOlli Salonen /* query chip revision */ 392888680ffSAntti Palosaari memcpy(cmd.args, "\x02", 1); 393845f3505SAntti Palosaari cmd.wlen = 1; 394845f3505SAntti Palosaari cmd.rlen = 13; 3956307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 396845f3505SAntti Palosaari if (ret) 397845f3505SAntti Palosaari goto err; 398845f3505SAntti Palosaari 399b6b6fd6fSAntti Palosaari chip_id = cmd.args[1] << 24 | cmd.args[2] << 16 | cmd.args[3] << 8 | 400b6b6fd6fSAntti Palosaari cmd.args[4] << 0; 401b6b6fd6fSAntti Palosaari 402635a90cfSLuis Alves #define SI2168_A20 ('A' << 24 | 68 << 16 | '2' << 8 | '0' << 0) 403b6b6fd6fSAntti Palosaari #define SI2168_A30 ('A' << 24 | 68 << 16 | '3' << 8 | '0' << 0) 404b6b6fd6fSAntti Palosaari #define SI2168_B40 ('B' << 24 | 68 << 16 | '4' << 8 | '0' << 0) 405b6b6fd6fSAntti Palosaari 406b6b6fd6fSAntti Palosaari switch (chip_id) { 407635a90cfSLuis Alves case SI2168_A20: 408635a90cfSLuis Alves fw_file = SI2168_A20_FIRMWARE; 409635a90cfSLuis Alves break; 410b6b6fd6fSAntti Palosaari case SI2168_A30: 411c9cb0820SOlli Salonen fw_file = SI2168_A30_FIRMWARE; 412b6b6fd6fSAntti Palosaari break; 413b6b6fd6fSAntti Palosaari case SI2168_B40: 414b6b6fd6fSAntti Palosaari fw_file = SI2168_B40_FIRMWARE; 415b6b6fd6fSAntti Palosaari break; 416b6b6fd6fSAntti Palosaari default: 4173de35835SAntti Palosaari dev_err(&client->dev, 41837b4e43dSOlli Salonen "unknown chip version Si21%d-%c%c%c\n", 41937b4e43dSOlli Salonen cmd.args[2], cmd.args[1], 420b6b6fd6fSAntti Palosaari cmd.args[3], cmd.args[4]); 421c9cb0820SOlli Salonen ret = -EINVAL; 422c9cb0820SOlli Salonen goto err; 423c9cb0820SOlli Salonen } 424c9cb0820SOlli Salonen 425845f3505SAntti Palosaari /* cold state - try to download firmware */ 4263de35835SAntti Palosaari dev_info(&client->dev, "found a '%s' in cold state\n", 42737b4e43dSOlli Salonen si2168_ops.info.name); 428845f3505SAntti Palosaari 429845f3505SAntti Palosaari /* request the firmware, this will block and timeout */ 4303de35835SAntti Palosaari ret = request_firmware(&fw, fw_file, &client->dev); 431845f3505SAntti Palosaari if (ret) { 432b6b6fd6fSAntti Palosaari /* fallback mechanism to handle old name for Si2168 B40 fw */ 433b6b6fd6fSAntti Palosaari if (chip_id == SI2168_B40) { 434c9cb0820SOlli Salonen fw_file = SI2168_B40_FIRMWARE_FALLBACK; 4353de35835SAntti Palosaari ret = request_firmware(&fw, fw_file, &client->dev); 436c9cb0820SOlli Salonen } 437b6b6fd6fSAntti Palosaari 438b6b6fd6fSAntti Palosaari if (ret == 0) { 4393de35835SAntti Palosaari dev_notice(&client->dev, 44037b4e43dSOlli Salonen "please install firmware file '%s'\n", 44137b4e43dSOlli Salonen SI2168_B40_FIRMWARE); 442b6b6fd6fSAntti Palosaari } else { 4433de35835SAntti Palosaari dev_err(&client->dev, 44437b4e43dSOlli Salonen "firmware file '%s' not found\n", 44537b4e43dSOlli Salonen fw_file); 446346d4900SAntti Palosaari goto err_release_firmware; 447845f3505SAntti Palosaari } 448c9cb0820SOlli Salonen } 449845f3505SAntti Palosaari 4503de35835SAntti Palosaari dev_info(&client->dev, "downloading firmware from file '%s'\n", 45137b4e43dSOlli Salonen fw_file); 452845f3505SAntti Palosaari 4531b97dc98SOlli Salonen if ((fw->size % 17 == 0) && (fw->data[0] > 5)) { 4541b97dc98SOlli Salonen /* firmware is in the new format */ 4551b97dc98SOlli Salonen for (remaining = fw->size; remaining > 0; remaining -= 17) { 4561b97dc98SOlli Salonen len = fw->data[fw->size - remaining]; 4571b97dc98SOlli Salonen memcpy(cmd.args, &fw->data[(fw->size - remaining) + 1], len); 4581b97dc98SOlli Salonen cmd.wlen = len; 4591b97dc98SOlli Salonen cmd.rlen = 1; 4606307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 46168c16a76SAntti Palosaari if (ret) 46268c16a76SAntti Palosaari break; 4631b97dc98SOlli Salonen } 46468c16a76SAntti Palosaari } else if (fw->size % 8 == 0) { 4651b97dc98SOlli Salonen /* firmware is in the old format */ 46668c16a76SAntti Palosaari for (remaining = fw->size; remaining > 0; remaining -= 8) { 46768c16a76SAntti Palosaari len = 8; 468845f3505SAntti Palosaari memcpy(cmd.args, &fw->data[fw->size - remaining], len); 469845f3505SAntti Palosaari cmd.wlen = len; 470845f3505SAntti Palosaari cmd.rlen = 1; 4716307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 47268c16a76SAntti Palosaari if (ret) 47368c16a76SAntti Palosaari break; 47468c16a76SAntti Palosaari } 47568c16a76SAntti Palosaari } else { 47668c16a76SAntti Palosaari /* bad or unknown firmware format */ 47768c16a76SAntti Palosaari ret = -EINVAL; 47868c16a76SAntti Palosaari } 47968c16a76SAntti Palosaari 480845f3505SAntti Palosaari if (ret) { 48168c16a76SAntti Palosaari dev_err(&client->dev, "firmware download failed %d\n", ret); 482346d4900SAntti Palosaari goto err_release_firmware; 483845f3505SAntti Palosaari } 484845f3505SAntti Palosaari 485845f3505SAntti Palosaari release_firmware(fw); 486845f3505SAntti Palosaari fw = NULL; 487845f3505SAntti Palosaari 488888680ffSAntti Palosaari memcpy(cmd.args, "\x01\x01", 2); 489845f3505SAntti Palosaari cmd.wlen = 2; 490845f3505SAntti Palosaari cmd.rlen = 1; 4916307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 492845f3505SAntti Palosaari if (ret) 493845f3505SAntti Palosaari goto err; 494845f3505SAntti Palosaari 495a594cf21SOlli Salonen /* query firmware version */ 496a594cf21SOlli Salonen memcpy(cmd.args, "\x11", 1); 497a594cf21SOlli Salonen cmd.wlen = 1; 498a594cf21SOlli Salonen cmd.rlen = 10; 4996307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 500a594cf21SOlli Salonen if (ret) 501a594cf21SOlli Salonen goto err; 502a594cf21SOlli Salonen 503955e0ab8SAntti Palosaari dev_info(&client->dev, "firmware version: %c.%c.%d\n", 504a594cf21SOlli Salonen cmd.args[6], cmd.args[7], cmd.args[8]); 505a594cf21SOlli Salonen 506389ce398SOlli Salonen /* set ts mode */ 507389ce398SOlli Salonen memcpy(cmd.args, "\x14\x00\x01\x10\x10\x00", 6); 508bd01c766SAntti Palosaari cmd.args[4] |= dev->ts_mode; 509389ce398SOlli Salonen cmd.wlen = 6; 510389ce398SOlli Salonen cmd.rlen = 4; 5116307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 512389ce398SOlli Salonen if (ret) 513389ce398SOlli Salonen goto err; 514389ce398SOlli Salonen 515bd01c766SAntti Palosaari dev->fw_loaded = true; 5168e417224SOlli Salonen 5173de35835SAntti Palosaari dev_info(&client->dev, "found a '%s' in warm state\n", 5188e417224SOlli Salonen si2168_ops.info.name); 51945c3cbb1SAntti Palosaari warm: 520bd01c766SAntti Palosaari dev->active = true; 521845f3505SAntti Palosaari 522845f3505SAntti Palosaari return 0; 523346d4900SAntti Palosaari err_release_firmware: 524034e1ec0SMarkus Elfring release_firmware(fw); 525034e1ec0SMarkus Elfring err: 5263de35835SAntti Palosaari dev_dbg(&client->dev, "failed=%d\n", ret); 527845f3505SAntti Palosaari return ret; 528845f3505SAntti Palosaari } 529845f3505SAntti Palosaari 530845f3505SAntti Palosaari static int si2168_sleep(struct dvb_frontend *fe) 531845f3505SAntti Palosaari { 5326307b560SAntti Palosaari struct i2c_client *client = fe->demodulator_priv; 5336307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 5344de0ed7cSAntti Palosaari int ret; 5354de0ed7cSAntti Palosaari struct si2168_cmd cmd; 536845f3505SAntti Palosaari 5373de35835SAntti Palosaari dev_dbg(&client->dev, "\n"); 538845f3505SAntti Palosaari 539bd01c766SAntti Palosaari dev->active = false; 540845f3505SAntti Palosaari 5414de0ed7cSAntti Palosaari memcpy(cmd.args, "\x13", 1); 5424de0ed7cSAntti Palosaari cmd.wlen = 1; 5434de0ed7cSAntti Palosaari cmd.rlen = 0; 5446307b560SAntti Palosaari ret = si2168_cmd_execute(client, &cmd); 5454de0ed7cSAntti Palosaari if (ret) 5464de0ed7cSAntti Palosaari goto err; 5474de0ed7cSAntti Palosaari 548845f3505SAntti Palosaari return 0; 5494de0ed7cSAntti Palosaari err: 5503de35835SAntti Palosaari dev_dbg(&client->dev, "failed=%d\n", ret); 5514de0ed7cSAntti Palosaari return ret; 552845f3505SAntti Palosaari } 553845f3505SAntti Palosaari 554845f3505SAntti Palosaari static int si2168_get_tune_settings(struct dvb_frontend *fe, 555845f3505SAntti Palosaari struct dvb_frontend_tune_settings *s) 556845f3505SAntti Palosaari { 557845f3505SAntti Palosaari s->min_delay_ms = 900; 558845f3505SAntti Palosaari 559845f3505SAntti Palosaari return 0; 560845f3505SAntti Palosaari } 561845f3505SAntti Palosaari 562845f3505SAntti Palosaari /* 563845f3505SAntti Palosaari * I2C gate logic 564845f3505SAntti Palosaari * We must use unlocked i2c_transfer() here because I2C lock is already taken 565845f3505SAntti Palosaari * by tuner driver. 566845f3505SAntti Palosaari */ 567845f3505SAntti Palosaari static int si2168_select(struct i2c_adapter *adap, void *mux_priv, u32 chan) 568845f3505SAntti Palosaari { 5696307b560SAntti Palosaari struct i2c_client *client = mux_priv; 5706307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 571845f3505SAntti Palosaari int ret; 572845f3505SAntti Palosaari struct i2c_msg gate_open_msg = { 5733de35835SAntti Palosaari .addr = client->addr, 574845f3505SAntti Palosaari .flags = 0, 575845f3505SAntti Palosaari .len = 3, 576845f3505SAntti Palosaari .buf = "\xc0\x0d\x01", 577845f3505SAntti Palosaari }; 578845f3505SAntti Palosaari 579bd01c766SAntti Palosaari mutex_lock(&dev->i2c_mutex); 580845f3505SAntti Palosaari 581845f3505SAntti Palosaari /* open tuner I2C gate */ 5823de35835SAntti Palosaari ret = __i2c_transfer(client->adapter, &gate_open_msg, 1); 583845f3505SAntti Palosaari if (ret != 1) { 5843de35835SAntti Palosaari dev_warn(&client->dev, "i2c write failed=%d\n", ret); 585845f3505SAntti Palosaari if (ret >= 0) 586845f3505SAntti Palosaari ret = -EREMOTEIO; 587845f3505SAntti Palosaari } else { 588845f3505SAntti Palosaari ret = 0; 589845f3505SAntti Palosaari } 590845f3505SAntti Palosaari 591845f3505SAntti Palosaari return ret; 592845f3505SAntti Palosaari } 593845f3505SAntti Palosaari 594845f3505SAntti Palosaari static int si2168_deselect(struct i2c_adapter *adap, void *mux_priv, u32 chan) 595845f3505SAntti Palosaari { 5966307b560SAntti Palosaari struct i2c_client *client = mux_priv; 5976307b560SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 598845f3505SAntti Palosaari int ret; 599845f3505SAntti Palosaari struct i2c_msg gate_close_msg = { 6003de35835SAntti Palosaari .addr = client->addr, 601845f3505SAntti Palosaari .flags = 0, 602845f3505SAntti Palosaari .len = 3, 603845f3505SAntti Palosaari .buf = "\xc0\x0d\x00", 604845f3505SAntti Palosaari }; 605845f3505SAntti Palosaari 606845f3505SAntti Palosaari /* close tuner I2C gate */ 6073de35835SAntti Palosaari ret = __i2c_transfer(client->adapter, &gate_close_msg, 1); 608845f3505SAntti Palosaari if (ret != 1) { 6093de35835SAntti Palosaari dev_warn(&client->dev, "i2c write failed=%d\n", ret); 610845f3505SAntti Palosaari if (ret >= 0) 611845f3505SAntti Palosaari ret = -EREMOTEIO; 612845f3505SAntti Palosaari } else { 613845f3505SAntti Palosaari ret = 0; 614845f3505SAntti Palosaari } 615845f3505SAntti Palosaari 616bd01c766SAntti Palosaari mutex_unlock(&dev->i2c_mutex); 617845f3505SAntti Palosaari 618845f3505SAntti Palosaari return ret; 619845f3505SAntti Palosaari } 620845f3505SAntti Palosaari 621845f3505SAntti Palosaari static const struct dvb_frontend_ops si2168_ops = { 622c790885bSAntti Palosaari .delsys = {SYS_DVBT, SYS_DVBT2, SYS_DVBC_ANNEX_A}, 623845f3505SAntti Palosaari .info = { 624845f3505SAntti Palosaari .name = "Silicon Labs Si2168", 625f1ecc5d1SAntti Palosaari .symbol_rate_min = 1000000, 626f1ecc5d1SAntti Palosaari .symbol_rate_max = 7200000, 627845f3505SAntti Palosaari .caps = FE_CAN_FEC_1_2 | 628845f3505SAntti Palosaari FE_CAN_FEC_2_3 | 629845f3505SAntti Palosaari FE_CAN_FEC_3_4 | 630845f3505SAntti Palosaari FE_CAN_FEC_5_6 | 631845f3505SAntti Palosaari FE_CAN_FEC_7_8 | 632845f3505SAntti Palosaari FE_CAN_FEC_AUTO | 633845f3505SAntti Palosaari FE_CAN_QPSK | 634845f3505SAntti Palosaari FE_CAN_QAM_16 | 635845f3505SAntti Palosaari FE_CAN_QAM_32 | 636845f3505SAntti Palosaari FE_CAN_QAM_64 | 637845f3505SAntti Palosaari FE_CAN_QAM_128 | 638845f3505SAntti Palosaari FE_CAN_QAM_256 | 639845f3505SAntti Palosaari FE_CAN_QAM_AUTO | 640845f3505SAntti Palosaari FE_CAN_TRANSMISSION_MODE_AUTO | 641845f3505SAntti Palosaari FE_CAN_GUARD_INTERVAL_AUTO | 642845f3505SAntti Palosaari FE_CAN_HIERARCHY_AUTO | 643845f3505SAntti Palosaari FE_CAN_MUTE_TS | 644327eeb3aSOlli Salonen FE_CAN_2G_MODULATION | 645327eeb3aSOlli Salonen FE_CAN_MULTISTREAM 646845f3505SAntti Palosaari }, 647845f3505SAntti Palosaari 648845f3505SAntti Palosaari .get_tune_settings = si2168_get_tune_settings, 649845f3505SAntti Palosaari 650845f3505SAntti Palosaari .init = si2168_init, 651845f3505SAntti Palosaari .sleep = si2168_sleep, 652845f3505SAntti Palosaari 653845f3505SAntti Palosaari .set_frontend = si2168_set_frontend, 654845f3505SAntti Palosaari 655845f3505SAntti Palosaari .read_status = si2168_read_status, 656845f3505SAntti Palosaari }; 657845f3505SAntti Palosaari 658845f3505SAntti Palosaari static int si2168_probe(struct i2c_client *client, 659845f3505SAntti Palosaari const struct i2c_device_id *id) 660845f3505SAntti Palosaari { 661845f3505SAntti Palosaari struct si2168_config *config = client->dev.platform_data; 662bd01c766SAntti Palosaari struct si2168_dev *dev; 663845f3505SAntti Palosaari int ret; 664845f3505SAntti Palosaari 66537b4e43dSOlli Salonen dev_dbg(&client->dev, "\n"); 666845f3505SAntti Palosaari 667bd01c766SAntti Palosaari dev = kzalloc(sizeof(*dev), GFP_KERNEL); 668bd01c766SAntti Palosaari if (!dev) { 669845f3505SAntti Palosaari ret = -ENOMEM; 67037b4e43dSOlli Salonen dev_err(&client->dev, "kzalloc() failed\n"); 6711ee5e7ddSAntti Palosaari goto err; 672845f3505SAntti Palosaari } 673845f3505SAntti Palosaari 674bd01c766SAntti Palosaari mutex_init(&dev->i2c_mutex); 675845f3505SAntti Palosaari 676845f3505SAntti Palosaari /* create mux i2c adapter for tuner */ 6776307b560SAntti Palosaari dev->adapter = i2c_add_mux_adapter(client->adapter, &client->dev, 6786307b560SAntti Palosaari client, 0, 0, 0, si2168_select, si2168_deselect); 679bd01c766SAntti Palosaari if (dev->adapter == NULL) { 6804d6efc7aSLuis Alves ret = -ENODEV; 681346d4900SAntti Palosaari goto err_kfree; 6824d6efc7aSLuis Alves } 683845f3505SAntti Palosaari 684845f3505SAntti Palosaari /* create dvb_frontend */ 685bd01c766SAntti Palosaari memcpy(&dev->fe.ops, &si2168_ops, sizeof(struct dvb_frontend_ops)); 6866307b560SAntti Palosaari dev->fe.demodulator_priv = client; 687bd01c766SAntti Palosaari *config->i2c_adapter = dev->adapter; 688bd01c766SAntti Palosaari *config->fe = &dev->fe; 689bd01c766SAntti Palosaari dev->ts_mode = config->ts_mode; 690bd01c766SAntti Palosaari dev->ts_clock_inv = config->ts_clock_inv; 691bd01c766SAntti Palosaari dev->fw_loaded = false; 692845f3505SAntti Palosaari 693bd01c766SAntti Palosaari i2c_set_clientdata(client, dev); 694845f3505SAntti Palosaari 695346d4900SAntti Palosaari dev_info(&client->dev, "Silicon Labs Si2168 successfully attached\n"); 696845f3505SAntti Palosaari return 0; 697346d4900SAntti Palosaari err_kfree: 698bd01c766SAntti Palosaari kfree(dev); 6991ee5e7ddSAntti Palosaari err: 70037b4e43dSOlli Salonen dev_dbg(&client->dev, "failed=%d\n", ret); 701845f3505SAntti Palosaari return ret; 702845f3505SAntti Palosaari } 703845f3505SAntti Palosaari 704845f3505SAntti Palosaari static int si2168_remove(struct i2c_client *client) 705845f3505SAntti Palosaari { 706bd01c766SAntti Palosaari struct si2168_dev *dev = i2c_get_clientdata(client); 707845f3505SAntti Palosaari 70837b4e43dSOlli Salonen dev_dbg(&client->dev, "\n"); 709845f3505SAntti Palosaari 710bd01c766SAntti Palosaari i2c_del_mux_adapter(dev->adapter); 711845f3505SAntti Palosaari 712bd01c766SAntti Palosaari dev->fe.ops.release = NULL; 713bd01c766SAntti Palosaari dev->fe.demodulator_priv = NULL; 714845f3505SAntti Palosaari 715bd01c766SAntti Palosaari kfree(dev); 716845f3505SAntti Palosaari 717845f3505SAntti Palosaari return 0; 718845f3505SAntti Palosaari } 719845f3505SAntti Palosaari 720346d4900SAntti Palosaari static const struct i2c_device_id si2168_id_table[] = { 721845f3505SAntti Palosaari {"si2168", 0}, 722845f3505SAntti Palosaari {} 723845f3505SAntti Palosaari }; 724346d4900SAntti Palosaari MODULE_DEVICE_TABLE(i2c, si2168_id_table); 725845f3505SAntti Palosaari 726845f3505SAntti Palosaari static struct i2c_driver si2168_driver = { 727845f3505SAntti Palosaari .driver = { 728845f3505SAntti Palosaari .owner = THIS_MODULE, 729845f3505SAntti Palosaari .name = "si2168", 730845f3505SAntti Palosaari }, 731845f3505SAntti Palosaari .probe = si2168_probe, 732845f3505SAntti Palosaari .remove = si2168_remove, 733346d4900SAntti Palosaari .id_table = si2168_id_table, 734845f3505SAntti Palosaari }; 735845f3505SAntti Palosaari 736845f3505SAntti Palosaari module_i2c_driver(si2168_driver); 737845f3505SAntti Palosaari 738845f3505SAntti Palosaari MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>"); 739845f3505SAntti Palosaari MODULE_DESCRIPTION("Silicon Labs Si2168 DVB-T/T2/C demodulator driver"); 740845f3505SAntti Palosaari MODULE_LICENSE("GPL"); 741635a90cfSLuis Alves MODULE_FIRMWARE(SI2168_A20_FIRMWARE); 742668aa63cSAntti Palosaari MODULE_FIRMWARE(SI2168_A30_FIRMWARE); 743c9cb0820SOlli Salonen MODULE_FIRMWARE(SI2168_B40_FIRMWARE); 744