]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* $Id: hscx.c,v 1.24.2.4 2004/01/24 20:47:23 keil Exp $ |
2 | * | |
3 | * HSCX specific routines | |
4 | * | |
5 | * Author Karsten Keil | |
6 | * Copyright by Karsten Keil <[email protected]> | |
475be4d8 | 7 | * |
1da177e4 LT |
8 | * This software may be used and distributed according to the terms |
9 | * of the GNU General Public License, incorporated herein by reference. | |
10 | * | |
11 | */ | |
12 | ||
13 | #include <linux/init.h> | |
14 | #include "hisax.h" | |
15 | #include "hscx.h" | |
16 | #include "isac.h" | |
17 | #include "isdnl1.h" | |
18 | #include <linux/interrupt.h> | |
5a0e3ad6 | 19 | #include <linux/slab.h> |
1da177e4 LT |
20 | |
21 | static char *HSCXVer[] = | |
22 | {"A1", "?1", "A2", "?3", "A3", "V2.1", "?6", "?7", | |
23 | "?8", "?9", "?10", "?11", "?12", "?13", "?14", "???"}; | |
24 | ||
25 | int | |
26 | HscxVersion(struct IsdnCardState *cs, char *s) | |
27 | { | |
28 | int verA, verB; | |
29 | ||
30 | verA = cs->BC_Read_Reg(cs, 0, HSCX_VSTR) & 0xf; | |
31 | verB = cs->BC_Read_Reg(cs, 1, HSCX_VSTR) & 0xf; | |
32 | printk(KERN_INFO "%s HSCX version A: %s B: %s\n", s, | |
33 | HSCXVer[verA], HSCXVer[verB]); | |
34 | if ((verA == 0) | (verA == 0xf) | (verB == 0) | (verB == 0xf)) | |
35 | return (1); | |
36 | else | |
37 | return (0); | |
38 | } | |
39 | ||
40 | void | |
41 | modehscx(struct BCState *bcs, int mode, int bc) | |
42 | { | |
43 | struct IsdnCardState *cs = bcs->cs; | |
44 | int hscx = bcs->hw.hscx.hscx; | |
45 | ||
46 | if (cs->debug & L1_DEB_HSCX) | |
47 | debugl1(cs, "hscx %c mode %d ichan %d", | |
48 | 'A' + hscx, mode, bc); | |
49 | bcs->mode = mode; | |
50 | bcs->channel = bc; | |
51 | cs->BC_Write_Reg(cs, hscx, HSCX_XAD1, 0xFF); | |
52 | cs->BC_Write_Reg(cs, hscx, HSCX_XAD2, 0xFF); | |
53 | cs->BC_Write_Reg(cs, hscx, HSCX_RAH2, 0xFF); | |
54 | cs->BC_Write_Reg(cs, hscx, HSCX_XBCH, 0x0); | |
55 | cs->BC_Write_Reg(cs, hscx, HSCX_RLCR, 0x0); | |
56 | cs->BC_Write_Reg(cs, hscx, HSCX_CCR1, | |
475be4d8 | 57 | test_bit(HW_IPAC, &cs->HW_Flags) ? 0x82 : 0x85); |
1da177e4 LT |
58 | cs->BC_Write_Reg(cs, hscx, HSCX_CCR2, 0x30); |
59 | cs->BC_Write_Reg(cs, hscx, HSCX_XCCR, 7); | |
60 | cs->BC_Write_Reg(cs, hscx, HSCX_RCCR, 7); | |
61 | ||
62 | /* Switch IOM 1 SSI */ | |
63 | if (test_bit(HW_IOM1, &cs->HW_Flags) && (hscx == 0)) | |
64 | bc = 1 - bc; | |
65 | ||
66 | if (bc == 0) { | |
67 | cs->BC_Write_Reg(cs, hscx, HSCX_TSAX, | |
475be4d8 | 68 | test_bit(HW_IOM1, &cs->HW_Flags) ? 0x7 : bcs->hw.hscx.tsaxr0); |
1da177e4 | 69 | cs->BC_Write_Reg(cs, hscx, HSCX_TSAR, |
475be4d8 | 70 | test_bit(HW_IOM1, &cs->HW_Flags) ? 0x7 : bcs->hw.hscx.tsaxr0); |
1da177e4 LT |
71 | } else { |
72 | cs->BC_Write_Reg(cs, hscx, HSCX_TSAX, bcs->hw.hscx.tsaxr1); | |
73 | cs->BC_Write_Reg(cs, hscx, HSCX_TSAR, bcs->hw.hscx.tsaxr1); | |
74 | } | |
75 | switch (mode) { | |
475be4d8 JP |
76 | case (L1_MODE_NULL): |
77 | cs->BC_Write_Reg(cs, hscx, HSCX_TSAX, 0x1f); | |
78 | cs->BC_Write_Reg(cs, hscx, HSCX_TSAR, 0x1f); | |
79 | cs->BC_Write_Reg(cs, hscx, HSCX_MODE, 0x84); | |
80 | break; | |
81 | case (L1_MODE_TRANS): | |
82 | cs->BC_Write_Reg(cs, hscx, HSCX_MODE, 0xe4); | |
83 | break; | |
84 | case (L1_MODE_HDLC): | |
85 | cs->BC_Write_Reg(cs, hscx, HSCX_CCR1, | |
86 | test_bit(HW_IPAC, &cs->HW_Flags) ? 0x8a : 0x8d); | |
87 | cs->BC_Write_Reg(cs, hscx, HSCX_MODE, 0x8c); | |
88 | break; | |
1da177e4 LT |
89 | } |
90 | if (mode) | |
91 | cs->BC_Write_Reg(cs, hscx, HSCX_CMDR, 0x41); | |
92 | cs->BC_Write_Reg(cs, hscx, HSCX_ISTA, 0x00); | |
93 | } | |
94 | ||
95 | void | |
96 | hscx_l2l1(struct PStack *st, int pr, void *arg) | |
97 | { | |
98 | struct BCState *bcs = st->l1.bcs; | |
99 | u_long flags; | |
100 | struct sk_buff *skb = arg; | |
101 | ||
102 | switch (pr) { | |
475be4d8 JP |
103 | case (PH_DATA | REQUEST): |
104 | spin_lock_irqsave(&bcs->cs->lock, flags); | |
105 | if (bcs->tx_skb) { | |
106 | skb_queue_tail(&bcs->squeue, skb); | |
107 | } else { | |
108 | bcs->tx_skb = skb; | |
109 | test_and_set_bit(BC_FLG_BUSY, &bcs->Flag); | |
110 | bcs->hw.hscx.count = 0; | |
111 | bcs->cs->BC_Send_Data(bcs); | |
112 | } | |
113 | spin_unlock_irqrestore(&bcs->cs->lock, flags); | |
114 | break; | |
115 | case (PH_PULL | INDICATION): | |
116 | spin_lock_irqsave(&bcs->cs->lock, flags); | |
117 | if (bcs->tx_skb) { | |
118 | printk(KERN_WARNING "hscx_l2l1: this shouldn't happen\n"); | |
119 | } else { | |
120 | test_and_set_bit(BC_FLG_BUSY, &bcs->Flag); | |
121 | bcs->tx_skb = skb; | |
122 | bcs->hw.hscx.count = 0; | |
123 | bcs->cs->BC_Send_Data(bcs); | |
124 | } | |
125 | spin_unlock_irqrestore(&bcs->cs->lock, flags); | |
126 | break; | |
127 | case (PH_PULL | REQUEST): | |
128 | if (!bcs->tx_skb) { | |
129 | test_and_clear_bit(FLG_L1_PULL_REQ, &st->l1.Flags); | |
130 | st->l1.l1l2(st, PH_PULL | CONFIRM, NULL); | |
131 | } else | |
132 | test_and_set_bit(FLG_L1_PULL_REQ, &st->l1.Flags); | |
133 | break; | |
134 | case (PH_ACTIVATE | REQUEST): | |
135 | spin_lock_irqsave(&bcs->cs->lock, flags); | |
136 | test_and_set_bit(BC_FLG_ACTIV, &bcs->Flag); | |
137 | modehscx(bcs, st->l1.mode, st->l1.bc); | |
138 | spin_unlock_irqrestore(&bcs->cs->lock, flags); | |
139 | l1_msg_b(st, pr, arg); | |
140 | break; | |
141 | case (PH_DEACTIVATE | REQUEST): | |
142 | l1_msg_b(st, pr, arg); | |
143 | break; | |
144 | case (PH_DEACTIVATE | CONFIRM): | |
145 | spin_lock_irqsave(&bcs->cs->lock, flags); | |
146 | test_and_clear_bit(BC_FLG_ACTIV, &bcs->Flag); | |
147 | test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag); | |
148 | modehscx(bcs, 0, st->l1.bc); | |
149 | spin_unlock_irqrestore(&bcs->cs->lock, flags); | |
150 | st->l1.l1l2(st, PH_DEACTIVATE | CONFIRM, NULL); | |
151 | break; | |
1da177e4 LT |
152 | } |
153 | } | |
154 | ||
672c3fd9 | 155 | static void |
1da177e4 LT |
156 | close_hscxstate(struct BCState *bcs) |
157 | { | |
158 | modehscx(bcs, 0, bcs->channel); | |
159 | if (test_and_clear_bit(BC_FLG_INIT, &bcs->Flag)) { | |
3c7208f2 JJ |
160 | kfree(bcs->hw.hscx.rcvbuf); |
161 | bcs->hw.hscx.rcvbuf = NULL; | |
162 | kfree(bcs->blog); | |
163 | bcs->blog = NULL; | |
1da177e4 LT |
164 | skb_queue_purge(&bcs->rqueue); |
165 | skb_queue_purge(&bcs->squeue); | |
166 | if (bcs->tx_skb) { | |
167 | dev_kfree_skb_any(bcs->tx_skb); | |
168 | bcs->tx_skb = NULL; | |
169 | test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag); | |
170 | } | |
171 | } | |
172 | } | |
173 | ||
174 | int | |
175 | open_hscxstate(struct IsdnCardState *cs, struct BCState *bcs) | |
176 | { | |
177 | if (!test_and_set_bit(BC_FLG_INIT, &bcs->Flag)) { | |
178 | if (!(bcs->hw.hscx.rcvbuf = kmalloc(HSCX_BUFMAX, GFP_ATOMIC))) { | |
179 | printk(KERN_WARNING | |
475be4d8 | 180 | "HiSax: No memory for hscx.rcvbuf\n"); |
1da177e4 LT |
181 | test_and_clear_bit(BC_FLG_INIT, &bcs->Flag); |
182 | return (1); | |
183 | } | |
184 | if (!(bcs->blog = kmalloc(MAX_BLOG_SPACE, GFP_ATOMIC))) { | |
185 | printk(KERN_WARNING | |
475be4d8 | 186 | "HiSax: No memory for bcs->blog\n"); |
1da177e4 LT |
187 | test_and_clear_bit(BC_FLG_INIT, &bcs->Flag); |
188 | kfree(bcs->hw.hscx.rcvbuf); | |
189 | bcs->hw.hscx.rcvbuf = NULL; | |
190 | return (2); | |
191 | } | |
192 | skb_queue_head_init(&bcs->rqueue); | |
193 | skb_queue_head_init(&bcs->squeue); | |
194 | } | |
195 | bcs->tx_skb = NULL; | |
196 | test_and_clear_bit(BC_FLG_BUSY, &bcs->Flag); | |
197 | bcs->event = 0; | |
198 | bcs->hw.hscx.rcvidx = 0; | |
199 | bcs->tx_cnt = 0; | |
200 | return (0); | |
201 | } | |
202 | ||
672c3fd9 | 203 | static int |
1da177e4 LT |
204 | setstack_hscx(struct PStack *st, struct BCState *bcs) |
205 | { | |
206 | bcs->channel = st->l1.bc; | |
207 | if (open_hscxstate(st->l1.hardware, bcs)) | |
208 | return (-1); | |
209 | st->l1.bcs = bcs; | |
210 | st->l2.l2l1 = hscx_l2l1; | |
211 | setstack_manager(st); | |
212 | bcs->st = st; | |
213 | setstack_l1_B(st); | |
214 | return (0); | |
215 | } | |
216 | ||
217 | void | |
218 | clear_pending_hscx_ints(struct IsdnCardState *cs) | |
219 | { | |
220 | int val, eval; | |
221 | ||
222 | val = cs->BC_Read_Reg(cs, 1, HSCX_ISTA); | |
223 | debugl1(cs, "HSCX B ISTA %x", val); | |
224 | if (val & 0x01) { | |
225 | eval = cs->BC_Read_Reg(cs, 1, HSCX_EXIR); | |
226 | debugl1(cs, "HSCX B EXIR %x", eval); | |
227 | } | |
228 | if (val & 0x02) { | |
229 | eval = cs->BC_Read_Reg(cs, 0, HSCX_EXIR); | |
230 | debugl1(cs, "HSCX A EXIR %x", eval); | |
231 | } | |
232 | val = cs->BC_Read_Reg(cs, 0, HSCX_ISTA); | |
233 | debugl1(cs, "HSCX A ISTA %x", val); | |
234 | val = cs->BC_Read_Reg(cs, 1, HSCX_STAR); | |
235 | debugl1(cs, "HSCX B STAR %x", val); | |
236 | val = cs->BC_Read_Reg(cs, 0, HSCX_STAR); | |
237 | debugl1(cs, "HSCX A STAR %x", val); | |
238 | /* disable all IRQ */ | |
239 | cs->BC_Write_Reg(cs, 0, HSCX_MASK, 0xFF); | |
240 | cs->BC_Write_Reg(cs, 1, HSCX_MASK, 0xFF); | |
241 | } | |
242 | ||
243 | void | |
244 | inithscx(struct IsdnCardState *cs) | |
245 | { | |
246 | cs->bcs[0].BC_SetStack = setstack_hscx; | |
247 | cs->bcs[1].BC_SetStack = setstack_hscx; | |
248 | cs->bcs[0].BC_Close = close_hscxstate; | |
249 | cs->bcs[1].BC_Close = close_hscxstate; | |
250 | cs->bcs[0].hw.hscx.hscx = 0; | |
251 | cs->bcs[1].hw.hscx.hscx = 1; | |
252 | cs->bcs[0].hw.hscx.tsaxr0 = 0x2f; | |
253 | cs->bcs[0].hw.hscx.tsaxr1 = 3; | |
254 | cs->bcs[1].hw.hscx.tsaxr0 = 0x2f; | |
255 | cs->bcs[1].hw.hscx.tsaxr1 = 3; | |
256 | modehscx(cs->bcs, 0, 0); | |
257 | modehscx(cs->bcs + 1, 0, 0); | |
258 | } | |
259 | ||
260 | void | |
261 | inithscxisac(struct IsdnCardState *cs, int part) | |
262 | { | |
263 | if (part & 1) { | |
264 | clear_pending_isac_ints(cs); | |
265 | clear_pending_hscx_ints(cs); | |
266 | initisac(cs); | |
267 | inithscx(cs); | |
268 | } | |
269 | if (part & 2) { | |
270 | /* Reenable all IRQ */ | |
271 | cs->writeisac(cs, ISAC_MASK, 0); | |
272 | cs->BC_Write_Reg(cs, 0, HSCX_MASK, 0); | |
273 | cs->BC_Write_Reg(cs, 1, HSCX_MASK, 0); | |
274 | /* RESET Receiver and Transmitter */ | |
275 | cs->writeisac(cs, ISAC_CMDR, 0x41); | |
276 | } | |
277 | } |