Blame view

kernel/linux-rt-4.4.41/drivers/media/pci/mantis/mantis_pcmcia.c 3.44 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
  /*
  	Mantis PCI bridge driver
  
  	Copyright (C) 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 <linux/kernel.h>
  
  #include <linux/signal.h>
  #include <linux/sched.h>
  #include <linux/interrupt.h>
  #include <asm/io.h>
  
  #include "dmxdev.h"
  #include "dvbdev.h"
  #include "dvb_demux.h"
  #include "dvb_frontend.h"
  #include "dvb_net.h"
  
  #include "mantis_common.h"
  #include "mantis_link.h" /* temporary due to physical layer stuff */
  #include "mantis_reg.h"
  
  /*
   * If Slot state is already PLUG_IN event and we are called
   * again, definitely it is jitter alone
   */
  void mantis_event_cam_plugin(struct mantis_ca *ca)
  {
  	struct mantis_pci *mantis = ca->ca_priv;
  
  	u32 gpif_irqcfg;
  
  	if (ca->slot_state == MODULE_XTRACTED) {
  		dprintk(MANTIS_DEBUG, 1, "Event: CAM Plugged IN: Adapter(%d) Slot(0)", mantis->num);
  		udelay(50);
  		mmwrite(0xda000000, MANTIS_CARD_RESET);
  		gpif_irqcfg  = mmread(MANTIS_GPIF_IRQCFG);
  		gpif_irqcfg |= MANTIS_MASK_PLUGOUT;
  		gpif_irqcfg &= ~MANTIS_MASK_PLUGIN;
  		mmwrite(gpif_irqcfg, MANTIS_GPIF_IRQCFG);
  		udelay(500);
  		ca->slot_state = MODULE_INSERTED;
  	}
  	udelay(100);
  }
  
  /*
   * If Slot state is already UN_PLUG event and we are called
   * again, definitely it is jitter alone
   */
  void mantis_event_cam_unplug(struct mantis_ca *ca)
  {
  	struct mantis_pci *mantis = ca->ca_priv;
  
  	u32 gpif_irqcfg;
  
  	if (ca->slot_state == MODULE_INSERTED) {
  		dprintk(MANTIS_DEBUG, 1, "Event: CAM Unplugged: Adapter(%d) Slot(0)", mantis->num);
  		udelay(50);
  		mmwrite(0x00da0000, MANTIS_CARD_RESET);
  		gpif_irqcfg  = mmread(MANTIS_GPIF_IRQCFG);
  		gpif_irqcfg |= MANTIS_MASK_PLUGIN;
  		gpif_irqcfg &= ~MANTIS_MASK_PLUGOUT;
  		mmwrite(gpif_irqcfg, MANTIS_GPIF_IRQCFG);
  		udelay(500);
  		ca->slot_state = MODULE_XTRACTED;
  	}
  	udelay(100);
  }
  
  int mantis_pcmcia_init(struct mantis_ca *ca)
  {
  	struct mantis_pci *mantis = ca->ca_priv;
  
  	u32 gpif_stat, card_stat;
  
  	mantis_unmask_ints(mantis, MANTIS_INT_IRQ0);
  	gpif_stat = mmread(MANTIS_GPIF_STATUS);
  	card_stat = mmread(MANTIS_GPIF_IRQCFG);
  
  	if (gpif_stat & MANTIS_GPIF_DETSTAT) {
  		dprintk(MANTIS_DEBUG, 1, "CAM found on Adapter(%d) Slot(0)", mantis->num);
  		mmwrite(card_stat | MANTIS_MASK_PLUGOUT, MANTIS_GPIF_IRQCFG);
  		ca->slot_state = MODULE_INSERTED;
  		dvb_ca_en50221_camchange_irq(&ca->en50221,
  					     0,
  					     DVB_CA_EN50221_CAMCHANGE_INSERTED);
  	} else {
  		dprintk(MANTIS_DEBUG, 1, "Empty Slot on Adapter(%d) Slot(0)", mantis->num);
  		mmwrite(card_stat | MANTIS_MASK_PLUGIN, MANTIS_GPIF_IRQCFG);
  		ca->slot_state = MODULE_XTRACTED;
  		dvb_ca_en50221_camchange_irq(&ca->en50221,
  					     0,
  					     DVB_CA_EN50221_CAMCHANGE_REMOVED);
  	}
  
  	return 0;
  }
  
  void mantis_pcmcia_exit(struct mantis_ca *ca)
  {
  	struct mantis_pci *mantis = ca->ca_priv;
  
  	mmwrite(mmread(MANTIS_GPIF_STATUS) & (~MANTIS_CARD_PLUGOUT | ~MANTIS_CARD_PLUGIN), MANTIS_GPIF_STATUS);
  	mantis_mask_ints(mantis, MANTIS_INT_IRQ0);
  }