1
2
3#include <linux/kernel.h>
4#include <linux/string.h>
5#include <linux/timer.h>
6#include <linux/ptrace.h>
7#include <linux/errno.h>
8#include <linux/ioport.h>
9#include <linux/interrupt.h>
10#include <linux/in.h>
11#include <linux/if_arp.h>
12#include <linux/netdevice.h>
13#include <linux/etherdevice.h>
14#include <linux/skbuff.h>
15#include <linux/inet.h>
16#include <linux/bitops.h>
17
18#include <asm/processor.h>
19#include <asm/io.h>
20#include <asm/dma.h>
21
22#include <asm/uaccess.h>
23
24#include "lmc.h"
25#include "lmc_var.h"
26#include "lmc_ioctl.h"
27#include "lmc_debug.h"
28
29#define CONFIG_LMC_IGNORE_HARDWARE_HANDSHAKE 1
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48static void lmc_set_protocol (lmc_softc_t * const, lmc_ctl_t *);
49
50
51
52
53
54static void lmc_ds3_init (lmc_softc_t * const);
55static void lmc_ds3_default (lmc_softc_t * const);
56static void lmc_ds3_set_status (lmc_softc_t * const, lmc_ctl_t *);
57static void lmc_ds3_set_100ft (lmc_softc_t * const, int);
58static int lmc_ds3_get_link_status (lmc_softc_t * const);
59static void lmc_ds3_set_crc_length (lmc_softc_t * const, int);
60static void lmc_ds3_set_scram (lmc_softc_t * const, int);
61static void lmc_ds3_watchdog (lmc_softc_t * const);
62
63static void lmc_hssi_init (lmc_softc_t * const);
64static void lmc_hssi_default (lmc_softc_t * const);
65static void lmc_hssi_set_status (lmc_softc_t * const, lmc_ctl_t *);
66static void lmc_hssi_set_clock (lmc_softc_t * const, int);
67static int lmc_hssi_get_link_status (lmc_softc_t * const);
68static void lmc_hssi_set_link_status (lmc_softc_t * const, int);
69static void lmc_hssi_set_crc_length (lmc_softc_t * const, int);
70static void lmc_hssi_watchdog (lmc_softc_t * const);
71
72static void lmc_ssi_init (lmc_softc_t * const);
73static void lmc_ssi_default (lmc_softc_t * const);
74static void lmc_ssi_set_status (lmc_softc_t * const, lmc_ctl_t *);
75static void lmc_ssi_set_clock (lmc_softc_t * const, int);
76static void lmc_ssi_set_speed (lmc_softc_t * const, lmc_ctl_t *);
77static int lmc_ssi_get_link_status (lmc_softc_t * const);
78static void lmc_ssi_set_link_status (lmc_softc_t * const, int);
79static void lmc_ssi_set_crc_length (lmc_softc_t * const, int);
80static void lmc_ssi_watchdog (lmc_softc_t * const);
81
82static void lmc_t1_init (lmc_softc_t * const);
83static void lmc_t1_default (lmc_softc_t * const);
84static void lmc_t1_set_status (lmc_softc_t * const, lmc_ctl_t *);
85static int lmc_t1_get_link_status (lmc_softc_t * const);
86static void lmc_t1_set_circuit_type (lmc_softc_t * const, int);
87static void lmc_t1_set_crc_length (lmc_softc_t * const, int);
88static void lmc_t1_set_clock (lmc_softc_t * const, int);
89static void lmc_t1_watchdog (lmc_softc_t * const);
90
91static void lmc_dummy_set_1 (lmc_softc_t * const, int);
92static void lmc_dummy_set2_1 (lmc_softc_t * const, lmc_ctl_t *);
93
94static inline void write_av9110_bit (lmc_softc_t *, int);
95static void write_av9110(lmc_softc_t *, u32, u32, u32, u32, u32);
96
97lmc_media_t lmc_ds3_media = {
98 lmc_ds3_init,
99 lmc_ds3_default,
100 lmc_ds3_set_status,
101 lmc_dummy_set_1,
102 lmc_dummy_set2_1,
103 lmc_ds3_set_100ft,
104 lmc_ds3_set_scram,
105 lmc_ds3_get_link_status,
106 lmc_dummy_set_1,
107 lmc_ds3_set_crc_length,
108 lmc_dummy_set_1,
109 lmc_ds3_watchdog
110};
111
112lmc_media_t lmc_hssi_media = {
113 lmc_hssi_init,
114 lmc_hssi_default,
115 lmc_hssi_set_status,
116 lmc_hssi_set_clock,
117 lmc_dummy_set2_1,
118 lmc_dummy_set_1,
119 lmc_dummy_set_1,
120 lmc_hssi_get_link_status,
121 lmc_hssi_set_link_status,
122 lmc_hssi_set_crc_length,
123 lmc_dummy_set_1,
124 lmc_hssi_watchdog
125};
126
127lmc_media_t lmc_ssi_media = { lmc_ssi_init,
128 lmc_ssi_default,
129 lmc_ssi_set_status,
130 lmc_ssi_set_clock,
131 lmc_ssi_set_speed,
132 lmc_dummy_set_1,
133 lmc_dummy_set_1,
134 lmc_ssi_get_link_status,
135 lmc_ssi_set_link_status,
136 lmc_ssi_set_crc_length,
137 lmc_dummy_set_1,
138 lmc_ssi_watchdog
139};
140
141lmc_media_t lmc_t1_media = {
142 lmc_t1_init,
143 lmc_t1_default,
144 lmc_t1_set_status,
145 lmc_t1_set_clock,
146 lmc_dummy_set2_1,
147 lmc_dummy_set_1,
148 lmc_dummy_set_1,
149 lmc_t1_get_link_status,
150 lmc_dummy_set_1,
151 lmc_t1_set_crc_length,
152 lmc_t1_set_circuit_type,
153 lmc_t1_watchdog
154};
155
156static void
157lmc_dummy_set_1 (lmc_softc_t * const sc, int a)
158{
159}
160
161static void
162lmc_dummy_set2_1 (lmc_softc_t * const sc, lmc_ctl_t * a)
163{
164}
165
166
167
168
169
170static void
171lmc_hssi_init (lmc_softc_t * const sc)
172{
173 sc->ictl.cardtype = LMC_CTL_CARDTYPE_LMC5200;
174
175 lmc_gpio_mkoutput (sc, LMC_GEP_HSSI_CLOCK);
176}
177
178static void
179lmc_hssi_default (lmc_softc_t * const sc)
180{
181 sc->lmc_miireg16 = LMC_MII16_LED_ALL;
182
183 sc->lmc_media->set_link_status (sc, LMC_LINK_DOWN);
184 sc->lmc_media->set_clock_source (sc, LMC_CTL_CLOCK_SOURCE_EXT);
185 sc->lmc_media->set_crc_length (sc, LMC_CTL_CRC_LENGTH_16);
186}
187
188
189
190
191
192static void
193lmc_hssi_set_status (lmc_softc_t * const sc, lmc_ctl_t * ctl)
194{
195 if (ctl == NULL)
196 {
197 sc->lmc_media->set_clock_source (sc, sc->ictl.clock_source);
198 lmc_set_protocol (sc, NULL);
199
200 return;
201 }
202
203
204
205
206 if (ctl->clock_source && !sc->ictl.clock_source)
207 {
208 sc->lmc_media->set_clock_source (sc, LMC_CTL_CLOCK_SOURCE_INT);
209 sc->lmc_timing = LMC_CTL_CLOCK_SOURCE_INT;
210 }
211 else if (!ctl->clock_source && sc->ictl.clock_source)
212 {
213 sc->lmc_timing = LMC_CTL_CLOCK_SOURCE_EXT;
214 sc->lmc_media->set_clock_source (sc, LMC_CTL_CLOCK_SOURCE_EXT);
215 }
216
217 lmc_set_protocol (sc, ctl);
218}
219
220
221
222
223static void
224lmc_hssi_set_clock (lmc_softc_t * const sc, int ie)
225{
226 int old;
227 old = sc->ictl.clock_source;
228 if (ie == LMC_CTL_CLOCK_SOURCE_EXT)
229 {
230 sc->lmc_gpio |= LMC_GEP_HSSI_CLOCK;
231 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
232 sc->ictl.clock_source = LMC_CTL_CLOCK_SOURCE_EXT;
233 if(old != ie)
234 printk (LMC_PRINTF_FMT ": clock external\n", LMC_PRINTF_ARGS);
235 }
236 else
237 {
238 sc->lmc_gpio &= ~(LMC_GEP_HSSI_CLOCK);
239 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
240 sc->ictl.clock_source = LMC_CTL_CLOCK_SOURCE_INT;
241 if(old != ie)
242 printk (LMC_PRINTF_FMT ": clock internal\n", LMC_PRINTF_ARGS);
243 }
244}
245
246
247
248
249
250static int
251lmc_hssi_get_link_status (lmc_softc_t * const sc)
252{
253
254
255
256
257 return lmc_ssi_get_link_status(sc);
258}
259
260static void
261lmc_hssi_set_link_status (lmc_softc_t * const sc, int state)
262{
263 if (state == LMC_LINK_UP)
264 sc->lmc_miireg16 |= LMC_MII16_HSSI_TA;
265 else
266 sc->lmc_miireg16 &= ~LMC_MII16_HSSI_TA;
267
268 lmc_mii_writereg (sc, 0, 16, sc->lmc_miireg16);
269}
270
271
272
273
274static void
275lmc_hssi_set_crc_length (lmc_softc_t * const sc, int state)
276{
277 if (state == LMC_CTL_CRC_LENGTH_32)
278 {
279
280 sc->lmc_miireg16 |= LMC_MII16_HSSI_CRC;
281 sc->ictl.crc_length = LMC_CTL_CRC_LENGTH_32;
282 }
283 else
284 {
285
286 sc->lmc_miireg16 &= ~LMC_MII16_HSSI_CRC;
287 sc->ictl.crc_length = LMC_CTL_CRC_LENGTH_16;
288 }
289
290 lmc_mii_writereg (sc, 0, 16, sc->lmc_miireg16);
291}
292
293static void
294lmc_hssi_watchdog (lmc_softc_t * const sc)
295{
296
297}
298
299
300
301
302
303
304
305
306static void
307lmc_ds3_set_100ft (lmc_softc_t * const sc, int ie)
308{
309 if (ie == LMC_CTL_CABLE_LENGTH_GT_100FT)
310 {
311 sc->lmc_miireg16 &= ~LMC_MII16_DS3_ZERO;
312 sc->ictl.cable_length = LMC_CTL_CABLE_LENGTH_GT_100FT;
313 }
314 else if (ie == LMC_CTL_CABLE_LENGTH_LT_100FT)
315 {
316 sc->lmc_miireg16 |= LMC_MII16_DS3_ZERO;
317 sc->ictl.cable_length = LMC_CTL_CABLE_LENGTH_LT_100FT;
318 }
319 lmc_mii_writereg (sc, 0, 16, sc->lmc_miireg16);
320}
321
322static void
323lmc_ds3_default (lmc_softc_t * const sc)
324{
325 sc->lmc_miireg16 = LMC_MII16_LED_ALL;
326
327 sc->lmc_media->set_link_status (sc, LMC_LINK_DOWN);
328 sc->lmc_media->set_cable_length (sc, LMC_CTL_CABLE_LENGTH_LT_100FT);
329 sc->lmc_media->set_scrambler (sc, LMC_CTL_OFF);
330 sc->lmc_media->set_crc_length (sc, LMC_CTL_CRC_LENGTH_16);
331}
332
333
334
335
336
337static void
338lmc_ds3_set_status (lmc_softc_t * const sc, lmc_ctl_t * ctl)
339{
340 if (ctl == NULL)
341 {
342 sc->lmc_media->set_cable_length (sc, sc->ictl.cable_length);
343 sc->lmc_media->set_scrambler (sc, sc->ictl.scrambler_onoff);
344 lmc_set_protocol (sc, NULL);
345
346 return;
347 }
348
349
350
351
352 if (ctl->cable_length && !sc->ictl.cable_length)
353 lmc_ds3_set_100ft (sc, LMC_CTL_CABLE_LENGTH_GT_100FT);
354 else if (!ctl->cable_length && sc->ictl.cable_length)
355 lmc_ds3_set_100ft (sc, LMC_CTL_CABLE_LENGTH_LT_100FT);
356
357
358
359
360 if (ctl->scrambler_onoff && !sc->ictl.scrambler_onoff)
361 lmc_ds3_set_scram (sc, LMC_CTL_ON);
362 else if (!ctl->scrambler_onoff && sc->ictl.scrambler_onoff)
363 lmc_ds3_set_scram (sc, LMC_CTL_OFF);
364
365 lmc_set_protocol (sc, ctl);
366}
367
368static void
369lmc_ds3_init (lmc_softc_t * const sc)
370{
371 int i;
372
373 sc->ictl.cardtype = LMC_CTL_CARDTYPE_LMC5245;
374
375
376 for (i = 0; i < 21; i++)
377 {
378 lmc_mii_writereg (sc, 0, 17, i);
379 lmc_mii_writereg (sc, 0, 18, 0);
380 }
381
382
383 lmc_mii_writereg (sc, 0, 17, 1);
384 lmc_mii_writereg (sc, 0, 18, 0x25);
385
386 lmc_mii_writereg (sc, 0, 17, 5);
387 lmc_mii_writereg (sc, 0, 18, 0x80);
388
389 lmc_mii_writereg (sc, 0, 17, 14);
390 lmc_mii_writereg (sc, 0, 18, 0x30);
391
392
393 for (i = 0; i < 21; i++)
394 {
395 lmc_mii_writereg (sc, 0, 17, i);
396 lmc_mii_readreg (sc, 0, 18);
397 }
398}
399
400
401
402
403static void
404lmc_ds3_set_scram (lmc_softc_t * const sc, int ie)
405{
406 if (ie == LMC_CTL_ON)
407 {
408 sc->lmc_miireg16 |= LMC_MII16_DS3_SCRAM;
409 sc->ictl.scrambler_onoff = LMC_CTL_ON;
410 }
411 else
412 {
413 sc->lmc_miireg16 &= ~LMC_MII16_DS3_SCRAM;
414 sc->ictl.scrambler_onoff = LMC_CTL_OFF;
415 }
416 lmc_mii_writereg (sc, 0, 16, sc->lmc_miireg16);
417}
418
419
420
421
422
423static int
424lmc_ds3_get_link_status (lmc_softc_t * const sc)
425{
426 u16 link_status, link_status_11;
427 int ret = 1;
428
429 lmc_mii_writereg (sc, 0, 17, 7);
430 link_status = lmc_mii_readreg (sc, 0, 18);
431
432
433
434
435
436
437
438
439
440
441
442 lmc_led_on(sc, LMC_DS3_LED2);
443
444 if ((link_status & LMC_FRAMER_REG0_DLOS) ||
445 (link_status & LMC_FRAMER_REG0_OOFS)){
446 ret = 0;
447 if(sc->last_led_err[3] != 1){
448 u16 r1;
449 lmc_mii_writereg (sc, 0, 17, 01);
450 r1 = lmc_mii_readreg (sc, 0, 18);
451 r1 &= 0xfe;
452 lmc_mii_writereg(sc, 0, 18, r1);
453 printk(KERN_WARNING "%s: Red Alarm - Loss of Signal or Loss of Framing\n", sc->name);
454 }
455 lmc_led_on(sc, LMC_DS3_LED3);
456 sc->last_led_err[3] = 1;
457 }
458 else {
459 lmc_led_off(sc, LMC_DS3_LED3);
460 if(sc->last_led_err[3] == 1){
461 u16 r1;
462 lmc_mii_writereg (sc, 0, 17, 01);
463 r1 = lmc_mii_readreg (sc, 0, 18);
464 r1 |= 0x01;
465 lmc_mii_writereg(sc, 0, 18, r1);
466 }
467 sc->last_led_err[3] = 0;
468 }
469
470 lmc_mii_writereg(sc, 0, 17, 0x10);
471 link_status_11 = lmc_mii_readreg(sc, 0, 18);
472 if((link_status & LMC_FRAMER_REG0_AIS) ||
473 (link_status_11 & LMC_FRAMER_REG10_XBIT)) {
474 ret = 0;
475 if(sc->last_led_err[0] != 1){
476 printk(KERN_WARNING "%s: AIS Alarm or XBit Error\n", sc->name);
477 printk(KERN_WARNING "%s: Remote end has loss of signal or framing\n", sc->name);
478 }
479 lmc_led_on(sc, LMC_DS3_LED0);
480 sc->last_led_err[0] = 1;
481 }
482 else {
483 lmc_led_off(sc, LMC_DS3_LED0);
484 sc->last_led_err[0] = 0;
485 }
486
487 lmc_mii_writereg (sc, 0, 17, 9);
488 link_status = lmc_mii_readreg (sc, 0, 18);
489
490 if(link_status & LMC_FRAMER_REG9_RBLUE){
491 ret = 0;
492 if(sc->last_led_err[1] != 1){
493 printk(KERN_WARNING "%s: Blue Alarm - Receiving all 1's\n", sc->name);
494 }
495 lmc_led_on(sc, LMC_DS3_LED1);
496 sc->last_led_err[1] = 1;
497 }
498 else {
499 lmc_led_off(sc, LMC_DS3_LED1);
500 sc->last_led_err[1] = 0;
501 }
502
503 return ret;
504}
505
506
507
508
509static void
510lmc_ds3_set_crc_length (lmc_softc_t * const sc, int state)
511{
512 if (state == LMC_CTL_CRC_LENGTH_32)
513 {
514
515 sc->lmc_miireg16 |= LMC_MII16_DS3_CRC;
516 sc->ictl.crc_length = LMC_CTL_CRC_LENGTH_32;
517 }
518 else
519 {
520
521 sc->lmc_miireg16 &= ~LMC_MII16_DS3_CRC;
522 sc->ictl.crc_length = LMC_CTL_CRC_LENGTH_16;
523 }
524
525 lmc_mii_writereg (sc, 0, 16, sc->lmc_miireg16);
526}
527
528static void
529lmc_ds3_watchdog (lmc_softc_t * const sc)
530{
531
532}
533
534
535
536
537
538
539static void lmc_ssi_init(lmc_softc_t * const sc)
540{
541 u16 mii17;
542 int cable;
543
544 sc->ictl.cardtype = LMC_CTL_CARDTYPE_LMC1000;
545
546 mii17 = lmc_mii_readreg(sc, 0, 17);
547
548 cable = (mii17 & LMC_MII17_SSI_CABLE_MASK) >> LMC_MII17_SSI_CABLE_SHIFT;
549 sc->ictl.cable_type = cable;
550
551 lmc_gpio_mkoutput(sc, LMC_GEP_SSI_TXCLOCK);
552}
553
554static void
555lmc_ssi_default (lmc_softc_t * const sc)
556{
557 sc->lmc_miireg16 = LMC_MII16_LED_ALL;
558
559
560
561
562 lmc_gpio_mkoutput (sc, LMC_GEP_SSI_TXCLOCK);
563
564 sc->lmc_media->set_link_status (sc, LMC_LINK_DOWN);
565 sc->lmc_media->set_clock_source (sc, LMC_CTL_CLOCK_SOURCE_EXT);
566 sc->lmc_media->set_speed (sc, NULL);
567 sc->lmc_media->set_crc_length (sc, LMC_CTL_CRC_LENGTH_16);
568}
569
570
571
572
573
574static void
575lmc_ssi_set_status (lmc_softc_t * const sc, lmc_ctl_t * ctl)
576{
577 if (ctl == NULL)
578 {
579 sc->lmc_media->set_clock_source (sc, sc->ictl.clock_source);
580 sc->lmc_media->set_speed (sc, &sc->ictl);
581 lmc_set_protocol (sc, NULL);
582
583 return;
584 }
585
586
587
588
589 if (ctl->clock_source == LMC_CTL_CLOCK_SOURCE_INT
590 && sc->ictl.clock_source == LMC_CTL_CLOCK_SOURCE_EXT)
591 {
592 sc->lmc_media->set_clock_source (sc, LMC_CTL_CLOCK_SOURCE_INT);
593 sc->lmc_timing = LMC_CTL_CLOCK_SOURCE_INT;
594 }
595 else if (ctl->clock_source == LMC_CTL_CLOCK_SOURCE_EXT
596 && sc->ictl.clock_source == LMC_CTL_CLOCK_SOURCE_INT)
597 {
598 sc->lmc_media->set_clock_source (sc, LMC_CTL_CLOCK_SOURCE_EXT);
599 sc->lmc_timing = LMC_CTL_CLOCK_SOURCE_EXT;
600 }
601
602 if (ctl->clock_rate != sc->ictl.clock_rate)
603 sc->lmc_media->set_speed (sc, ctl);
604
605 lmc_set_protocol (sc, ctl);
606}
607
608
609
610
611static void
612lmc_ssi_set_clock (lmc_softc_t * const sc, int ie)
613{
614 int old;
615 old = ie;
616 if (ie == LMC_CTL_CLOCK_SOURCE_EXT)
617 {
618 sc->lmc_gpio &= ~(LMC_GEP_SSI_TXCLOCK);
619 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
620 sc->ictl.clock_source = LMC_CTL_CLOCK_SOURCE_EXT;
621 if(ie != old)
622 printk (LMC_PRINTF_FMT ": clock external\n", LMC_PRINTF_ARGS);
623 }
624 else
625 {
626 sc->lmc_gpio |= LMC_GEP_SSI_TXCLOCK;
627 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
628 sc->ictl.clock_source = LMC_CTL_CLOCK_SOURCE_INT;
629 if(ie != old)
630 printk (LMC_PRINTF_FMT ": clock internal\n", LMC_PRINTF_ARGS);
631 }
632}
633
634static void
635lmc_ssi_set_speed (lmc_softc_t * const sc, lmc_ctl_t * ctl)
636{
637 lmc_ctl_t *ictl = &sc->ictl;
638 lmc_av9110_t *av;
639
640
641
642
643
644
645
646 if (ctl == NULL)
647 {
648 av = &ictl->cardspec.ssi;
649 ictl->clock_rate = 1500000;
650 av->f = ictl->clock_rate;
651 av->n = 120;
652 av->m = 100;
653 av->v = 1;
654 av->x = 1;
655 av->r = 2;
656
657 write_av9110 (sc, av->n, av->m, av->v, av->x, av->r);
658 return;
659 }
660
661 av = &ctl->cardspec.ssi;
662
663 if (av->f == 0)
664 return;
665
666 ictl->clock_rate = av->f;
667 ictl->cardspec.ssi = *av;
668
669 write_av9110 (sc, av->n, av->m, av->v, av->x, av->r);
670}
671
672
673
674
675
676static int
677lmc_ssi_get_link_status (lmc_softc_t * const sc)
678{
679 u16 link_status;
680 u32 ticks;
681 int ret = 1;
682 int hw_hdsk = 1;
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704 link_status = lmc_mii_readreg (sc, 0, 16);
705
706
707 ticks = LMC_CSR_READ (sc, csr_gp_timer);
708 ticks = 0x0000ffff - (ticks & 0x0000ffff);
709
710 lmc_led_on (sc, LMC_MII16_LED0);
711
712
713 if (sc->lmc_timing == LMC_CTL_CLOCK_SOURCE_INT) {
714 lmc_led_off(sc, LMC_MII16_LED3);
715 }
716 else if (ticks == 0 ) {
717 ret = 0;
718 if (sc->last_led_err[3] != 1) {
719 sc->extra_stats.tx_lossOfClockCnt++;
720 printk(KERN_WARNING "%s: Lost Clock, Link Down\n", sc->name);
721 }
722 sc->last_led_err[3] = 1;
723 lmc_led_on (sc, LMC_MII16_LED3);
724 }
725 else {
726 if(sc->last_led_err[3] == 1)
727 printk(KERN_WARNING "%s: Clock Returned\n", sc->name);
728 sc->last_led_err[3] = 0;
729 lmc_led_off (sc, LMC_MII16_LED3);
730 }
731
732 if ((link_status & LMC_MII16_SSI_DSR) == 0) {
733 ret = 0;
734 hw_hdsk = 0;
735 }
736
737#ifdef CONFIG_LMC_IGNORE_HARDWARE_HANDSHAKE
738 if ((link_status & (LMC_MII16_SSI_CTS | LMC_MII16_SSI_DCD)) == 0){
739 ret = 0;
740 hw_hdsk = 0;
741 }
742#endif
743
744 if(hw_hdsk == 0){
745 if(sc->last_led_err[1] != 1)
746 printk(KERN_WARNING "%s: DSR not asserted\n", sc->name);
747 sc->last_led_err[1] = 1;
748 lmc_led_off(sc, LMC_MII16_LED1);
749 }
750 else {
751 if(sc->last_led_err[1] != 0)
752 printk(KERN_WARNING "%s: DSR now asserted\n", sc->name);
753 sc->last_led_err[1] = 0;
754 lmc_led_on(sc, LMC_MII16_LED1);
755 }
756
757 if(ret == 1) {
758 lmc_led_on(sc, LMC_MII16_LED2);
759 }
760
761 return ret;
762}
763
764static void
765lmc_ssi_set_link_status (lmc_softc_t * const sc, int state)
766{
767 if (state == LMC_LINK_UP)
768 {
769 sc->lmc_miireg16 |= (LMC_MII16_SSI_DTR | LMC_MII16_SSI_RTS);
770 printk (LMC_PRINTF_FMT ": asserting DTR and RTS\n", LMC_PRINTF_ARGS);
771 }
772 else
773 {
774 sc->lmc_miireg16 &= ~(LMC_MII16_SSI_DTR | LMC_MII16_SSI_RTS);
775 printk (LMC_PRINTF_FMT ": deasserting DTR and RTS\n", LMC_PRINTF_ARGS);
776 }
777
778 lmc_mii_writereg (sc, 0, 16, sc->lmc_miireg16);
779
780}
781
782
783
784
785static void
786lmc_ssi_set_crc_length (lmc_softc_t * const sc, int state)
787{
788 if (state == LMC_CTL_CRC_LENGTH_32)
789 {
790
791 sc->lmc_miireg16 |= LMC_MII16_SSI_CRC;
792 sc->ictl.crc_length = LMC_CTL_CRC_LENGTH_32;
793 sc->lmc_crcSize = LMC_CTL_CRC_BYTESIZE_4;
794
795 }
796 else
797 {
798
799 sc->lmc_miireg16 &= ~LMC_MII16_SSI_CRC;
800 sc->ictl.crc_length = LMC_CTL_CRC_LENGTH_16;
801 sc->lmc_crcSize = LMC_CTL_CRC_BYTESIZE_2;
802 }
803
804 lmc_mii_writereg (sc, 0, 16, sc->lmc_miireg16);
805}
806
807
808
809
810static inline void
811write_av9110_bit (lmc_softc_t * sc, int c)
812{
813
814
815
816 sc->lmc_gpio &= ~(LMC_GEP_CLK);
817 if (c & 0x01)
818 sc->lmc_gpio |= LMC_GEP_DATA;
819 else
820 sc->lmc_gpio &= ~(LMC_GEP_DATA);
821 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
822
823
824
825
826 sc->lmc_gpio |= LMC_GEP_CLK;
827 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
828
829
830
831
832 sc->lmc_gpio &= ~(LMC_GEP_CLK);
833 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
834}
835
836static void write_av9110(lmc_softc_t *sc, u32 n, u32 m, u32 v, u32 x, u32 r)
837{
838 int i;
839
840#if 0
841 printk (LMC_PRINTF_FMT ": speed %u, %d %d %d %d %d\n",
842 LMC_PRINTF_ARGS, sc->ictl.clock_rate, n, m, v, x, r);
843#endif
844
845 sc->lmc_gpio |= LMC_GEP_SSI_GENERATOR;
846 sc->lmc_gpio &= ~(LMC_GEP_DATA | LMC_GEP_CLK);
847 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
848
849
850
851
852
853 lmc_gpio_mkoutput (sc, (LMC_GEP_DATA | LMC_GEP_CLK
854 | LMC_GEP_SSI_GENERATOR));
855
856 sc->lmc_gpio &= ~(LMC_GEP_SSI_GENERATOR);
857 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
858
859
860
861
862 for (i = 0; i < 7; i++)
863 write_av9110_bit (sc, n >> i);
864 for (i = 0; i < 7; i++)
865 write_av9110_bit (sc, m >> i);
866 for (i = 0; i < 1; i++)
867 write_av9110_bit (sc, v >> i);
868 for (i = 0; i < 2; i++)
869 write_av9110_bit (sc, x >> i);
870 for (i = 0; i < 2; i++)
871 write_av9110_bit (sc, r >> i);
872 for (i = 0; i < 5; i++)
873 write_av9110_bit (sc, 0x17 >> i);
874
875
876
877
878 lmc_gpio_mkinput (sc,
879 (LMC_GEP_DATA | LMC_GEP_CLK
880 | LMC_GEP_SSI_GENERATOR));
881}
882
883static void lmc_ssi_watchdog(lmc_softc_t * const sc)
884{
885 u16 mii17 = lmc_mii_readreg(sc, 0, 17);
886 if (((mii17 >> 3) & 7) == 7)
887 lmc_led_off(sc, LMC_MII16_LED2);
888 else
889 lmc_led_on(sc, LMC_MII16_LED2);
890}
891
892
893
894
895
896
897
898
899static void
900lmc_t1_write (lmc_softc_t * const sc, int a, int d)
901{
902 lmc_mii_writereg (sc, 0, 17, a);
903 lmc_mii_writereg (sc, 0, 18, d);
904}
905
906
907
908
909
910
911
912
913
914
915
916static void
917lmc_t1_init (lmc_softc_t * const sc)
918{
919 u16 mii16;
920 int i;
921
922 sc->ictl.cardtype = LMC_CTL_CARDTYPE_LMC1200;
923 mii16 = lmc_mii_readreg (sc, 0, 16);
924
925
926 mii16 &= ~LMC_MII16_T1_RST;
927 lmc_mii_writereg (sc, 0, 16, mii16 | LMC_MII16_T1_RST);
928 lmc_mii_writereg (sc, 0, 16, mii16);
929
930
931 sc->lmc_miireg16 = mii16;
932 lmc_t1_set_circuit_type(sc, LMC_CTL_CIRCUIT_TYPE_T1);
933 mii16 = sc->lmc_miireg16;
934
935 lmc_t1_write (sc, 0x01, 0x1B);
936 lmc_t1_write (sc, 0x02, 0x42);
937 lmc_t1_write (sc, 0x14, 0x00);
938 lmc_t1_write (sc, 0x15, 0x00);
939 lmc_t1_write (sc, 0x18, 0xFF);
940 lmc_t1_write (sc, 0x19, 0x30);
941 lmc_t1_write (sc, 0x1A, 0x0F);
942 lmc_t1_write (sc, 0x20, 0x41);
943 lmc_t1_write (sc, 0x22, 0x76);
944 lmc_t1_write (sc, 0x40, 0x03);
945 lmc_t1_write (sc, 0x45, 0x00);
946 lmc_t1_write (sc, 0x46, 0x05);
947 lmc_t1_write (sc, 0x68, 0x40);
948 lmc_t1_write (sc, 0x70, 0x0D);
949 lmc_t1_write (sc, 0x71, 0x05);
950 lmc_t1_write (sc, 0x72, 0x0B);
951 lmc_t1_write (sc, 0x73, 0x00);
952 lmc_t1_write (sc, 0x74, 0x00);
953 lmc_t1_write (sc, 0x75, 0x00);
954 lmc_t1_write (sc, 0x76, 0x00);
955 lmc_t1_write (sc, 0x77, 0x00);
956 lmc_t1_write (sc, 0x90, 0x05);
957 lmc_t1_write (sc, 0x91, 0x05);
958 lmc_t1_write (sc, 0xA6, 0x00);
959 lmc_t1_write (sc, 0xB1, 0x00);
960 lmc_t1_write (sc, 0xD0, 0x47);
961 lmc_t1_write (sc, 0xD1, 0x70);
962 lmc_t1_write (sc, 0xD4, 0x30);
963 for (i = 0; i < 32; i++)
964 {
965 lmc_t1_write (sc, 0x0E0 + i, 0x00);
966 lmc_t1_write (sc, 0x100 + i, 0x00);
967 lmc_t1_write (sc, 0x180 + i, 0x00);
968 }
969 for (i = 1; i < 25; i++)
970 {
971 lmc_t1_write (sc, 0x0E0 + i, 0x0D);
972 }
973
974 mii16 |= LMC_MII16_T1_XOE;
975 lmc_mii_writereg (sc, 0, 16, mii16);
976 sc->lmc_miireg16 = mii16;
977}
978
979static void
980lmc_t1_default (lmc_softc_t * const sc)
981{
982 sc->lmc_miireg16 = LMC_MII16_LED_ALL;
983 sc->lmc_media->set_link_status (sc, LMC_LINK_DOWN);
984 sc->lmc_media->set_circuit_type (sc, LMC_CTL_CIRCUIT_TYPE_T1);
985 sc->lmc_media->set_crc_length (sc, LMC_CTL_CRC_LENGTH_16);
986
987 sc->ictl.clock_source = LMC_CTL_CLOCK_SOURCE_INT;
988}
989
990
991static void
992lmc_t1_set_status (lmc_softc_t * const sc, lmc_ctl_t * ctl)
993{
994 if (ctl == NULL)
995 {
996 sc->lmc_media->set_circuit_type (sc, sc->ictl.circuit_type);
997 lmc_set_protocol (sc, NULL);
998
999 return;
1000 }
1001
1002
1003 if (ctl->circuit_type == LMC_CTL_CIRCUIT_TYPE_T1
1004 && sc->ictl.circuit_type ==
1005 LMC_CTL_CIRCUIT_TYPE_E1) sc->lmc_media->set_circuit_type (sc,
1006 LMC_CTL_CIRCUIT_TYPE_E1);
1007 else if (ctl->circuit_type == LMC_CTL_CIRCUIT_TYPE_E1
1008 && sc->ictl.circuit_type == LMC_CTL_CIRCUIT_TYPE_T1)
1009 sc->lmc_media->set_circuit_type (sc, LMC_CTL_CIRCUIT_TYPE_T1);
1010 lmc_set_protocol (sc, ctl);
1011}
1012
1013
1014
1015 static int
1016lmc_t1_get_link_status (lmc_softc_t * const sc)
1017{
1018 u16 link_status;
1019 int ret = 1;
1020
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030 lmc_trace(sc->lmc_device, "lmc_t1_get_link_status in");
1031 lmc_led_on(sc, LMC_DS3_LED2);
1032
1033 lmc_mii_writereg (sc, 0, 17, T1FRAMER_ALARM1_STATUS);
1034 link_status = lmc_mii_readreg (sc, 0, 18);
1035
1036
1037 if (link_status & T1F_RAIS) {
1038 ret = 0;
1039 if(sc->last_led_err[1] != 1){
1040 printk(KERN_WARNING "%s: Receive AIS/Blue Alarm. Far end in RED alarm\n", sc->name);
1041 }
1042 lmc_led_on(sc, LMC_DS3_LED1);
1043 sc->last_led_err[1] = 1;
1044 }
1045 else {
1046 if(sc->last_led_err[1] != 0){
1047 printk(KERN_WARNING "%s: End AIS/Blue Alarm\n", sc->name);
1048 }
1049 lmc_led_off (sc, LMC_DS3_LED1);
1050 sc->last_led_err[1] = 0;
1051 }
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063 if (link_status & T1F_RMYEL) {
1064 ret = 0;
1065 if(sc->last_led_err[0] != 1){
1066 printk(KERN_WARNING "%s: Receive Yellow AIS Alarm\n", sc->name);
1067 }
1068 lmc_led_on(sc, LMC_DS3_LED0);
1069 sc->last_led_err[0] = 1;
1070 }
1071 else {
1072 if(sc->last_led_err[0] != 0){
1073 printk(KERN_WARNING "%s: End of Yellow AIS Alarm\n", sc->name);
1074 }
1075 lmc_led_off(sc, LMC_DS3_LED0);
1076 sc->last_led_err[0] = 0;
1077 }
1078
1079
1080
1081
1082
1083 if(link_status & T1F_RLOF){
1084 ret = 0;
1085 if(sc->last_led_err[3] != 1){
1086 printk(KERN_WARNING "%s: Local Red Alarm: Loss of Framing\n", sc->name);
1087 }
1088 lmc_led_on(sc, LMC_DS3_LED3);
1089 sc->last_led_err[3] = 1;
1090
1091 }
1092 else {
1093 if(sc->last_led_err[3] != 0){
1094 printk(KERN_WARNING "%s: End Red Alarm (LOF)\n", sc->name);
1095 }
1096 if( ! (link_status & T1F_RLOS))
1097 lmc_led_off(sc, LMC_DS3_LED3);
1098 sc->last_led_err[3] = 0;
1099 }
1100
1101 if(link_status & T1F_RLOS){
1102 ret = 0;
1103 if(sc->last_led_err[2] != 1){
1104 printk(KERN_WARNING "%s: Local Red Alarm: Loss of Signal\n", sc->name);
1105 }
1106 lmc_led_on(sc, LMC_DS3_LED3);
1107 sc->last_led_err[2] = 1;
1108
1109 }
1110 else {
1111 if(sc->last_led_err[2] != 0){
1112 printk(KERN_WARNING "%s: End Red Alarm (LOS)\n", sc->name);
1113 }
1114 if( ! (link_status & T1F_RLOF))
1115 lmc_led_off(sc, LMC_DS3_LED3);
1116 sc->last_led_err[2] = 0;
1117 }
1118
1119 sc->lmc_xinfo.t1_alarm1_status = link_status;
1120
1121 lmc_mii_writereg (sc, 0, 17, T1FRAMER_ALARM2_STATUS);
1122 sc->lmc_xinfo.t1_alarm2_status = lmc_mii_readreg (sc, 0, 18);
1123
1124
1125 lmc_trace(sc->lmc_device, "lmc_t1_get_link_status out");
1126
1127 return ret;
1128}
1129
1130
1131
1132
1133static void
1134lmc_t1_set_circuit_type (lmc_softc_t * const sc, int ie)
1135{
1136 if (ie == LMC_CTL_CIRCUIT_TYPE_T1) {
1137 sc->lmc_miireg16 |= LMC_MII16_T1_Z;
1138 sc->ictl.circuit_type = LMC_CTL_CIRCUIT_TYPE_T1;
1139 printk(KERN_INFO "%s: In T1 Mode\n", sc->name);
1140 }
1141 else {
1142 sc->lmc_miireg16 &= ~LMC_MII16_T1_Z;
1143 sc->ictl.circuit_type = LMC_CTL_CIRCUIT_TYPE_E1;
1144 printk(KERN_INFO "%s: In E1 Mode\n", sc->name);
1145 }
1146
1147 lmc_mii_writereg (sc, 0, 16, sc->lmc_miireg16);
1148
1149}
1150
1151
1152
1153static void
1154lmc_t1_set_crc_length (lmc_softc_t * const sc, int state)
1155{
1156 if (state == LMC_CTL_CRC_LENGTH_32)
1157 {
1158
1159 sc->lmc_miireg16 |= LMC_MII16_T1_CRC;
1160 sc->ictl.crc_length = LMC_CTL_CRC_LENGTH_32;
1161 sc->lmc_crcSize = LMC_CTL_CRC_BYTESIZE_4;
1162
1163 }
1164 else
1165 {
1166 sc->lmc_miireg16 &= ~LMC_MII16_T1_CRC;
1167 sc->ictl.crc_length = LMC_CTL_CRC_LENGTH_16;
1168 sc->lmc_crcSize = LMC_CTL_CRC_BYTESIZE_2;
1169
1170 }
1171
1172 lmc_mii_writereg (sc, 0, 16, sc->lmc_miireg16);
1173}
1174
1175
1176
1177
1178static void
1179lmc_t1_set_clock (lmc_softc_t * const sc, int ie)
1180{
1181 int old;
1182 old = ie;
1183 if (ie == LMC_CTL_CLOCK_SOURCE_EXT)
1184 {
1185 sc->lmc_gpio &= ~(LMC_GEP_SSI_TXCLOCK);
1186 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
1187 sc->ictl.clock_source = LMC_CTL_CLOCK_SOURCE_EXT;
1188 if(old != ie)
1189 printk (LMC_PRINTF_FMT ": clock external\n", LMC_PRINTF_ARGS);
1190 }
1191 else
1192 {
1193 sc->lmc_gpio |= LMC_GEP_SSI_TXCLOCK;
1194 LMC_CSR_WRITE (sc, csr_gp, sc->lmc_gpio);
1195 sc->ictl.clock_source = LMC_CTL_CLOCK_SOURCE_INT;
1196 if(old != ie)
1197 printk (LMC_PRINTF_FMT ": clock internal\n", LMC_PRINTF_ARGS);
1198 }
1199}
1200
1201static void
1202lmc_t1_watchdog (lmc_softc_t * const sc)
1203{
1204}
1205
1206static void
1207lmc_set_protocol (lmc_softc_t * const sc, lmc_ctl_t * ctl)
1208{
1209 if (!ctl)
1210 sc->ictl.keepalive_onoff = LMC_CTL_ON;
1211}
1212