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