Antti Palosaari | ba92ae0 | 2014-04-14 21:51:32 -0300 | [diff] [blame] | 1 | /* |
CrazyCat | 17ad09f | 2014-11-14 18:19:37 -0300 | [diff] [blame] | 2 | * Silicon Labs Si2146/2147/2148/2157/2158 silicon tuner driver |
Antti Palosaari | ba92ae0 | 2014-04-14 21:51:32 -0300 | [diff] [blame] | 3 | * |
| 4 | * Copyright (C) 2014 Antti Palosaari <crope@iki.fi> |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License as published by |
| 8 | * the Free Software Foundation; either version 2 of the License, or |
| 9 | * (at your option) any later version. |
| 10 | * |
| 11 | * This program is distributed in the hope that it will be useful, |
| 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 14 | * GNU General Public License for more details. |
| 15 | */ |
| 16 | |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 17 | #include "si2157_priv.h" |
| 18 | |
Olli Salonen | 1b92373 | 2014-07-13 10:52:20 -0300 | [diff] [blame] | 19 | static const struct dvb_tuner_ops si2157_ops; |
| 20 | |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 21 | /* execute firmware command */ |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 22 | static int si2157_cmd_execute(struct i2c_client *client, struct si2157_cmd *cmd) |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 23 | { |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 24 | struct si2157_dev *dev = i2c_get_clientdata(client); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 25 | int ret; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 26 | unsigned long timeout; |
| 27 | |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 28 | mutex_lock(&dev->i2c_mutex); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 29 | |
Antti Palosaari | e6b4380 | 2014-07-10 06:02:53 -0300 | [diff] [blame] | 30 | if (cmd->wlen) { |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 31 | /* write cmd and args for firmware */ |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 32 | ret = i2c_master_send(client, cmd->args, cmd->wlen); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 33 | if (ret < 0) { |
| 34 | goto err_mutex_unlock; |
Antti Palosaari | e6b4380 | 2014-07-10 06:02:53 -0300 | [diff] [blame] | 35 | } else if (ret != cmd->wlen) { |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 36 | ret = -EREMOTEIO; |
| 37 | goto err_mutex_unlock; |
| 38 | } |
| 39 | } |
| 40 | |
Antti Palosaari | e6b4380 | 2014-07-10 06:02:53 -0300 | [diff] [blame] | 41 | if (cmd->rlen) { |
| 42 | /* wait cmd execution terminate */ |
| 43 | #define TIMEOUT 80 |
| 44 | timeout = jiffies + msecs_to_jiffies(TIMEOUT); |
| 45 | while (!time_after(jiffies, timeout)) { |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 46 | ret = i2c_master_recv(client, cmd->args, cmd->rlen); |
Antti Palosaari | e6b4380 | 2014-07-10 06:02:53 -0300 | [diff] [blame] | 47 | if (ret < 0) { |
| 48 | goto err_mutex_unlock; |
| 49 | } else if (ret != cmd->rlen) { |
| 50 | ret = -EREMOTEIO; |
| 51 | goto err_mutex_unlock; |
| 52 | } |
| 53 | |
| 54 | /* firmware ready? */ |
| 55 | if ((cmd->args[0] >> 7) & 0x01) |
| 56 | break; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 57 | } |
| 58 | |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 59 | dev_dbg(&client->dev, "cmd execution took %d ms\n", |
Antti Palosaari | e6b4380 | 2014-07-10 06:02:53 -0300 | [diff] [blame] | 60 | jiffies_to_msecs(jiffies) - |
| 61 | (jiffies_to_msecs(timeout) - TIMEOUT)); |
| 62 | |
| 63 | if (!((cmd->args[0] >> 7) & 0x01)) { |
| 64 | ret = -ETIMEDOUT; |
| 65 | goto err_mutex_unlock; |
| 66 | } |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 67 | } |
| 68 | |
Antti Palosaari | 7cbf5d7 | 2014-12-06 14:04:05 -0300 | [diff] [blame] | 69 | mutex_unlock(&dev->i2c_mutex); |
| 70 | return 0; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 71 | |
| 72 | err_mutex_unlock: |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 73 | mutex_unlock(&dev->i2c_mutex); |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 74 | dev_dbg(&client->dev, "failed=%d\n", ret); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 75 | return ret; |
| 76 | } |
| 77 | |
| 78 | static int si2157_init(struct dvb_frontend *fe) |
| 79 | { |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 80 | struct i2c_client *client = fe->tuner_priv; |
| 81 | struct si2157_dev *dev = i2c_get_clientdata(client); |
Antti Palosaari | 2f1ea29 | 2014-09-07 11:20:34 -0300 | [diff] [blame] | 82 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 83 | int ret, len, remaining; |
Olli Salonen | b154121 | 2014-07-13 10:52:19 -0300 | [diff] [blame] | 84 | struct si2157_cmd cmd; |
Antti Palosaari | 78dab40 | 2014-12-06 14:51:17 -0300 | [diff] [blame] | 85 | const struct firmware *fw; |
Antti Palosaari | 08272db | 2014-12-06 18:15:18 -0300 | [diff] [blame] | 86 | const char *fw_name; |
Antti Palosaari | 78bab93 | 2016-02-08 09:51:16 -0200 | [diff] [blame] | 87 | unsigned int uitmp, chip_id; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 88 | |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 89 | dev_dbg(&client->dev, "\n"); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 90 | |
Antti Palosaari | 78bab93 | 2016-02-08 09:51:16 -0200 | [diff] [blame] | 91 | /* Returned IF frequency is garbage when firmware is not running */ |
| 92 | memcpy(cmd.args, "\x15\x00\x06\x07", 4); |
| 93 | cmd.wlen = 4; |
| 94 | cmd.rlen = 4; |
| 95 | ret = si2157_cmd_execute(client, &cmd); |
| 96 | if (ret) |
| 97 | goto err; |
| 98 | |
| 99 | uitmp = cmd.args[2] << 0 | cmd.args[3] << 8; |
| 100 | dev_dbg(&client->dev, "if_frequency kHz=%u\n", uitmp); |
| 101 | |
| 102 | if (uitmp == dev->if_frequency / 1000) |
Olli Salonen | 4cbf6ed | 2014-08-25 15:07:03 -0300 | [diff] [blame] | 103 | goto warm; |
| 104 | |
| 105 | /* power up */ |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 106 | if (dev->chiptype == SI2157_CHIPTYPE_SI2146) { |
Olli Salonen | 073f384 | 2014-11-24 03:57:33 -0300 | [diff] [blame] | 107 | memcpy(cmd.args, "\xc0\x05\x01\x00\x00\x0b\x00\x00\x01", 9); |
| 108 | cmd.wlen = 9; |
| 109 | } else { |
| 110 | memcpy(cmd.args, "\xc0\x00\x0c\x00\x00\x01\x01\x01\x01\x01\x01\x02\x00\x00\x01", 15); |
| 111 | cmd.wlen = 15; |
| 112 | } |
Olli Salonen | b154121 | 2014-07-13 10:52:19 -0300 | [diff] [blame] | 113 | cmd.rlen = 1; |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 114 | ret = si2157_cmd_execute(client, &cmd); |
Olli Salonen | b154121 | 2014-07-13 10:52:19 -0300 | [diff] [blame] | 115 | if (ret) |
| 116 | goto err; |
| 117 | |
| 118 | /* query chip revision */ |
| 119 | memcpy(cmd.args, "\x02", 1); |
| 120 | cmd.wlen = 1; |
| 121 | cmd.rlen = 13; |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 122 | ret = si2157_cmd_execute(client, &cmd); |
Olli Salonen | b154121 | 2014-07-13 10:52:19 -0300 | [diff] [blame] | 123 | if (ret) |
| 124 | goto err; |
| 125 | |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 126 | chip_id = cmd.args[1] << 24 | cmd.args[2] << 16 | cmd.args[3] << 8 | |
| 127 | cmd.args[4] << 0; |
Olli Salonen | 1b92373 | 2014-07-13 10:52:20 -0300 | [diff] [blame] | 128 | |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 129 | #define SI2158_A20 ('A' << 24 | 58 << 16 | '2' << 8 | '0' << 0) |
CrazyCat | 17ad09f | 2014-11-14 18:19:37 -0300 | [diff] [blame] | 130 | #define SI2148_A20 ('A' << 24 | 48 << 16 | '2' << 8 | '0' << 0) |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 131 | #define SI2157_A30 ('A' << 24 | 57 << 16 | '3' << 8 | '0' << 0) |
Olli Salonen | d87a505 | 2014-09-11 17:01:38 -0300 | [diff] [blame] | 132 | #define SI2147_A30 ('A' << 24 | 47 << 16 | '3' << 8 | '0' << 0) |
Olli Salonen | 073f384 | 2014-11-24 03:57:33 -0300 | [diff] [blame] | 133 | #define SI2146_A10 ('A' << 24 | 46 << 16 | '1' << 8 | '0' << 0) |
Olli Salonen | 1b92373 | 2014-07-13 10:52:20 -0300 | [diff] [blame] | 134 | |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 135 | switch (chip_id) { |
| 136 | case SI2158_A20: |
CrazyCat | 17ad09f | 2014-11-14 18:19:37 -0300 | [diff] [blame] | 137 | case SI2148_A20: |
Antti Palosaari | 08272db | 2014-12-06 18:15:18 -0300 | [diff] [blame] | 138 | fw_name = SI2158_A20_FIRMWARE; |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 139 | break; |
| 140 | case SI2157_A30: |
Olli Salonen | d87a505 | 2014-09-11 17:01:38 -0300 | [diff] [blame] | 141 | case SI2147_A30: |
Olli Salonen | 073f384 | 2014-11-24 03:57:33 -0300 | [diff] [blame] | 142 | case SI2146_A10: |
Antti Palosaari | 08272db | 2014-12-06 18:15:18 -0300 | [diff] [blame] | 143 | fw_name = NULL; |
Antti Palosaari | 6c37253 | 2014-12-06 18:12:39 -0300 | [diff] [blame] | 144 | break; |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 145 | default: |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 146 | dev_err(&client->dev, "unknown chip version Si21%d-%c%c%c\n", |
Olli Salonen | 67d0113 | 2014-08-05 09:03:54 -0300 | [diff] [blame] | 147 | cmd.args[2], cmd.args[1], |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 148 | cmd.args[3], cmd.args[4]); |
| 149 | ret = -EINVAL; |
| 150 | goto err; |
Olli Salonen | 1b92373 | 2014-07-13 10:52:20 -0300 | [diff] [blame] | 151 | } |
| 152 | |
Antti Palosaari | 6c37253 | 2014-12-06 18:12:39 -0300 | [diff] [blame] | 153 | dev_info(&client->dev, "found a 'Silicon Labs Si21%d-%c%c%c'\n", |
| 154 | cmd.args[2], cmd.args[1], cmd.args[3], cmd.args[4]); |
| 155 | |
Antti Palosaari | 08272db | 2014-12-06 18:15:18 -0300 | [diff] [blame] | 156 | if (fw_name == NULL) |
Antti Palosaari | 6c37253 | 2014-12-06 18:12:39 -0300 | [diff] [blame] | 157 | goto skip_fw_download; |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 158 | |
| 159 | /* request the firmware, this will block and timeout */ |
Antti Palosaari | 08272db | 2014-12-06 18:15:18 -0300 | [diff] [blame] | 160 | ret = request_firmware(&fw, fw_name, &client->dev); |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 161 | if (ret) { |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 162 | dev_err(&client->dev, "firmware file '%s' not found\n", |
Antti Palosaari | 08272db | 2014-12-06 18:15:18 -0300 | [diff] [blame] | 163 | fw_name); |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 164 | goto err; |
| 165 | } |
| 166 | |
| 167 | /* firmware should be n chunks of 17 bytes */ |
| 168 | if (fw->size % 17 != 0) { |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 169 | dev_err(&client->dev, "firmware file '%s' is invalid\n", |
Antti Palosaari | 08272db | 2014-12-06 18:15:18 -0300 | [diff] [blame] | 170 | fw_name); |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 171 | ret = -EINVAL; |
Antti Palosaari | 78dab40 | 2014-12-06 14:51:17 -0300 | [diff] [blame] | 172 | goto err_release_firmware; |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 173 | } |
| 174 | |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 175 | dev_info(&client->dev, "downloading firmware from file '%s'\n", |
Antti Palosaari | 08272db | 2014-12-06 18:15:18 -0300 | [diff] [blame] | 176 | fw_name); |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 177 | |
| 178 | for (remaining = fw->size; remaining > 0; remaining -= 17) { |
| 179 | len = fw->data[fw->size - remaining]; |
Laura Abbott | a828d72 | 2015-09-29 21:10:10 -0300 | [diff] [blame] | 180 | if (len > SI2157_ARGLEN) { |
| 181 | dev_err(&client->dev, "Bad firmware length\n"); |
Laura Abbott | d2cc2f0 | 2015-10-05 19:33:29 -0300 | [diff] [blame] | 182 | ret = -EINVAL; |
Laura Abbott | a828d72 | 2015-09-29 21:10:10 -0300 | [diff] [blame] | 183 | goto err_release_firmware; |
| 184 | } |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 185 | memcpy(cmd.args, &fw->data[(fw->size - remaining) + 1], len); |
| 186 | cmd.wlen = len; |
| 187 | cmd.rlen = 1; |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 188 | ret = si2157_cmd_execute(client, &cmd); |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 189 | if (ret) { |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 190 | dev_err(&client->dev, "firmware download failed %d\n", |
Olli Salonen | 67d0113 | 2014-08-05 09:03:54 -0300 | [diff] [blame] | 191 | ret); |
Antti Palosaari | 78dab40 | 2014-12-06 14:51:17 -0300 | [diff] [blame] | 192 | goto err_release_firmware; |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 193 | } |
| 194 | } |
| 195 | |
| 196 | release_firmware(fw); |
Antti Palosaari | 7d6bc60 | 2014-07-13 20:05:28 -0300 | [diff] [blame] | 197 | |
| 198 | skip_fw_download: |
Olli Salonen | b154121 | 2014-07-13 10:52:19 -0300 | [diff] [blame] | 199 | /* reboot the tuner with new firmware? */ |
| 200 | memcpy(cmd.args, "\x01\x01", 2); |
| 201 | cmd.wlen = 2; |
| 202 | cmd.rlen = 1; |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 203 | ret = si2157_cmd_execute(client, &cmd); |
Olli Salonen | b154121 | 2014-07-13 10:52:19 -0300 | [diff] [blame] | 204 | if (ret) |
| 205 | goto err; |
| 206 | |
Antti Palosaari | c701184 | 2014-12-06 17:25:24 -0300 | [diff] [blame] | 207 | /* query firmware version */ |
| 208 | memcpy(cmd.args, "\x11", 1); |
| 209 | cmd.wlen = 1; |
| 210 | cmd.rlen = 10; |
| 211 | ret = si2157_cmd_execute(client, &cmd); |
| 212 | if (ret) |
| 213 | goto err; |
| 214 | |
| 215 | dev_info(&client->dev, "firmware version: %c.%c.%d\n", |
| 216 | cmd.args[6], cmd.args[7], cmd.args[8]); |
Olli Salonen | 4cbf6ed | 2014-08-25 15:07:03 -0300 | [diff] [blame] | 217 | warm: |
Antti Palosaari | 2f1ea29 | 2014-09-07 11:20:34 -0300 | [diff] [blame] | 218 | /* init statistics in order signal app which are supported */ |
| 219 | c->strength.len = 1; |
| 220 | c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE; |
| 221 | /* start statistics polling */ |
| 222 | schedule_delayed_work(&dev->stat_work, msecs_to_jiffies(1000)); |
| 223 | |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 224 | dev->active = true; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 225 | return 0; |
Antti Palosaari | 78dab40 | 2014-12-06 14:51:17 -0300 | [diff] [blame] | 226 | err_release_firmware: |
Markus Elfring | dc89cfc | 2014-11-30 15:05:48 -0300 | [diff] [blame] | 227 | release_firmware(fw); |
Markus Elfring | e358c8a | 2014-11-30 16:48:24 -0300 | [diff] [blame] | 228 | err: |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 229 | dev_dbg(&client->dev, "failed=%d\n", ret); |
Olli Salonen | b154121 | 2014-07-13 10:52:19 -0300 | [diff] [blame] | 230 | return ret; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 231 | } |
| 232 | |
| 233 | static int si2157_sleep(struct dvb_frontend *fe) |
| 234 | { |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 235 | struct i2c_client *client = fe->tuner_priv; |
| 236 | struct si2157_dev *dev = i2c_get_clientdata(client); |
Antti Palosaari | a83d7d1 | 2014-07-09 18:37:30 -0300 | [diff] [blame] | 237 | int ret; |
| 238 | struct si2157_cmd cmd; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 239 | |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 240 | dev_dbg(&client->dev, "\n"); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 241 | |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 242 | dev->active = false; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 243 | |
Antti Palosaari | 2f1ea29 | 2014-09-07 11:20:34 -0300 | [diff] [blame] | 244 | /* stop statistics polling */ |
| 245 | cancel_delayed_work_sync(&dev->stat_work); |
| 246 | |
Olli Salonen | 0e38233 | 2014-08-25 15:07:02 -0300 | [diff] [blame] | 247 | /* standby */ |
| 248 | memcpy(cmd.args, "\x16\x00", 2); |
| 249 | cmd.wlen = 2; |
| 250 | cmd.rlen = 1; |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 251 | ret = si2157_cmd_execute(client, &cmd); |
Antti Palosaari | a83d7d1 | 2014-07-09 18:37:30 -0300 | [diff] [blame] | 252 | if (ret) |
| 253 | goto err; |
| 254 | |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 255 | return 0; |
Antti Palosaari | a83d7d1 | 2014-07-09 18:37:30 -0300 | [diff] [blame] | 256 | err: |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 257 | dev_dbg(&client->dev, "failed=%d\n", ret); |
Antti Palosaari | a83d7d1 | 2014-07-09 18:37:30 -0300 | [diff] [blame] | 258 | return ret; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 259 | } |
| 260 | |
| 261 | static int si2157_set_params(struct dvb_frontend *fe) |
| 262 | { |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 263 | struct i2c_client *client = fe->tuner_priv; |
| 264 | struct si2157_dev *dev = i2c_get_clientdata(client); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 265 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
| 266 | int ret; |
| 267 | struct si2157_cmd cmd; |
Olli Salonen | a1dad50 | 2014-07-13 10:52:21 -0300 | [diff] [blame] | 268 | u8 bandwidth, delivery_system; |
Olli Salonen | c28aebe | 2015-02-28 12:25:23 -0300 | [diff] [blame] | 269 | u32 if_frequency = 5000000; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 270 | |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 271 | dev_dbg(&client->dev, |
Olli Salonen | 67d0113 | 2014-08-05 09:03:54 -0300 | [diff] [blame] | 272 | "delivery_system=%d frequency=%u bandwidth_hz=%u\n", |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 273 | c->delivery_system, c->frequency, c->bandwidth_hz); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 274 | |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 275 | if (!dev->active) { |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 276 | ret = -EAGAIN; |
| 277 | goto err; |
| 278 | } |
| 279 | |
Olli Salonen | a1dad50 | 2014-07-13 10:52:21 -0300 | [diff] [blame] | 280 | if (c->bandwidth_hz <= 6000000) |
| 281 | bandwidth = 0x06; |
| 282 | else if (c->bandwidth_hz <= 7000000) |
| 283 | bandwidth = 0x07; |
| 284 | else if (c->bandwidth_hz <= 8000000) |
| 285 | bandwidth = 0x08; |
| 286 | else |
| 287 | bandwidth = 0x0f; |
| 288 | |
| 289 | switch (c->delivery_system) { |
Olli Salonen | 5cd62db | 2014-08-17 02:24:49 -0300 | [diff] [blame] | 290 | case SYS_ATSC: |
| 291 | delivery_system = 0x00; |
Olli Salonen | c28aebe | 2015-02-28 12:25:23 -0300 | [diff] [blame] | 292 | if_frequency = 3250000; |
Olli Salonen | 5cd62db | 2014-08-17 02:24:49 -0300 | [diff] [blame] | 293 | break; |
Olli Salonen | 0d1165f | 2014-10-30 07:43:16 -0300 | [diff] [blame] | 294 | case SYS_DVBC_ANNEX_B: |
| 295 | delivery_system = 0x10; |
Olli Salonen | c28aebe | 2015-02-28 12:25:23 -0300 | [diff] [blame] | 296 | if_frequency = 4000000; |
Olli Salonen | 0d1165f | 2014-10-30 07:43:16 -0300 | [diff] [blame] | 297 | break; |
Olli Salonen | a1dad50 | 2014-07-13 10:52:21 -0300 | [diff] [blame] | 298 | case SYS_DVBT: |
| 299 | case SYS_DVBT2: /* it seems DVB-T and DVB-T2 both are 0x20 here */ |
| 300 | delivery_system = 0x20; |
| 301 | break; |
| 302 | case SYS_DVBC_ANNEX_A: |
| 303 | delivery_system = 0x30; |
| 304 | break; |
| 305 | default: |
| 306 | ret = -EINVAL; |
| 307 | goto err; |
| 308 | } |
| 309 | |
| 310 | memcpy(cmd.args, "\x14\x00\x03\x07\x00\x00", 6); |
| 311 | cmd.args[4] = delivery_system | bandwidth; |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 312 | if (dev->inversion) |
Matthias Schwarzott | 05024ef | 2014-07-15 16:34:36 -0300 | [diff] [blame] | 313 | cmd.args[5] = 0x01; |
Olli Salonen | a1dad50 | 2014-07-13 10:52:21 -0300 | [diff] [blame] | 314 | cmd.wlen = 6; |
Olli Salonen | d87a505 | 2014-09-11 17:01:38 -0300 | [diff] [blame] | 315 | cmd.rlen = 4; |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 316 | ret = si2157_cmd_execute(client, &cmd); |
Olli Salonen | d87a505 | 2014-09-11 17:01:38 -0300 | [diff] [blame] | 317 | if (ret) |
| 318 | goto err; |
| 319 | |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 320 | if (dev->chiptype == SI2157_CHIPTYPE_SI2146) |
Olli Salonen | 073f384 | 2014-11-24 03:57:33 -0300 | [diff] [blame] | 321 | memcpy(cmd.args, "\x14\x00\x02\x07\x00\x01", 6); |
| 322 | else |
Olli Salonen | ee3c3e4 | 2015-05-05 13:54:17 -0300 | [diff] [blame] | 323 | memcpy(cmd.args, "\x14\x00\x02\x07\x00\x00", 6); |
| 324 | cmd.args[4] = dev->if_port; |
Olli Salonen | d87a505 | 2014-09-11 17:01:38 -0300 | [diff] [blame] | 325 | cmd.wlen = 6; |
| 326 | cmd.rlen = 4; |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 327 | ret = si2157_cmd_execute(client, &cmd); |
Olli Salonen | a1dad50 | 2014-07-13 10:52:21 -0300 | [diff] [blame] | 328 | if (ret) |
| 329 | goto err; |
| 330 | |
Olli Salonen | c28aebe | 2015-02-28 12:25:23 -0300 | [diff] [blame] | 331 | /* set if frequency if needed */ |
| 332 | if (if_frequency != dev->if_frequency) { |
| 333 | memcpy(cmd.args, "\x14\x00\x06\x07", 4); |
| 334 | cmd.args[4] = (if_frequency / 1000) & 0xff; |
| 335 | cmd.args[5] = ((if_frequency / 1000) >> 8) & 0xff; |
| 336 | cmd.wlen = 6; |
| 337 | cmd.rlen = 4; |
| 338 | ret = si2157_cmd_execute(client, &cmd); |
| 339 | if (ret) |
| 340 | goto err; |
| 341 | |
| 342 | dev->if_frequency = if_frequency; |
| 343 | } |
| 344 | |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 345 | /* set frequency */ |
Olli Salonen | b154121 | 2014-07-13 10:52:19 -0300 | [diff] [blame] | 346 | memcpy(cmd.args, "\x41\x00\x00\x00\x00\x00\x00\x00", 8); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 347 | cmd.args[4] = (c->frequency >> 0) & 0xff; |
| 348 | cmd.args[5] = (c->frequency >> 8) & 0xff; |
| 349 | cmd.args[6] = (c->frequency >> 16) & 0xff; |
| 350 | cmd.args[7] = (c->frequency >> 24) & 0xff; |
Antti Palosaari | e6b4380 | 2014-07-10 06:02:53 -0300 | [diff] [blame] | 351 | cmd.wlen = 8; |
| 352 | cmd.rlen = 1; |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 353 | ret = si2157_cmd_execute(client, &cmd); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 354 | if (ret) |
| 355 | goto err; |
| 356 | |
| 357 | return 0; |
| 358 | err: |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 359 | dev_dbg(&client->dev, "failed=%d\n", ret); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 360 | return ret; |
| 361 | } |
| 362 | |
Matthias Schwarzott | 1140540 | 2014-07-15 04:58:40 -0300 | [diff] [blame] | 363 | static int si2157_get_if_frequency(struct dvb_frontend *fe, u32 *frequency) |
| 364 | { |
Olli Salonen | c28aebe | 2015-02-28 12:25:23 -0300 | [diff] [blame] | 365 | struct i2c_client *client = fe->tuner_priv; |
| 366 | struct si2157_dev *dev = i2c_get_clientdata(client); |
| 367 | |
| 368 | *frequency = dev->if_frequency; |
Matthias Schwarzott | 1140540 | 2014-07-15 04:58:40 -0300 | [diff] [blame] | 369 | return 0; |
| 370 | } |
| 371 | |
Olli Salonen | 6cc8a35 | 2014-07-18 02:41:12 -0300 | [diff] [blame] | 372 | static const struct dvb_tuner_ops si2157_ops = { |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 373 | .info = { |
CrazyCat | 17ad09f | 2014-11-14 18:19:37 -0300 | [diff] [blame] | 374 | .name = "Silicon Labs Si2146/2147/2148/2157/2158", |
Andrei Koshkosh | 9398ddf | 2016-01-03 23:31:26 -0200 | [diff] [blame] | 375 | .frequency_min = 42000000, |
| 376 | .frequency_max = 870000000, |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 377 | }, |
| 378 | |
| 379 | .init = si2157_init, |
| 380 | .sleep = si2157_sleep, |
| 381 | .set_params = si2157_set_params, |
Matthias Schwarzott | 1140540 | 2014-07-15 04:58:40 -0300 | [diff] [blame] | 382 | .get_if_frequency = si2157_get_if_frequency, |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 383 | }; |
| 384 | |
Antti Palosaari | 2f1ea29 | 2014-09-07 11:20:34 -0300 | [diff] [blame] | 385 | static void si2157_stat_work(struct work_struct *work) |
| 386 | { |
| 387 | struct si2157_dev *dev = container_of(work, struct si2157_dev, stat_work.work); |
| 388 | struct dvb_frontend *fe = dev->fe; |
| 389 | struct i2c_client *client = fe->tuner_priv; |
| 390 | struct dtv_frontend_properties *c = &fe->dtv_property_cache; |
| 391 | struct si2157_cmd cmd; |
| 392 | int ret; |
| 393 | |
| 394 | dev_dbg(&client->dev, "\n"); |
| 395 | |
| 396 | memcpy(cmd.args, "\x42\x00", 2); |
| 397 | cmd.wlen = 2; |
| 398 | cmd.rlen = 12; |
| 399 | ret = si2157_cmd_execute(client, &cmd); |
| 400 | if (ret) |
| 401 | goto err; |
| 402 | |
| 403 | c->strength.stat[0].scale = FE_SCALE_DECIBEL; |
| 404 | c->strength.stat[0].svalue = (s8) cmd.args[3] * 1000; |
| 405 | |
| 406 | schedule_delayed_work(&dev->stat_work, msecs_to_jiffies(2000)); |
| 407 | return; |
| 408 | err: |
| 409 | c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE; |
| 410 | dev_dbg(&client->dev, "failed=%d\n", ret); |
| 411 | } |
| 412 | |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 413 | static int si2157_probe(struct i2c_client *client, |
Mauro Carvalho Chehab | 8b0a81c | 2016-02-11 18:06:36 -0200 | [diff] [blame] | 414 | const struct i2c_device_id *id) |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 415 | { |
| 416 | struct si2157_config *cfg = client->dev.platform_data; |
| 417 | struct dvb_frontend *fe = cfg->fe; |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 418 | struct si2157_dev *dev; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 419 | struct si2157_cmd cmd; |
| 420 | int ret; |
| 421 | |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 422 | dev = kzalloc(sizeof(*dev), GFP_KERNEL); |
| 423 | if (!dev) { |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 424 | ret = -ENOMEM; |
Olli Salonen | 67d0113 | 2014-08-05 09:03:54 -0300 | [diff] [blame] | 425 | dev_err(&client->dev, "kzalloc() failed\n"); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 426 | goto err; |
| 427 | } |
| 428 | |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 429 | i2c_set_clientdata(client, dev); |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 430 | dev->fe = cfg->fe; |
| 431 | dev->inversion = cfg->inversion; |
Olli Salonen | ee3c3e4 | 2015-05-05 13:54:17 -0300 | [diff] [blame] | 432 | dev->if_port = cfg->if_port; |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 433 | dev->chiptype = (u8)id->driver_data; |
Olli Salonen | c28aebe | 2015-02-28 12:25:23 -0300 | [diff] [blame] | 434 | dev->if_frequency = 5000000; /* default value of property 0x0706 */ |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 435 | mutex_init(&dev->i2c_mutex); |
Antti Palosaari | 2f1ea29 | 2014-09-07 11:20:34 -0300 | [diff] [blame] | 436 | INIT_DELAYED_WORK(&dev->stat_work, si2157_stat_work); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 437 | |
| 438 | /* check if the tuner is there */ |
Antti Palosaari | e6b4380 | 2014-07-10 06:02:53 -0300 | [diff] [blame] | 439 | cmd.wlen = 0; |
| 440 | cmd.rlen = 1; |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 441 | ret = si2157_cmd_execute(client, &cmd); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 442 | if (ret) |
Antti Palosaari | e7f3f9f3 | 2014-12-06 15:13:31 -0300 | [diff] [blame] | 443 | goto err_kfree; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 444 | |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 445 | memcpy(&fe->ops.tuner_ops, &si2157_ops, sizeof(struct dvb_tuner_ops)); |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 446 | fe->tuner_priv = client; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 447 | |
Mauro Carvalho Chehab | 8b0a81c | 2016-02-11 18:06:36 -0200 | [diff] [blame] | 448 | #ifdef CONFIG_MEDIA_CONTROLLER |
| 449 | if (cfg->mdev) { |
| 450 | dev->mdev = cfg->mdev; |
| 451 | |
| 452 | dev->ent.name = KBUILD_MODNAME; |
| 453 | dev->ent.function = MEDIA_ENT_F_TUNER; |
| 454 | |
| 455 | dev->pad[TUNER_PAD_RF_INPUT].flags = MEDIA_PAD_FL_SINK; |
| 456 | dev->pad[TUNER_PAD_OUTPUT].flags = MEDIA_PAD_FL_SOURCE; |
| 457 | dev->pad[TUNER_PAD_AUD_OUT].flags = MEDIA_PAD_FL_SOURCE; |
| 458 | |
| 459 | ret = media_entity_pads_init(&dev->ent, TUNER_NUM_PADS, |
| 460 | &dev->pad[0]); |
| 461 | |
| 462 | if (ret) |
| 463 | goto err_kfree; |
| 464 | |
| 465 | ret = media_device_register_entity(cfg->mdev, &dev->ent); |
| 466 | if (ret) { |
| 467 | media_entity_cleanup(&dev->ent); |
| 468 | goto err_kfree; |
| 469 | } |
| 470 | } |
| 471 | #endif |
| 472 | |
Antti Palosaari | 8fe5172 | 2014-12-06 14:40:06 -0300 | [diff] [blame] | 473 | dev_info(&client->dev, "Silicon Labs %s successfully attached\n", |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 474 | dev->chiptype == SI2157_CHIPTYPE_SI2146 ? |
CrazyCat | 17ad09f | 2014-11-14 18:19:37 -0300 | [diff] [blame] | 475 | "Si2146" : "Si2147/2148/2157/2158"); |
Olli Salonen | 073f384 | 2014-11-24 03:57:33 -0300 | [diff] [blame] | 476 | |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 477 | return 0; |
Antti Palosaari | e7f3f9f3 | 2014-12-06 15:13:31 -0300 | [diff] [blame] | 478 | |
| 479 | err_kfree: |
| 480 | kfree(dev); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 481 | err: |
Olli Salonen | 67d0113 | 2014-08-05 09:03:54 -0300 | [diff] [blame] | 482 | dev_dbg(&client->dev, "failed=%d\n", ret); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 483 | return ret; |
| 484 | } |
| 485 | |
| 486 | static int si2157_remove(struct i2c_client *client) |
| 487 | { |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 488 | struct si2157_dev *dev = i2c_get_clientdata(client); |
| 489 | struct dvb_frontend *fe = dev->fe; |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 490 | |
Olli Salonen | 67d0113 | 2014-08-05 09:03:54 -0300 | [diff] [blame] | 491 | dev_dbg(&client->dev, "\n"); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 492 | |
Ernst Martin Witte | 01d1d71 | 2016-01-09 18:18:43 -0200 | [diff] [blame] | 493 | /* stop statistics polling */ |
| 494 | cancel_delayed_work_sync(&dev->stat_work); |
| 495 | |
Mauro Carvalho Chehab | 8b0a81c | 2016-02-11 18:06:36 -0200 | [diff] [blame] | 496 | #ifdef CONFIG_MEDIA_CONTROLLER_DVB |
| 497 | if (dev->mdev) |
| 498 | media_device_unregister_entity(&dev->ent); |
| 499 | #endif |
| 500 | |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 501 | memset(&fe->ops.tuner_ops, 0, sizeof(struct dvb_tuner_ops)); |
| 502 | fe->tuner_priv = NULL; |
Antti Palosaari | 70f13ff | 2014-12-05 17:46:30 -0300 | [diff] [blame] | 503 | kfree(dev); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 504 | |
| 505 | return 0; |
| 506 | } |
| 507 | |
Antti Palosaari | c129223 | 2014-12-06 15:07:45 -0300 | [diff] [blame] | 508 | static const struct i2c_device_id si2157_id_table[] = { |
| 509 | {"si2157", SI2157_CHIPTYPE_SI2157}, |
| 510 | {"si2146", SI2157_CHIPTYPE_SI2146}, |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 511 | {} |
| 512 | }; |
Antti Palosaari | c129223 | 2014-12-06 15:07:45 -0300 | [diff] [blame] | 513 | MODULE_DEVICE_TABLE(i2c, si2157_id_table); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 514 | |
| 515 | static struct i2c_driver si2157_driver = { |
| 516 | .driver = { |
Antti Palosaari | e6dd44d | 2016-06-29 20:38:19 -0300 | [diff] [blame] | 517 | .name = "si2157", |
| 518 | .suppress_bind_attrs = true, |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 519 | }, |
| 520 | .probe = si2157_probe, |
| 521 | .remove = si2157_remove, |
Antti Palosaari | c129223 | 2014-12-06 15:07:45 -0300 | [diff] [blame] | 522 | .id_table = si2157_id_table, |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 523 | }; |
| 524 | |
| 525 | module_i2c_driver(si2157_driver); |
| 526 | |
CrazyCat | 17ad09f | 2014-11-14 18:19:37 -0300 | [diff] [blame] | 527 | MODULE_DESCRIPTION("Silicon Labs Si2146/2147/2148/2157/2158 silicon tuner driver"); |
Antti Palosaari | 930a873 | 2014-04-10 21:58:10 -0300 | [diff] [blame] | 528 | MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>"); |
| 529 | MODULE_LICENSE("GPL"); |
Antti Palosaari | bac53a2 | 2014-07-13 16:13:49 -0300 | [diff] [blame] | 530 | MODULE_FIRMWARE(SI2158_A20_FIRMWARE); |