1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * ddbridge-ci.c: Digital Devices bridge CI (DuoFlex, CI Bridge) support 4 * 5 * Copyright (C) 2010-2017 Digital Devices GmbH 6 * Marcus Metzler <mocm@metzlerbros.de> 7 * Ralph Metzler <rjkm@metzlerbros.de> 8 */ 9 10 #include "ddbridge.h" 11 #include "ddbridge-regs.h" 12 #include "ddbridge-ci.h" 13 #include "ddbridge-io.h" 14 #include "ddbridge-i2c.h" 15 16 #include "cxd2099.h" 17 18 /* Octopus CI internal CI interface */ 19 20 static int wait_ci_ready(struct ddb_ci *ci) 21 { 22 u32 count = 10; 23 24 ndelay(500); 25 do { 26 if (ddbreadl(ci->port->dev, 27 CI_CONTROL(ci->nr)) & CI_READY) 28 break; 29 usleep_range(1, 2); 30 if ((--count) == 0) 31 return -1; 32 } while (1); 33 return 0; 34 } 35 36 static int read_attribute_mem(struct dvb_ca_en50221 *ca, 37 int slot, int address) 38 { 39 struct ddb_ci *ci = ca->data; 40 u32 val, off = (address >> 1) & (CI_BUFFER_SIZE - 1); 41 42 if (address > CI_BUFFER_SIZE) 43 return -1; 44 ddbwritel(ci->port->dev, CI_READ_CMD | (1 << 16) | address, 45 CI_DO_READ_ATTRIBUTES(ci->nr)); 46 wait_ci_ready(ci); 47 val = 0xff & ddbreadl(ci->port->dev, CI_BUFFER(ci->nr) + off); 48 return val; 49 } 50 51 static int write_attribute_mem(struct dvb_ca_en50221 *ca, int slot, 52 int address, u8 value) 53 { 54 struct ddb_ci *ci = ca->data; 55 56 ddbwritel(ci->port->dev, CI_WRITE_CMD | (value << 16) | address, 57 CI_DO_ATTRIBUTE_RW(ci->nr)); 58 wait_ci_ready(ci); 59 return 0; 60 } 61 62 static int read_cam_control(struct dvb_ca_en50221 *ca, 63 int slot, u8 address) 64 { 65 u32 count = 100; 66 struct ddb_ci *ci = ca->data; 67 u32 res; 68 69 ddbwritel(ci->port->dev, CI_READ_CMD | address, 70 CI_DO_IO_RW(ci->nr)); 71 ndelay(500); 72 do { 73 res = ddbreadl(ci->port->dev, CI_READDATA(ci->nr)); 74 if (res & CI_READY) 75 break; 76 usleep_range(1, 2); 77 if ((--count) == 0) 78 return -1; 79 } while (1); 80 return 0xff & res; 81 } 82 83 static int write_cam_control(struct dvb_ca_en50221 *ca, int slot, 84 u8 address, u8 value) 85 { 86 struct ddb_ci *ci = ca->data; 87 88 ddbwritel(ci->port->dev, CI_WRITE_CMD | (value << 16) | address, 89 CI_DO_IO_RW(ci->nr)); 90 wait_ci_ready(ci); 91 return 0; 92 } 93 94 static int slot_reset(struct dvb_ca_en50221 *ca, int slot) 95 { 96 struct ddb_ci *ci = ca->data; 97 98 ddbwritel(ci->port->dev, CI_POWER_ON, 99 CI_CONTROL(ci->nr)); 100 msleep(100); 101 ddbwritel(ci->port->dev, CI_POWER_ON | CI_RESET_CAM, 102 CI_CONTROL(ci->nr)); 103 ddbwritel(ci->port->dev, CI_ENABLE | CI_POWER_ON | CI_RESET_CAM, 104 CI_CONTROL(ci->nr)); 105 usleep_range(20, 25); 106 ddbwritel(ci->port->dev, CI_ENABLE | CI_POWER_ON, 107 CI_CONTROL(ci->nr)); 108 return 0; 109 } 110 111 static int slot_shutdown(struct dvb_ca_en50221 *ca, int slot) 112 { 113 struct ddb_ci *ci = ca->data; 114 115 ddbwritel(ci->port->dev, 0, CI_CONTROL(ci->nr)); 116 msleep(300); 117 return 0; 118 } 119 120 static int slot_ts_enable(struct dvb_ca_en50221 *ca, int slot) 121 { 122 struct ddb_ci *ci = ca->data; 123 u32 val = ddbreadl(ci->port->dev, CI_CONTROL(ci->nr)); 124 125 ddbwritel(ci->port->dev, val | CI_BYPASS_DISABLE, 126 CI_CONTROL(ci->nr)); 127 return 0; 128 } 129 130 static int poll_slot_status(struct dvb_ca_en50221 *ca, int slot, int open) 131 { 132 struct ddb_ci *ci = ca->data; 133 u32 val = ddbreadl(ci->port->dev, CI_CONTROL(ci->nr)); 134 int stat = 0; 135 136 if (val & CI_CAM_DETECT) 137 stat |= DVB_CA_EN50221_POLL_CAM_PRESENT; 138 if (val & CI_CAM_READY) 139 stat |= DVB_CA_EN50221_POLL_CAM_READY; 140 return stat; 141 } 142 143 static struct dvb_ca_en50221 en_templ = { 144 .read_attribute_mem = read_attribute_mem, 145 .write_attribute_mem = write_attribute_mem, 146 .read_cam_control = read_cam_control, 147 .write_cam_control = write_cam_control, 148 .slot_reset = slot_reset, 149 .slot_shutdown = slot_shutdown, 150 .slot_ts_enable = slot_ts_enable, 151 .poll_slot_status = poll_slot_status, 152 }; 153 154 static void ci_attach(struct ddb_port *port) 155 { 156 struct ddb_ci *ci; 157 158 ci = kzalloc(sizeof(*ci), GFP_KERNEL); 159 if (!ci) 160 return; 161 memcpy(&ci->en, &en_templ, sizeof(en_templ)); 162 ci->en.data = ci; 163 port->en = &ci->en; 164 port->en_freedata = 1; 165 ci->port = port; 166 ci->nr = port->nr - 2; 167 } 168 169 /* DuoFlex Dual CI support */ 170 171 static int write_creg(struct ddb_ci *ci, u8 data, u8 mask) 172 { 173 struct i2c_adapter *i2c = &ci->port->i2c->adap; 174 u8 adr = (ci->port->type == DDB_CI_EXTERNAL_XO2) ? 0x12 : 0x13; 175 176 ci->port->creg = (ci->port->creg & ~mask) | data; 177 return i2c_write_reg(i2c, adr, 0x02, ci->port->creg); 178 } 179 180 static int read_attribute_mem_xo2(struct dvb_ca_en50221 *ca, 181 int slot, int address) 182 { 183 struct ddb_ci *ci = ca->data; 184 struct i2c_adapter *i2c = &ci->port->i2c->adap; 185 u8 adr = (ci->port->type == DDB_CI_EXTERNAL_XO2) ? 0x12 : 0x13; 186 int res; 187 u8 val; 188 189 res = i2c_read_reg16(i2c, adr, 0x8000 | address, &val); 190 return res ? res : val; 191 } 192 193 static int write_attribute_mem_xo2(struct dvb_ca_en50221 *ca, int slot, 194 int address, u8 value) 195 { 196 struct ddb_ci *ci = ca->data; 197 struct i2c_adapter *i2c = &ci->port->i2c->adap; 198 u8 adr = (ci->port->type == DDB_CI_EXTERNAL_XO2) ? 0x12 : 0x13; 199 200 return i2c_write_reg16(i2c, adr, 0x8000 | address, value); 201 } 202 203 static int read_cam_control_xo2(struct dvb_ca_en50221 *ca, 204 int slot, u8 address) 205 { 206 struct ddb_ci *ci = ca->data; 207 struct i2c_adapter *i2c = &ci->port->i2c->adap; 208 u8 adr = (ci->port->type == DDB_CI_EXTERNAL_XO2) ? 0x12 : 0x13; 209 u8 val; 210 int res; 211 212 res = i2c_read_reg(i2c, adr, 0x20 | (address & 3), &val); 213 return res ? res : val; 214 } 215 216 static int write_cam_control_xo2(struct dvb_ca_en50221 *ca, int slot, 217 u8 address, u8 value) 218 { 219 struct ddb_ci *ci = ca->data; 220 struct i2c_adapter *i2c = &ci->port->i2c->adap; 221 u8 adr = (ci->port->type == DDB_CI_EXTERNAL_XO2) ? 0x12 : 0x13; 222 223 return i2c_write_reg(i2c, adr, 0x20 | (address & 3), value); 224 } 225 226 static int slot_reset_xo2(struct dvb_ca_en50221 *ca, int slot) 227 { 228 struct ddb_ci *ci = ca->data; 229 230 dev_dbg(ci->port->dev->dev, "%s\n", __func__); 231 write_creg(ci, 0x01, 0x01); 232 write_creg(ci, 0x04, 0x04); 233 msleep(20); 234 write_creg(ci, 0x02, 0x02); 235 write_creg(ci, 0x00, 0x04); 236 write_creg(ci, 0x18, 0x18); 237 return 0; 238 } 239 240 static int slot_shutdown_xo2(struct dvb_ca_en50221 *ca, int slot) 241 { 242 struct ddb_ci *ci = ca->data; 243 244 dev_dbg(ci->port->dev->dev, "%s\n", __func__); 245 write_creg(ci, 0x10, 0xff); 246 write_creg(ci, 0x08, 0x08); 247 return 0; 248 } 249 250 static int slot_ts_enable_xo2(struct dvb_ca_en50221 *ca, int slot) 251 { 252 struct ddb_ci *ci = ca->data; 253 254 dev_dbg(ci->port->dev->dev, "%s\n", __func__); 255 write_creg(ci, 0x00, 0x10); 256 return 0; 257 } 258 259 static int poll_slot_status_xo2(struct dvb_ca_en50221 *ca, int slot, int open) 260 { 261 struct ddb_ci *ci = ca->data; 262 struct i2c_adapter *i2c = &ci->port->i2c->adap; 263 u8 adr = (ci->port->type == DDB_CI_EXTERNAL_XO2) ? 0x12 : 0x13; 264 u8 val = 0; 265 int stat = 0; 266 267 i2c_read_reg(i2c, adr, 0x01, &val); 268 269 if (val & 2) 270 stat |= DVB_CA_EN50221_POLL_CAM_PRESENT; 271 if (val & 1) 272 stat |= DVB_CA_EN50221_POLL_CAM_READY; 273 return stat; 274 } 275 276 static struct dvb_ca_en50221 en_xo2_templ = { 277 .read_attribute_mem = read_attribute_mem_xo2, 278 .write_attribute_mem = write_attribute_mem_xo2, 279 .read_cam_control = read_cam_control_xo2, 280 .write_cam_control = write_cam_control_xo2, 281 .slot_reset = slot_reset_xo2, 282 .slot_shutdown = slot_shutdown_xo2, 283 .slot_ts_enable = slot_ts_enable_xo2, 284 .poll_slot_status = poll_slot_status_xo2, 285 }; 286 287 static void ci_xo2_attach(struct ddb_port *port) 288 { 289 struct ddb_ci *ci; 290 291 ci = kzalloc(sizeof(*ci), GFP_KERNEL); 292 if (!ci) 293 return; 294 memcpy(&ci->en, &en_xo2_templ, sizeof(en_xo2_templ)); 295 ci->en.data = ci; 296 port->en = &ci->en; 297 port->en_freedata = 1; 298 ci->port = port; 299 ci->nr = port->nr - 2; 300 ci->port->creg = 0; 301 write_creg(ci, 0x10, 0xff); 302 write_creg(ci, 0x08, 0x08); 303 } 304 305 static const struct cxd2099_cfg cxd_cfgtmpl = { 306 .bitrate = 72000, 307 .polarity = 1, 308 .clock_mode = 1, 309 .max_i2c = 512, 310 }; 311 312 static int ci_cxd2099_attach(struct ddb_port *port, u32 bitrate) 313 { 314 struct cxd2099_cfg cxd_cfg = cxd_cfgtmpl; 315 struct i2c_client *client; 316 317 cxd_cfg.bitrate = bitrate; 318 cxd_cfg.en = &port->en; 319 320 client = dvb_module_probe("cxd2099", NULL, &port->i2c->adap, 321 0x40, &cxd_cfg); 322 if (!client) 323 goto err; 324 325 port->dvb[0].i2c_client[0] = client; 326 port->en_freedata = 0; 327 return 0; 328 329 err: 330 dev_err(port->dev->dev, "CXD2099AR attach failed\n"); 331 return -ENODEV; 332 } 333 334 int ddb_ci_attach(struct ddb_port *port, u32 bitrate) 335 { 336 int ret; 337 338 switch (port->type) { 339 case DDB_CI_EXTERNAL_SONY: 340 ret = ci_cxd2099_attach(port, bitrate); 341 if (ret) 342 return -ENODEV; 343 break; 344 case DDB_CI_EXTERNAL_XO2: 345 case DDB_CI_EXTERNAL_XO2_B: 346 ci_xo2_attach(port); 347 break; 348 case DDB_CI_INTERNAL: 349 ci_attach(port); 350 break; 351 default: 352 return -ENODEV; 353 } 354 355 if (!port->en) 356 return -ENODEV; 357 dvb_ca_en50221_init(port->dvb[0].adap, port->en, 0, 1); 358 return 0; 359 } 360 361 void ddb_ci_detach(struct ddb_port *port) 362 { 363 if (port->dvb[0].dev) 364 dvb_unregister_device(port->dvb[0].dev); 365 if (port->en) { 366 dvb_ca_en50221_release(port->en); 367 368 dvb_module_release(port->dvb[0].i2c_client[0]); 369 port->dvb[0].i2c_client[0] = NULL; 370 371 /* free alloc'ed memory if needed */ 372 if (port->en_freedata) 373 kfree(port->en->data); 374 375 port->en = NULL; 376 } 377 } 378