1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * netup_unidvb_ci.c 4 * 5 * DVB CAM support for NetUP Universal Dual DVB-CI 6 * 7 * Copyright (C) 2014 NetUP Inc. 8 * Copyright (C) 2014 Sergey Kozlov <serjk@netup.ru> 9 * Copyright (C) 2014 Abylay Ospan <aospan@netup.ru> 10 */ 11 12 #include <linux/init.h> 13 #include <linux/module.h> 14 #include <linux/moduleparam.h> 15 #include <linux/kmod.h> 16 #include <linux/kernel.h> 17 #include <linux/slab.h> 18 #include <linux/interrupt.h> 19 #include <linux/delay.h> 20 #include "netup_unidvb.h" 21 22 /* CI slot 0 base address */ 23 #define CAM0_CONFIG 0x0 24 #define CAM0_IO 0x8000 25 #define CAM0_MEM 0x10000 26 #define CAM0_SZ 32 27 /* CI slot 1 base address */ 28 #define CAM1_CONFIG 0x20000 29 #define CAM1_IO 0x28000 30 #define CAM1_MEM 0x30000 31 #define CAM1_SZ 32 32 /* ctrlstat registers */ 33 #define CAM_CTRLSTAT_READ_SET 0x4980 34 #define CAM_CTRLSTAT_CLR 0x4982 35 /* register bits */ 36 #define BIT_CAM_STCHG (1<<0) 37 #define BIT_CAM_PRESENT (1<<1) 38 #define BIT_CAM_RESET (1<<2) 39 #define BIT_CAM_BYPASS (1<<3) 40 #define BIT_CAM_READY (1<<4) 41 #define BIT_CAM_ERROR (1<<5) 42 #define BIT_CAM_OVERCURR (1<<6) 43 /* BIT_CAM_BYPASS bit shift for SLOT 1 */ 44 #define CAM1_SHIFT 8 45 netup_ci_interrupt(struct netup_unidvb_dev * ndev)46 irqreturn_t netup_ci_interrupt(struct netup_unidvb_dev *ndev) 47 { 48 writew(0x101, ndev->bmmio0 + CAM_CTRLSTAT_CLR); 49 return IRQ_HANDLED; 50 } 51 netup_unidvb_ci_slot_ts_ctl(struct dvb_ca_en50221 * en50221,int slot)52 static int netup_unidvb_ci_slot_ts_ctl(struct dvb_ca_en50221 *en50221, 53 int slot) 54 { 55 struct netup_ci_state *state = en50221->data; 56 struct netup_unidvb_dev *dev = state->dev; 57 u16 shift = (state->nr == 1) ? CAM1_SHIFT : 0; 58 59 dev_dbg(&dev->pci_dev->dev, "%s(): CAM_CTRLSTAT=0x%x\n", 60 __func__, readw(dev->bmmio0 + CAM_CTRLSTAT_READ_SET)); 61 if (slot != 0) 62 return -EINVAL; 63 /* pass data to CAM module */ 64 writew(BIT_CAM_BYPASS << shift, dev->bmmio0 + CAM_CTRLSTAT_CLR); 65 dev_dbg(&dev->pci_dev->dev, "%s(): CAM_CTRLSTAT=0x%x done\n", 66 __func__, readw(dev->bmmio0 + CAM_CTRLSTAT_READ_SET)); 67 return 0; 68 } 69 netup_unidvb_ci_slot_shutdown(struct dvb_ca_en50221 * en50221,int slot)70 static int netup_unidvb_ci_slot_shutdown(struct dvb_ca_en50221 *en50221, 71 int slot) 72 { 73 struct netup_ci_state *state = en50221->data; 74 struct netup_unidvb_dev *dev = state->dev; 75 76 dev_dbg(&dev->pci_dev->dev, "%s()\n", __func__); 77 return 0; 78 } 79 netup_unidvb_ci_slot_reset(struct dvb_ca_en50221 * en50221,int slot)80 static int netup_unidvb_ci_slot_reset(struct dvb_ca_en50221 *en50221, 81 int slot) 82 { 83 struct netup_ci_state *state = en50221->data; 84 struct netup_unidvb_dev *dev = state->dev; 85 unsigned long timeout = 0; 86 u16 shift = (state->nr == 1) ? CAM1_SHIFT : 0; 87 u16 ci_stat = 0; 88 int reset_counter = 3; 89 90 dev_dbg(&dev->pci_dev->dev, "%s(): CAM_CTRLSTAT_READ_SET=0x%x\n", 91 __func__, readw(dev->bmmio0 + CAM_CTRLSTAT_READ_SET)); 92 reset: 93 timeout = jiffies + msecs_to_jiffies(5000); 94 /* start reset */ 95 writew(BIT_CAM_RESET << shift, dev->bmmio0 + CAM_CTRLSTAT_READ_SET); 96 dev_dbg(&dev->pci_dev->dev, "%s(): waiting for reset\n", __func__); 97 /* wait until reset done */ 98 while (time_before(jiffies, timeout)) { 99 ci_stat = readw(dev->bmmio0 + CAM_CTRLSTAT_READ_SET); 100 if (ci_stat & (BIT_CAM_READY << shift)) 101 break; 102 udelay(1000); 103 } 104 if (!(ci_stat & (BIT_CAM_READY << shift)) && reset_counter > 0) { 105 dev_dbg(&dev->pci_dev->dev, 106 "%s(): CAMP reset timeout! Will try again..\n", 107 __func__); 108 reset_counter--; 109 goto reset; 110 } 111 return 0; 112 } 113 netup_unidvb_poll_ci_slot_status(struct dvb_ca_en50221 * en50221,int slot,int open)114 static int netup_unidvb_poll_ci_slot_status(struct dvb_ca_en50221 *en50221, 115 int slot, int open) 116 { 117 struct netup_ci_state *state = en50221->data; 118 struct netup_unidvb_dev *dev = state->dev; 119 u16 shift = (state->nr == 1) ? CAM1_SHIFT : 0; 120 u16 ci_stat = 0; 121 122 dev_dbg(&dev->pci_dev->dev, "%s(): CAM_CTRLSTAT_READ_SET=0x%x\n", 123 __func__, readw(dev->bmmio0 + CAM_CTRLSTAT_READ_SET)); 124 ci_stat = readw(dev->bmmio0 + CAM_CTRLSTAT_READ_SET); 125 if (ci_stat & (BIT_CAM_READY << shift)) { 126 state->status = DVB_CA_EN50221_POLL_CAM_PRESENT | 127 DVB_CA_EN50221_POLL_CAM_READY; 128 } else if (ci_stat & (BIT_CAM_PRESENT << shift)) { 129 state->status = DVB_CA_EN50221_POLL_CAM_PRESENT; 130 } else { 131 state->status = 0; 132 } 133 return state->status; 134 } 135 netup_unidvb_ci_read_attribute_mem(struct dvb_ca_en50221 * en50221,int slot,int addr)136 static int netup_unidvb_ci_read_attribute_mem(struct dvb_ca_en50221 *en50221, 137 int slot, int addr) 138 { 139 struct netup_ci_state *state = en50221->data; 140 struct netup_unidvb_dev *dev = state->dev; 141 u8 val = *((u8 __force *)state->membase8_config + addr); 142 143 dev_dbg(&dev->pci_dev->dev, 144 "%s(): addr=0x%x val=0x%x\n", __func__, addr, val); 145 return val; 146 } 147 netup_unidvb_ci_write_attribute_mem(struct dvb_ca_en50221 * en50221,int slot,int addr,u8 data)148 static int netup_unidvb_ci_write_attribute_mem(struct dvb_ca_en50221 *en50221, 149 int slot, int addr, u8 data) 150 { 151 struct netup_ci_state *state = en50221->data; 152 struct netup_unidvb_dev *dev = state->dev; 153 154 dev_dbg(&dev->pci_dev->dev, 155 "%s(): addr=0x%x data=0x%x\n", __func__, addr, data); 156 *((u8 __force *)state->membase8_config + addr) = data; 157 return 0; 158 } 159 netup_unidvb_ci_read_cam_ctl(struct dvb_ca_en50221 * en50221,int slot,u8 addr)160 static int netup_unidvb_ci_read_cam_ctl(struct dvb_ca_en50221 *en50221, 161 int slot, u8 addr) 162 { 163 struct netup_ci_state *state = en50221->data; 164 struct netup_unidvb_dev *dev = state->dev; 165 u8 val = *((u8 __force *)state->membase8_io + addr); 166 167 dev_dbg(&dev->pci_dev->dev, 168 "%s(): addr=0x%x val=0x%x\n", __func__, addr, val); 169 return val; 170 } 171 netup_unidvb_ci_write_cam_ctl(struct dvb_ca_en50221 * en50221,int slot,u8 addr,u8 data)172 static int netup_unidvb_ci_write_cam_ctl(struct dvb_ca_en50221 *en50221, 173 int slot, u8 addr, u8 data) 174 { 175 struct netup_ci_state *state = en50221->data; 176 struct netup_unidvb_dev *dev = state->dev; 177 178 dev_dbg(&dev->pci_dev->dev, 179 "%s(): addr=0x%x data=0x%x\n", __func__, addr, data); 180 *((u8 __force *)state->membase8_io + addr) = data; 181 return 0; 182 } 183 netup_unidvb_ci_register(struct netup_unidvb_dev * dev,int num,struct pci_dev * pci_dev)184 int netup_unidvb_ci_register(struct netup_unidvb_dev *dev, 185 int num, struct pci_dev *pci_dev) 186 { 187 int result; 188 struct netup_ci_state *state; 189 190 if (num < 0 || num > 1) { 191 dev_err(&pci_dev->dev, "%s(): invalid CI adapter %d\n", 192 __func__, num); 193 return -EINVAL; 194 } 195 state = &dev->ci[num]; 196 state->nr = num; 197 state->membase8_config = dev->bmmio1 + 198 ((num == 0) ? CAM0_CONFIG : CAM1_CONFIG); 199 state->membase8_io = dev->bmmio1 + 200 ((num == 0) ? CAM0_IO : CAM1_IO); 201 state->dev = dev; 202 state->ca.owner = THIS_MODULE; 203 state->ca.read_attribute_mem = netup_unidvb_ci_read_attribute_mem; 204 state->ca.write_attribute_mem = netup_unidvb_ci_write_attribute_mem; 205 state->ca.read_cam_control = netup_unidvb_ci_read_cam_ctl; 206 state->ca.write_cam_control = netup_unidvb_ci_write_cam_ctl; 207 state->ca.slot_reset = netup_unidvb_ci_slot_reset; 208 state->ca.slot_shutdown = netup_unidvb_ci_slot_shutdown; 209 state->ca.slot_ts_enable = netup_unidvb_ci_slot_ts_ctl; 210 state->ca.poll_slot_status = netup_unidvb_poll_ci_slot_status; 211 state->ca.data = state; 212 result = dvb_ca_en50221_init(&dev->frontends[num].adapter, 213 &state->ca, 0, 1); 214 if (result < 0) { 215 dev_err(&pci_dev->dev, 216 "%s(): dvb_ca_en50221_init result %d\n", 217 __func__, result); 218 return result; 219 } 220 writew(NETUP_UNIDVB_IRQ_CI, dev->bmmio0 + REG_IMASK_SET); 221 dev_info(&pci_dev->dev, 222 "%s(): CI adapter %d init done\n", __func__, num); 223 return 0; 224 } 225 netup_unidvb_ci_unregister(struct netup_unidvb_dev * dev,int num)226 void netup_unidvb_ci_unregister(struct netup_unidvb_dev *dev, int num) 227 { 228 struct netup_ci_state *state; 229 230 dev_dbg(&dev->pci_dev->dev, "%s()\n", __func__); 231 if (num < 0 || num > 1) { 232 dev_err(&dev->pci_dev->dev, "%s(): invalid CI adapter %d\n", 233 __func__, num); 234 return; 235 } 236 state = &dev->ci[num]; 237 dvb_ca_en50221_release(&state->ca); 238 } 239 240