Thomas Gleixner | 74ba920 | 2019-05-20 09:19:02 +0200 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0-or-later |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 2 | /* |
| 3 | Mantis PCI bridge driver |
| 4 | |
Manu Abraham | 8825a09 | 2009-12-15 09:13:49 -0300 | [diff] [blame] | 5 | Copyright (C) Manu Abraham (abraham.manu@gmail.com) |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 6 | |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 7 | */ |
| 8 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 9 | #include <linux/signal.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 10 | #include <linux/slab.h> |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 11 | #include <linux/sched.h> |
| 12 | #include <linux/interrupt.h> |
Alexey Dobriyan | b7f080c | 2011-06-16 11:01:34 +0000 | [diff] [blame] | 13 | #include <asm/io.h> |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 14 | |
Mauro Carvalho Chehab | fada193 | 2017-12-28 13:03:51 -0500 | [diff] [blame] | 15 | #include <media/dmxdev.h> |
| 16 | #include <media/dvbdev.h> |
| 17 | #include <media/dvb_demux.h> |
| 18 | #include <media/dvb_frontend.h> |
| 19 | #include <media/dvb_net.h> |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 20 | |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 21 | #include "mantis_common.h" |
| 22 | #include "mantis_link.h" |
| 23 | #include "mantis_hif.h" |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 24 | #include "mantis_reg.h" |
| 25 | |
| 26 | #include "mantis_ca.h" |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 27 | |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 28 | static int mantis_ca_read_attr_mem(struct dvb_ca_en50221 *en50221, int slot, int addr) |
| 29 | { |
| 30 | struct mantis_ca *ca = en50221->data; |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 31 | struct mantis_pci *mantis = ca->ca_priv; |
| 32 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 33 | dprintk(MANTIS_DEBUG, 1, "Slot(%d): Request Attribute Mem Read", slot); |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 34 | |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 35 | if (slot != 0) |
| 36 | return -EINVAL; |
| 37 | |
| 38 | return mantis_hif_read_mem(ca, addr); |
| 39 | } |
| 40 | |
| 41 | static int mantis_ca_write_attr_mem(struct dvb_ca_en50221 *en50221, int slot, int addr, u8 data) |
| 42 | { |
| 43 | struct mantis_ca *ca = en50221->data; |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 44 | struct mantis_pci *mantis = ca->ca_priv; |
| 45 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 46 | dprintk(MANTIS_DEBUG, 1, "Slot(%d): Request Attribute Mem Write", slot); |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 47 | |
| 48 | if (slot != 0) |
| 49 | return -EINVAL; |
| 50 | |
| 51 | return mantis_hif_write_mem(ca, addr, data); |
| 52 | } |
| 53 | |
| 54 | static int mantis_ca_read_cam_ctl(struct dvb_ca_en50221 *en50221, int slot, u8 addr) |
| 55 | { |
| 56 | struct mantis_ca *ca = en50221->data; |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 57 | struct mantis_pci *mantis = ca->ca_priv; |
| 58 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 59 | dprintk(MANTIS_DEBUG, 1, "Slot(%d): Request CAM control Read", slot); |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 60 | |
| 61 | if (slot != 0) |
| 62 | return -EINVAL; |
| 63 | |
| 64 | return mantis_hif_read_iom(ca, addr); |
| 65 | } |
| 66 | |
| 67 | static int mantis_ca_write_cam_ctl(struct dvb_ca_en50221 *en50221, int slot, u8 addr, u8 data) |
| 68 | { |
| 69 | struct mantis_ca *ca = en50221->data; |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 70 | struct mantis_pci *mantis = ca->ca_priv; |
| 71 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 72 | dprintk(MANTIS_DEBUG, 1, "Slot(%d): Request CAM control Write", slot); |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 73 | |
| 74 | if (slot != 0) |
| 75 | return -EINVAL; |
| 76 | |
| 77 | return mantis_hif_write_iom(ca, addr, data); |
| 78 | } |
| 79 | |
| 80 | static int mantis_ca_slot_reset(struct dvb_ca_en50221 *en50221, int slot) |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 81 | { |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 82 | struct mantis_ca *ca = en50221->data; |
| 83 | struct mantis_pci *mantis = ca->ca_priv; |
| 84 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 85 | dprintk(MANTIS_DEBUG, 1, "Slot(%d): Slot RESET", slot); |
Manu Abraham | fb6de9c | 2009-12-04 05:17:46 -0300 | [diff] [blame] | 86 | udelay(500); /* Wait.. */ |
| 87 | mmwrite(0xda, MANTIS_PCMCIA_RESET); /* Leading edge assert */ |
| 88 | udelay(500); |
| 89 | mmwrite(0x00, MANTIS_PCMCIA_RESET); /* Trailing edge deassert */ |
| 90 | msleep(1000); |
Manu Abraham | 2ec9b00 | 2009-12-04 05:20:44 -0300 | [diff] [blame] | 91 | dvb_ca_en50221_camready_irq(&ca->en50221, 0); |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 92 | |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 93 | return 0; |
| 94 | } |
| 95 | |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 96 | static int mantis_ca_slot_shutdown(struct dvb_ca_en50221 *en50221, int slot) |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 97 | { |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 98 | struct mantis_ca *ca = en50221->data; |
| 99 | struct mantis_pci *mantis = ca->ca_priv; |
| 100 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 101 | dprintk(MANTIS_DEBUG, 1, "Slot(%d): Slot shutdown", slot); |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 102 | |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 103 | return 0; |
| 104 | } |
| 105 | |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 106 | static int mantis_ts_control(struct dvb_ca_en50221 *en50221, int slot) |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 107 | { |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 108 | struct mantis_ca *ca = en50221->data; |
| 109 | struct mantis_pci *mantis = ca->ca_priv; |
| 110 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 111 | dprintk(MANTIS_DEBUG, 1, "Slot(%d): TS control", slot); |
Manu Abraham | f5ae4f6 | 2009-12-15 08:47:21 -0300 | [diff] [blame] | 112 | /* mantis_set_direction(mantis, 1); */ /* Enable TS through CAM */ |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 113 | |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 114 | return 0; |
| 115 | } |
| 116 | |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 117 | static int mantis_slot_status(struct dvb_ca_en50221 *en50221, int slot, int open) |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 118 | { |
Manu Abraham | 4e9fbee | 2009-12-04 05:11:41 -0300 | [diff] [blame] | 119 | struct mantis_ca *ca = en50221->data; |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 120 | struct mantis_pci *mantis = ca->ca_priv; |
| 121 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 122 | dprintk(MANTIS_DEBUG, 1, "Slot(%d): Poll Slot status", slot); |
Manu Abraham | 4e9fbee | 2009-12-04 05:11:41 -0300 | [diff] [blame] | 123 | |
Manu Abraham | 5e2a0c9 | 2009-12-04 05:23:17 -0300 | [diff] [blame] | 124 | if (ca->slot_state == MODULE_INSERTED) { |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 125 | dprintk(MANTIS_DEBUG, 1, "CA Module present and ready"); |
Manu Abraham | 4e9fbee | 2009-12-04 05:11:41 -0300 | [diff] [blame] | 126 | return DVB_CA_EN50221_POLL_CAM_PRESENT | DVB_CA_EN50221_POLL_CAM_READY; |
Manu Abraham | 5e2a0c9 | 2009-12-04 05:23:17 -0300 | [diff] [blame] | 127 | } else { |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 128 | dprintk(MANTIS_DEBUG, 1, "CA Module not present or not ready"); |
Manu Abraham | 5e2a0c9 | 2009-12-04 05:23:17 -0300 | [diff] [blame] | 129 | } |
Manu Abraham | 4e9fbee | 2009-12-04 05:11:41 -0300 | [diff] [blame] | 130 | |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 131 | return 0; |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 132 | } |
| 133 | |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 134 | int mantis_ca_init(struct mantis_pci *mantis) |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 135 | { |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 136 | struct dvb_adapter *dvb_adapter = &mantis->dvb_adapter; |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 137 | struct mantis_ca *ca; |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 138 | int ca_flags = 0, result; |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 139 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 140 | dprintk(MANTIS_DEBUG, 1, "Initializing Mantis CA"); |
Manu Abraham | f5ae4f6 | 2009-12-15 08:47:21 -0300 | [diff] [blame] | 141 | ca = kzalloc(sizeof(struct mantis_ca), GFP_KERNEL); |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 142 | if (!ca) { |
| 143 | dprintk(MANTIS_ERROR, 1, "Out of memory!, exiting .."); |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 144 | result = -ENOMEM; |
| 145 | goto err; |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 146 | } |
| 147 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 148 | ca->ca_priv = mantis; |
| 149 | mantis->mantis_ca = ca; |
| 150 | ca_flags = DVB_CA_EN50221_FLAG_IRQ_CAMCHANGE; |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 151 | /* register CA interface */ |
| 152 | ca->en50221.owner = THIS_MODULE; |
| 153 | ca->en50221.read_attribute_mem = mantis_ca_read_attr_mem; |
| 154 | ca->en50221.write_attribute_mem = mantis_ca_write_attr_mem; |
| 155 | ca->en50221.read_cam_control = mantis_ca_read_cam_ctl; |
| 156 | ca->en50221.write_cam_control = mantis_ca_write_cam_ctl; |
| 157 | ca->en50221.slot_reset = mantis_ca_slot_reset; |
| 158 | ca->en50221.slot_shutdown = mantis_ca_slot_shutdown; |
| 159 | ca->en50221.slot_ts_enable = mantis_ts_control; |
| 160 | ca->en50221.poll_slot_status = mantis_slot_status; |
| 161 | ca->en50221.data = ca; |
| 162 | |
Manu Abraham | 99b55b2 | 2009-12-04 05:34:44 -0300 | [diff] [blame] | 163 | mutex_init(&ca->ca_lock); |
| 164 | |
Manu Abraham | 42f541b | 2009-12-04 05:35:07 -0300 | [diff] [blame] | 165 | init_waitqueue_head(&ca->hif_data_wq); |
| 166 | init_waitqueue_head(&ca->hif_opdone_wq); |
| 167 | init_waitqueue_head(&ca->hif_write_wq); |
| 168 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 169 | dprintk(MANTIS_ERROR, 1, "Registering EN50221 device"); |
| 170 | result = dvb_ca_en50221_init(dvb_adapter, &ca->en50221, ca_flags, 1); |
| 171 | if (result != 0) { |
| 172 | dprintk(MANTIS_ERROR, 1, "EN50221: Initialization failed <%d>", result); |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 173 | goto err; |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 174 | } |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 175 | dprintk(MANTIS_ERROR, 1, "Registered EN50221 device"); |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 176 | mantis_evmgr_init(ca); |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 177 | return 0; |
Manu Abraham | 6053240 | 2009-12-04 05:11:14 -0300 | [diff] [blame] | 178 | err: |
| 179 | kfree(ca); |
| 180 | return result; |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 181 | } |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 182 | EXPORT_SYMBOL_GPL(mantis_ca_init); |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 183 | |
| 184 | void mantis_ca_exit(struct mantis_pci *mantis) |
| 185 | { |
| 186 | struct mantis_ca *ca = mantis->mantis_ca; |
Manu Abraham | 2133ffb | 2009-12-04 05:12:16 -0300 | [diff] [blame] | 187 | |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 188 | dprintk(MANTIS_DEBUG, 1, "Mantis CA exit"); |
Dan Carpenter | 1d6ca29 | 2012-12-02 06:43:13 -0300 | [diff] [blame] | 189 | if (!ca) |
| 190 | return; |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 191 | |
| 192 | mantis_evmgr_exit(ca); |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 193 | dprintk(MANTIS_ERROR, 1, "Unregistering EN50221 device"); |
Dan Carpenter | 1d6ca29 | 2012-12-02 06:43:13 -0300 | [diff] [blame] | 194 | dvb_ca_en50221_release(&ca->en50221); |
Manu Abraham | 50d8260 | 2009-12-04 05:06:38 -0300 | [diff] [blame] | 195 | |
| 196 | kfree(ca); |
| 197 | } |
Manu Abraham | b3b9614 | 2009-12-04 05:41:11 -0300 | [diff] [blame] | 198 | EXPORT_SYMBOL_GPL(mantis_ca_exit); |