1868736ad3404b205794bc04233eca58293818deaOlli Salonen/* 2868736ad3404b205794bc04233eca58293818deaOlli Salonen * CIMaX SP2/SP2HF (Atmel T90FJR) CI driver 3868736ad3404b205794bc04233eca58293818deaOlli Salonen * 4868736ad3404b205794bc04233eca58293818deaOlli Salonen * Copyright (C) 2014 Olli Salonen <olli.salonen@iki.fi> 5868736ad3404b205794bc04233eca58293818deaOlli Salonen * 6868736ad3404b205794bc04233eca58293818deaOlli Salonen * Heavily based on CIMax2(R) SP2 driver in conjunction with NetUp Dual 7868736ad3404b205794bc04233eca58293818deaOlli Salonen * DVB-S2 CI card (cimax2) with following copyrights: 8868736ad3404b205794bc04233eca58293818deaOlli Salonen * 9868736ad3404b205794bc04233eca58293818deaOlli Salonen * Copyright (C) 2009 NetUP Inc. 10868736ad3404b205794bc04233eca58293818deaOlli Salonen * Copyright (C) 2009 Igor M. Liplianin <liplianin@netup.ru> 11868736ad3404b205794bc04233eca58293818deaOlli Salonen * Copyright (C) 2009 Abylay Ospan <aospan@netup.ru> 12868736ad3404b205794bc04233eca58293818deaOlli Salonen * 13868736ad3404b205794bc04233eca58293818deaOlli Salonen * This program is free software; you can redistribute it and/or modify 14868736ad3404b205794bc04233eca58293818deaOlli Salonen * it under the terms of the GNU General Public License as published by 15868736ad3404b205794bc04233eca58293818deaOlli Salonen * the Free Software Foundation; either version 2 of the License, or 16868736ad3404b205794bc04233eca58293818deaOlli Salonen * (at your option) any later version. 17868736ad3404b205794bc04233eca58293818deaOlli Salonen * 18868736ad3404b205794bc04233eca58293818deaOlli Salonen * This program is distributed in the hope that it will be useful, 19868736ad3404b205794bc04233eca58293818deaOlli Salonen * but WITHOUT ANY WARRANTY; without even the implied warranty of 20868736ad3404b205794bc04233eca58293818deaOlli Salonen * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 21868736ad3404b205794bc04233eca58293818deaOlli Salonen * GNU General Public License for more details. 22868736ad3404b205794bc04233eca58293818deaOlli Salonen */ 23868736ad3404b205794bc04233eca58293818deaOlli Salonen 24868736ad3404b205794bc04233eca58293818deaOlli Salonen#include "sp2_priv.h" 25868736ad3404b205794bc04233eca58293818deaOlli Salonen 26868736ad3404b205794bc04233eca58293818deaOlli Salonenstatic int sp2_read_i2c(struct sp2 *s, u8 reg, u8 *buf, int len) 27868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 28868736ad3404b205794bc04233eca58293818deaOlli Salonen int ret; 29868736ad3404b205794bc04233eca58293818deaOlli Salonen struct i2c_client *client = s->client; 30868736ad3404b205794bc04233eca58293818deaOlli Salonen struct i2c_adapter *adap = client->adapter; 31868736ad3404b205794bc04233eca58293818deaOlli Salonen struct i2c_msg msg[] = { 32868736ad3404b205794bc04233eca58293818deaOlli Salonen { 33868736ad3404b205794bc04233eca58293818deaOlli Salonen .addr = client->addr, 34868736ad3404b205794bc04233eca58293818deaOlli Salonen .flags = 0, 35868736ad3404b205794bc04233eca58293818deaOlli Salonen .buf = ®, 36868736ad3404b205794bc04233eca58293818deaOlli Salonen .len = 1 37868736ad3404b205794bc04233eca58293818deaOlli Salonen }, { 38868736ad3404b205794bc04233eca58293818deaOlli Salonen .addr = client->addr, 39868736ad3404b205794bc04233eca58293818deaOlli Salonen .flags = I2C_M_RD, 40868736ad3404b205794bc04233eca58293818deaOlli Salonen .buf = buf, 41868736ad3404b205794bc04233eca58293818deaOlli Salonen .len = len 42868736ad3404b205794bc04233eca58293818deaOlli Salonen } 43868736ad3404b205794bc04233eca58293818deaOlli Salonen }; 44868736ad3404b205794bc04233eca58293818deaOlli Salonen 45868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = i2c_transfer(adap, msg, 2); 46868736ad3404b205794bc04233eca58293818deaOlli Salonen 47868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret != 2) { 48868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_err(&client->dev, "i2c read error, reg = 0x%02x, status = %d\n", 49868736ad3404b205794bc04233eca58293818deaOlli Salonen reg, ret); 50868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret < 0) 51868736ad3404b205794bc04233eca58293818deaOlli Salonen return ret; 52868736ad3404b205794bc04233eca58293818deaOlli Salonen else 53868736ad3404b205794bc04233eca58293818deaOlli Salonen return -EIO; 54868736ad3404b205794bc04233eca58293818deaOlli Salonen } 55868736ad3404b205794bc04233eca58293818deaOlli Salonen 56868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&s->client->dev, "addr=0x%04x, reg = 0x%02x, data = %02x\n", 57868736ad3404b205794bc04233eca58293818deaOlli Salonen client->addr, reg, buf[0]); 58868736ad3404b205794bc04233eca58293818deaOlli Salonen 59868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 60868736ad3404b205794bc04233eca58293818deaOlli Salonen} 61868736ad3404b205794bc04233eca58293818deaOlli Salonen 62868736ad3404b205794bc04233eca58293818deaOlli Salonenstatic int sp2_write_i2c(struct sp2 *s, u8 reg, u8 *buf, int len) 63868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 64868736ad3404b205794bc04233eca58293818deaOlli Salonen int ret; 65868736ad3404b205794bc04233eca58293818deaOlli Salonen u8 buffer[35]; 66868736ad3404b205794bc04233eca58293818deaOlli Salonen struct i2c_client *client = s->client; 67868736ad3404b205794bc04233eca58293818deaOlli Salonen struct i2c_adapter *adap = client->adapter; 68868736ad3404b205794bc04233eca58293818deaOlli Salonen struct i2c_msg msg = { 69868736ad3404b205794bc04233eca58293818deaOlli Salonen .addr = client->addr, 70868736ad3404b205794bc04233eca58293818deaOlli Salonen .flags = 0, 71868736ad3404b205794bc04233eca58293818deaOlli Salonen .buf = &buffer[0], 72868736ad3404b205794bc04233eca58293818deaOlli Salonen .len = len + 1 73868736ad3404b205794bc04233eca58293818deaOlli Salonen }; 74868736ad3404b205794bc04233eca58293818deaOlli Salonen 75868736ad3404b205794bc04233eca58293818deaOlli Salonen if ((len + 1) > sizeof(buffer)) { 76868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_err(&client->dev, "i2c wr reg=%02x: len=%d is too big!\n", 77868736ad3404b205794bc04233eca58293818deaOlli Salonen reg, len); 78868736ad3404b205794bc04233eca58293818deaOlli Salonen return -EINVAL; 79868736ad3404b205794bc04233eca58293818deaOlli Salonen } 80868736ad3404b205794bc04233eca58293818deaOlli Salonen 81868736ad3404b205794bc04233eca58293818deaOlli Salonen buffer[0] = reg; 82868736ad3404b205794bc04233eca58293818deaOlli Salonen memcpy(&buffer[1], buf, len); 83868736ad3404b205794bc04233eca58293818deaOlli Salonen 84868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = i2c_transfer(adap, &msg, 1); 85868736ad3404b205794bc04233eca58293818deaOlli Salonen 86868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret != 1) { 87868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_err(&client->dev, "i2c write error, reg = 0x%02x, status = %d\n", 88868736ad3404b205794bc04233eca58293818deaOlli Salonen reg, ret); 89868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret < 0) 90868736ad3404b205794bc04233eca58293818deaOlli Salonen return ret; 91868736ad3404b205794bc04233eca58293818deaOlli Salonen else 92868736ad3404b205794bc04233eca58293818deaOlli Salonen return -EIO; 93868736ad3404b205794bc04233eca58293818deaOlli Salonen } 94868736ad3404b205794bc04233eca58293818deaOlli Salonen 95868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 96868736ad3404b205794bc04233eca58293818deaOlli Salonen} 97868736ad3404b205794bc04233eca58293818deaOlli Salonen 98868736ad3404b205794bc04233eca58293818deaOlli Salonenstatic int sp2_ci_op_cam(struct dvb_ca_en50221 *en50221, int slot, u8 acs, 99868736ad3404b205794bc04233eca58293818deaOlli Salonen u8 read, int addr, u8 data) 100868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 101868736ad3404b205794bc04233eca58293818deaOlli Salonen struct sp2 *s = en50221->data; 102868736ad3404b205794bc04233eca58293818deaOlli Salonen u8 store; 103868736ad3404b205794bc04233eca58293818deaOlli Salonen int mem, ret; 104868736ad3404b205794bc04233eca58293818deaOlli Salonen int (*ci_op_cam)(void*, u8, int, u8, int*) = s->ci_control; 105868736ad3404b205794bc04233eca58293818deaOlli Salonen 106868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&s->client->dev, "slot=%d, acs=0x%02x, addr=0x%04x, data = 0x%02x", 107868736ad3404b205794bc04233eca58293818deaOlli Salonen slot, acs, addr, data); 108868736ad3404b205794bc04233eca58293818deaOlli Salonen 109868736ad3404b205794bc04233eca58293818deaOlli Salonen if (slot != 0) 110868736ad3404b205794bc04233eca58293818deaOlli Salonen return -EINVAL; 111868736ad3404b205794bc04233eca58293818deaOlli Salonen 112868736ad3404b205794bc04233eca58293818deaOlli Salonen /* 113868736ad3404b205794bc04233eca58293818deaOlli Salonen * change module access type between IO space and attribute memory 114868736ad3404b205794bc04233eca58293818deaOlli Salonen * when needed 115868736ad3404b205794bc04233eca58293818deaOlli Salonen */ 116868736ad3404b205794bc04233eca58293818deaOlli Salonen if (s->module_access_type != acs) { 117868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = sp2_read_i2c(s, 0x00, &store, 1); 118868736ad3404b205794bc04233eca58293818deaOlli Salonen 119868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 120868736ad3404b205794bc04233eca58293818deaOlli Salonen return ret; 121868736ad3404b205794bc04233eca58293818deaOlli Salonen 122868736ad3404b205794bc04233eca58293818deaOlli Salonen store &= ~(SP2_MOD_CTL_ACS1 | SP2_MOD_CTL_ACS0); 123868736ad3404b205794bc04233eca58293818deaOlli Salonen store |= acs; 124868736ad3404b205794bc04233eca58293818deaOlli Salonen 125868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = sp2_write_i2c(s, 0x00, &store, 1); 126868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 127868736ad3404b205794bc04233eca58293818deaOlli Salonen return ret; 128868736ad3404b205794bc04233eca58293818deaOlli Salonen } 129868736ad3404b205794bc04233eca58293818deaOlli Salonen 130868736ad3404b205794bc04233eca58293818deaOlli Salonen s->module_access_type = acs; 131868736ad3404b205794bc04233eca58293818deaOlli Salonen 132868736ad3404b205794bc04233eca58293818deaOlli Salonen /* implementation of ci_op_cam is device specific */ 133868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ci_op_cam) { 134868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = ci_op_cam(s->priv, read, addr, data, &mem); 135868736ad3404b205794bc04233eca58293818deaOlli Salonen } else { 136868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_err(&s->client->dev, "callback not defined"); 137868736ad3404b205794bc04233eca58293818deaOlli Salonen return -EINVAL; 138868736ad3404b205794bc04233eca58293818deaOlli Salonen } 139868736ad3404b205794bc04233eca58293818deaOlli Salonen 140868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 141868736ad3404b205794bc04233eca58293818deaOlli Salonen return ret; 142868736ad3404b205794bc04233eca58293818deaOlli Salonen 143868736ad3404b205794bc04233eca58293818deaOlli Salonen if (read) { 144868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&s->client->dev, "cam read, addr=0x%04x, data = 0x%04x", 145868736ad3404b205794bc04233eca58293818deaOlli Salonen addr, mem); 146868736ad3404b205794bc04233eca58293818deaOlli Salonen return mem; 147868736ad3404b205794bc04233eca58293818deaOlli Salonen } else { 148868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 149868736ad3404b205794bc04233eca58293818deaOlli Salonen } 150868736ad3404b205794bc04233eca58293818deaOlli Salonen} 151868736ad3404b205794bc04233eca58293818deaOlli Salonen 152868736ad3404b205794bc04233eca58293818deaOlli Salonenint sp2_ci_read_attribute_mem(struct dvb_ca_en50221 *en50221, 153868736ad3404b205794bc04233eca58293818deaOlli Salonen int slot, int addr) 154868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 155868736ad3404b205794bc04233eca58293818deaOlli Salonen return sp2_ci_op_cam(en50221, slot, SP2_CI_ATTR_ACS, 156868736ad3404b205794bc04233eca58293818deaOlli Salonen SP2_CI_RD, addr, 0); 157868736ad3404b205794bc04233eca58293818deaOlli Salonen} 158868736ad3404b205794bc04233eca58293818deaOlli Salonen 159868736ad3404b205794bc04233eca58293818deaOlli Salonenint sp2_ci_write_attribute_mem(struct dvb_ca_en50221 *en50221, 160868736ad3404b205794bc04233eca58293818deaOlli Salonen int slot, int addr, u8 data) 161868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 162868736ad3404b205794bc04233eca58293818deaOlli Salonen return sp2_ci_op_cam(en50221, slot, SP2_CI_ATTR_ACS, 163868736ad3404b205794bc04233eca58293818deaOlli Salonen SP2_CI_WR, addr, data); 164868736ad3404b205794bc04233eca58293818deaOlli Salonen} 165868736ad3404b205794bc04233eca58293818deaOlli Salonen 166868736ad3404b205794bc04233eca58293818deaOlli Salonenint sp2_ci_read_cam_control(struct dvb_ca_en50221 *en50221, 167868736ad3404b205794bc04233eca58293818deaOlli Salonen int slot, u8 addr) 168868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 169868736ad3404b205794bc04233eca58293818deaOlli Salonen return sp2_ci_op_cam(en50221, slot, SP2_CI_IO_ACS, 170868736ad3404b205794bc04233eca58293818deaOlli Salonen SP2_CI_RD, addr, 0); 171868736ad3404b205794bc04233eca58293818deaOlli Salonen} 172868736ad3404b205794bc04233eca58293818deaOlli Salonen 173868736ad3404b205794bc04233eca58293818deaOlli Salonenint sp2_ci_write_cam_control(struct dvb_ca_en50221 *en50221, 174868736ad3404b205794bc04233eca58293818deaOlli Salonen int slot, u8 addr, u8 data) 175868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 176868736ad3404b205794bc04233eca58293818deaOlli Salonen return sp2_ci_op_cam(en50221, slot, SP2_CI_IO_ACS, 177868736ad3404b205794bc04233eca58293818deaOlli Salonen SP2_CI_WR, addr, data); 178868736ad3404b205794bc04233eca58293818deaOlli Salonen} 179868736ad3404b205794bc04233eca58293818deaOlli Salonen 180868736ad3404b205794bc04233eca58293818deaOlli Salonenint sp2_ci_slot_reset(struct dvb_ca_en50221 *en50221, int slot) 181868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 182868736ad3404b205794bc04233eca58293818deaOlli Salonen struct sp2 *s = en50221->data; 183868736ad3404b205794bc04233eca58293818deaOlli Salonen u8 buf; 184868736ad3404b205794bc04233eca58293818deaOlli Salonen int ret; 185868736ad3404b205794bc04233eca58293818deaOlli Salonen 186868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&s->client->dev, "slot: %d\n", slot); 187868736ad3404b205794bc04233eca58293818deaOlli Salonen 188868736ad3404b205794bc04233eca58293818deaOlli Salonen if (slot != 0) 189868736ad3404b205794bc04233eca58293818deaOlli Salonen return -EINVAL; 190868736ad3404b205794bc04233eca58293818deaOlli Salonen 191868736ad3404b205794bc04233eca58293818deaOlli Salonen /* RST on */ 192868736ad3404b205794bc04233eca58293818deaOlli Salonen buf = SP2_MOD_CTL_RST; 193868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = sp2_write_i2c(s, 0x00, &buf, 1); 194868736ad3404b205794bc04233eca58293818deaOlli Salonen 195868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 196868736ad3404b205794bc04233eca58293818deaOlli Salonen return ret; 197868736ad3404b205794bc04233eca58293818deaOlli Salonen 198868736ad3404b205794bc04233eca58293818deaOlli Salonen usleep_range(500, 600); 199868736ad3404b205794bc04233eca58293818deaOlli Salonen 200868736ad3404b205794bc04233eca58293818deaOlli Salonen /* RST off */ 201868736ad3404b205794bc04233eca58293818deaOlli Salonen buf = 0x00; 202868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = sp2_write_i2c(s, 0x00, &buf, 1); 203868736ad3404b205794bc04233eca58293818deaOlli Salonen 204868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 205868736ad3404b205794bc04233eca58293818deaOlli Salonen return ret; 206868736ad3404b205794bc04233eca58293818deaOlli Salonen 207868736ad3404b205794bc04233eca58293818deaOlli Salonen msleep(1000); 208868736ad3404b205794bc04233eca58293818deaOlli Salonen 209868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 210868736ad3404b205794bc04233eca58293818deaOlli Salonen} 211868736ad3404b205794bc04233eca58293818deaOlli Salonen 212868736ad3404b205794bc04233eca58293818deaOlli Salonenint sp2_ci_slot_shutdown(struct dvb_ca_en50221 *en50221, int slot) 213868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 214868736ad3404b205794bc04233eca58293818deaOlli Salonen struct sp2 *s = en50221->data; 215868736ad3404b205794bc04233eca58293818deaOlli Salonen 216868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&s->client->dev, "slot:%d\n", slot); 217868736ad3404b205794bc04233eca58293818deaOlli Salonen 218868736ad3404b205794bc04233eca58293818deaOlli Salonen /* not implemented */ 219868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 220868736ad3404b205794bc04233eca58293818deaOlli Salonen} 221868736ad3404b205794bc04233eca58293818deaOlli Salonen 222868736ad3404b205794bc04233eca58293818deaOlli Salonenint sp2_ci_slot_ts_enable(struct dvb_ca_en50221 *en50221, int slot) 223868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 224868736ad3404b205794bc04233eca58293818deaOlli Salonen struct sp2 *s = en50221->data; 225868736ad3404b205794bc04233eca58293818deaOlli Salonen u8 buf; 226868736ad3404b205794bc04233eca58293818deaOlli Salonen 227868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&s->client->dev, "slot:%d\n", slot); 228868736ad3404b205794bc04233eca58293818deaOlli Salonen 229868736ad3404b205794bc04233eca58293818deaOlli Salonen if (slot != 0) 230868736ad3404b205794bc04233eca58293818deaOlli Salonen return -EINVAL; 231868736ad3404b205794bc04233eca58293818deaOlli Salonen 232868736ad3404b205794bc04233eca58293818deaOlli Salonen sp2_read_i2c(s, 0x00, &buf, 1); 233868736ad3404b205794bc04233eca58293818deaOlli Salonen 234868736ad3404b205794bc04233eca58293818deaOlli Salonen /* disable bypass and enable TS */ 235868736ad3404b205794bc04233eca58293818deaOlli Salonen buf |= (SP2_MOD_CTL_TSOEN | SP2_MOD_CTL_TSIEN); 236868736ad3404b205794bc04233eca58293818deaOlli Salonen return sp2_write_i2c(s, 0, &buf, 1); 237868736ad3404b205794bc04233eca58293818deaOlli Salonen} 238868736ad3404b205794bc04233eca58293818deaOlli Salonen 239868736ad3404b205794bc04233eca58293818deaOlli Salonenint sp2_ci_poll_slot_status(struct dvb_ca_en50221 *en50221, 240868736ad3404b205794bc04233eca58293818deaOlli Salonen int slot, int open) 241868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 242868736ad3404b205794bc04233eca58293818deaOlli Salonen struct sp2 *s = en50221->data; 243868736ad3404b205794bc04233eca58293818deaOlli Salonen u8 buf[2]; 244868736ad3404b205794bc04233eca58293818deaOlli Salonen int ret; 245868736ad3404b205794bc04233eca58293818deaOlli Salonen 246868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&s->client->dev, "slot:%d open:%d\n", slot, open); 247868736ad3404b205794bc04233eca58293818deaOlli Salonen 248868736ad3404b205794bc04233eca58293818deaOlli Salonen /* 249868736ad3404b205794bc04233eca58293818deaOlli Salonen * CAM module INSERT/REMOVE processing. Slow operation because of i2c 250868736ad3404b205794bc04233eca58293818deaOlli Salonen * transfers. Throttle read to one per sec. 251868736ad3404b205794bc04233eca58293818deaOlli Salonen */ 252868736ad3404b205794bc04233eca58293818deaOlli Salonen if (time_after(jiffies, s->next_status_checked_time)) { 253868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = sp2_read_i2c(s, 0x00, buf, 1); 254868736ad3404b205794bc04233eca58293818deaOlli Salonen s->next_status_checked_time = jiffies + msecs_to_jiffies(1000); 255868736ad3404b205794bc04233eca58293818deaOlli Salonen 256868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 257868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 258868736ad3404b205794bc04233eca58293818deaOlli Salonen 259868736ad3404b205794bc04233eca58293818deaOlli Salonen if (buf[0] & SP2_MOD_CTL_DET) 260868736ad3404b205794bc04233eca58293818deaOlli Salonen s->status = DVB_CA_EN50221_POLL_CAM_PRESENT | 261868736ad3404b205794bc04233eca58293818deaOlli Salonen DVB_CA_EN50221_POLL_CAM_READY; 262868736ad3404b205794bc04233eca58293818deaOlli Salonen else 263868736ad3404b205794bc04233eca58293818deaOlli Salonen s->status = 0; 264868736ad3404b205794bc04233eca58293818deaOlli Salonen } 265868736ad3404b205794bc04233eca58293818deaOlli Salonen 266868736ad3404b205794bc04233eca58293818deaOlli Salonen return s->status; 267868736ad3404b205794bc04233eca58293818deaOlli Salonen} 268868736ad3404b205794bc04233eca58293818deaOlli Salonen 269167921cb0ff2bdbf25138dad799fec88c99ed316Fengguang Wustatic int sp2_init(struct sp2 *s) 270868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 271868736ad3404b205794bc04233eca58293818deaOlli Salonen int ret = 0; 272868736ad3404b205794bc04233eca58293818deaOlli Salonen u8 buf; 273868736ad3404b205794bc04233eca58293818deaOlli Salonen u8 cimax_init[34] = { 274868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* module A control*/ 275868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select mask high A */ 276868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select mask low A */ 277868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select pattern high A */ 278868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select pattern low A */ 279868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x44, /* memory access time A, 600 ns */ 280868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* invert input A */ 281868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* RFU */ 282868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* RFU */ 283868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* module B control*/ 284868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select mask high B */ 285868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select mask low B */ 286868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select pattern high B */ 287868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select pattern low B */ 288868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x44, /* memory access time B, 600 ns */ 289868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* invert input B */ 290868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* RFU */ 291868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* RFU */ 292868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select mask high Ext */ 293868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select mask low Ext */ 294868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select pattern high Ext */ 295868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* auto select pattern low Ext */ 296868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* RFU */ 297868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x02, /* destination - module A */ 298868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x01, /* power control reg, VCC power on */ 299868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* RFU */ 300868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* int status read only */ 301868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* Interrupt Mask Register */ 302868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x05, /* EXTINT=active-high, INT=push-pull */ 303868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* USCG1 */ 304868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x04, /* ack active low */ 305868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* LOCK = 0 */ 306868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x22, /* unknown */ 307868736ad3404b205794bc04233eca58293818deaOlli Salonen 0x00, /* synchronization? */ 308868736ad3404b205794bc04233eca58293818deaOlli Salonen }; 309868736ad3404b205794bc04233eca58293818deaOlli Salonen 310868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&s->client->dev, "\n"); 311868736ad3404b205794bc04233eca58293818deaOlli Salonen 312868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.owner = THIS_MODULE; 313868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.read_attribute_mem = sp2_ci_read_attribute_mem; 314868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.write_attribute_mem = sp2_ci_write_attribute_mem; 315868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.read_cam_control = sp2_ci_read_cam_control; 316868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.write_cam_control = sp2_ci_write_cam_control; 317868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.slot_reset = sp2_ci_slot_reset; 318868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.slot_shutdown = sp2_ci_slot_shutdown; 319868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.slot_ts_enable = sp2_ci_slot_ts_enable; 320868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.poll_slot_status = sp2_ci_poll_slot_status; 321868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ca.data = s; 322868736ad3404b205794bc04233eca58293818deaOlli Salonen s->module_access_type = 0; 323868736ad3404b205794bc04233eca58293818deaOlli Salonen 324868736ad3404b205794bc04233eca58293818deaOlli Salonen /* initialize all regs */ 325868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = sp2_write_i2c(s, 0x00, &cimax_init[0], 34); 326868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 327868736ad3404b205794bc04233eca58293818deaOlli Salonen goto err; 328868736ad3404b205794bc04233eca58293818deaOlli Salonen 329868736ad3404b205794bc04233eca58293818deaOlli Salonen /* lock registers */ 330868736ad3404b205794bc04233eca58293818deaOlli Salonen buf = 1; 331868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = sp2_write_i2c(s, 0x1f, &buf, 1); 332868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 333868736ad3404b205794bc04233eca58293818deaOlli Salonen goto err; 334868736ad3404b205794bc04233eca58293818deaOlli Salonen 335868736ad3404b205794bc04233eca58293818deaOlli Salonen /* power on slots */ 336868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = sp2_write_i2c(s, 0x18, &buf, 1); 337868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 338868736ad3404b205794bc04233eca58293818deaOlli Salonen goto err; 339868736ad3404b205794bc04233eca58293818deaOlli Salonen 340868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = dvb_ca_en50221_init(s->dvb_adap, &s->ca, 0, 1); 341868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 342868736ad3404b205794bc04233eca58293818deaOlli Salonen goto err; 343868736ad3404b205794bc04233eca58293818deaOlli Salonen 344868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 345868736ad3404b205794bc04233eca58293818deaOlli Salonen 346868736ad3404b205794bc04233eca58293818deaOlli Salonenerr: 347868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&s->client->dev, "init failed=%d\n", ret); 348868736ad3404b205794bc04233eca58293818deaOlli Salonen return ret; 349868736ad3404b205794bc04233eca58293818deaOlli Salonen} 350868736ad3404b205794bc04233eca58293818deaOlli Salonen 351167921cb0ff2bdbf25138dad799fec88c99ed316Fengguang Wustatic int sp2_exit(struct i2c_client *client) 352868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 353868736ad3404b205794bc04233eca58293818deaOlli Salonen struct sp2 *s; 354868736ad3404b205794bc04233eca58293818deaOlli Salonen 355868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&client->dev, "\n"); 356868736ad3404b205794bc04233eca58293818deaOlli Salonen 357868736ad3404b205794bc04233eca58293818deaOlli Salonen if (client == NULL) 358868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 359868736ad3404b205794bc04233eca58293818deaOlli Salonen 360868736ad3404b205794bc04233eca58293818deaOlli Salonen s = i2c_get_clientdata(client); 361868736ad3404b205794bc04233eca58293818deaOlli Salonen if (s == NULL) 362868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 363868736ad3404b205794bc04233eca58293818deaOlli Salonen 364868736ad3404b205794bc04233eca58293818deaOlli Salonen if (s->ca.data == NULL) 365868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 366868736ad3404b205794bc04233eca58293818deaOlli Salonen 367868736ad3404b205794bc04233eca58293818deaOlli Salonen dvb_ca_en50221_release(&s->ca); 368868736ad3404b205794bc04233eca58293818deaOlli Salonen 369868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 370868736ad3404b205794bc04233eca58293818deaOlli Salonen} 371868736ad3404b205794bc04233eca58293818deaOlli Salonen 372868736ad3404b205794bc04233eca58293818deaOlli Salonenstatic int sp2_probe(struct i2c_client *client, 373868736ad3404b205794bc04233eca58293818deaOlli Salonen const struct i2c_device_id *id) 374868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 375868736ad3404b205794bc04233eca58293818deaOlli Salonen struct sp2_config *cfg = client->dev.platform_data; 376868736ad3404b205794bc04233eca58293818deaOlli Salonen struct sp2 *s; 377868736ad3404b205794bc04233eca58293818deaOlli Salonen int ret; 378868736ad3404b205794bc04233eca58293818deaOlli Salonen 379868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&client->dev, "\n"); 380868736ad3404b205794bc04233eca58293818deaOlli Salonen 381868736ad3404b205794bc04233eca58293818deaOlli Salonen s = kzalloc(sizeof(struct sp2), GFP_KERNEL); 382868736ad3404b205794bc04233eca58293818deaOlli Salonen if (!s) { 383868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = -ENOMEM; 384868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_err(&client->dev, "kzalloc() failed\n"); 385868736ad3404b205794bc04233eca58293818deaOlli Salonen goto err; 386868736ad3404b205794bc04233eca58293818deaOlli Salonen } 387868736ad3404b205794bc04233eca58293818deaOlli Salonen 388868736ad3404b205794bc04233eca58293818deaOlli Salonen s->client = client; 389868736ad3404b205794bc04233eca58293818deaOlli Salonen s->dvb_adap = cfg->dvb_adap; 390868736ad3404b205794bc04233eca58293818deaOlli Salonen s->priv = cfg->priv; 391868736ad3404b205794bc04233eca58293818deaOlli Salonen s->ci_control = cfg->ci_control; 392868736ad3404b205794bc04233eca58293818deaOlli Salonen 393868736ad3404b205794bc04233eca58293818deaOlli Salonen i2c_set_clientdata(client, s); 394868736ad3404b205794bc04233eca58293818deaOlli Salonen 395868736ad3404b205794bc04233eca58293818deaOlli Salonen ret = sp2_init(s); 396868736ad3404b205794bc04233eca58293818deaOlli Salonen if (ret) 397868736ad3404b205794bc04233eca58293818deaOlli Salonen goto err; 398868736ad3404b205794bc04233eca58293818deaOlli Salonen 399868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_info(&s->client->dev, "CIMaX SP2 successfully attached\n"); 400868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 401868736ad3404b205794bc04233eca58293818deaOlli Salonenerr: 402868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&client->dev, "init failed=%d\n", ret); 403868736ad3404b205794bc04233eca58293818deaOlli Salonen kfree(s); 404868736ad3404b205794bc04233eca58293818deaOlli Salonen 405868736ad3404b205794bc04233eca58293818deaOlli Salonen return ret; 406868736ad3404b205794bc04233eca58293818deaOlli Salonen} 407868736ad3404b205794bc04233eca58293818deaOlli Salonen 408868736ad3404b205794bc04233eca58293818deaOlli Salonenstatic int sp2_remove(struct i2c_client *client) 409868736ad3404b205794bc04233eca58293818deaOlli Salonen{ 410868736ad3404b205794bc04233eca58293818deaOlli Salonen struct si2157 *s = i2c_get_clientdata(client); 411868736ad3404b205794bc04233eca58293818deaOlli Salonen 412868736ad3404b205794bc04233eca58293818deaOlli Salonen dev_dbg(&client->dev, "\n"); 413868736ad3404b205794bc04233eca58293818deaOlli Salonen 414868736ad3404b205794bc04233eca58293818deaOlli Salonen sp2_exit(client); 415868736ad3404b205794bc04233eca58293818deaOlli Salonen if (s != NULL) 416868736ad3404b205794bc04233eca58293818deaOlli Salonen kfree(s); 417868736ad3404b205794bc04233eca58293818deaOlli Salonen 418868736ad3404b205794bc04233eca58293818deaOlli Salonen return 0; 419868736ad3404b205794bc04233eca58293818deaOlli Salonen} 420868736ad3404b205794bc04233eca58293818deaOlli Salonen 421868736ad3404b205794bc04233eca58293818deaOlli Salonenstatic const struct i2c_device_id sp2_id[] = { 422868736ad3404b205794bc04233eca58293818deaOlli Salonen {"sp2", 0}, 423868736ad3404b205794bc04233eca58293818deaOlli Salonen {} 424868736ad3404b205794bc04233eca58293818deaOlli Salonen}; 425868736ad3404b205794bc04233eca58293818deaOlli SalonenMODULE_DEVICE_TABLE(i2c, sp2_id); 426868736ad3404b205794bc04233eca58293818deaOlli Salonen 427868736ad3404b205794bc04233eca58293818deaOlli Salonenstatic struct i2c_driver sp2_driver = { 428868736ad3404b205794bc04233eca58293818deaOlli Salonen .driver = { 429868736ad3404b205794bc04233eca58293818deaOlli Salonen .owner = THIS_MODULE, 430868736ad3404b205794bc04233eca58293818deaOlli Salonen .name = "sp2", 431868736ad3404b205794bc04233eca58293818deaOlli Salonen }, 432868736ad3404b205794bc04233eca58293818deaOlli Salonen .probe = sp2_probe, 433868736ad3404b205794bc04233eca58293818deaOlli Salonen .remove = sp2_remove, 434868736ad3404b205794bc04233eca58293818deaOlli Salonen .id_table = sp2_id, 435868736ad3404b205794bc04233eca58293818deaOlli Salonen}; 436868736ad3404b205794bc04233eca58293818deaOlli Salonen 437868736ad3404b205794bc04233eca58293818deaOlli Salonenmodule_i2c_driver(sp2_driver); 438868736ad3404b205794bc04233eca58293818deaOlli Salonen 439868736ad3404b205794bc04233eca58293818deaOlli SalonenMODULE_DESCRIPTION("CIMaX SP2/HF CI driver"); 440868736ad3404b205794bc04233eca58293818deaOlli SalonenMODULE_AUTHOR("Olli Salonen <olli.salonen@iki.fi>"); 441868736ad3404b205794bc04233eca58293818deaOlli SalonenMODULE_LICENSE("GPL"); 442