V4L/DVB (13754): [Mantis] CAM_CONTROL: Implement TS control
[deliverable/linux.git] / drivers / media / dvb / mantis / mantis_ca.c
1 /*
2 Mantis PCI bridge driver
3
4 Copyright (C) 2005, 2006 Manu Abraham (abraham.manu@gmail.com)
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 You should have received a copy of the GNU General Public License
17 along with this program; if not, write to the Free Software
18 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19 */
20
21 #include "mantis_common.h"
22 #include "mantis_link.h"
23 #include "mantis_hif.h"
24
25 static int mantis_ca_read_attr_mem(struct dvb_ca_en50221 *en50221, int slot, int addr)
26 {
27 struct mantis_ca *ca = en50221->data;
28 struct mantis_pci *mantis = ca->ca_priv;
29
30 dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Request Attribute Mem Read", slot);
31
32 if (slot != 0)
33 return -EINVAL;
34
35 return mantis_hif_read_mem(ca, addr);
36 }
37
38 static int mantis_ca_write_attr_mem(struct dvb_ca_en50221 *en50221, int slot, int addr, u8 data)
39 {
40 struct mantis_ca *ca = en50221->data;
41 struct mantis_pci *mantis = ca->ca_priv;
42
43 dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Request Attribute Mem Write", slot);
44
45 if (slot != 0)
46 return -EINVAL;
47
48 return mantis_hif_write_mem(ca, addr, data);
49 }
50
51 static int mantis_ca_read_cam_ctl(struct dvb_ca_en50221 *en50221, int slot, u8 addr)
52 {
53 struct mantis_ca *ca = en50221->data;
54 struct mantis_pci *mantis = ca->ca_priv;
55
56 dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Request CAM control Read", slot);
57
58 if (slot != 0)
59 return -EINVAL;
60
61 return mantis_hif_read_iom(ca, addr);
62 }
63
64 static int mantis_ca_write_cam_ctl(struct dvb_ca_en50221 *en50221, int slot, u8 addr, u8 data)
65 {
66 struct mantis_ca *ca = en50221->data;
67 struct mantis_pci *mantis = ca->ca_priv;
68
69 dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Request CAM control Write", slot);
70
71 if (slot != 0)
72 return -EINVAL;
73
74 return mantis_hif_write_iom(ca, addr, data);
75 }
76
77 static int mantis_ca_slot_reset(struct dvb_ca_en50221 *en50221, int slot)
78 {
79 struct mantis_ca *ca = en50221->data;
80 struct mantis_pci *mantis = ca->ca_priv;
81
82 dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Slot RESET", slot);
83 udelay(500); /* Wait.. */
84 mmwrite(0xda, MANTIS_PCMCIA_RESET); /* Leading edge assert */
85 udelay(500);
86 mmwrite(0x00, MANTIS_PCMCIA_RESET); /* Trailing edge deassert */
87 msleep(1000);
88
89 return 0;
90 }
91
92 static int mantis_ca_slot_shutdown(struct dvb_ca_en50221 *en50221, int slot)
93 {
94 struct mantis_ca *ca = en50221->data;
95 struct mantis_pci *mantis = ca->ca_priv;
96
97 dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Slot shutdown", slot);
98
99 return 0;
100 }
101
102 static int mantis_ts_control(struct dvb_ca_en50221 *en50221, int slot)
103 {
104 struct mantis_ca *ca = en50221->data;
105 struct mantis_pci *mantis = ca->ca_priv;
106
107 dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): TS control", slot);
108 mantis_set_direction(mantis, 1); /* Enable TS through CAM */
109
110 return 0;
111 }
112
113 static int mantis_slot_status(struct dvb_ca_en50221 *en50221, int slot, int open)
114 {
115 struct mantis_ca *ca = en50221->data;
116 struct mantis_pci *mantis = ca->ca_priv;
117
118 dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Poll Slot status", slot);
119
120 if (ca->slot_state == MODULE_INSERTED)
121 return DVB_CA_EN50221_POLL_CAM_PRESENT | DVB_CA_EN50221_POLL_CAM_READY;
122
123 return 0;
124 }
125
126 int mantis_ca_init(struct mantis_pci *mantis)
127 {
128 struct dvb_adapter *dvb_adapter = &mantis->dvb_adapter;
129 struct mantis_ca *ca;
130 int ca_flags = 0, result;
131
132 dprintk(verbose, MANTIS_DEBUG, 1, "Initializing Mantis CA");
133 if (!(ca = kzalloc(sizeof (struct mantis_ca), GFP_KERNEL))) {
134 dprintk(verbose, MANTIS_ERROR, 1, "Out of memory!, exiting ..");
135 result = -ENOMEM;
136 goto err;
137 }
138
139 ca->ca_priv = mantis;
140 mantis->mantis_ca = ca;
141
142 /* register CA interface */
143 ca->en50221.owner = THIS_MODULE;
144 ca->en50221.read_attribute_mem = mantis_ca_read_attr_mem;
145 ca->en50221.write_attribute_mem = mantis_ca_write_attr_mem;
146 ca->en50221.read_cam_control = mantis_ca_read_cam_ctl;
147 ca->en50221.write_cam_control = mantis_ca_write_cam_ctl;
148 ca->en50221.slot_reset = mantis_ca_slot_reset;
149 ca->en50221.slot_shutdown = mantis_ca_slot_shutdown;
150 ca->en50221.slot_ts_enable = mantis_ts_control;
151 ca->en50221.poll_slot_status = mantis_slot_status;
152 ca->en50221.data = ca;
153
154 dprintk(verbose, MANTIS_ERROR, 1, "Registering EN50221 device");
155 if ((result = dvb_ca_en50221_init(dvb_adapter, &ca->en50221, ca_flags, 1)) != 0) {
156 dprintk(verbose, MANTIS_ERROR, 1, "EN50221: Initialization failed");
157 goto err;
158 }
159 dprintk(verbose, MANTIS_ERROR, 1, "Registered EN50221 device");
160 mantis_evmgr_init(ca);
161 return 0;
162 err:
163 kfree(ca);
164 return result;
165 }
166
167 void mantis_ca_exit(struct mantis_pci *mantis)
168 {
169 struct mantis_ca *ca = mantis->mantis_ca;
170
171 dprintk(verbose, MANTIS_DEBUG, 1, "Mantis CA exit");
172
173 mantis_evmgr_exit(ca);
174 dprintk(verbose, MANTIS_ERROR, 1, "Unregistering EN50221 device");
175 dvb_ca_en50221_release(&ca->en50221);
176
177 kfree(ca);
178 }
This page took 0.059143 seconds and 5 git commands to generate.