diff options
Diffstat (limited to 'drivers/net/wan/wanpipe_multppp.c')
-rw-r--r-- | drivers/net/wan/wanpipe_multppp.c | 2358 |
1 files changed, 0 insertions, 2358 deletions
diff --git a/drivers/net/wan/wanpipe_multppp.c b/drivers/net/wan/wanpipe_multppp.c deleted file mode 100644 index 812a1183c502..000000000000 --- a/drivers/net/wan/wanpipe_multppp.c +++ /dev/null | |||
@@ -1,2358 +0,0 @@ | |||
1 | /***************************************************************************** | ||
2 | * wanpipe_multppp.c Multi-Port PPP driver module. | ||
3 | * | ||
4 | * Authors: Nenad Corbic <ncorbic@sangoma.com> | ||
5 | * | ||
6 | * Copyright: (c) 1995-2001 Sangoma Technologies Inc. | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or | ||
9 | * modify it under the terms of the GNU General Public License | ||
10 | * as published by the Free Software Foundation; either version | ||
11 | * 2 of the License, or (at your option) any later version. | ||
12 | * ============================================================================ | ||
13 | * Dec 15 2000 Updated for 2.4.X kernel | ||
14 | * Nov 15 2000 Fixed the SyncPPP support for kernels 2.2.16 and higher. | ||
15 | * The pppstruct has changed. | ||
16 | * Jul 13 2000 Using the kernel Syncppp module on top of RAW Wanpipe CHDLC | ||
17 | * module. | ||
18 | *****************************************************************************/ | ||
19 | |||
20 | #include <linux/module.h> | ||
21 | #include <linux/kernel.h> /* printk(), and other useful stuff */ | ||
22 | #include <linux/stddef.h> /* offsetof(), etc. */ | ||
23 | #include <linux/errno.h> /* return codes */ | ||
24 | #include <linux/string.h> /* inline memset(), etc. */ | ||
25 | #include <linux/slab.h> /* kmalloc(), kfree() */ | ||
26 | #include <linux/wanrouter.h> /* WAN router definitions */ | ||
27 | #include <linux/wanpipe.h> /* WANPIPE common user API definitions */ | ||
28 | #include <linux/if_arp.h> /* ARPHRD_* defines */ | ||
29 | #include <linux/jiffies.h> /* time_after() macro */ | ||
30 | |||
31 | #include <linux/in.h> /* sockaddr_in */ | ||
32 | #include <linux/inet.h> | ||
33 | #include <linux/if.h> | ||
34 | #include <asm/byteorder.h> /* htons(), etc. */ | ||
35 | #include <linux/sdlapci.h> | ||
36 | #include <asm/io.h> | ||
37 | |||
38 | #include <linux/sdla_chdlc.h> /* CHDLC firmware API definitions */ | ||
39 | #include <linux/sdla_asy.h> /* CHDLC (async) API definitions */ | ||
40 | |||
41 | #include <linux/if_wanpipe_common.h> /* Socket Driver common area */ | ||
42 | #include <linux/if_wanpipe.h> | ||
43 | |||
44 | |||
45 | #include <linux/inetdevice.h> | ||
46 | #include <asm/uaccess.h> | ||
47 | |||
48 | #include <net/syncppp.h> | ||
49 | |||
50 | |||
51 | /****** Defines & Macros ****************************************************/ | ||
52 | |||
53 | #ifdef _DEBUG_ | ||
54 | #define STATIC | ||
55 | #else | ||
56 | #define STATIC static | ||
57 | #endif | ||
58 | |||
59 | /* reasons for enabling the timer interrupt on the adapter */ | ||
60 | #define TMR_INT_ENABLED_UDP 0x01 | ||
61 | #define TMR_INT_ENABLED_UPDATE 0x02 | ||
62 | #define TMR_INT_ENABLED_CONFIG 0x04 | ||
63 | |||
64 | #define CHDLC_DFLT_DATA_LEN 1500 /* default MTU */ | ||
65 | #define CHDLC_HDR_LEN 1 | ||
66 | |||
67 | #define IFF_POINTTOPOINT 0x10 | ||
68 | |||
69 | #define CHDLC_API 0x01 | ||
70 | |||
71 | #define PORT(x) (x == 0 ? "PRIMARY" : "SECONDARY" ) | ||
72 | #define MAX_BH_BUFF 10 | ||
73 | |||
74 | #define CRC_LENGTH 2 | ||
75 | #define PPP_HEADER_LEN 4 | ||
76 | |||
77 | /******Data Structures*****************************************************/ | ||
78 | |||
79 | /* This structure is placed in the private data area of the device structure. | ||
80 | * The card structure used to occupy the private area but now the following | ||
81 | * structure will incorporate the card structure along with CHDLC specific data | ||
82 | */ | ||
83 | |||
84 | typedef struct chdlc_private_area | ||
85 | { | ||
86 | void *if_ptr; /* General Pointer used by SPPP */ | ||
87 | wanpipe_common_t common; | ||
88 | sdla_t *card; | ||
89 | int TracingEnabled; /* For enabling Tracing */ | ||
90 | unsigned long curr_trace_addr; /* Used for Tracing */ | ||
91 | unsigned long start_trace_addr; | ||
92 | unsigned long end_trace_addr; | ||
93 | unsigned long base_addr_trace_buffer; | ||
94 | unsigned long end_addr_trace_buffer; | ||
95 | unsigned short number_trace_elements; | ||
96 | unsigned available_buffer_space; | ||
97 | unsigned long router_start_time; | ||
98 | unsigned char route_status; | ||
99 | unsigned char route_removed; | ||
100 | unsigned long tick_counter; /* For 5s timeout counter */ | ||
101 | unsigned long router_up_time; | ||
102 | u32 IP_address; /* IP addressing */ | ||
103 | u32 IP_netmask; | ||
104 | unsigned char mc; /* Mulitcast support on/off */ | ||
105 | unsigned short udp_pkt_lgth; /* udp packet processing */ | ||
106 | char udp_pkt_src; | ||
107 | char udp_pkt_data[MAX_LGTH_UDP_MGNT_PKT]; | ||
108 | unsigned short timer_int_enabled; | ||
109 | char update_comms_stats; /* updating comms stats */ | ||
110 | |||
111 | //FIXME: add driver stats as per frame relay! | ||
112 | |||
113 | } chdlc_private_area_t; | ||
114 | |||
115 | /* Route Status options */ | ||
116 | #define NO_ROUTE 0x00 | ||
117 | #define ADD_ROUTE 0x01 | ||
118 | #define ROUTE_ADDED 0x02 | ||
119 | #define REMOVE_ROUTE 0x03 | ||
120 | |||
121 | |||
122 | /* variable for keeping track of enabling/disabling FT1 monitor status */ | ||
123 | static int rCount = 0; | ||
124 | |||
125 | /* variable for tracking how many interfaces to open for WANPIPE on the | ||
126 | two ports */ | ||
127 | |||
128 | extern void disable_irq(unsigned int); | ||
129 | extern void enable_irq(unsigned int); | ||
130 | |||
131 | /****** Function Prototypes *************************************************/ | ||
132 | /* WAN link driver entry points. These are called by the WAN router module. */ | ||
133 | static int update(struct wan_device* wandev); | ||
134 | static int new_if(struct wan_device* wandev, struct net_device* dev, | ||
135 | wanif_conf_t* conf); | ||
136 | static int del_if(struct wan_device* wandev, struct net_device* dev); | ||
137 | |||
138 | /* Network device interface */ | ||
139 | static int if_init(struct net_device* dev); | ||
140 | static int if_open(struct net_device* dev); | ||
141 | static int if_close(struct net_device* dev); | ||
142 | static int if_send(struct sk_buff* skb, struct net_device* dev); | ||
143 | static struct net_device_stats* if_stats(struct net_device* dev); | ||
144 | |||
145 | static void if_tx_timeout(struct net_device *dev); | ||
146 | |||
147 | /* CHDLC Firmware interface functions */ | ||
148 | static int chdlc_configure (sdla_t* card, void* data); | ||
149 | static int chdlc_comm_enable (sdla_t* card); | ||
150 | static int chdlc_comm_disable (sdla_t* card); | ||
151 | static int chdlc_read_version (sdla_t* card, char* str); | ||
152 | static int chdlc_set_intr_mode (sdla_t* card, unsigned mode); | ||
153 | static int chdlc_send (sdla_t* card, void* data, unsigned len); | ||
154 | static int chdlc_read_comm_err_stats (sdla_t* card); | ||
155 | static int chdlc_read_op_stats (sdla_t* card); | ||
156 | static int config_chdlc (sdla_t *card); | ||
157 | |||
158 | |||
159 | /* Miscellaneous CHDLC Functions */ | ||
160 | static int set_chdlc_config (sdla_t* card); | ||
161 | static void init_chdlc_tx_rx_buff(sdla_t* card, struct net_device *dev); | ||
162 | static int chdlc_error (sdla_t *card, int err, CHDLC_MAILBOX_STRUCT *mb); | ||
163 | static int process_chdlc_exception(sdla_t *card); | ||
164 | static int process_global_exception(sdla_t *card); | ||
165 | static int update_comms_stats(sdla_t* card, | ||
166 | chdlc_private_area_t* chdlc_priv_area); | ||
167 | static void port_set_state (sdla_t *card, int); | ||
168 | |||
169 | /* Interrupt handlers */ | ||
170 | static void wsppp_isr (sdla_t* card); | ||
171 | static void rx_intr (sdla_t* card); | ||
172 | static void timer_intr(sdla_t *); | ||
173 | |||
174 | /* Miscellaneous functions */ | ||
175 | static int reply_udp( unsigned char *data, unsigned int mbox_len ); | ||
176 | static int intr_test( sdla_t* card); | ||
177 | static int udp_pkt_type( struct sk_buff *skb , sdla_t* card); | ||
178 | static int store_udp_mgmt_pkt(char udp_pkt_src, sdla_t* card, | ||
179 | struct sk_buff *skb, struct net_device* dev, | ||
180 | chdlc_private_area_t* chdlc_priv_area); | ||
181 | static int process_udp_mgmt_pkt(sdla_t* card, struct net_device* dev, | ||
182 | chdlc_private_area_t* chdlc_priv_area); | ||
183 | static unsigned short calc_checksum (char *, int); | ||
184 | static void s508_lock (sdla_t *card, unsigned long *smp_flags); | ||
185 | static void s508_unlock (sdla_t *card, unsigned long *smp_flags); | ||
186 | static void send_ppp_term_request(struct net_device *dev); | ||
187 | |||
188 | |||
189 | static int Intr_test_counter; | ||
190 | /****** Public Functions ****************************************************/ | ||
191 | |||
192 | /*============================================================================ | ||
193 | * Cisco HDLC protocol initialization routine. | ||
194 | * | ||
195 | * This routine is called by the main WANPIPE module during setup. At this | ||
196 | * point adapter is completely initialized and firmware is running. | ||
197 | * o read firmware version (to make sure it's alive) | ||
198 | * o configure adapter | ||
199 | * o initialize protocol-specific fields of the adapter data space. | ||
200 | * | ||
201 | * Return: 0 o.k. | ||
202 | * < 0 failure. | ||
203 | */ | ||
204 | int wsppp_init (sdla_t* card, wandev_conf_t* conf) | ||
205 | { | ||
206 | unsigned char port_num; | ||
207 | int err; | ||
208 | unsigned long max_permitted_baud = 0; | ||
209 | SHARED_MEMORY_INFO_STRUCT *flags; | ||
210 | |||
211 | union | ||
212 | { | ||
213 | char str[80]; | ||
214 | } u; | ||
215 | volatile CHDLC_MAILBOX_STRUCT* mb; | ||
216 | CHDLC_MAILBOX_STRUCT* mb1; | ||
217 | unsigned long timeout; | ||
218 | |||
219 | /* Verify configuration ID */ | ||
220 | if (conf->config_id != WANCONFIG_MPPP) { | ||
221 | printk(KERN_INFO "%s: invalid configuration ID %u!\n", | ||
222 | card->devname, conf->config_id); | ||
223 | return -EINVAL; | ||
224 | } | ||
225 | |||
226 | /* Find out which Port to use */ | ||
227 | if ((conf->comm_port == WANOPT_PRI) || (conf->comm_port == WANOPT_SEC)){ | ||
228 | if (card->next){ | ||
229 | |||
230 | if (conf->comm_port != card->next->u.c.comm_port){ | ||
231 | card->u.c.comm_port = conf->comm_port; | ||
232 | }else{ | ||
233 | printk(KERN_ERR "%s: ERROR - %s port used!\n", | ||
234 | card->wandev.name, PORT(conf->comm_port)); | ||
235 | return -EINVAL; | ||
236 | } | ||
237 | }else{ | ||
238 | card->u.c.comm_port = conf->comm_port; | ||
239 | } | ||
240 | }else{ | ||
241 | printk(KERN_ERR "%s: ERROR - Invalid Port Selected!\n", | ||
242 | card->wandev.name); | ||
243 | return -EINVAL; | ||
244 | } | ||
245 | |||
246 | |||
247 | /* Initialize protocol-specific fields */ | ||
248 | if(card->hw.type != SDLA_S514){ | ||
249 | |||
250 | if (card->u.c.comm_port == WANOPT_PRI){ | ||
251 | card->mbox = (void *) card->hw.dpmbase; | ||
252 | }else{ | ||
253 | card->mbox = (void *) card->hw.dpmbase + | ||
254 | SEC_BASE_ADDR_MB_STRUCT - PRI_BASE_ADDR_MB_STRUCT; | ||
255 | } | ||
256 | }else{ | ||
257 | /* for a S514 adapter, set a pointer to the actual mailbox in the */ | ||
258 | /* allocated virtual memory area */ | ||
259 | if (card->u.c.comm_port == WANOPT_PRI){ | ||
260 | card->mbox = (void *) card->hw.dpmbase + PRI_BASE_ADDR_MB_STRUCT; | ||
261 | }else{ | ||
262 | card->mbox = (void *) card->hw.dpmbase + SEC_BASE_ADDR_MB_STRUCT; | ||
263 | } | ||
264 | } | ||
265 | |||
266 | mb = mb1 = card->mbox; | ||
267 | |||
268 | if (!card->configured){ | ||
269 | |||
270 | /* The board will place an 'I' in the return code to indicate that it is | ||
271 | ready to accept commands. We expect this to be completed in less | ||
272 | than 1 second. */ | ||
273 | |||
274 | timeout = jiffies + 1 * HZ; | ||
275 | while (mb->return_code != 'I') /* Wait 1s for board to initialize */ | ||
276 | if (time_after(jiffies, timeout)) break; | ||
277 | |||
278 | if (mb->return_code != 'I') { | ||
279 | printk(KERN_INFO | ||
280 | "%s: Initialization not completed by adapter\n", | ||
281 | card->devname); | ||
282 | printk(KERN_INFO "Please contact Sangoma representative.\n"); | ||
283 | return -EIO; | ||
284 | } | ||
285 | } | ||
286 | |||
287 | /* Read firmware version. Note that when adapter initializes, it | ||
288 | * clears the mailbox, so it may appear that the first command was | ||
289 | * executed successfully when in fact it was merely erased. To work | ||
290 | * around this, we execute the first command twice. | ||
291 | */ | ||
292 | |||
293 | if (chdlc_read_version(card, u.str)) | ||
294 | return -EIO; | ||
295 | |||
296 | printk(KERN_INFO "%s: Running Raw CHDLC firmware v%s\n" | ||
297 | "%s: for Multi-Port PPP protocol.\n", | ||
298 | card->devname,u.str,card->devname); | ||
299 | |||
300 | card->isr = &wsppp_isr; | ||
301 | card->poll = NULL; | ||
302 | card->exec = NULL; | ||
303 | card->wandev.update = &update; | ||
304 | card->wandev.new_if = &new_if; | ||
305 | card->wandev.del_if = &del_if; | ||
306 | card->wandev.udp_port = conf->udp_port; | ||
307 | |||
308 | card->wandev.new_if_cnt = 0; | ||
309 | |||
310 | /* reset the number of times the 'update()' proc has been called */ | ||
311 | card->u.c.update_call_count = 0; | ||
312 | |||
313 | card->wandev.ttl = conf->ttl; | ||
314 | card->wandev.interface = conf->interface; | ||
315 | |||
316 | if ((card->u.c.comm_port == WANOPT_SEC && conf->interface == WANOPT_V35)&& | ||
317 | card->hw.type != SDLA_S514){ | ||
318 | printk(KERN_INFO "%s: ERROR - V35 Interface not supported on S508 %s port \n", | ||
319 | card->devname, PORT(card->u.c.comm_port)); | ||
320 | return -EIO; | ||
321 | } | ||
322 | |||
323 | |||
324 | card->wandev.clocking = conf->clocking; | ||
325 | |||
326 | port_num = card->u.c.comm_port; | ||
327 | |||
328 | /* Setup Port Bps */ | ||
329 | |||
330 | if(card->wandev.clocking) { | ||
331 | if((port_num == WANOPT_PRI) || card->u.c.receive_only) { | ||
332 | /* For Primary Port 0 */ | ||
333 | max_permitted_baud = | ||
334 | (card->hw.type == SDLA_S514) ? | ||
335 | PRI_MAX_BAUD_RATE_S514 : | ||
336 | PRI_MAX_BAUD_RATE_S508; | ||
337 | } | ||
338 | else if(port_num == WANOPT_SEC) { | ||
339 | /* For Secondary Port 1 */ | ||
340 | max_permitted_baud = | ||
341 | (card->hw.type == SDLA_S514) ? | ||
342 | SEC_MAX_BAUD_RATE_S514 : | ||
343 | SEC_MAX_BAUD_RATE_S508; | ||
344 | } | ||
345 | |||
346 | if(conf->bps > max_permitted_baud) { | ||
347 | conf->bps = max_permitted_baud; | ||
348 | printk(KERN_INFO "%s: Baud too high!\n", | ||
349 | card->wandev.name); | ||
350 | printk(KERN_INFO "%s: Baud rate set to %lu bps\n", | ||
351 | card->wandev.name, max_permitted_baud); | ||
352 | } | ||
353 | |||
354 | card->wandev.bps = conf->bps; | ||
355 | }else{ | ||
356 | card->wandev.bps = 0; | ||
357 | } | ||
358 | |||
359 | /* Setup the Port MTU */ | ||
360 | if((port_num == WANOPT_PRI) || card->u.c.receive_only) { | ||
361 | |||
362 | /* For Primary Port 0 */ | ||
363 | card->wandev.mtu = | ||
364 | (conf->mtu >= MIN_LGTH_CHDLC_DATA_CFG) ? | ||
365 | min_t(unsigned int, conf->mtu, PRI_MAX_NO_DATA_BYTES_IN_FRAME) : | ||
366 | CHDLC_DFLT_DATA_LEN; | ||
367 | } else if(port_num == WANOPT_SEC) { | ||
368 | /* For Secondary Port 1 */ | ||
369 | card->wandev.mtu = | ||
370 | (conf->mtu >= MIN_LGTH_CHDLC_DATA_CFG) ? | ||
371 | min_t(unsigned int, conf->mtu, SEC_MAX_NO_DATA_BYTES_IN_FRAME) : | ||
372 | CHDLC_DFLT_DATA_LEN; | ||
373 | } | ||
374 | |||
375 | /* Add on a PPP Header */ | ||
376 | card->wandev.mtu += PPP_HEADER_LEN; | ||
377 | |||
378 | /* Set up the interrupt status area */ | ||
379 | /* Read the CHDLC Configuration and obtain: | ||
380 | * Ptr to shared memory infor struct | ||
381 | * Use this pointer to calculate the value of card->u.c.flags ! | ||
382 | */ | ||
383 | mb1->buffer_length = 0; | ||
384 | mb1->command = READ_CHDLC_CONFIGURATION; | ||
385 | err = sdla_exec(mb1) ? mb1->return_code : CMD_TIMEOUT; | ||
386 | if(err != COMMAND_OK) { | ||
387 | clear_bit(1, (void*)&card->wandev.critical); | ||
388 | |||
389 | if(card->hw.type != SDLA_S514) | ||
390 | enable_irq(card->hw.irq); | ||
391 | |||
392 | chdlc_error(card, err, mb1); | ||
393 | return -EIO; | ||
394 | } | ||
395 | |||
396 | if(card->hw.type == SDLA_S514){ | ||
397 | card->u.c.flags = (void *)(card->hw.dpmbase + | ||
398 | (((CHDLC_CONFIGURATION_STRUCT *)mb1->data)-> | ||
399 | ptr_shared_mem_info_struct)); | ||
400 | }else{ | ||
401 | card->u.c.flags = (void *)(card->hw.dpmbase + | ||
402 | (((CHDLC_CONFIGURATION_STRUCT *)mb1->data)-> | ||
403 | ptr_shared_mem_info_struct % SDLA_WINDOWSIZE)); | ||
404 | } | ||
405 | |||
406 | flags = card->u.c.flags; | ||
407 | |||
408 | /* This is for the ports link state */ | ||
409 | card->wandev.state = WAN_DUALPORT; | ||
410 | card->u.c.state = WAN_DISCONNECTED; | ||
411 | |||
412 | |||
413 | if (!card->wandev.piggyback){ | ||
414 | err = intr_test(card); | ||
415 | |||
416 | if(err || (Intr_test_counter < MAX_INTR_TEST_COUNTER)) { | ||
417 | printk(KERN_ERR "%s: Interrupt test failed (%i)\n", | ||
418 | card->devname, Intr_test_counter); | ||
419 | printk(KERN_ERR "%s: Please choose another interrupt\n", | ||
420 | card->devname); | ||
421 | return -EIO; | ||
422 | } | ||
423 | |||
424 | printk(KERN_INFO "%s: Interrupt test passed (%i)\n", | ||
425 | card->devname, Intr_test_counter); | ||
426 | } | ||
427 | |||
428 | |||
429 | if (chdlc_set_intr_mode(card, APP_INT_ON_TIMER)){ | ||
430 | printk (KERN_INFO "%s: Failed to set interrupt triggers!\n", | ||
431 | card->devname); | ||
432 | return -EIO; | ||
433 | } | ||
434 | |||
435 | /* Mask the Timer interrupt */ | ||
436 | flags->interrupt_info_struct.interrupt_permission &= | ||
437 | ~APP_INT_ON_TIMER; | ||
438 | |||
439 | printk(KERN_INFO "\n"); | ||
440 | |||
441 | return 0; | ||
442 | } | ||
443 | |||
444 | /******* WAN Device Driver Entry Points *************************************/ | ||
445 | |||
446 | /*============================================================================ | ||
447 | * Update device status & statistics | ||
448 | * This procedure is called when updating the PROC file system and returns | ||
449 | * various communications statistics. These statistics are accumulated from 3 | ||
450 | * different locations: | ||
451 | * 1) The 'if_stats' recorded for the device. | ||
452 | * 2) Communication error statistics on the adapter. | ||
453 | * 3) CHDLC operational statistics on the adapter. | ||
454 | * The board level statistics are read during a timer interrupt. Note that we | ||
455 | * read the error and operational statistics during consecitive timer ticks so | ||
456 | * as to minimize the time that we are inside the interrupt handler. | ||
457 | * | ||
458 | */ | ||
459 | static int update(struct wan_device* wandev) | ||
460 | { | ||
461 | sdla_t* card = wandev->private; | ||
462 | struct net_device* dev; | ||
463 | volatile chdlc_private_area_t* chdlc_priv_area; | ||
464 | SHARED_MEMORY_INFO_STRUCT *flags; | ||
465 | unsigned long timeout; | ||
466 | |||
467 | /* sanity checks */ | ||
468 | if((wandev == NULL) || (wandev->private == NULL)) | ||
469 | return -EFAULT; | ||
470 | |||
471 | if(wandev->state == WAN_UNCONFIGURED) | ||
472 | return -ENODEV; | ||
473 | |||
474 | /* more sanity checks */ | ||
475 | if(!card->u.c.flags) | ||
476 | return -ENODEV; | ||
477 | |||
478 | if((dev=card->wandev.dev) == NULL) | ||
479 | return -ENODEV; | ||
480 | |||
481 | if((chdlc_priv_area=dev->priv) == NULL) | ||
482 | return -ENODEV; | ||
483 | |||
484 | flags = card->u.c.flags; | ||
485 | |||
486 | if(chdlc_priv_area->update_comms_stats){ | ||
487 | return -EAGAIN; | ||
488 | } | ||
489 | |||
490 | /* we will need 2 timer interrupts to complete the */ | ||
491 | /* reading of the statistics */ | ||
492 | chdlc_priv_area->update_comms_stats = 2; | ||
493 | flags->interrupt_info_struct.interrupt_permission |= APP_INT_ON_TIMER; | ||
494 | chdlc_priv_area->timer_int_enabled = TMR_INT_ENABLED_UPDATE; | ||
495 | |||
496 | /* wait a maximum of 1 second for the statistics to be updated */ | ||
497 | timeout = jiffies + 1 * HZ; | ||
498 | for(;;) { | ||
499 | if(chdlc_priv_area->update_comms_stats == 0) | ||
500 | break; | ||
501 | if (time_after(jiffies, timeout)){ | ||
502 | chdlc_priv_area->update_comms_stats = 0; | ||
503 | chdlc_priv_area->timer_int_enabled &= | ||
504 | ~TMR_INT_ENABLED_UPDATE; | ||
505 | return -EAGAIN; | ||
506 | } | ||
507 | } | ||
508 | |||
509 | return 0; | ||
510 | } | ||
511 | |||
512 | |||
513 | /*============================================================================ | ||
514 | * Create new logical channel. | ||
515 | * This routine is called by the router when ROUTER_IFNEW IOCTL is being | ||
516 | * handled. | ||
517 | * o parse media- and hardware-specific configuration | ||
518 | * o make sure that a new channel can be created | ||
519 | * o allocate resources, if necessary | ||
520 | * o prepare network device structure for registaration. | ||
521 | * | ||
522 | * Return: 0 o.k. | ||
523 | * < 0 failure (channel will not be created) | ||
524 | */ | ||
525 | static int new_if(struct wan_device* wandev, struct net_device* pdev, | ||
526 | wanif_conf_t* conf) | ||
527 | { | ||
528 | |||
529 | struct ppp_device *pppdev = (struct ppp_device *)pdev; | ||
530 | struct net_device *dev = NULL; | ||
531 | struct sppp *sp; | ||
532 | sdla_t* card = wandev->private; | ||
533 | chdlc_private_area_t* chdlc_priv_area; | ||
534 | |||
535 | if ((conf->name[0] == '\0') || (strlen(conf->name) > WAN_IFNAME_SZ)) { | ||
536 | printk(KERN_INFO "%s: invalid interface name!\n", | ||
537 | card->devname); | ||
538 | return -EINVAL; | ||
539 | } | ||
540 | |||
541 | /* allocate and initialize private data */ | ||
542 | chdlc_priv_area = kmalloc(sizeof(chdlc_private_area_t), GFP_KERNEL); | ||
543 | |||
544 | if(chdlc_priv_area == NULL) | ||
545 | return -ENOMEM; | ||
546 | |||
547 | memset(chdlc_priv_area, 0, sizeof(chdlc_private_area_t)); | ||
548 | |||
549 | chdlc_priv_area->card = card; | ||
550 | |||
551 | /* initialize data */ | ||
552 | strcpy(card->u.c.if_name, conf->name); | ||
553 | |||
554 | if(card->wandev.new_if_cnt > 0) { | ||
555 | kfree(chdlc_priv_area); | ||
556 | return -EEXIST; | ||
557 | } | ||
558 | |||
559 | card->wandev.new_if_cnt++; | ||
560 | |||
561 | chdlc_priv_area->TracingEnabled = 0; | ||
562 | |||
563 | //We don't need this any more | ||
564 | chdlc_priv_area->route_status = NO_ROUTE; | ||
565 | chdlc_priv_area->route_removed = 0; | ||
566 | |||
567 | printk(KERN_INFO "%s: Firmware running in HDLC STREAMING Mode\n", | ||
568 | wandev->name); | ||
569 | |||
570 | /* Setup wanpipe as a router (WANPIPE) or as an API */ | ||
571 | if( strcmp(conf->usedby, "WANPIPE") == 0) { | ||
572 | printk(KERN_INFO "%s: Driver running in WANPIPE mode!\n", | ||
573 | wandev->name); | ||
574 | card->u.c.usedby = WANPIPE; | ||
575 | } else { | ||
576 | printk(KERN_INFO | ||
577 | "%s: API Mode is not supported for SyncPPP!\n", | ||
578 | wandev->name); | ||
579 | kfree(chdlc_priv_area); | ||
580 | return -EINVAL; | ||
581 | } | ||
582 | |||
583 | /* Get Multicast Information */ | ||
584 | chdlc_priv_area->mc = conf->mc; | ||
585 | |||
586 | |||
587 | chdlc_priv_area->if_ptr = pppdev; | ||
588 | |||
589 | /* prepare network device data space for registration */ | ||
590 | |||
591 | strcpy(dev->name,card->u.c.if_name); | ||
592 | |||
593 | /* Attach PPP protocol layer to pppdev | ||
594 | * The sppp_attach() will initilize the dev structure | ||
595 | * and setup ppp layer protocols. | ||
596 | * All we have to do is to bind in: | ||
597 | * if_open(), if_close(), if_send() and get_stats() functions. | ||
598 | */ | ||
599 | sppp_attach(pppdev); | ||
600 | dev = pppdev->dev; | ||
601 | sp = &pppdev->sppp; | ||
602 | |||
603 | /* Enable PPP Debugging */ | ||
604 | // FIXME Fix this up somehow | ||
605 | //sp->pp_flags |= PP_DEBUG; | ||
606 | sp->pp_flags &= ~PP_CISCO; | ||
607 | |||
608 | dev->init = &if_init; | ||
609 | dev->priv = chdlc_priv_area; | ||
610 | |||
611 | return 0; | ||
612 | } | ||
613 | |||
614 | |||
615 | |||
616 | |||
617 | /*============================================================================ | ||
618 | * Delete logical channel. | ||
619 | */ | ||
620 | static int del_if(struct wan_device* wandev, struct net_device* dev) | ||
621 | { | ||
622 | chdlc_private_area_t *chdlc_priv_area = dev->priv; | ||
623 | sdla_t *card = chdlc_priv_area->card; | ||
624 | unsigned long smp_lock; | ||
625 | |||
626 | /* Detach the PPP layer */ | ||
627 | printk(KERN_INFO "%s: Detaching SyncPPP Module from %s\n", | ||
628 | wandev->name,dev->name); | ||
629 | |||
630 | lock_adapter_irq(&wandev->lock,&smp_lock); | ||
631 | |||
632 | sppp_detach(dev); | ||
633 | chdlc_priv_area->if_ptr=NULL; | ||
634 | |||
635 | chdlc_set_intr_mode(card, 0); | ||
636 | if (card->u.c.comm_enabled) | ||
637 | chdlc_comm_disable(card); | ||
638 | unlock_adapter_irq(&wandev->lock,&smp_lock); | ||
639 | |||
640 | port_set_state(card, WAN_DISCONNECTED); | ||
641 | |||
642 | return 0; | ||
643 | } | ||
644 | |||
645 | |||
646 | /****** Network Device Interface ********************************************/ | ||
647 | |||
648 | /*============================================================================ | ||
649 | * Initialize Linux network interface. | ||
650 | * | ||
651 | * This routine is called only once for each interface, during Linux network | ||
652 | * interface registration. Returning anything but zero will fail interface | ||
653 | * registration. | ||
654 | */ | ||
655 | static int if_init(struct net_device* dev) | ||
656 | { | ||
657 | chdlc_private_area_t* chdlc_priv_area = dev->priv; | ||
658 | sdla_t* card = chdlc_priv_area->card; | ||
659 | struct wan_device* wandev = &card->wandev; | ||
660 | |||
661 | /* NOTE: Most of the dev initialization was | ||
662 | * done in sppp_attach(), called by new_if() | ||
663 | * function. All we have to do here is | ||
664 | * to link four major routines below. | ||
665 | */ | ||
666 | |||
667 | /* Initialize device driver entry points */ | ||
668 | dev->open = &if_open; | ||
669 | dev->stop = &if_close; | ||
670 | dev->hard_start_xmit = &if_send; | ||
671 | dev->get_stats = &if_stats; | ||
672 | dev->tx_timeout = &if_tx_timeout; | ||
673 | dev->watchdog_timeo = TX_TIMEOUT; | ||
674 | |||
675 | |||
676 | /* Initialize hardware parameters */ | ||
677 | dev->irq = wandev->irq; | ||
678 | dev->dma = wandev->dma; | ||
679 | dev->base_addr = wandev->ioport; | ||
680 | dev->mem_start = wandev->maddr; | ||
681 | dev->mem_end = wandev->maddr + wandev->msize - 1; | ||
682 | |||
683 | /* Set transmit buffer queue length | ||
684 | * If we over fill this queue the packets will | ||
685 | * be droped by the kernel. | ||
686 | * sppp_attach() sets this to 10, but | ||
687 | * 100 will give us more room at low speeds. | ||
688 | */ | ||
689 | dev->tx_queue_len = 100; | ||
690 | |||
691 | return 0; | ||
692 | } | ||
693 | |||
694 | |||
695 | /*============================================================================ | ||
696 | * Handle transmit timeout event from netif watchdog | ||
697 | */ | ||
698 | static void if_tx_timeout(struct net_device *dev) | ||
699 | { | ||
700 | chdlc_private_area_t* chan = dev->priv; | ||
701 | sdla_t *card = chan->card; | ||
702 | |||
703 | /* If our device stays busy for at least 5 seconds then we will | ||
704 | * kick start the device by making dev->tbusy = 0. We expect | ||
705 | * that our device never stays busy more than 5 seconds. So this | ||
706 | * is only used as a last resort. | ||
707 | */ | ||
708 | |||
709 | ++card->wandev.stats.collisions; | ||
710 | |||
711 | printk (KERN_INFO "%s: Transmit timed out on %s\n", card->devname,dev->name); | ||
712 | netif_wake_queue (dev); | ||
713 | } | ||
714 | |||
715 | |||
716 | /*============================================================================ | ||
717 | * Open network interface. | ||
718 | * o enable communications and interrupts. | ||
719 | * o prevent module from unloading by incrementing use count | ||
720 | * | ||
721 | * Return 0 if O.k. or errno. | ||
722 | */ | ||
723 | static int if_open(struct net_device* dev) | ||
724 | { | ||
725 | chdlc_private_area_t* chdlc_priv_area = dev->priv; | ||
726 | sdla_t* card = chdlc_priv_area->card; | ||
727 | struct timeval tv; | ||
728 | SHARED_MEMORY_INFO_STRUCT *flags = card->u.c.flags; | ||
729 | |||
730 | /* Only one open per interface is allowed */ | ||
731 | if (netif_running(dev)) | ||
732 | return -EBUSY; | ||
733 | |||
734 | /* Start PPP Layer */ | ||
735 | if (sppp_open(dev)){ | ||
736 | return -EIO; | ||
737 | } | ||
738 | |||
739 | do_gettimeofday(&tv); | ||
740 | chdlc_priv_area->router_start_time = tv.tv_sec; | ||
741 | |||
742 | netif_start_queue(dev); | ||
743 | |||
744 | wanpipe_open(card); | ||
745 | |||
746 | chdlc_priv_area->timer_int_enabled |= TMR_INT_ENABLED_CONFIG; | ||
747 | flags->interrupt_info_struct.interrupt_permission |= APP_INT_ON_TIMER; | ||
748 | return 0; | ||
749 | } | ||
750 | |||
751 | /*============================================================================ | ||
752 | * Close network interface. | ||
753 | * o if this is the last close, then disable communications and interrupts. | ||
754 | * o reset flags. | ||
755 | */ | ||
756 | static int if_close(struct net_device* dev) | ||
757 | { | ||
758 | chdlc_private_area_t* chdlc_priv_area = dev->priv; | ||
759 | sdla_t* card = chdlc_priv_area->card; | ||
760 | |||
761 | /* Stop the PPP Layer */ | ||
762 | sppp_close(dev); | ||
763 | netif_stop_queue(dev); | ||
764 | |||
765 | wanpipe_close(card); | ||
766 | |||
767 | return 0; | ||
768 | } | ||
769 | |||
770 | /*============================================================================ | ||
771 | * Send a packet on a network interface. | ||
772 | * o set tbusy flag (marks start of the transmission) to block a timer-based | ||
773 | * transmit from overlapping. | ||
774 | * o check link state. If link is not up, then drop the packet. | ||
775 | * o execute adapter send command. | ||
776 | * o free socket buffer | ||
777 | * | ||
778 | * Return: 0 complete (socket buffer must be freed) | ||
779 | * non-0 packet may be re-transmitted (tbusy must be set) | ||
780 | * | ||
781 | * Notes: | ||
782 | * 1. This routine is called either by the protocol stack or by the "net | ||
783 | * bottom half" (with interrupts enabled). | ||
784 | * 2. Setting tbusy flag will inhibit further transmit requests from the | ||
785 | * protocol stack and can be used for flow control with protocol layer. | ||
786 | */ | ||
787 | static int if_send(struct sk_buff* skb, struct net_device* dev) | ||
788 | { | ||
789 | chdlc_private_area_t *chdlc_priv_area = dev->priv; | ||
790 | sdla_t *card = chdlc_priv_area->card; | ||
791 | SHARED_MEMORY_INFO_STRUCT *flags = card->u.c.flags; | ||
792 | INTERRUPT_INFORMATION_STRUCT *chdlc_int = &flags->interrupt_info_struct; | ||
793 | int udp_type = 0; | ||
794 | unsigned long smp_flags; | ||
795 | int err=0; | ||
796 | |||
797 | netif_stop_queue(dev); | ||
798 | |||
799 | |||
800 | if (skb == NULL){ | ||
801 | /* If we get here, some higher layer thinks we've missed an | ||
802 | * tx-done interrupt. | ||
803 | */ | ||
804 | printk(KERN_INFO "%s: Received NULL skb buffer! interface %s got kicked!\n", | ||
805 | card->devname, dev->name); | ||
806 | |||
807 | netif_wake_queue(dev); | ||
808 | return 0; | ||
809 | } | ||
810 | |||
811 | if (ntohs(skb->protocol) != htons(PVC_PROT)){ | ||
812 | /* check the udp packet type */ | ||
813 | |||
814 | udp_type = udp_pkt_type(skb, card); | ||
815 | if (udp_type == UDP_CPIPE_TYPE){ | ||
816 | if(store_udp_mgmt_pkt(UDP_PKT_FRM_STACK, card, skb, dev, | ||
817 | chdlc_priv_area)){ | ||
818 | chdlc_int->interrupt_permission |= | ||
819 | APP_INT_ON_TIMER; | ||
820 | } | ||
821 | netif_start_queue(dev); | ||
822 | return 0; | ||
823 | } | ||
824 | } | ||
825 | |||
826 | /* Lock the 508 Card: SMP is supported */ | ||
827 | if(card->hw.type != SDLA_S514){ | ||
828 | s508_lock(card,&smp_flags); | ||
829 | } | ||
830 | |||
831 | if (test_and_set_bit(SEND_CRIT, (void*)&card->wandev.critical)){ | ||
832 | |||
833 | printk(KERN_INFO "%s: Critical in if_send: %lx\n", | ||
834 | card->wandev.name,card->wandev.critical); | ||
835 | ++card->wandev.stats.tx_dropped; | ||
836 | netif_start_queue(dev); | ||
837 | goto if_send_crit_exit; | ||
838 | } | ||
839 | |||
840 | if (card->wandev.state != WAN_CONNECTED){ | ||
841 | ++card->wandev.stats.tx_dropped; | ||
842 | netif_start_queue(dev); | ||
843 | goto if_send_crit_exit; | ||
844 | } | ||
845 | |||
846 | if (chdlc_send(card, skb->data, skb->len)){ | ||
847 | netif_stop_queue(dev); | ||
848 | |||
849 | }else{ | ||
850 | ++card->wandev.stats.tx_packets; | ||
851 | card->wandev.stats.tx_bytes += skb->len; | ||
852 | dev->trans_start = jiffies; | ||
853 | netif_start_queue(dev); | ||
854 | } | ||
855 | |||
856 | if_send_crit_exit: | ||
857 | if (!(err=netif_queue_stopped(dev))){ | ||
858 | dev_kfree_skb_any(skb); | ||
859 | }else{ | ||
860 | chdlc_priv_area->tick_counter = jiffies; | ||
861 | chdlc_int->interrupt_permission |= APP_INT_ON_TX_FRAME; | ||
862 | } | ||
863 | |||
864 | clear_bit(SEND_CRIT, (void*)&card->wandev.critical); | ||
865 | if(card->hw.type != SDLA_S514){ | ||
866 | s508_unlock(card,&smp_flags); | ||
867 | } | ||
868 | |||
869 | return err; | ||
870 | } | ||
871 | |||
872 | |||
873 | /*============================================================================ | ||
874 | * Reply to UDP Management system. | ||
875 | * Return length of reply. | ||
876 | */ | ||
877 | static int reply_udp( unsigned char *data, unsigned int mbox_len ) | ||
878 | { | ||
879 | |||
880 | unsigned short len, udp_length, temp, ip_length; | ||
881 | unsigned long ip_temp; | ||
882 | int even_bound = 0; | ||
883 | chdlc_udp_pkt_t *c_udp_pkt = (chdlc_udp_pkt_t *)data; | ||
884 | |||
885 | /* Set length of packet */ | ||
886 | len = sizeof(ip_pkt_t)+ | ||
887 | sizeof(udp_pkt_t)+ | ||
888 | sizeof(wp_mgmt_t)+ | ||
889 | sizeof(cblock_t)+ | ||
890 | sizeof(trace_info_t)+ | ||
891 | mbox_len; | ||
892 | |||
893 | /* fill in UDP reply */ | ||
894 | c_udp_pkt->wp_mgmt.request_reply = UDPMGMT_REPLY; | ||
895 | |||
896 | /* fill in UDP length */ | ||
897 | udp_length = sizeof(udp_pkt_t)+ | ||
898 | sizeof(wp_mgmt_t)+ | ||
899 | sizeof(cblock_t)+ | ||
900 | sizeof(trace_info_t)+ | ||
901 | mbox_len; | ||
902 | |||
903 | /* put it on an even boundary */ | ||
904 | if ( udp_length & 0x0001 ) { | ||
905 | udp_length += 1; | ||
906 | len += 1; | ||
907 | even_bound = 1; | ||
908 | } | ||
909 | |||
910 | temp = (udp_length<<8)|(udp_length>>8); | ||
911 | c_udp_pkt->udp_pkt.udp_length = temp; | ||
912 | |||
913 | /* swap UDP ports */ | ||
914 | temp = c_udp_pkt->udp_pkt.udp_src_port; | ||
915 | c_udp_pkt->udp_pkt.udp_src_port = | ||
916 | c_udp_pkt->udp_pkt.udp_dst_port; | ||
917 | c_udp_pkt->udp_pkt.udp_dst_port = temp; | ||
918 | |||
919 | /* add UDP pseudo header */ | ||
920 | temp = 0x1100; | ||
921 | *((unsigned short *)(c_udp_pkt->data+mbox_len+even_bound)) = temp; | ||
922 | temp = (udp_length<<8)|(udp_length>>8); | ||
923 | *((unsigned short *)(c_udp_pkt->data+mbox_len+even_bound+2)) = temp; | ||
924 | |||
925 | |||
926 | /* calculate UDP checksum */ | ||
927 | c_udp_pkt->udp_pkt.udp_checksum = 0; | ||
928 | c_udp_pkt->udp_pkt.udp_checksum = calc_checksum(&data[UDP_OFFSET],udp_length+UDP_OFFSET); | ||
929 | |||
930 | /* fill in IP length */ | ||
931 | ip_length = len; | ||
932 | temp = (ip_length<<8)|(ip_length>>8); | ||
933 | c_udp_pkt->ip_pkt.total_length = temp; | ||
934 | |||
935 | /* swap IP addresses */ | ||
936 | ip_temp = c_udp_pkt->ip_pkt.ip_src_address; | ||
937 | c_udp_pkt->ip_pkt.ip_src_address = c_udp_pkt->ip_pkt.ip_dst_address; | ||
938 | c_udp_pkt->ip_pkt.ip_dst_address = ip_temp; | ||
939 | |||
940 | /* fill in IP checksum */ | ||
941 | c_udp_pkt->ip_pkt.hdr_checksum = 0; | ||
942 | c_udp_pkt->ip_pkt.hdr_checksum = calc_checksum(data,sizeof(ip_pkt_t)); | ||
943 | |||
944 | return len; | ||
945 | |||
946 | } /* reply_udp */ | ||
947 | |||
948 | unsigned short calc_checksum (char *data, int len) | ||
949 | { | ||
950 | unsigned short temp; | ||
951 | unsigned long sum=0; | ||
952 | int i; | ||
953 | |||
954 | for( i = 0; i <len; i+=2 ) { | ||
955 | memcpy(&temp,&data[i],2); | ||
956 | sum += (unsigned long)temp; | ||
957 | } | ||
958 | |||
959 | while (sum >> 16 ) { | ||
960 | sum = (sum & 0xffffUL) + (sum >> 16); | ||
961 | } | ||
962 | |||
963 | temp = (unsigned short)sum; | ||
964 | temp = ~temp; | ||
965 | |||
966 | if( temp == 0 ) | ||
967 | temp = 0xffff; | ||
968 | |||
969 | return temp; | ||
970 | } | ||
971 | |||
972 | |||
973 | /*============================================================================ | ||
974 | * Get ethernet-style interface statistics. | ||
975 | * Return a pointer to struct enet_statistics. | ||
976 | */ | ||
977 | static struct net_device_stats* if_stats(struct net_device* dev) | ||
978 | { | ||
979 | sdla_t *my_card; | ||
980 | chdlc_private_area_t* chdlc_priv_area; | ||
981 | |||
982 | /* Shutdown bug fix. In del_if() we kill | ||
983 | * dev->priv pointer. This function, gets | ||
984 | * called after del_if(), thus check | ||
985 | * if pointer has been deleted */ | ||
986 | if ((chdlc_priv_area=dev->priv) == NULL) | ||
987 | return NULL; | ||
988 | |||
989 | my_card = chdlc_priv_area->card; | ||
990 | return &my_card->wandev.stats; | ||
991 | } | ||
992 | |||
993 | |||
994 | /****** Cisco HDLC Firmware Interface Functions *******************************/ | ||
995 | |||
996 | /*============================================================================ | ||
997 | * Read firmware code version. | ||
998 | * Put code version as ASCII string in str. | ||
999 | */ | ||
1000 | static int chdlc_read_version (sdla_t* card, char* str) | ||
1001 | { | ||
1002 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
1003 | int len; | ||
1004 | char err; | ||
1005 | mb->buffer_length = 0; | ||
1006 | mb->command = READ_CHDLC_CODE_VERSION; | ||
1007 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1008 | |||
1009 | if(err != COMMAND_OK) { | ||
1010 | chdlc_error(card,err,mb); | ||
1011 | } | ||
1012 | else if (str) { /* is not null */ | ||
1013 | len = mb->buffer_length; | ||
1014 | memcpy(str, mb->data, len); | ||
1015 | str[len] = '\0'; | ||
1016 | } | ||
1017 | return (err); | ||
1018 | } | ||
1019 | |||
1020 | /*----------------------------------------------------------------------------- | ||
1021 | * Configure CHDLC firmware. | ||
1022 | */ | ||
1023 | static int chdlc_configure (sdla_t* card, void* data) | ||
1024 | { | ||
1025 | int err; | ||
1026 | CHDLC_MAILBOX_STRUCT *mailbox = card->mbox; | ||
1027 | int data_length = sizeof(CHDLC_CONFIGURATION_STRUCT); | ||
1028 | |||
1029 | mailbox->buffer_length = data_length; | ||
1030 | memcpy(mailbox->data, data, data_length); | ||
1031 | mailbox->command = SET_CHDLC_CONFIGURATION; | ||
1032 | err = sdla_exec(mailbox) ? mailbox->return_code : CMD_TIMEOUT; | ||
1033 | |||
1034 | if (err != COMMAND_OK) chdlc_error (card, err, mailbox); | ||
1035 | |||
1036 | return err; | ||
1037 | } | ||
1038 | |||
1039 | |||
1040 | /*============================================================================ | ||
1041 | * Set interrupt mode -- HDLC Version. | ||
1042 | */ | ||
1043 | |||
1044 | static int chdlc_set_intr_mode (sdla_t* card, unsigned mode) | ||
1045 | { | ||
1046 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
1047 | CHDLC_INT_TRIGGERS_STRUCT* int_data = | ||
1048 | (CHDLC_INT_TRIGGERS_STRUCT *)mb->data; | ||
1049 | int err; | ||
1050 | |||
1051 | int_data->CHDLC_interrupt_triggers = mode; | ||
1052 | int_data->IRQ = card->hw.irq; | ||
1053 | int_data->interrupt_timer = 1; | ||
1054 | |||
1055 | mb->buffer_length = sizeof(CHDLC_INT_TRIGGERS_STRUCT); | ||
1056 | mb->command = SET_CHDLC_INTERRUPT_TRIGGERS; | ||
1057 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1058 | if (err != COMMAND_OK) | ||
1059 | chdlc_error (card, err, mb); | ||
1060 | return err; | ||
1061 | } | ||
1062 | |||
1063 | |||
1064 | /*============================================================================ | ||
1065 | * Enable communications. | ||
1066 | */ | ||
1067 | |||
1068 | static int chdlc_comm_enable (sdla_t* card) | ||
1069 | { | ||
1070 | int err; | ||
1071 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
1072 | |||
1073 | mb->buffer_length = 0; | ||
1074 | mb->command = ENABLE_CHDLC_COMMUNICATIONS; | ||
1075 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1076 | if (err != COMMAND_OK) | ||
1077 | chdlc_error(card, err, mb); | ||
1078 | else | ||
1079 | card->u.c.comm_enabled=1; | ||
1080 | |||
1081 | return err; | ||
1082 | } | ||
1083 | |||
1084 | /*============================================================================ | ||
1085 | * Disable communications and Drop the Modem lines (DCD and RTS). | ||
1086 | */ | ||
1087 | static int chdlc_comm_disable (sdla_t* card) | ||
1088 | { | ||
1089 | int err; | ||
1090 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
1091 | |||
1092 | mb->buffer_length = 0; | ||
1093 | mb->command = DISABLE_CHDLC_COMMUNICATIONS; | ||
1094 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1095 | if (err != COMMAND_OK) | ||
1096 | chdlc_error(card,err,mb); | ||
1097 | |||
1098 | return err; | ||
1099 | } | ||
1100 | |||
1101 | /*============================================================================ | ||
1102 | * Read communication error statistics. | ||
1103 | */ | ||
1104 | static int chdlc_read_comm_err_stats (sdla_t* card) | ||
1105 | { | ||
1106 | int err; | ||
1107 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
1108 | |||
1109 | mb->buffer_length = 0; | ||
1110 | mb->command = READ_COMMS_ERROR_STATS; | ||
1111 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1112 | if (err != COMMAND_OK) | ||
1113 | chdlc_error(card,err,mb); | ||
1114 | return err; | ||
1115 | } | ||
1116 | |||
1117 | |||
1118 | /*============================================================================ | ||
1119 | * Read CHDLC operational statistics. | ||
1120 | */ | ||
1121 | static int chdlc_read_op_stats (sdla_t* card) | ||
1122 | { | ||
1123 | int err; | ||
1124 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
1125 | |||
1126 | mb->buffer_length = 0; | ||
1127 | mb->command = READ_CHDLC_OPERATIONAL_STATS; | ||
1128 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1129 | if (err != COMMAND_OK) | ||
1130 | chdlc_error(card,err,mb); | ||
1131 | return err; | ||
1132 | } | ||
1133 | |||
1134 | |||
1135 | /*============================================================================ | ||
1136 | * Update communications error and general packet statistics. | ||
1137 | */ | ||
1138 | static int update_comms_stats(sdla_t* card, | ||
1139 | chdlc_private_area_t* chdlc_priv_area) | ||
1140 | { | ||
1141 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
1142 | COMMS_ERROR_STATS_STRUCT* err_stats; | ||
1143 | CHDLC_OPERATIONAL_STATS_STRUCT *op_stats; | ||
1144 | |||
1145 | /* on the first timer interrupt, read the comms error statistics */ | ||
1146 | if(chdlc_priv_area->update_comms_stats == 2) { | ||
1147 | if(chdlc_read_comm_err_stats(card)) | ||
1148 | return 1; | ||
1149 | err_stats = (COMMS_ERROR_STATS_STRUCT *)mb->data; | ||
1150 | card->wandev.stats.rx_over_errors = | ||
1151 | err_stats->Rx_overrun_err_count; | ||
1152 | card->wandev.stats.rx_crc_errors = | ||
1153 | err_stats->CRC_err_count; | ||
1154 | card->wandev.stats.rx_frame_errors = | ||
1155 | err_stats->Rx_abort_count; | ||
1156 | card->wandev.stats.rx_fifo_errors = | ||
1157 | err_stats->Rx_dis_pri_bfrs_full_count; | ||
1158 | card->wandev.stats.rx_missed_errors = | ||
1159 | card->wandev.stats.rx_fifo_errors; | ||
1160 | card->wandev.stats.tx_aborted_errors = | ||
1161 | err_stats->sec_Tx_abort_count; | ||
1162 | } | ||
1163 | |||
1164 | /* on the second timer interrupt, read the operational statistics */ | ||
1165 | else { | ||
1166 | if(chdlc_read_op_stats(card)) | ||
1167 | return 1; | ||
1168 | op_stats = (CHDLC_OPERATIONAL_STATS_STRUCT *)mb->data; | ||
1169 | card->wandev.stats.rx_length_errors = | ||
1170 | (op_stats->Rx_Data_discard_short_count + | ||
1171 | op_stats->Rx_Data_discard_long_count); | ||
1172 | } | ||
1173 | |||
1174 | return 0; | ||
1175 | } | ||
1176 | |||
1177 | /*============================================================================ | ||
1178 | * Send packet. | ||
1179 | * Return: 0 - o.k. | ||
1180 | * 1 - no transmit buffers available | ||
1181 | */ | ||
1182 | static int chdlc_send (sdla_t* card, void* data, unsigned len) | ||
1183 | { | ||
1184 | CHDLC_DATA_TX_STATUS_EL_STRUCT *txbuf = card->u.c.txbuf; | ||
1185 | |||
1186 | if (txbuf->opp_flag) | ||
1187 | return 1; | ||
1188 | |||
1189 | sdla_poke(&card->hw, txbuf->ptr_data_bfr, data, len); | ||
1190 | |||
1191 | txbuf->frame_length = len; | ||
1192 | txbuf->opp_flag = 1; /* start transmission */ | ||
1193 | |||
1194 | /* Update transmit buffer control fields */ | ||
1195 | card->u.c.txbuf = ++txbuf; | ||
1196 | |||
1197 | if ((void*)txbuf > card->u.c.txbuf_last) | ||
1198 | card->u.c.txbuf = card->u.c.txbuf_base; | ||
1199 | |||
1200 | return 0; | ||
1201 | } | ||
1202 | |||
1203 | /****** Firmware Error Handler **********************************************/ | ||
1204 | |||
1205 | /*============================================================================ | ||
1206 | * Firmware error handler. | ||
1207 | * This routine is called whenever firmware command returns non-zero | ||
1208 | * return code. | ||
1209 | * | ||
1210 | * Return zero if previous command has to be cancelled. | ||
1211 | */ | ||
1212 | static int chdlc_error (sdla_t *card, int err, CHDLC_MAILBOX_STRUCT *mb) | ||
1213 | { | ||
1214 | unsigned cmd = mb->command; | ||
1215 | |||
1216 | switch (err) { | ||
1217 | |||
1218 | case CMD_TIMEOUT: | ||
1219 | printk(KERN_ERR "%s: command 0x%02X timed out!\n", | ||
1220 | card->devname, cmd); | ||
1221 | break; | ||
1222 | |||
1223 | case S514_BOTH_PORTS_SAME_CLK_MODE: | ||
1224 | if(cmd == SET_CHDLC_CONFIGURATION) { | ||
1225 | printk(KERN_INFO | ||
1226 | "%s: Configure both ports for the same clock source\n", | ||
1227 | card->devname); | ||
1228 | break; | ||
1229 | } | ||
1230 | |||
1231 | default: | ||
1232 | printk(KERN_INFO "%s: command 0x%02X returned 0x%02X!\n", | ||
1233 | card->devname, cmd, err); | ||
1234 | } | ||
1235 | |||
1236 | return 0; | ||
1237 | } | ||
1238 | |||
1239 | /****** Interrupt Handlers **************************************************/ | ||
1240 | |||
1241 | /*============================================================================ | ||
1242 | * Cisco HDLC interrupt service routine. | ||
1243 | */ | ||
1244 | STATIC void wsppp_isr (sdla_t* card) | ||
1245 | { | ||
1246 | struct net_device* dev; | ||
1247 | SHARED_MEMORY_INFO_STRUCT* flags = NULL; | ||
1248 | int i; | ||
1249 | sdla_t *my_card; | ||
1250 | |||
1251 | |||
1252 | /* Check for which port the interrupt has been generated | ||
1253 | * Since Secondary Port is piggybacking on the Primary | ||
1254 | * the check must be done here. | ||
1255 | */ | ||
1256 | |||
1257 | flags = card->u.c.flags; | ||
1258 | if (!flags->interrupt_info_struct.interrupt_type){ | ||
1259 | /* Check for a second port (piggybacking) */ | ||
1260 | if((my_card = card->next)){ | ||
1261 | flags = my_card->u.c.flags; | ||
1262 | if (flags->interrupt_info_struct.interrupt_type){ | ||
1263 | card = my_card; | ||
1264 | card->isr(card); | ||
1265 | return; | ||
1266 | } | ||
1267 | } | ||
1268 | } | ||
1269 | |||
1270 | dev = card->wandev.dev; | ||
1271 | card->in_isr = 1; | ||
1272 | flags = card->u.c.flags; | ||
1273 | |||
1274 | /* If we get an interrupt with no network device, stop the interrupts | ||
1275 | * and issue an error */ | ||
1276 | if ((!dev || !dev->priv) && flags->interrupt_info_struct.interrupt_type != | ||
1277 | COMMAND_COMPLETE_APP_INT_PEND){ | ||
1278 | goto isr_done; | ||
1279 | } | ||
1280 | |||
1281 | |||
1282 | /* if critical due to peripheral operations | ||
1283 | * ie. update() or getstats() then reset the interrupt and | ||
1284 | * wait for the board to retrigger. | ||
1285 | */ | ||
1286 | if(test_bit(PERI_CRIT, (void*)&card->wandev.critical)) { | ||
1287 | flags->interrupt_info_struct. | ||
1288 | interrupt_type = 0; | ||
1289 | goto isr_done; | ||
1290 | } | ||
1291 | |||
1292 | |||
1293 | /* On a 508 Card, if critical due to if_send | ||
1294 | * Major Error !!! | ||
1295 | */ | ||
1296 | if(card->hw.type != SDLA_S514) { | ||
1297 | if(test_bit(0, (void*)&card->wandev.critical)) { | ||
1298 | printk(KERN_INFO "%s: Critical while in ISR: %lx\n", | ||
1299 | card->devname, card->wandev.critical); | ||
1300 | goto isr_done; | ||
1301 | } | ||
1302 | } | ||
1303 | |||
1304 | switch(flags->interrupt_info_struct.interrupt_type) { | ||
1305 | |||
1306 | case RX_APP_INT_PEND: /* 0x01: receive interrupt */ | ||
1307 | rx_intr(card); | ||
1308 | break; | ||
1309 | |||
1310 | case TX_APP_INT_PEND: /* 0x02: transmit interrupt */ | ||
1311 | flags->interrupt_info_struct.interrupt_permission &= | ||
1312 | ~APP_INT_ON_TX_FRAME; | ||
1313 | |||
1314 | netif_wake_queue(dev); | ||
1315 | break; | ||
1316 | |||
1317 | case COMMAND_COMPLETE_APP_INT_PEND:/* 0x04: cmd cplt */ | ||
1318 | ++ Intr_test_counter; | ||
1319 | break; | ||
1320 | |||
1321 | case CHDLC_EXCEP_COND_APP_INT_PEND: /* 0x20 */ | ||
1322 | process_chdlc_exception(card); | ||
1323 | break; | ||
1324 | |||
1325 | case GLOBAL_EXCEP_COND_APP_INT_PEND: | ||
1326 | process_global_exception(card); | ||
1327 | break; | ||
1328 | |||
1329 | case TIMER_APP_INT_PEND: | ||
1330 | timer_intr(card); | ||
1331 | break; | ||
1332 | |||
1333 | default: | ||
1334 | printk(KERN_INFO "%s: spurious interrupt 0x%02X!\n", | ||
1335 | card->devname, | ||
1336 | flags->interrupt_info_struct.interrupt_type); | ||
1337 | printk(KERN_INFO "Code name: "); | ||
1338 | for(i = 0; i < 4; i ++) | ||
1339 | printk(KERN_INFO "%c", | ||
1340 | flags->global_info_struct.codename[i]); | ||
1341 | printk(KERN_INFO "\nCode version: "); | ||
1342 | for(i = 0; i < 4; i ++) | ||
1343 | printk(KERN_INFO "%c", | ||
1344 | flags->global_info_struct.codeversion[i]); | ||
1345 | printk(KERN_INFO "\n"); | ||
1346 | break; | ||
1347 | } | ||
1348 | |||
1349 | isr_done: | ||
1350 | card->in_isr = 0; | ||
1351 | flags->interrupt_info_struct.interrupt_type = 0; | ||
1352 | } | ||
1353 | |||
1354 | /*============================================================================ | ||
1355 | * Receive interrupt handler. | ||
1356 | */ | ||
1357 | static void rx_intr (sdla_t* card) | ||
1358 | { | ||
1359 | struct net_device *dev; | ||
1360 | chdlc_private_area_t *chdlc_priv_area; | ||
1361 | SHARED_MEMORY_INFO_STRUCT *flags = card->u.c.flags; | ||
1362 | CHDLC_DATA_RX_STATUS_EL_STRUCT *rxbuf = card->u.c.rxmb; | ||
1363 | struct sk_buff *skb; | ||
1364 | unsigned len; | ||
1365 | unsigned addr = rxbuf->ptr_data_bfr; | ||
1366 | void *buf; | ||
1367 | int i,udp_type; | ||
1368 | |||
1369 | if (rxbuf->opp_flag != 0x01) { | ||
1370 | printk(KERN_INFO | ||
1371 | "%s: corrupted Rx buffer @ 0x%X, flag = 0x%02X!\n", | ||
1372 | card->devname, (unsigned)rxbuf, rxbuf->opp_flag); | ||
1373 | printk(KERN_INFO "Code name: "); | ||
1374 | for(i = 0; i < 4; i ++) | ||
1375 | printk(KERN_INFO "%c", | ||
1376 | flags->global_info_struct.codename[i]); | ||
1377 | printk(KERN_INFO "\nCode version: "); | ||
1378 | for(i = 0; i < 4; i ++) | ||
1379 | printk(KERN_INFO "%c", | ||
1380 | flags->global_info_struct.codeversion[i]); | ||
1381 | printk(KERN_INFO "\n"); | ||
1382 | |||
1383 | |||
1384 | /* Bug Fix: Mar 6 2000 | ||
1385 | * If we get a corrupted mailbox, it measn that driver | ||
1386 | * is out of sync with the firmware. There is no recovery. | ||
1387 | * If we don't turn off all interrupts for this card | ||
1388 | * the machine will crash. | ||
1389 | */ | ||
1390 | printk(KERN_INFO "%s: Critical router failure ...!!!\n", card->devname); | ||
1391 | printk(KERN_INFO "Please contact Sangoma Technologies !\n"); | ||
1392 | chdlc_set_intr_mode(card,0); | ||
1393 | return; | ||
1394 | } | ||
1395 | |||
1396 | dev = card->wandev.dev; | ||
1397 | |||
1398 | if (!dev){ | ||
1399 | goto rx_exit; | ||
1400 | } | ||
1401 | |||
1402 | if (!netif_running(dev)){ | ||
1403 | goto rx_exit; | ||
1404 | } | ||
1405 | |||
1406 | chdlc_priv_area = dev->priv; | ||
1407 | |||
1408 | if (rxbuf->error_flag){ | ||
1409 | goto rx_exit; | ||
1410 | } | ||
1411 | /* Take off two CRC bytes */ | ||
1412 | |||
1413 | if (rxbuf->frame_length < 7 || rxbuf->frame_length > 1506 ){ | ||
1414 | goto rx_exit; | ||
1415 | } | ||
1416 | |||
1417 | len = rxbuf->frame_length - CRC_LENGTH; | ||
1418 | |||
1419 | /* Allocate socket buffer */ | ||
1420 | skb = dev_alloc_skb(len); | ||
1421 | |||
1422 | if (skb == NULL) { | ||
1423 | if (net_ratelimit()){ | ||
1424 | printk(KERN_INFO "%s: no socket buffers available!\n", | ||
1425 | card->devname); | ||
1426 | } | ||
1427 | ++card->wandev.stats.rx_dropped; | ||
1428 | goto rx_exit; | ||
1429 | } | ||
1430 | |||
1431 | /* Copy data to the socket buffer */ | ||
1432 | if((addr + len) > card->u.c.rx_top + 1) { | ||
1433 | unsigned tmp = card->u.c.rx_top - addr + 1; | ||
1434 | buf = skb_put(skb, tmp); | ||
1435 | sdla_peek(&card->hw, addr, buf, tmp); | ||
1436 | addr = card->u.c.rx_base; | ||
1437 | len -= tmp; | ||
1438 | } | ||
1439 | |||
1440 | buf = skb_put(skb, len); | ||
1441 | sdla_peek(&card->hw, addr, buf, len); | ||
1442 | |||
1443 | skb->protocol = htons(ETH_P_WAN_PPP); | ||
1444 | |||
1445 | card->wandev.stats.rx_packets ++; | ||
1446 | card->wandev.stats.rx_bytes += skb->len; | ||
1447 | udp_type = udp_pkt_type( skb, card ); | ||
1448 | |||
1449 | if(udp_type == UDP_CPIPE_TYPE) { | ||
1450 | if(store_udp_mgmt_pkt(UDP_PKT_FRM_NETWORK, | ||
1451 | card, skb, dev, chdlc_priv_area)) { | ||
1452 | flags->interrupt_info_struct. | ||
1453 | interrupt_permission |= | ||
1454 | APP_INT_ON_TIMER; | ||
1455 | } | ||
1456 | }else{ | ||
1457 | /* Pass it up the protocol stack */ | ||
1458 | skb->dev = dev; | ||
1459 | skb->mac.raw = skb->data; | ||
1460 | netif_rx(skb); | ||
1461 | dev->last_rx = jiffies; | ||
1462 | } | ||
1463 | |||
1464 | rx_exit: | ||
1465 | /* Release buffer element and calculate a pointer to the next one */ | ||
1466 | rxbuf->opp_flag = 0x00; | ||
1467 | card->u.c.rxmb = ++ rxbuf; | ||
1468 | if((void*)rxbuf > card->u.c.rxbuf_last){ | ||
1469 | card->u.c.rxmb = card->u.c.rxbuf_base; | ||
1470 | } | ||
1471 | } | ||
1472 | |||
1473 | /*============================================================================ | ||
1474 | * Timer interrupt handler. | ||
1475 | * The timer interrupt is used for two purposes: | ||
1476 | * 1) Processing udp calls from 'cpipemon'. | ||
1477 | * 2) Reading board-level statistics for updating the proc file system. | ||
1478 | */ | ||
1479 | void timer_intr(sdla_t *card) | ||
1480 | { | ||
1481 | struct net_device* dev; | ||
1482 | chdlc_private_area_t* chdlc_priv_area = NULL; | ||
1483 | SHARED_MEMORY_INFO_STRUCT* flags = NULL; | ||
1484 | |||
1485 | dev = card->wandev.dev; | ||
1486 | chdlc_priv_area = dev->priv; | ||
1487 | |||
1488 | if (chdlc_priv_area->timer_int_enabled & TMR_INT_ENABLED_CONFIG) { | ||
1489 | if (!config_chdlc(card)){ | ||
1490 | chdlc_priv_area->timer_int_enabled &= ~TMR_INT_ENABLED_CONFIG; | ||
1491 | } | ||
1492 | } | ||
1493 | |||
1494 | /* process a udp call if pending */ | ||
1495 | if(chdlc_priv_area->timer_int_enabled & TMR_INT_ENABLED_UDP) { | ||
1496 | process_udp_mgmt_pkt(card, dev, | ||
1497 | chdlc_priv_area); | ||
1498 | chdlc_priv_area->timer_int_enabled &= ~TMR_INT_ENABLED_UDP; | ||
1499 | } | ||
1500 | |||
1501 | |||
1502 | /* read the communications statistics if required */ | ||
1503 | if(chdlc_priv_area->timer_int_enabled & TMR_INT_ENABLED_UPDATE) { | ||
1504 | update_comms_stats(card, chdlc_priv_area); | ||
1505 | if(!(-- chdlc_priv_area->update_comms_stats)) { | ||
1506 | chdlc_priv_area->timer_int_enabled &= | ||
1507 | ~TMR_INT_ENABLED_UPDATE; | ||
1508 | } | ||
1509 | } | ||
1510 | |||
1511 | /* only disable the timer interrupt if there are no udp or statistic */ | ||
1512 | /* updates pending */ | ||
1513 | if(!chdlc_priv_area->timer_int_enabled) { | ||
1514 | flags = card->u.c.flags; | ||
1515 | flags->interrupt_info_struct.interrupt_permission &= | ||
1516 | ~APP_INT_ON_TIMER; | ||
1517 | } | ||
1518 | } | ||
1519 | |||
1520 | /*------------------------------------------------------------------------------ | ||
1521 | Miscellaneous Functions | ||
1522 | - set_chdlc_config() used to set configuration options on the board | ||
1523 | ------------------------------------------------------------------------------*/ | ||
1524 | |||
1525 | static int set_chdlc_config(sdla_t* card) | ||
1526 | { | ||
1527 | |||
1528 | CHDLC_CONFIGURATION_STRUCT cfg; | ||
1529 | |||
1530 | memset(&cfg, 0, sizeof(CHDLC_CONFIGURATION_STRUCT)); | ||
1531 | |||
1532 | if(card->wandev.clocking) | ||
1533 | cfg.baud_rate = card->wandev.bps; | ||
1534 | |||
1535 | cfg.line_config_options = (card->wandev.interface == WANOPT_RS232) ? | ||
1536 | INTERFACE_LEVEL_RS232 : INTERFACE_LEVEL_V35; | ||
1537 | |||
1538 | cfg.modem_config_options = 0; | ||
1539 | //API OPTIONS | ||
1540 | cfg.CHDLC_API_options = DISCARD_RX_ERROR_FRAMES; | ||
1541 | cfg.modem_status_timer = 100; | ||
1542 | cfg.CHDLC_protocol_options = HDLC_STREAMING_MODE; | ||
1543 | cfg.percent_data_buffer_for_Tx = 50; | ||
1544 | cfg.CHDLC_statistics_options = (CHDLC_TX_DATA_BYTE_COUNT_STAT | | ||
1545 | CHDLC_RX_DATA_BYTE_COUNT_STAT); | ||
1546 | cfg.max_CHDLC_data_field_length = card->wandev.mtu; | ||
1547 | |||
1548 | cfg.transmit_keepalive_timer = 0; | ||
1549 | cfg.receive_keepalive_timer = 0; | ||
1550 | cfg.keepalive_error_tolerance = 0; | ||
1551 | cfg.SLARP_request_timer = 0; | ||
1552 | |||
1553 | cfg.IP_address = 0; | ||
1554 | cfg.IP_netmask = 0; | ||
1555 | |||
1556 | return chdlc_configure(card, &cfg); | ||
1557 | } | ||
1558 | |||
1559 | /*============================================================================ | ||
1560 | * Process global exception condition | ||
1561 | */ | ||
1562 | static int process_global_exception(sdla_t *card) | ||
1563 | { | ||
1564 | CHDLC_MAILBOX_STRUCT* mbox = card->mbox; | ||
1565 | int err; | ||
1566 | |||
1567 | mbox->buffer_length = 0; | ||
1568 | mbox->command = READ_GLOBAL_EXCEPTION_CONDITION; | ||
1569 | err = sdla_exec(mbox) ? mbox->return_code : CMD_TIMEOUT; | ||
1570 | |||
1571 | if(err != CMD_TIMEOUT ){ | ||
1572 | |||
1573 | switch(mbox->return_code) { | ||
1574 | |||
1575 | case EXCEP_MODEM_STATUS_CHANGE: | ||
1576 | |||
1577 | printk(KERN_INFO "%s: Modem status change\n", | ||
1578 | card->devname); | ||
1579 | |||
1580 | switch(mbox->data[0] & (DCD_HIGH | CTS_HIGH)) { | ||
1581 | case (DCD_HIGH): | ||
1582 | printk(KERN_INFO "%s: DCD high, CTS low\n",card->devname); | ||
1583 | break; | ||
1584 | case (CTS_HIGH): | ||
1585 | printk(KERN_INFO "%s: DCD low, CTS high\n",card->devname); | ||
1586 | break; | ||
1587 | case ((DCD_HIGH | CTS_HIGH)): | ||
1588 | printk(KERN_INFO "%s: DCD high, CTS high\n",card->devname); | ||
1589 | break; | ||
1590 | default: | ||
1591 | printk(KERN_INFO "%s: DCD low, CTS low\n",card->devname); | ||
1592 | break; | ||
1593 | } | ||
1594 | |||
1595 | if (!(mbox->data[0] & DCD_HIGH) || !(mbox->data[0] & DCD_HIGH)){ | ||
1596 | //printk(KERN_INFO "Sending TERM Request Manually !\n"); | ||
1597 | send_ppp_term_request(card->wandev.dev); | ||
1598 | } | ||
1599 | break; | ||
1600 | |||
1601 | case EXCEP_TRC_DISABLED: | ||
1602 | printk(KERN_INFO "%s: Line trace disabled\n", | ||
1603 | card->devname); | ||
1604 | break; | ||
1605 | |||
1606 | case EXCEP_IRQ_TIMEOUT: | ||
1607 | printk(KERN_INFO "%s: IRQ timeout occurred\n", | ||
1608 | card->devname); | ||
1609 | break; | ||
1610 | |||
1611 | default: | ||
1612 | printk(KERN_INFO "%s: Global exception %x\n", | ||
1613 | card->devname, mbox->return_code); | ||
1614 | break; | ||
1615 | } | ||
1616 | } | ||
1617 | return 0; | ||
1618 | } | ||
1619 | |||
1620 | |||
1621 | /*============================================================================ | ||
1622 | * Process chdlc exception condition | ||
1623 | */ | ||
1624 | static int process_chdlc_exception(sdla_t *card) | ||
1625 | { | ||
1626 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
1627 | int err; | ||
1628 | |||
1629 | mb->buffer_length = 0; | ||
1630 | mb->command = READ_CHDLC_EXCEPTION_CONDITION; | ||
1631 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1632 | if(err != CMD_TIMEOUT) { | ||
1633 | |||
1634 | switch (err) { | ||
1635 | |||
1636 | case EXCEP_LINK_ACTIVE: | ||
1637 | port_set_state(card, WAN_CONNECTED); | ||
1638 | break; | ||
1639 | |||
1640 | case EXCEP_LINK_INACTIVE_MODEM: | ||
1641 | port_set_state(card, WAN_DISCONNECTED); | ||
1642 | break; | ||
1643 | |||
1644 | case EXCEP_LOOPBACK_CONDITION: | ||
1645 | printk(KERN_INFO "%s: Loopback Condition Detected.\n", | ||
1646 | card->devname); | ||
1647 | break; | ||
1648 | |||
1649 | case NO_CHDLC_EXCEP_COND_TO_REPORT: | ||
1650 | printk(KERN_INFO "%s: No exceptions reported.\n", | ||
1651 | card->devname); | ||
1652 | break; | ||
1653 | default: | ||
1654 | printk(KERN_INFO "%s: Exception Condition %x!\n", | ||
1655 | card->devname,err); | ||
1656 | break; | ||
1657 | } | ||
1658 | |||
1659 | } | ||
1660 | return 0; | ||
1661 | } | ||
1662 | |||
1663 | |||
1664 | /*============================================================================= | ||
1665 | * Store a UDP management packet for later processing. | ||
1666 | */ | ||
1667 | |||
1668 | static int store_udp_mgmt_pkt(char udp_pkt_src, sdla_t* card, | ||
1669 | struct sk_buff *skb, struct net_device* dev, | ||
1670 | chdlc_private_area_t* chdlc_priv_area ) | ||
1671 | { | ||
1672 | int udp_pkt_stored = 0; | ||
1673 | |||
1674 | if(!chdlc_priv_area->udp_pkt_lgth && | ||
1675 | (skb->len <= MAX_LGTH_UDP_MGNT_PKT)) { | ||
1676 | chdlc_priv_area->udp_pkt_lgth = skb->len; | ||
1677 | chdlc_priv_area->udp_pkt_src = udp_pkt_src; | ||
1678 | memcpy(chdlc_priv_area->udp_pkt_data, skb->data, skb->len); | ||
1679 | chdlc_priv_area->timer_int_enabled = TMR_INT_ENABLED_UDP; | ||
1680 | udp_pkt_stored = 1; | ||
1681 | } | ||
1682 | |||
1683 | if(udp_pkt_src == UDP_PKT_FRM_STACK) | ||
1684 | dev_kfree_skb_any(skb); | ||
1685 | else | ||
1686 | dev_kfree_skb_any(skb); | ||
1687 | |||
1688 | return(udp_pkt_stored); | ||
1689 | } | ||
1690 | |||
1691 | |||
1692 | /*============================================================================= | ||
1693 | * Process UDP management packet. | ||
1694 | */ | ||
1695 | |||
1696 | static int process_udp_mgmt_pkt(sdla_t* card, struct net_device* dev, | ||
1697 | chdlc_private_area_t* chdlc_priv_area ) | ||
1698 | { | ||
1699 | unsigned char *buf; | ||
1700 | unsigned int frames, len; | ||
1701 | struct sk_buff *new_skb; | ||
1702 | unsigned short buffer_length, real_len; | ||
1703 | unsigned long data_ptr; | ||
1704 | unsigned data_length; | ||
1705 | int udp_mgmt_req_valid = 1; | ||
1706 | CHDLC_MAILBOX_STRUCT *mb = card->mbox; | ||
1707 | SHARED_MEMORY_INFO_STRUCT *flags = card->u.c.flags; | ||
1708 | chdlc_udp_pkt_t *chdlc_udp_pkt; | ||
1709 | struct timeval tv; | ||
1710 | int err; | ||
1711 | char ut_char; | ||
1712 | |||
1713 | chdlc_udp_pkt = (chdlc_udp_pkt_t *) chdlc_priv_area->udp_pkt_data; | ||
1714 | |||
1715 | if(chdlc_priv_area->udp_pkt_src == UDP_PKT_FRM_NETWORK) { | ||
1716 | |||
1717 | switch(chdlc_udp_pkt->cblock.command) { | ||
1718 | case READ_GLOBAL_STATISTICS: | ||
1719 | case READ_MODEM_STATUS: | ||
1720 | case READ_CHDLC_LINK_STATUS: | ||
1721 | case CPIPE_ROUTER_UP_TIME: | ||
1722 | case READ_COMMS_ERROR_STATS: | ||
1723 | case READ_CHDLC_OPERATIONAL_STATS: | ||
1724 | |||
1725 | /* These two commands are executed for | ||
1726 | * each request */ | ||
1727 | case READ_CHDLC_CONFIGURATION: | ||
1728 | case READ_CHDLC_CODE_VERSION: | ||
1729 | udp_mgmt_req_valid = 1; | ||
1730 | break; | ||
1731 | default: | ||
1732 | udp_mgmt_req_valid = 0; | ||
1733 | break; | ||
1734 | } | ||
1735 | } | ||
1736 | |||
1737 | if(!udp_mgmt_req_valid) { | ||
1738 | |||
1739 | /* set length to 0 */ | ||
1740 | chdlc_udp_pkt->cblock.buffer_length = 0; | ||
1741 | |||
1742 | /* set return code */ | ||
1743 | chdlc_udp_pkt->cblock.return_code = 0xCD; | ||
1744 | |||
1745 | if (net_ratelimit()){ | ||
1746 | printk(KERN_INFO | ||
1747 | "%s: Warning, Illegal UDP command attempted from network: %x\n", | ||
1748 | card->devname,chdlc_udp_pkt->cblock.command); | ||
1749 | } | ||
1750 | |||
1751 | } else { | ||
1752 | unsigned long trace_status_cfg_addr = 0; | ||
1753 | TRACE_STATUS_EL_CFG_STRUCT trace_cfg_struct; | ||
1754 | TRACE_STATUS_ELEMENT_STRUCT trace_element_struct; | ||
1755 | |||
1756 | switch(chdlc_udp_pkt->cblock.command) { | ||
1757 | |||
1758 | case CPIPE_ENABLE_TRACING: | ||
1759 | if (!chdlc_priv_area->TracingEnabled) { | ||
1760 | |||
1761 | /* OPERATE_DATALINE_MONITOR */ | ||
1762 | |||
1763 | mb->buffer_length = sizeof(LINE_TRACE_CONFIG_STRUCT); | ||
1764 | mb->command = SET_TRACE_CONFIGURATION; | ||
1765 | |||
1766 | ((LINE_TRACE_CONFIG_STRUCT *)mb->data)-> | ||
1767 | trace_config = TRACE_ACTIVE; | ||
1768 | /* Trace delay mode is not used because it slows | ||
1769 | down transfer and results in a standoff situation | ||
1770 | when there is a lot of data */ | ||
1771 | |||
1772 | /* Configure the Trace based on user inputs */ | ||
1773 | ((LINE_TRACE_CONFIG_STRUCT *)mb->data)->trace_config |= | ||
1774 | chdlc_udp_pkt->data[0]; | ||
1775 | |||
1776 | ((LINE_TRACE_CONFIG_STRUCT *)mb->data)-> | ||
1777 | trace_deactivation_timer = 4000; | ||
1778 | |||
1779 | |||
1780 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1781 | if (err != COMMAND_OK) { | ||
1782 | chdlc_error(card,err,mb); | ||
1783 | card->TracingEnabled = 0; | ||
1784 | chdlc_udp_pkt->cblock.return_code = err; | ||
1785 | mb->buffer_length = 0; | ||
1786 | break; | ||
1787 | } | ||
1788 | |||
1789 | /* Get the base address of the trace element list */ | ||
1790 | mb->buffer_length = 0; | ||
1791 | mb->command = READ_TRACE_CONFIGURATION; | ||
1792 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1793 | |||
1794 | if (err != COMMAND_OK) { | ||
1795 | chdlc_error(card,err,mb); | ||
1796 | chdlc_priv_area->TracingEnabled = 0; | ||
1797 | chdlc_udp_pkt->cblock.return_code = err; | ||
1798 | mb->buffer_length = 0; | ||
1799 | break; | ||
1800 | } | ||
1801 | |||
1802 | trace_status_cfg_addr =((LINE_TRACE_CONFIG_STRUCT *) | ||
1803 | mb->data) -> ptr_trace_stat_el_cfg_struct; | ||
1804 | |||
1805 | sdla_peek(&card->hw, trace_status_cfg_addr, | ||
1806 | &trace_cfg_struct, sizeof(trace_cfg_struct)); | ||
1807 | |||
1808 | chdlc_priv_area->start_trace_addr = trace_cfg_struct. | ||
1809 | base_addr_trace_status_elements; | ||
1810 | |||
1811 | chdlc_priv_area->number_trace_elements = | ||
1812 | trace_cfg_struct.number_trace_status_elements; | ||
1813 | |||
1814 | chdlc_priv_area->end_trace_addr = (unsigned long) | ||
1815 | ((TRACE_STATUS_ELEMENT_STRUCT *) | ||
1816 | chdlc_priv_area->start_trace_addr + | ||
1817 | (chdlc_priv_area->number_trace_elements - 1)); | ||
1818 | |||
1819 | chdlc_priv_area->base_addr_trace_buffer = | ||
1820 | trace_cfg_struct.base_addr_trace_buffer; | ||
1821 | |||
1822 | chdlc_priv_area->end_addr_trace_buffer = | ||
1823 | trace_cfg_struct.end_addr_trace_buffer; | ||
1824 | |||
1825 | chdlc_priv_area->curr_trace_addr = | ||
1826 | trace_cfg_struct.next_trace_element_to_use; | ||
1827 | |||
1828 | chdlc_priv_area->available_buffer_space = 2000 - | ||
1829 | sizeof(ip_pkt_t) - | ||
1830 | sizeof(udp_pkt_t) - | ||
1831 | sizeof(wp_mgmt_t) - | ||
1832 | sizeof(cblock_t) - | ||
1833 | sizeof(trace_info_t); | ||
1834 | } | ||
1835 | chdlc_udp_pkt->cblock.return_code = COMMAND_OK; | ||
1836 | mb->buffer_length = 0; | ||
1837 | chdlc_priv_area->TracingEnabled = 1; | ||
1838 | break; | ||
1839 | |||
1840 | |||
1841 | case CPIPE_DISABLE_TRACING: | ||
1842 | if (chdlc_priv_area->TracingEnabled) { | ||
1843 | |||
1844 | /* OPERATE_DATALINE_MONITOR */ | ||
1845 | mb->buffer_length = sizeof(LINE_TRACE_CONFIG_STRUCT); | ||
1846 | mb->command = SET_TRACE_CONFIGURATION; | ||
1847 | ((LINE_TRACE_CONFIG_STRUCT *)mb->data)-> | ||
1848 | trace_config = TRACE_INACTIVE; | ||
1849 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
1850 | } | ||
1851 | |||
1852 | chdlc_priv_area->TracingEnabled = 0; | ||
1853 | chdlc_udp_pkt->cblock.return_code = COMMAND_OK; | ||
1854 | mb->buffer_length = 0; | ||
1855 | break; | ||
1856 | |||
1857 | |||
1858 | case CPIPE_GET_TRACE_INFO: | ||
1859 | |||
1860 | if (!chdlc_priv_area->TracingEnabled) { | ||
1861 | chdlc_udp_pkt->cblock.return_code = 1; | ||
1862 | mb->buffer_length = 0; | ||
1863 | break; | ||
1864 | } | ||
1865 | |||
1866 | chdlc_udp_pkt->trace_info.ismoredata = 0x00; | ||
1867 | buffer_length = 0; /* offset of packet already occupied */ | ||
1868 | |||
1869 | for (frames=0; frames < chdlc_priv_area->number_trace_elements; frames++){ | ||
1870 | |||
1871 | trace_pkt_t *trace_pkt = (trace_pkt_t *) | ||
1872 | &chdlc_udp_pkt->data[buffer_length]; | ||
1873 | |||
1874 | sdla_peek(&card->hw, chdlc_priv_area->curr_trace_addr, | ||
1875 | (unsigned char *)&trace_element_struct, | ||
1876 | sizeof(TRACE_STATUS_ELEMENT_STRUCT)); | ||
1877 | |||
1878 | if (trace_element_struct.opp_flag == 0x00) { | ||
1879 | break; | ||
1880 | } | ||
1881 | |||
1882 | /* get pointer to real data */ | ||
1883 | data_ptr = trace_element_struct.ptr_data_bfr; | ||
1884 | |||
1885 | /* See if there is actual data on the trace buffer */ | ||
1886 | if (data_ptr){ | ||
1887 | data_length = trace_element_struct.trace_length; | ||
1888 | }else{ | ||
1889 | data_length = 0; | ||
1890 | chdlc_udp_pkt->trace_info.ismoredata = 0x01; | ||
1891 | } | ||
1892 | |||
1893 | if( (chdlc_priv_area->available_buffer_space - buffer_length) | ||
1894 | < ( sizeof(trace_pkt_t) + data_length) ) { | ||
1895 | |||
1896 | /* indicate there are more frames on board & exit */ | ||
1897 | chdlc_udp_pkt->trace_info.ismoredata = 0x01; | ||
1898 | break; | ||
1899 | } | ||
1900 | |||
1901 | trace_pkt->status = trace_element_struct.trace_type; | ||
1902 | |||
1903 | trace_pkt->time_stamp = | ||
1904 | trace_element_struct.trace_time_stamp; | ||
1905 | |||
1906 | trace_pkt->real_length = | ||
1907 | trace_element_struct.trace_length; | ||
1908 | |||
1909 | /* see if we can fit the frame into the user buffer */ | ||
1910 | real_len = trace_pkt->real_length; | ||
1911 | |||
1912 | if (data_ptr == 0) { | ||
1913 | trace_pkt->data_avail = 0x00; | ||
1914 | } else { | ||
1915 | unsigned tmp = 0; | ||
1916 | |||
1917 | /* get the data from circular buffer | ||
1918 | must check for end of buffer */ | ||
1919 | trace_pkt->data_avail = 0x01; | ||
1920 | |||
1921 | if ((data_ptr + real_len) > | ||
1922 | chdlc_priv_area->end_addr_trace_buffer + 1){ | ||
1923 | |||
1924 | tmp = chdlc_priv_area->end_addr_trace_buffer - data_ptr + 1; | ||
1925 | sdla_peek(&card->hw, data_ptr, | ||
1926 | trace_pkt->data,tmp); | ||
1927 | data_ptr = chdlc_priv_area->base_addr_trace_buffer; | ||
1928 | } | ||
1929 | |||
1930 | sdla_peek(&card->hw, data_ptr, | ||
1931 | &trace_pkt->data[tmp], real_len - tmp); | ||
1932 | } | ||
1933 | |||
1934 | /* zero the opp flag to show we got the frame */ | ||
1935 | ut_char = 0x00; | ||
1936 | sdla_poke(&card->hw, chdlc_priv_area->curr_trace_addr, &ut_char, 1); | ||
1937 | |||
1938 | /* now move onto the next frame */ | ||
1939 | chdlc_priv_area->curr_trace_addr += sizeof(TRACE_STATUS_ELEMENT_STRUCT); | ||
1940 | |||
1941 | /* check if we went over the last address */ | ||
1942 | if ( chdlc_priv_area->curr_trace_addr > chdlc_priv_area->end_trace_addr ) { | ||
1943 | chdlc_priv_area->curr_trace_addr = chdlc_priv_area->start_trace_addr; | ||
1944 | } | ||
1945 | |||
1946 | if(trace_pkt->data_avail == 0x01) { | ||
1947 | buffer_length += real_len - 1; | ||
1948 | } | ||
1949 | |||
1950 | /* for the header */ | ||
1951 | buffer_length += sizeof(trace_pkt_t); | ||
1952 | |||
1953 | } /* For Loop */ | ||
1954 | |||
1955 | if (frames == chdlc_priv_area->number_trace_elements){ | ||
1956 | chdlc_udp_pkt->trace_info.ismoredata = 0x01; | ||
1957 | } | ||
1958 | chdlc_udp_pkt->trace_info.num_frames = frames; | ||
1959 | |||
1960 | mb->buffer_length = buffer_length; | ||
1961 | chdlc_udp_pkt->cblock.buffer_length = buffer_length; | ||
1962 | |||
1963 | chdlc_udp_pkt->cblock.return_code = COMMAND_OK; | ||
1964 | |||
1965 | break; | ||
1966 | |||
1967 | |||
1968 | case CPIPE_FT1_READ_STATUS: | ||
1969 | ((unsigned char *)chdlc_udp_pkt->data )[0] = | ||
1970 | flags->FT1_info_struct.parallel_port_A_input; | ||
1971 | |||
1972 | ((unsigned char *)chdlc_udp_pkt->data )[1] = | ||
1973 | flags->FT1_info_struct.parallel_port_B_input; | ||
1974 | |||
1975 | chdlc_udp_pkt->cblock.return_code = COMMAND_OK; | ||
1976 | mb->buffer_length = 2; | ||
1977 | break; | ||
1978 | |||
1979 | case CPIPE_ROUTER_UP_TIME: | ||
1980 | do_gettimeofday( &tv ); | ||
1981 | chdlc_priv_area->router_up_time = tv.tv_sec - | ||
1982 | chdlc_priv_area->router_start_time; | ||
1983 | *(unsigned long *)&chdlc_udp_pkt->data = | ||
1984 | chdlc_priv_area->router_up_time; | ||
1985 | mb->buffer_length = sizeof(unsigned long); | ||
1986 | break; | ||
1987 | |||
1988 | case FT1_MONITOR_STATUS_CTRL: | ||
1989 | /* Enable FT1 MONITOR STATUS */ | ||
1990 | if ((chdlc_udp_pkt->data[0] & ENABLE_READ_FT1_STATUS) || | ||
1991 | (chdlc_udp_pkt->data[0] & ENABLE_READ_FT1_OP_STATS)) { | ||
1992 | |||
1993 | if( rCount++ != 0 ) { | ||
1994 | chdlc_udp_pkt->cblock. | ||
1995 | return_code = COMMAND_OK; | ||
1996 | mb->buffer_length = 1; | ||
1997 | break; | ||
1998 | } | ||
1999 | } | ||
2000 | |||
2001 | /* Disable FT1 MONITOR STATUS */ | ||
2002 | if( chdlc_udp_pkt->data[0] == 0) { | ||
2003 | |||
2004 | if( --rCount != 0) { | ||
2005 | chdlc_udp_pkt->cblock. | ||
2006 | return_code = COMMAND_OK; | ||
2007 | mb->buffer_length = 1; | ||
2008 | break; | ||
2009 | } | ||
2010 | } | ||
2011 | |||
2012 | default: | ||
2013 | /* it's a board command */ | ||
2014 | mb->command = chdlc_udp_pkt->cblock.command; | ||
2015 | mb->buffer_length = chdlc_udp_pkt->cblock.buffer_length; | ||
2016 | if (mb->buffer_length) { | ||
2017 | memcpy(&mb->data, (unsigned char *) chdlc_udp_pkt-> | ||
2018 | data, mb->buffer_length); | ||
2019 | } | ||
2020 | /* run the command on the board */ | ||
2021 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
2022 | if (err != COMMAND_OK) { | ||
2023 | break; | ||
2024 | } | ||
2025 | |||
2026 | /* copy the result back to our buffer */ | ||
2027 | memcpy(&chdlc_udp_pkt->cblock, mb, sizeof(cblock_t)); | ||
2028 | |||
2029 | if (mb->buffer_length) { | ||
2030 | memcpy(&chdlc_udp_pkt->data, &mb->data, | ||
2031 | mb->buffer_length); | ||
2032 | } | ||
2033 | |||
2034 | } /* end of switch */ | ||
2035 | } /* end of else */ | ||
2036 | |||
2037 | /* Fill UDP TTL */ | ||
2038 | chdlc_udp_pkt->ip_pkt.ttl = card->wandev.ttl; | ||
2039 | |||
2040 | len = reply_udp(chdlc_priv_area->udp_pkt_data, mb->buffer_length); | ||
2041 | |||
2042 | if(chdlc_priv_area->udp_pkt_src == UDP_PKT_FRM_NETWORK) { | ||
2043 | if(!chdlc_send(card, chdlc_priv_area->udp_pkt_data, len)) { | ||
2044 | ++ card->wandev.stats.tx_packets; | ||
2045 | card->wandev.stats.tx_bytes += len; | ||
2046 | } | ||
2047 | } else { | ||
2048 | |||
2049 | /* Pass it up the stack | ||
2050 | Allocate socket buffer */ | ||
2051 | if ((new_skb = dev_alloc_skb(len)) != NULL) { | ||
2052 | /* copy data into new_skb */ | ||
2053 | |||
2054 | buf = skb_put(new_skb, len); | ||
2055 | memcpy(buf, chdlc_priv_area->udp_pkt_data, len); | ||
2056 | |||
2057 | /* Decapsulate pkt and pass it up the protocol stack */ | ||
2058 | new_skb->protocol = htons(ETH_P_IP); | ||
2059 | new_skb->dev = dev; | ||
2060 | new_skb->mac.raw = new_skb->data; | ||
2061 | |||
2062 | netif_rx(new_skb); | ||
2063 | dev->last_rx = jiffies; | ||
2064 | } else { | ||
2065 | |||
2066 | printk(KERN_INFO "%s: no socket buffers available!\n", | ||
2067 | card->devname); | ||
2068 | } | ||
2069 | } | ||
2070 | |||
2071 | chdlc_priv_area->udp_pkt_lgth = 0; | ||
2072 | |||
2073 | return 0; | ||
2074 | } | ||
2075 | |||
2076 | /*============================================================================ | ||
2077 | * Initialize Receive and Transmit Buffers. | ||
2078 | */ | ||
2079 | |||
2080 | static void init_chdlc_tx_rx_buff(sdla_t* card, struct net_device *dev) | ||
2081 | { | ||
2082 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
2083 | CHDLC_TX_STATUS_EL_CFG_STRUCT *tx_config; | ||
2084 | CHDLC_RX_STATUS_EL_CFG_STRUCT *rx_config; | ||
2085 | char err; | ||
2086 | |||
2087 | mb->buffer_length = 0; | ||
2088 | mb->command = READ_CHDLC_CONFIGURATION; | ||
2089 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
2090 | |||
2091 | if(err != COMMAND_OK) { | ||
2092 | chdlc_error(card,err,mb); | ||
2093 | return; | ||
2094 | } | ||
2095 | |||
2096 | if(card->hw.type == SDLA_S514) { | ||
2097 | tx_config = (CHDLC_TX_STATUS_EL_CFG_STRUCT *)(card->hw.dpmbase + | ||
2098 | (((CHDLC_CONFIGURATION_STRUCT *)mb->data)-> | ||
2099 | ptr_CHDLC_Tx_stat_el_cfg_struct)); | ||
2100 | rx_config = (CHDLC_RX_STATUS_EL_CFG_STRUCT *)(card->hw.dpmbase + | ||
2101 | (((CHDLC_CONFIGURATION_STRUCT *)mb->data)-> | ||
2102 | ptr_CHDLC_Rx_stat_el_cfg_struct)); | ||
2103 | |||
2104 | /* Setup Head and Tails for buffers */ | ||
2105 | card->u.c.txbuf_base = (void *)(card->hw.dpmbase + | ||
2106 | tx_config->base_addr_Tx_status_elements); | ||
2107 | card->u.c.txbuf_last = | ||
2108 | (CHDLC_DATA_TX_STATUS_EL_STRUCT *) | ||
2109 | card->u.c.txbuf_base + | ||
2110 | (tx_config->number_Tx_status_elements - 1); | ||
2111 | |||
2112 | card->u.c.rxbuf_base = (void *)(card->hw.dpmbase + | ||
2113 | rx_config->base_addr_Rx_status_elements); | ||
2114 | card->u.c.rxbuf_last = | ||
2115 | (CHDLC_DATA_RX_STATUS_EL_STRUCT *) | ||
2116 | card->u.c.rxbuf_base + | ||
2117 | (rx_config->number_Rx_status_elements - 1); | ||
2118 | |||
2119 | /* Set up next pointer to be used */ | ||
2120 | card->u.c.txbuf = (void *)(card->hw.dpmbase + | ||
2121 | tx_config->next_Tx_status_element_to_use); | ||
2122 | card->u.c.rxmb = (void *)(card->hw.dpmbase + | ||
2123 | rx_config->next_Rx_status_element_to_use); | ||
2124 | } | ||
2125 | else { | ||
2126 | tx_config = (CHDLC_TX_STATUS_EL_CFG_STRUCT *)(card->hw.dpmbase + | ||
2127 | (((CHDLC_CONFIGURATION_STRUCT *)mb->data)-> | ||
2128 | ptr_CHDLC_Tx_stat_el_cfg_struct % SDLA_WINDOWSIZE)); | ||
2129 | |||
2130 | rx_config = (CHDLC_RX_STATUS_EL_CFG_STRUCT *)(card->hw.dpmbase + | ||
2131 | (((CHDLC_CONFIGURATION_STRUCT *)mb->data)-> | ||
2132 | ptr_CHDLC_Rx_stat_el_cfg_struct % SDLA_WINDOWSIZE)); | ||
2133 | |||
2134 | /* Setup Head and Tails for buffers */ | ||
2135 | card->u.c.txbuf_base = (void *)(card->hw.dpmbase + | ||
2136 | (tx_config->base_addr_Tx_status_elements % SDLA_WINDOWSIZE)); | ||
2137 | card->u.c.txbuf_last = | ||
2138 | (CHDLC_DATA_TX_STATUS_EL_STRUCT *)card->u.c.txbuf_base | ||
2139 | + (tx_config->number_Tx_status_elements - 1); | ||
2140 | card->u.c.rxbuf_base = (void *)(card->hw.dpmbase + | ||
2141 | (rx_config->base_addr_Rx_status_elements % SDLA_WINDOWSIZE)); | ||
2142 | card->u.c.rxbuf_last = | ||
2143 | (CHDLC_DATA_RX_STATUS_EL_STRUCT *)card->u.c.rxbuf_base | ||
2144 | + (rx_config->number_Rx_status_elements - 1); | ||
2145 | |||
2146 | /* Set up next pointer to be used */ | ||
2147 | card->u.c.txbuf = (void *)(card->hw.dpmbase + | ||
2148 | (tx_config->next_Tx_status_element_to_use % SDLA_WINDOWSIZE)); | ||
2149 | card->u.c.rxmb = (void *)(card->hw.dpmbase + | ||
2150 | (rx_config->next_Rx_status_element_to_use % SDLA_WINDOWSIZE)); | ||
2151 | } | ||
2152 | |||
2153 | /* Setup Actual Buffer Start and end addresses */ | ||
2154 | card->u.c.rx_base = rx_config->base_addr_Rx_buffer; | ||
2155 | card->u.c.rx_top = rx_config->end_addr_Rx_buffer; | ||
2156 | |||
2157 | } | ||
2158 | |||
2159 | /*============================================================================= | ||
2160 | * Perform Interrupt Test by running READ_CHDLC_CODE_VERSION command MAX_INTR | ||
2161 | * _TEST_COUNTER times. | ||
2162 | */ | ||
2163 | static int intr_test( sdla_t* card) | ||
2164 | { | ||
2165 | CHDLC_MAILBOX_STRUCT* mb = card->mbox; | ||
2166 | int err,i; | ||
2167 | |||
2168 | Intr_test_counter = 0; | ||
2169 | |||
2170 | /* The critical flag is unset because during initialization (if_open) | ||
2171 | * we want the interrupts to be enabled so that when the wpc_isr is | ||
2172 | * called it does not exit due to critical flag set. | ||
2173 | */ | ||
2174 | |||
2175 | err = chdlc_set_intr_mode(card, APP_INT_ON_COMMAND_COMPLETE); | ||
2176 | |||
2177 | if (err == CMD_OK) { | ||
2178 | for (i = 0; i < MAX_INTR_TEST_COUNTER; i ++) { | ||
2179 | mb->buffer_length = 0; | ||
2180 | mb->command = READ_CHDLC_CODE_VERSION; | ||
2181 | err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT; | ||
2182 | } | ||
2183 | } | ||
2184 | else { | ||
2185 | return err; | ||
2186 | } | ||
2187 | |||
2188 | err = chdlc_set_intr_mode(card, 0); | ||
2189 | |||
2190 | if (err != CMD_OK) | ||
2191 | return err; | ||
2192 | |||
2193 | return 0; | ||
2194 | } | ||
2195 | |||
2196 | /*============================================================================== | ||
2197 | * Determine what type of UDP call it is. CPIPEAB ? | ||
2198 | */ | ||
2199 | static int udp_pkt_type(struct sk_buff *skb, sdla_t* card) | ||
2200 | { | ||
2201 | chdlc_udp_pkt_t *chdlc_udp_pkt = (chdlc_udp_pkt_t *)skb->data; | ||
2202 | |||
2203 | if (!strncmp(chdlc_udp_pkt->wp_mgmt.signature,UDPMGMT_SIGNATURE,8) && | ||
2204 | (chdlc_udp_pkt->udp_pkt.udp_dst_port == ntohs(card->wandev.udp_port)) && | ||
2205 | (chdlc_udp_pkt->ip_pkt.protocol == UDPMGMT_UDP_PROTOCOL) && | ||
2206 | (chdlc_udp_pkt->wp_mgmt.request_reply == UDPMGMT_REQUEST)) { | ||
2207 | return UDP_CPIPE_TYPE; | ||
2208 | } | ||
2209 | else return UDP_INVALID_TYPE; | ||
2210 | } | ||
2211 | |||
2212 | /*============================================================================ | ||
2213 | * Set PORT state. | ||
2214 | */ | ||
2215 | static void port_set_state (sdla_t *card, int state) | ||
2216 | { | ||
2217 | struct net_device *dev = card->wandev.dev; | ||
2218 | chdlc_private_area_t *chdlc_priv_area = dev->priv; | ||
2219 | |||
2220 | if (card->u.c.state != state) | ||
2221 | { | ||
2222 | switch (state) | ||
2223 | { | ||
2224 | case WAN_CONNECTED: | ||
2225 | printk (KERN_INFO "%s: HDLC link connected!\n", | ||
2226 | card->devname); | ||
2227 | break; | ||
2228 | |||
2229 | case WAN_CONNECTING: | ||
2230 | printk (KERN_INFO "%s: HDLC link connecting...\n", | ||
2231 | card->devname); | ||
2232 | break; | ||
2233 | |||
2234 | case WAN_DISCONNECTED: | ||
2235 | printk (KERN_INFO "%s: HDLC link disconnected!\n", | ||
2236 | card->devname); | ||
2237 | break; | ||
2238 | } | ||
2239 | |||
2240 | card->wandev.state = card->u.c.state = state; | ||
2241 | chdlc_priv_area->common.state = state; | ||
2242 | } | ||
2243 | } | ||
2244 | |||
2245 | void s508_lock (sdla_t *card, unsigned long *smp_flags) | ||
2246 | { | ||
2247 | spin_lock_irqsave(&card->wandev.lock, *smp_flags); | ||
2248 | if (card->next){ | ||
2249 | /* It is ok to use spin_lock here, since we | ||
2250 | * already turned off interrupts */ | ||
2251 | spin_lock(&card->next->wandev.lock); | ||
2252 | } | ||
2253 | } | ||
2254 | |||
2255 | void s508_unlock (sdla_t *card, unsigned long *smp_flags) | ||
2256 | { | ||
2257 | if (card->next){ | ||
2258 | spin_unlock(&card->next->wandev.lock); | ||
2259 | } | ||
2260 | spin_unlock_irqrestore(&card->wandev.lock, *smp_flags); | ||
2261 | } | ||
2262 | |||
2263 | |||
2264 | |||
2265 | /*=========================================================================== | ||
2266 | * config_chdlc | ||
2267 | * | ||
2268 | * Configure the chdlc protocol and enable communications. | ||
2269 | * | ||
2270 | * The if_open() function binds this function to the poll routine. | ||
2271 | * Therefore, this function will run every time the chdlc interface | ||
2272 | * is brought up. We cannot run this function from the if_open | ||
2273 | * because if_open does not have access to the remote IP address. | ||
2274 | * | ||
2275 | * If the communications are not enabled, proceed to configure | ||
2276 | * the card and enable communications. | ||
2277 | * | ||
2278 | * If the communications are enabled, it means that the interface | ||
2279 | * was shutdown by ether the user or driver. In this case, we | ||
2280 | * have to check that the IP addresses have not changed. If | ||
2281 | * the IP addresses have changed, we have to reconfigure the firmware | ||
2282 | * and update the changed IP addresses. Otherwise, just exit. | ||
2283 | * | ||
2284 | */ | ||
2285 | |||
2286 | static int config_chdlc (sdla_t *card) | ||
2287 | { | ||
2288 | struct net_device *dev = card->wandev.dev; | ||
2289 | SHARED_MEMORY_INFO_STRUCT *flags = card->u.c.flags; | ||
2290 | |||
2291 | if (card->u.c.comm_enabled){ | ||
2292 | chdlc_comm_disable(card); | ||
2293 | port_set_state(card, WAN_DISCONNECTED); | ||
2294 | } | ||
2295 | |||
2296 | if (set_chdlc_config(card)) { | ||
2297 | printk(KERN_INFO "%s: CHDLC Configuration Failed!\n", | ||
2298 | card->devname); | ||
2299 | return 0; | ||
2300 | } | ||
2301 | init_chdlc_tx_rx_buff(card, dev); | ||
2302 | |||
2303 | /* Set interrupt mode and mask */ | ||
2304 | if (chdlc_set_intr_mode(card, APP_INT_ON_RX_FRAME | | ||
2305 | APP_INT_ON_GLOBAL_EXCEP_COND | | ||
2306 | APP_INT_ON_TX_FRAME | | ||
2307 | APP_INT_ON_CHDLC_EXCEP_COND | APP_INT_ON_TIMER)){ | ||
2308 | printk (KERN_INFO "%s: Failed to set interrupt triggers!\n", | ||
2309 | card->devname); | ||
2310 | return 0; | ||
2311 | } | ||
2312 | |||
2313 | |||
2314 | /* Mask the Transmit and Timer interrupt */ | ||
2315 | flags->interrupt_info_struct.interrupt_permission &= | ||
2316 | ~(APP_INT_ON_TX_FRAME | APP_INT_ON_TIMER); | ||
2317 | |||
2318 | |||
2319 | if (chdlc_comm_enable(card) != 0) { | ||
2320 | printk(KERN_INFO "%s: Failed to enable chdlc communications!\n", | ||
2321 | card->devname); | ||
2322 | flags->interrupt_info_struct.interrupt_permission = 0; | ||
2323 | card->u.c.comm_enabled=0; | ||
2324 | chdlc_set_intr_mode(card,0); | ||
2325 | return 0; | ||
2326 | } | ||
2327 | |||
2328 | /* Initialize Rx/Tx buffer control fields */ | ||
2329 | port_set_state(card, WAN_CONNECTING); | ||
2330 | return 0; | ||
2331 | } | ||
2332 | |||
2333 | |||
2334 | static void send_ppp_term_request(struct net_device *dev) | ||
2335 | { | ||
2336 | struct sk_buff *new_skb; | ||
2337 | unsigned char *buf; | ||
2338 | |||
2339 | if ((new_skb = dev_alloc_skb(8)) != NULL) { | ||
2340 | /* copy data into new_skb */ | ||
2341 | |||
2342 | buf = skb_put(new_skb, 8); | ||
2343 | sprintf(buf,"%c%c%c%c%c%c%c%c", 0xFF,0x03,0xC0,0x21,0x05,0x98,0x00,0x07); | ||
2344 | |||
2345 | /* Decapsulate pkt and pass it up the protocol stack */ | ||
2346 | new_skb->protocol = htons(ETH_P_WAN_PPP); | ||
2347 | new_skb->dev = dev; | ||
2348 | new_skb->mac.raw = new_skb->data; | ||
2349 | |||
2350 | netif_rx(new_skb); | ||
2351 | dev->last_rx = jiffies; | ||
2352 | } | ||
2353 | } | ||
2354 | |||
2355 | |||
2356 | MODULE_LICENSE("GPL"); | ||
2357 | |||
2358 | /****** End ****************************************************************/ | ||