mantis_ca.c 5.4 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/*
	Mantis PCI bridge driver

	Copyright (C) 2005, 2006 Manu Abraham (abraham.manu@gmail.com)

	This program is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation; either version 2 of the License, or
	(at your option) any later version.

	This program is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with this program; if not, write to the Free Software
	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*/

#include "mantis_common.h"
#include "mantis_link.h"
#include "mantis_hif.h"

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 29 30
	struct mantis_pci *mantis = ca->ca_priv;

	dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Request Attribute Mem Read", slot);
31 32 33 34 35

	if (slot != 0)
		return -EINVAL;

	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 42 43
	struct mantis_pci *mantis = ca->ca_priv;

	dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Request Attribute Mem Write", slot);
44 45 46 47 48

	if (slot != 0)
		return -EINVAL;

	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 55 56
	struct mantis_pci *mantis = ca->ca_priv;

	dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Request CAM control Read", slot);
57 58 59 60 61

	if (slot != 0)
		return -EINVAL;

	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 68 69
	struct mantis_pci *mantis = ca->ca_priv;

	dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Request CAM control Write", slot);
70

71 72
	if (slot != 0)
		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 80 81 82
	struct mantis_ca *ca = en50221->data;
	struct mantis_pci *mantis = ca->ca_priv;

	dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Slot RESET", slot);
83 84 85 86 87
	udelay(500); /* Wait.. */
	mmwrite(0xda, MANTIS_PCMCIA_RESET); /* Leading edge assert */
	udelay(500);
	mmwrite(0x00, MANTIS_PCMCIA_RESET); /* Trailing edge deassert */
	msleep(1000);
88
	dvb_ca_en50221_camready_irq(&ca->en50221, 0);
89

90 91
	return 0;
}
92

93 94
static int mantis_ca_slot_shutdown(struct dvb_ca_en50221 *en50221, int slot)
{
95 96 97 98 99
	struct mantis_ca *ca = en50221->data;
	struct mantis_pci *mantis = ca->ca_priv;

	dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Slot shutdown", slot);

100 101
	return 0;
}
102

103 104
static int mantis_ts_control(struct dvb_ca_en50221 *en50221, int slot)
{
105 106 107 108
	struct mantis_ca *ca = en50221->data;
	struct mantis_pci *mantis = ca->ca_priv;

	dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): TS control", slot);
109
	mantis_set_direction(mantis, 1); /* Enable TS through CAM */
110

111 112 113
	return 0;
}

114
static int mantis_slot_status(struct dvb_ca_en50221 *en50221, int slot, int open)
115
{
116
	struct mantis_ca *ca = en50221->data;
117 118 119
	struct mantis_pci *mantis = ca->ca_priv;

	dprintk(verbose, MANTIS_DEBUG, 1, "Slot(%d): Poll Slot status", slot);
120

121 122
	if (ca->slot_state == MODULE_INSERTED) {
		dprintk(verbose, MANTIS_DEBUG, 1, "CA Module present and ready");
123
		return DVB_CA_EN50221_POLL_CAM_PRESENT | DVB_CA_EN50221_POLL_CAM_READY;
124 125 126
	} else {
		dprintk(verbose, MANTIS_DEBUG, 1, "CA Module not present or not ready");
	}
127

128 129
	return 0;
}
130

131 132
int mantis_ca_init(struct mantis_pci *mantis)
{
133 134
	struct dvb_adapter *dvb_adapter = &mantis->dvb_adapter;
	struct mantis_ca *ca;
135
	int ca_flags = 0, result;
136

137
	dprintk(verbose, MANTIS_DEBUG, 1, "Initializing Mantis CA");
138 139
	if (!(ca = kzalloc(sizeof (struct mantis_ca), GFP_KERNEL))) {
		dprintk(verbose, MANTIS_ERROR, 1, "Out of memory!, exiting ..");
140 141
		result = -ENOMEM;
		goto err;
142 143 144
	}

	ca->ca_priv = mantis;
145
	mantis->mantis_ca = ca;
146 147 148
	ca_flags = DVB_CA_EN50221_FLAG_IRQ_CAMCHANGE	|
		   DVB_CA_EN50221_FLAG_IRQ_FR		|
		   DVB_CA_EN50221_FLAG_IRQ_DA;
149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165

	/* register CA interface */
	ca->en50221.owner		= THIS_MODULE;
	ca->en50221.read_attribute_mem	= mantis_ca_read_attr_mem;
	ca->en50221.write_attribute_mem	= mantis_ca_write_attr_mem;
	ca->en50221.read_cam_control	= mantis_ca_read_cam_ctl;
	ca->en50221.write_cam_control	= mantis_ca_write_cam_ctl;
	ca->en50221.slot_reset		= mantis_ca_slot_reset;
	ca->en50221.slot_shutdown	= mantis_ca_slot_shutdown;
	ca->en50221.slot_ts_enable	= mantis_ts_control;
	ca->en50221.poll_slot_status	= mantis_slot_status;
	ca->en50221.data		= ca;

	dprintk(verbose, MANTIS_ERROR, 1, "Registering EN50221 device");
	if ((result = dvb_ca_en50221_init(dvb_adapter, &ca->en50221, ca_flags, 1)) != 0) {
		dprintk(verbose, MANTIS_ERROR, 1, "EN50221: Initialization failed");
		goto err;
166
	}
167 168
	dprintk(verbose, MANTIS_ERROR, 1, "Registered EN50221 device");
	mantis_evmgr_init(ca);
169
	return 0;
170 171 172
err:
	kfree(ca);
	return result;
173 174 175 176 177
}

void mantis_ca_exit(struct mantis_pci *mantis)
{
	struct mantis_ca *ca = mantis->mantis_ca;
178 179

	dprintk(verbose, MANTIS_DEBUG, 1, "Mantis CA exit");
180 181

	mantis_evmgr_exit(ca);
182 183
	dprintk(verbose, MANTIS_ERROR, 1, "Unregistering EN50221 device");
	dvb_ca_en50221_release(&ca->en50221);
184 185 186

	kfree(ca);
}