From b56ddc636ddcaacf7fa497819cc1b9517d610eee Mon Sep 17 00:00:00 2001 From: wdenk Date: Mon, 15 Sep 2003 21:14:37 +0000 Subject: [PATCH] Cleanup of code, output formatting, and indentation. --- drivers/s3c24x0_i2c.c | 2 +- drivers/smc91111.c | 712 ++++++++++++++++++++---------------------- 2 files changed, 347 insertions(+), 367 deletions(-) diff --git a/drivers/s3c24x0_i2c.c b/drivers/s3c24x0_i2c.c index 4158b148cf..2c27cb5458 100644 --- a/drivers/s3c24x0_i2c.c +++ b/drivers/s3c24x0_i2c.c @@ -56,7 +56,7 @@ #define I2C_START_STOP 0x20 /* START / STOP */ #define I2C_TXRX_ENA 0x10 /* I2C Tx/Rx enable */ -#define I2C_TIMEOUT 1 /* 1 seconde */ +#define I2C_TIMEOUT 1 /* 1 second */ static int GetI2CSDA(void) diff --git a/drivers/smc91111.c b/drivers/smc91111.c index 9bee025176..d0cb695c4f 100644 --- a/drivers/smc91111.c +++ b/drivers/smc91111.c @@ -295,38 +295,40 @@ static void smc_write_phy_register(byte phyreg, word phydata); #endif /* !CONFIG_SMC91111_EXT_PHY */ -static int poll4int( byte mask, int timeout ) { - int tmo = get_timer(0) + timeout * CFG_HZ; - int is_timeout = 0; - word old_bank = SMC_inw(BSR_REG); - - PRINTK2("Polling...\n"); - SMC_SELECT_BANK(2); - while((SMC_inw(SMC91111_INT_REG) & mask) == 0) - { - if (get_timer(0) >= tmo) { - is_timeout = 1; - break; +static int poll4int (byte mask, int timeout) +{ + int tmo = get_timer (0) + timeout * CFG_HZ; + int is_timeout = 0; + word old_bank = SMC_inw (BSR_REG); + + PRINTK2 ("Polling...\n"); + SMC_SELECT_BANK (2); + while ((SMC_inw (SMC91111_INT_REG) & mask) == 0) { + if (get_timer (0) >= tmo) { + is_timeout = 1; + break; + } } - } - /* restore old bank selection */ - SMC_SELECT_BANK(old_bank); + /* restore old bank selection */ + SMC_SELECT_BANK (old_bank); - if (is_timeout) - return 1; - else - return 0; + if (is_timeout) + return 1; + else + return 0; } /* Only one release command at a time, please */ -static inline void smc_wait_mmu_release_complete(void) +static inline void smc_wait_mmu_release_complete (void) { int count = 0; + /* assume bank 2 selected */ - while ( SMC_inw(MMU_CMD_REG) & MC_BUSY ) { - udelay(1); /* Wait until not busy */ - if( ++count > 200) break; + while (SMC_inw (MMU_CMD_REG) & MC_BUSY) { + udelay (1); /* Wait until not busy */ + if (++count > 200) + break; } } @@ -347,57 +349,57 @@ static inline void smc_wait_mmu_release_complete(void) . 5. clear all interrupts . */ -static void smc_reset( void ) +static void smc_reset (void) { - PRINTK2("%s:smc_reset\n", SMC_DEV_NAME); + PRINTK2 ("%s:smc_reset\n", SMC_DEV_NAME); /* This resets the registers mostly to defaults, but doesn't affect EEPROM. That seems unnecessary */ - SMC_SELECT_BANK( 0 ); - SMC_outw( RCR_SOFTRST, RCR_REG ); + SMC_SELECT_BANK (0); + SMC_outw (RCR_SOFTRST, RCR_REG); /* Setup the Configuration Register */ /* This is necessary because the CONFIG_REG is not affected */ /* by a soft reset */ - SMC_SELECT_BANK( 1 ); + SMC_SELECT_BANK (1); #if defined(CONFIG_SMC91111_EXT_PHY) - SMC_outw( CONFIG_DEFAULT | CONFIG_EXT_PHY, CONFIG_REG); + SMC_outw (CONFIG_DEFAULT | CONFIG_EXT_PHY, CONFIG_REG); #else - SMC_outw( CONFIG_DEFAULT, CONFIG_REG); + SMC_outw (CONFIG_DEFAULT, CONFIG_REG); #endif /* Release from possible power-down state */ /* Configuration register is not affected by Soft Reset */ - SMC_outw( SMC_inw( CONFIG_REG ) | CONFIG_EPH_POWER_EN, CONFIG_REG ); + SMC_outw (SMC_inw (CONFIG_REG) | CONFIG_EPH_POWER_EN, CONFIG_REG); - SMC_SELECT_BANK( 0 ); + SMC_SELECT_BANK (0); /* this should pause enough for the chip to be happy */ - udelay(10); + udelay (10); /* Disable transmit and receive functionality */ - SMC_outw( RCR_CLEAR, RCR_REG ); - SMC_outw( TCR_CLEAR, TCR_REG ); + SMC_outw (RCR_CLEAR, RCR_REG); + SMC_outw (TCR_CLEAR, TCR_REG); /* set the control register */ - SMC_SELECT_BANK( 1 ); - SMC_outw( CTL_DEFAULT, CTL_REG ); + SMC_SELECT_BANK (1); + SMC_outw (CTL_DEFAULT, CTL_REG); /* Reset the MMU */ - SMC_SELECT_BANK( 2 ); - smc_wait_mmu_release_complete(); - SMC_outw( MC_RESET, MMU_CMD_REG ); - while ( SMC_inw( MMU_CMD_REG ) & MC_BUSY ) - udelay(1); /* Wait until not busy */ + SMC_SELECT_BANK (2); + smc_wait_mmu_release_complete (); + SMC_outw (MC_RESET, MMU_CMD_REG); + while (SMC_inw (MMU_CMD_REG) & MC_BUSY) + udelay (1); /* Wait until not busy */ /* Note: It doesn't seem that waiting for the MMU busy is needed here, but this is a place where future chipsets _COULD_ break. Be wary of issuing another MMU command right after this */ /* Disable all interrupts */ - SMC_outb( 0, IM_REG ); + SMC_outb (0, IM_REG); } /* @@ -467,45 +469,45 @@ static void smc_shutdown() . Enable the transmit interrupt, so I know if it failed . Free the kernel data if I actually sent it. */ -static int smc_send_packet(volatile void *packet, int packet_length) +static int smc_send_packet (volatile void *packet, int packet_length) { - byte packet_no; - unsigned long ioaddr; - byte * buf; - int length; - int numPages; - int try = 0; - int time_out; - byte status; + byte packet_no; + unsigned long ioaddr; + byte *buf; + int length; + int numPages; + int try = 0; + int time_out; + byte status; - PRINTK3("%s:smc_hardware_send_packet\n", SMC_DEV_NAME); + PRINTK3 ("%s:smc_hardware_send_packet\n", SMC_DEV_NAME); length = ETH_ZLEN < packet_length ? packet_length : ETH_ZLEN; /* allocate memory - ** The MMU wants the number of pages to be the number of 256 bytes - ** 'pages', minus 1 ( since a packet can't ever have 0 pages :) ) - ** - ** The 91C111 ignores the size bits, but the code is left intact - ** for backwards and future compatibility. - ** - ** Pkt size for allocating is data length +6 (for additional status - ** words, length and ctl!) - ** - ** If odd size then last byte is included in this header. - */ - numPages = ((length & 0xfffe) + 6); - numPages >>= 8; /* Divide by 256 */ - - if (numPages > 7 ) { - printf("%s: Far too big packet error. \n", SMC_DEV_NAME); + ** The MMU wants the number of pages to be the number of 256 bytes + ** 'pages', minus 1 ( since a packet can't ever have 0 pages :) ) + ** + ** The 91C111 ignores the size bits, but the code is left intact + ** for backwards and future compatibility. + ** + ** Pkt size for allocating is data length +6 (for additional status + ** words, length and ctl!) + ** + ** If odd size then last byte is included in this header. + */ + numPages = ((length & 0xfffe) + 6); + numPages >>= 8; /* Divide by 256 */ + + if (numPages > 7) { + printf ("%s: Far too big packet error. \n", SMC_DEV_NAME); return 0; } /* now, try to allocate the memory */ - SMC_SELECT_BANK( 2 ); - SMC_outw( MC_ALLOC | numPages, MMU_CMD_REG ); + SMC_SELECT_BANK (2); + SMC_outw (MC_ALLOC | numPages, MMU_CMD_REG); /* FIXME: the ALLOC_INT bit never gets set * * so the following will always give a * @@ -518,125 +520,122 @@ again: try++; time_out = MEMORY_WAIT_TIME; do { - status = SMC_inb( SMC91111_INT_REG ); - if ( status & IM_ALLOC_INT ) { + status = SMC_inb (SMC91111_INT_REG); + if (status & IM_ALLOC_INT) { /* acknowledge the interrupt */ - SMC_outb( IM_ALLOC_INT, SMC91111_INT_REG ); + SMC_outb (IM_ALLOC_INT, SMC91111_INT_REG); break; } - } while ( -- time_out ); - - if ( !time_out ) { - PRINTK2("%s: memory allocation, try %d failed ...\n", - SMC_DEV_NAME, try); - if (try < SMC_ALLOC_MAX_TRY) - goto again; - else - return 0; + } while (--time_out); + + if (!time_out) { + PRINTK2 ("%s: memory allocation, try %d failed ...\n", + SMC_DEV_NAME, try); + if (try < SMC_ALLOC_MAX_TRY) + goto again; + else + return 0; } - PRINTK2("%s: memory allocation, try %d succeeded ...\n", - SMC_DEV_NAME, - try); + PRINTK2 ("%s: memory allocation, try %d succeeded ...\n", + SMC_DEV_NAME, try); /* I can send the packet now.. */ ioaddr = SMC_BASE_ADDRESS; - buf = (byte *)packet; + buf = (byte *) packet; /* If I get here, I _know_ there is a packet slot waiting for me */ - packet_no = SMC_inb( AR_REG ); - if ( packet_no & AR_FAILED ) { + packet_no = SMC_inb (AR_REG); + if (packet_no & AR_FAILED) { /* or isn't there? BAD CHIP! */ - printf("%s: Memory allocation failed. \n", - SMC_DEV_NAME); + printf ("%s: Memory allocation failed. \n", SMC_DEV_NAME); return 0; } /* we have a packet address, so tell the card to use it */ - SMC_outb( packet_no, PN_REG ); + SMC_outb (packet_no, PN_REG); /* point to the beginning of the packet */ - SMC_outw( PTR_AUTOINC , PTR_REG ); + SMC_outw (PTR_AUTOINC, PTR_REG); - PRINTK3("%s: Trying to xmit packet of length %x\n", - SMC_DEV_NAME, length); + PRINTK3 ("%s: Trying to xmit packet of length %x\n", + SMC_DEV_NAME, length); #if SMC_DEBUG > 2 - printf("Transmitting Packet\n"); - print_packet( buf, length ); + printf ("Transmitting Packet\n"); + print_packet (buf, length); #endif /* send the packet length ( +6 for status, length and ctl byte ) and the status word ( set to zeros ) */ #ifdef USE_32_BIT - SMC_outl( (length +6 ) << 16 , SMC91111_DATA_REG ); + SMC_outl ((length + 6) << 16, SMC91111_DATA_REG); #else - SMC_outw( 0, SMC91111_DATA_REG ); - /* send the packet length ( +6 for status words, length, and ctl*/ - SMC_outw( (length+6), SMC91111_DATA_REG ); + SMC_outw (0, SMC91111_DATA_REG); + /* send the packet length ( +6 for status words, length, and ctl */ + SMC_outw ((length + 6), SMC91111_DATA_REG); #endif /* send the actual data - . I _think_ it's faster to send the longs first, and then - . mop up by sending the last word. It depends heavily - . on alignment, at least on the 486. Maybe it would be - . a good idea to check which is optimal? But that could take - . almost as much time as is saved? - */ + . I _think_ it's faster to send the longs first, and then + . mop up by sending the last word. It depends heavily + . on alignment, at least on the 486. Maybe it would be + . a good idea to check which is optimal? But that could take + . almost as much time as is saved? + */ #ifdef USE_32_BIT - SMC_outsl(SMC91111_DATA_REG, buf, length >> 2 ); - if ( length & 0x2 ) - SMC_outw(*((word *)(buf + (length & 0xFFFFFFFC))), SMC91111_DATA_REG); + SMC_outsl (SMC91111_DATA_REG, buf, length >> 2); + if (length & 0x2) + SMC_outw (*((word *) (buf + (length & 0xFFFFFFFC))), + SMC91111_DATA_REG); #else - SMC_outsw(SMC91111_DATA_REG , buf, (length ) >> 1); + SMC_outsw (SMC91111_DATA_REG, buf, (length) >> 1); #endif /* USE_32_BIT */ /* Send the last byte, if there is one. */ - if ( (length & 1) == 0 ) { - SMC_outw( 0, SMC91111_DATA_REG ); + if ((length & 1) == 0) { + SMC_outw (0, SMC91111_DATA_REG); } else { - SMC_outw( buf[length -1 ] | 0x2000, SMC91111_DATA_REG ); + SMC_outw (buf[length - 1] | 0x2000, SMC91111_DATA_REG); } /* and let the chipset deal with it */ - SMC_outw( MC_ENQUEUE , MMU_CMD_REG ); + SMC_outw (MC_ENQUEUE, MMU_CMD_REG); /* poll for TX INT */ - if (poll4int(IM_TX_INT, SMC_TX_TIMEOUT)) { + if (poll4int (IM_TX_INT, SMC_TX_TIMEOUT)) { /* sending failed */ - PRINTK2("%s: TX timeout, sending failed...\n", - SMC_DEV_NAME); + PRINTK2 ("%s: TX timeout, sending failed...\n", SMC_DEV_NAME); /* release packet */ - SMC_outw(MC_FREEPKT, MMU_CMD_REG); + SMC_outw (MC_FREEPKT, MMU_CMD_REG); /* wait for MMU getting ready (low) */ - while (SMC_inw(MMU_CMD_REG) & MC_BUSY) - { - udelay(10); + while (SMC_inw (MMU_CMD_REG) & MC_BUSY) { + udelay (10); } - PRINTK2("MMU ready\n"); + PRINTK2 ("MMU ready\n"); return 0; } else { /* ack. int */ - SMC_outw(IM_TX_INT, SMC91111_INT_REG); - PRINTK2("%s: Sent packet of length %d \n", SMC_DEV_NAME, length); + SMC_outw (IM_TX_INT, SMC91111_INT_REG); + PRINTK2 ("%s: Sent packet of length %d \n", SMC_DEV_NAME, + length); /* release packet */ - SMC_outw(MC_FREEPKT, MMU_CMD_REG); + SMC_outw (MC_FREEPKT, MMU_CMD_REG); /* wait for MMU getting ready (low) */ - while (SMC_inw(MMU_CMD_REG) & MC_BUSY) - { - udelay(10); + while (SMC_inw (MMU_CMD_REG) & MC_BUSY) { + udelay (10); } - PRINTK2("MMU ready\n"); + PRINTK2 ("MMU ready\n"); } @@ -667,64 +666,47 @@ void smc_destructor() * Set up everything, reset the card, etc .. * */ -static int smc_open(bd_t *bd) +static int smc_open (bd_t * bd) { - int i, err; + int i, err; - PRINTK2("%s:smc_open\n", SMC_DEV_NAME); + PRINTK2 ("%s:smc_open\n", SMC_DEV_NAME); /* reset the hardware */ - smc_reset(); - smc_enable(); + smc_reset (); + smc_enable (); /* Configure the PHY */ #ifndef CONFIG_SMC91111_EXT_PHY - smc_phy_configure(); + smc_phy_configure (); #endif /* conservative setting (10Mbps, HalfDuplex, no AutoNeg.) */ /* SMC_SELECT_BANK(0); */ /* SMC_outw(0, RPC_REG); */ - SMC_SELECT_BANK(1); - - err = smc_get_ethaddr(bd); /* set smc_mac_addr, and sync it with u-boot globals */ - if(err < 0){ - memset(bd->bi_enetaddr, 0, 6); /* hack to make error stick! upper code will abort if not set*/ - return(-1); /* upper code ignores this, but NOT bi_enetaddr */ - } + SMC_SELECT_BANK (1); + err = smc_get_ethaddr (bd); /* set smc_mac_addr, and sync it with u-boot globals */ + if (err < 0) { + memset (bd->bi_enetaddr, 0, 6); /* hack to make error stick! upper code will abort if not set */ + return (-1); /* upper code ignores this, but NOT bi_enetaddr */ + } #ifdef USE_32_BIT - for ( i = 0; i < 6; i += 2 ) { + for (i = 0; i < 6; i += 2) { word address; - address = smc_mac_addr[ i + 1 ] << 8 ; - address |= smc_mac_addr[ i ]; - SMC_outw( address, ADDR0_REG + i ); + address = smc_mac_addr[i + 1] << 8; + address |= smc_mac_addr[i]; + SMC_outw (address, ADDR0_REG + i); } #else - for ( i = 0; i < 6; i ++ ) - SMC_outb( smc_mac_addr[i], ADDR0_REG + i ); + for (i = 0; i < 6; i++) + SMC_outb (smc_mac_addr[i], ADDR0_REG + i); #endif return 0; } -#if 0 /* dead code? -- wd */ -#ifdef USE_32_BIT -void -insl32(r,b,l) -{ - int __i ; - dword *__b2; - - __b2 = (dword *) b; - for (__i = 0; __i < l; __i++) { - *(__b2 + __i) = *(dword *)(r+0x10000300); - } -} -#endif -#endif - /*------------------------------------------------------------- . . smc_rcv - receive a packet from the card @@ -920,44 +902,40 @@ static int smc_get_reg(int bank, int ioaddr, int reg) /*------------------------------------------------------------ . Debugging function for viewing MII Management serial bitstream .-------------------------------------------------------------*/ -static void smc_dump_mii_stream(byte* bits, int size) +static void smc_dump_mii_stream (byte * bits, int size) { int i; - printf("BIT#:"); - for (i = 0; i < size; ++i) - { - printf("%d", i%10); - } + printf ("BIT#:"); + for (i = 0; i < size; ++i) { + printf ("%d", i % 10); + } - printf("\nMDOE:"); - for (i = 0; i < size; ++i) - { + printf ("\nMDOE:"); + for (i = 0; i < size; ++i) { if (bits[i] & MII_MDOE) - printf("1"); + printf ("1"); else - printf("0"); - } + printf ("0"); + } - printf("\nMDO :"); - for (i = 0; i < size; ++i) - { + printf ("\nMDO :"); + for (i = 0; i < size; ++i) { if (bits[i] & MII_MDO) - printf("1"); + printf ("1"); else - printf("0"); - } + printf ("0"); + } - printf("\nMDI :"); - for (i = 0; i < size; ++i) - { + printf ("\nMDI :"); + for (i = 0; i < size; ++i) { if (bits[i] & MII_MDI) - printf("1"); + printf ("1"); else - printf("0"); - } + printf ("0"); + } - printf("\n"); + printf ("\n"); } #endif @@ -965,7 +943,7 @@ static void smc_dump_mii_stream(byte* bits, int size) . Reads a register from the MII Management serial interface .-------------------------------------------------------------*/ #ifndef CONFIG_SMC91111_EXT_PHY -static word smc_read_phy_register(byte phyreg) +static word smc_read_phy_register (byte phyreg) { int oldBank; int i; @@ -990,9 +968,8 @@ static word smc_read_phy_register(byte phyreg) bits[clk_idx++] = MII_MDOE; /* Output the PHY address, msb first */ - mask = (byte)0x10; - for (i = 0; i < 5; ++i) - { + mask = (byte) 0x10; + for (i = 0; i < 5; ++i) { if (phyaddr & mask) bits[clk_idx++] = MII_MDOE | MII_MDO; else @@ -1000,12 +977,11 @@ static word smc_read_phy_register(byte phyreg) /* Shift to next lowest bit */ mask >>= 1; - } + } /* Output the phy register number, msb first */ - mask = (byte)0x10; - for (i = 0; i < 5; ++i) - { + mask = (byte) 0x10; + for (i = 0; i < 5; ++i) { if (phyreg & mask) bits[clk_idx++] = MII_MDOE | MII_MDO; else @@ -1013,7 +989,7 @@ static word smc_read_phy_register(byte phyreg) /* Shift to next lowest bit */ mask >>= 1; - } + } /* Tristate and turnaround (2 bit times) */ bits[clk_idx++] = 0; @@ -1030,63 +1006,61 @@ static word smc_read_phy_register(byte phyreg) bits[clk_idx++] = 0; /* Save the current bank */ - oldBank = SMC_inw( BANK_SELECT ); + oldBank = SMC_inw (BANK_SELECT); /* Select bank 3 */ - SMC_SELECT_BANK( 3 ); + SMC_SELECT_BANK (3); /* Get the current MII register value */ - mii_reg = SMC_inw( MII_REG ); + mii_reg = SMC_inw (MII_REG); /* Turn off all MII Interface bits */ - mii_reg &= ~(MII_MDOE|MII_MCLK|MII_MDI|MII_MDO); + mii_reg &= ~(MII_MDOE | MII_MCLK | MII_MDI | MII_MDO); /* Clock all 64 cycles */ - for (i = 0; i < sizeof bits; ++i) - { + for (i = 0; i < sizeof bits; ++i) { /* Clock Low - output data */ - SMC_outw( mii_reg | bits[i], MII_REG ); - udelay(SMC_PHY_CLOCK_DELAY); + SMC_outw (mii_reg | bits[i], MII_REG); + udelay (SMC_PHY_CLOCK_DELAY); /* Clock Hi - input data */ - SMC_outw( mii_reg | bits[i] | MII_MCLK, MII_REG ); - udelay(SMC_PHY_CLOCK_DELAY); - bits[i] |= SMC_inw( MII_REG ) & MII_MDI; - } + SMC_outw (mii_reg | bits[i] | MII_MCLK, MII_REG); + udelay (SMC_PHY_CLOCK_DELAY); + bits[i] |= SMC_inw (MII_REG) & MII_MDI; + } /* Return to idle state */ /* Set clock to low, data to low, and output tristated */ - SMC_outw( mii_reg, MII_REG ); - udelay(SMC_PHY_CLOCK_DELAY); + SMC_outw (mii_reg, MII_REG); + udelay (SMC_PHY_CLOCK_DELAY); /* Restore original bank select */ - SMC_SELECT_BANK( oldBank ); + SMC_SELECT_BANK (oldBank); /* Recover input data */ phydata = 0; - for (i = 0; i < 16; ++i) - { + for (i = 0; i < 16; ++i) { phydata <<= 1; if (bits[input_idx++] & MII_MDI) phydata |= 0x0001; - } + } #if (SMC_DEBUG > 2 ) - printf("smc_read_phy_register(): phyaddr=%x,phyreg=%x,phydata=%x\n", + printf ("smc_read_phy_register(): phyaddr=%x,phyreg=%x,phydata=%x\n", phyaddr, phyreg, phydata); - smc_dump_mii_stream(bits, sizeof bits); + smc_dump_mii_stream (bits, sizeof bits); #endif - return(phydata); + return (phydata); } /*------------------------------------------------------------ . Writes a register to the MII Management serial interface .-------------------------------------------------------------*/ -static void smc_write_phy_register(byte phyreg, word phydata) +static void smc_write_phy_register (byte phyreg, word phydata) { int oldBank; int i; @@ -1109,9 +1083,8 @@ static void smc_write_phy_register(byte phyreg, word phydata) bits[clk_idx++] = MII_MDOE | MII_MDO; /* Output the PHY address, msb first */ - mask = (byte)0x10; - for (i = 0; i < 5; ++i) - { + mask = (byte) 0x10; + for (i = 0; i < 5; ++i) { if (phyaddr & mask) bits[clk_idx++] = MII_MDOE | MII_MDO; else @@ -1119,12 +1092,11 @@ static void smc_write_phy_register(byte phyreg, word phydata) /* Shift to next lowest bit */ mask >>= 1; - } + } /* Output the phy register number, msb first */ - mask = (byte)0x10; - for (i = 0; i < 5; ++i) - { + mask = (byte) 0x10; + for (i = 0; i < 5; ++i) { if (phyreg & mask) bits[clk_idx++] = MII_MDOE | MII_MDO; else @@ -1132,7 +1104,7 @@ static void smc_write_phy_register(byte phyreg, word phydata) /* Shift to next lowest bit */ mask >>= 1; - } + } /* Tristate and turnaround (2 bit times) */ bits[clk_idx++] = 0; @@ -1140,8 +1112,7 @@ static void smc_write_phy_register(byte phyreg, word phydata) /* Write out 16 bits of data, msb first */ mask = 0x8000; - for (i = 0; i < 16; ++i) - { + for (i = 0; i < 16; ++i) { if (phydata & mask) bits[clk_idx++] = MII_MDOE | MII_MDO; else @@ -1149,49 +1120,48 @@ static void smc_write_phy_register(byte phyreg, word phydata) /* Shift to next lowest bit */ mask >>= 1; - } + } /* Final clock bit (tristate) */ bits[clk_idx++] = 0; /* Save the current bank */ - oldBank = SMC_inw( BANK_SELECT ); + oldBank = SMC_inw (BANK_SELECT); /* Select bank 3 */ - SMC_SELECT_BANK( 3 ); + SMC_SELECT_BANK (3); /* Get the current MII register value */ - mii_reg = SMC_inw( MII_REG ); + mii_reg = SMC_inw (MII_REG); /* Turn off all MII Interface bits */ - mii_reg &= ~(MII_MDOE|MII_MCLK|MII_MDI|MII_MDO); + mii_reg &= ~(MII_MDOE | MII_MCLK | MII_MDI | MII_MDO); /* Clock all cycles */ - for (i = 0; i < sizeof bits; ++i) - { + for (i = 0; i < sizeof bits; ++i) { /* Clock Low - output data */ - SMC_outw( mii_reg | bits[i], MII_REG ); - udelay(SMC_PHY_CLOCK_DELAY); + SMC_outw (mii_reg | bits[i], MII_REG); + udelay (SMC_PHY_CLOCK_DELAY); /* Clock Hi - input data */ - SMC_outw( mii_reg | bits[i] | MII_MCLK, MII_REG ); - udelay(SMC_PHY_CLOCK_DELAY); - bits[i] |= SMC_inw( MII_REG ) & MII_MDI; - } + SMC_outw (mii_reg | bits[i] | MII_MCLK, MII_REG); + udelay (SMC_PHY_CLOCK_DELAY); + bits[i] |= SMC_inw (MII_REG) & MII_MDI; + } /* Return to idle state */ /* Set clock to low, data to low, and output tristated */ - SMC_outw( mii_reg, MII_REG ); - udelay(SMC_PHY_CLOCK_DELAY); + SMC_outw (mii_reg, MII_REG); + udelay (SMC_PHY_CLOCK_DELAY); /* Restore original bank select */ - SMC_SELECT_BANK( oldBank ); + SMC_SELECT_BANK (oldBank); #if (SMC_DEBUG > 2 ) - printf("smc_write_phy_register(): phyaddr=%x,phyreg=%x,phydata=%x\n", + printf ("smc_write_phy_register(): phyaddr=%x,phyreg=%x,phydata=%x\n", phyaddr, phyreg, phydata); - smc_dump_mii_stream(bits, sizeof bits); + smc_dump_mii_stream (bits, sizeof bits); #endif } #endif /* !CONFIG_SMC91111_EXT_PHY */ @@ -1213,58 +1183,55 @@ static void smc_wait_ms(unsigned int ms) . smc_phy_fixed() if the user has requested a certain config. .-------------------------------------------------------------*/ #ifndef CONFIG_SMC91111_EXT_PHY -static void smc_phy_configure() +static void smc_phy_configure () { int timeout; byte phyaddr; - word my_phy_caps; /* My PHY capabilities */ - word my_ad_caps; /* My Advertised capabilities */ - word status = 0; /*;my status = 0 */ + word my_phy_caps; /* My PHY capabilities */ + word my_ad_caps; /* My Advertised capabilities */ + word status = 0; /*;my status = 0 */ int failed = 0; - PRINTK3("%s:smc_program_phy()\n", SMC_DEV_NAME); + PRINTK3 ("%s:smc_program_phy()\n", SMC_DEV_NAME); /* Get the detected phy address */ phyaddr = SMC_PHY_ADDR; /* Reset the PHY, setting all other bits to zero */ - smc_write_phy_register(PHY_CNTL_REG, PHY_CNTL_RST); + smc_write_phy_register (PHY_CNTL_REG, PHY_CNTL_RST); /* Wait for the reset to complete, or time out */ - timeout = 6; /* Wait up to 3 seconds */ - while (timeout--) - { - if (!(smc_read_phy_register(PHY_CNTL_REG) - & PHY_CNTL_RST)) - { + timeout = 6; /* Wait up to 3 seconds */ + while (timeout--) { + if (!(smc_read_phy_register (PHY_CNTL_REG) + & PHY_CNTL_RST)) { /* reset complete */ break; - } - - smc_wait_ms(500); /* wait 500 millisecs */ } - if (timeout < 1) - { - printf("%s:PHY reset timed out\n", SMC_DEV_NAME); + smc_wait_ms (500); /* wait 500 millisecs */ + } + + if (timeout < 1) { + printf ("%s:PHY reset timed out\n", SMC_DEV_NAME); goto smc_phy_configure_exit; - } + } /* Read PHY Register 18, Status Output */ /* lp->lastPhy18 = smc_read_phy_register(PHY_INT_REG); */ /* Enable PHY Interrupts (for register 18) */ /* Interrupts listed here are disabled */ - smc_write_phy_register(PHY_INT_REG, 0xffff); + smc_write_phy_register (PHY_INT_REG, 0xffff); /* Configure the Receive/Phy Control register */ - SMC_SELECT_BANK( 0 ); - SMC_outw( RPC_DEFAULT, RPC_REG ); + SMC_SELECT_BANK (0); + SMC_outw (RPC_DEFAULT, RPC_REG); /* Copy our capabilities from PHY_STAT_REG to PHY_AD_REG */ - my_phy_caps = smc_read_phy_register(PHY_STAT_REG); - my_ad_caps = PHY_AD_CSMA; /* I am CSMA capable */ + my_phy_caps = smc_read_phy_register (PHY_STAT_REG); + my_ad_caps = PHY_AD_CSMA; /* I am CSMA capable */ if (my_phy_caps & PHY_STAT_CAP_T4) my_ad_caps |= PHY_AD_T4; @@ -1282,64 +1249,61 @@ static void smc_phy_configure() my_ad_caps |= PHY_AD_10_HDX; /* Update our Auto-Neg Advertisement Register */ - smc_write_phy_register( PHY_AD_REG, my_ad_caps); + smc_write_phy_register (PHY_AD_REG, my_ad_caps); - PRINTK2("%s:phy caps=%x\n", SMC_DEV_NAME, my_phy_caps); - PRINTK2("%s:phy advertised caps=%x\n", SMC_DEV_NAME, my_ad_caps); + PRINTK2 ("%s:phy caps=%x\n", SMC_DEV_NAME, my_phy_caps); + PRINTK2 ("%s:phy advertised caps=%x\n", SMC_DEV_NAME, my_ad_caps); /* Restart auto-negotiation process in order to advertise my caps */ - smc_write_phy_register( PHY_CNTL_REG, - PHY_CNTL_ANEG_EN | PHY_CNTL_ANEG_RST ); + smc_write_phy_register (PHY_CNTL_REG, + PHY_CNTL_ANEG_EN | PHY_CNTL_ANEG_RST); /* Wait for the auto-negotiation to complete. This may take from */ /* 2 to 3 seconds. */ /* Wait for the reset to complete, or time out */ - timeout = 20; /* Wait up to 10 seconds */ - while (timeout--) - { - status = smc_read_phy_register( PHY_STAT_REG); - if (status & PHY_STAT_ANEG_ACK) - { + timeout = 20; /* Wait up to 10 seconds */ + while (timeout--) { + status = smc_read_phy_register (PHY_STAT_REG); + if (status & PHY_STAT_ANEG_ACK) { /* auto-negotiate complete */ break; - } + } - smc_wait_ms(500); /* wait 500 millisecs */ + smc_wait_ms (500); /* wait 500 millisecs */ /* Restart auto-negotiation if remote fault */ - if (status & PHY_STAT_REM_FLT) - { - printf("%s:PHY remote fault detected\n", SMC_DEV_NAME); + if (status & PHY_STAT_REM_FLT) { + printf ("%s:PHY remote fault detected\n", + SMC_DEV_NAME); /* Restart auto-negotiation */ - printf("%s:PHY restarting auto-negotiation\n", + printf ("%s:PHY restarting auto-negotiation\n", SMC_DEV_NAME); - smc_write_phy_register( PHY_CNTL_REG, - PHY_CNTL_ANEG_EN | PHY_CNTL_ANEG_RST | - PHY_CNTL_SPEED | PHY_CNTL_DPLX); - } + smc_write_phy_register (PHY_CNTL_REG, + PHY_CNTL_ANEG_EN | + PHY_CNTL_ANEG_RST | + PHY_CNTL_SPEED | + PHY_CNTL_DPLX); } + } - if (timeout < 1) - { - printf("%s:PHY auto-negotiate timed out\n", - SMC_DEV_NAME); - printf("%s:PHY auto-negotiate timed out\n", SMC_DEV_NAME); + if (timeout < 1) { + printf ("%s:PHY auto-negotiate timed out\n", SMC_DEV_NAME); + printf ("%s:PHY auto-negotiate timed out\n", SMC_DEV_NAME); failed = 1; - } + } /* Fail if we detected an auto-negotiate remote fault */ - if (status & PHY_STAT_REM_FLT) - { - printf( "%s:PHY remote fault detected\n", SMC_DEV_NAME); - printf("%s:PHY remote fault detected\n", SMC_DEV_NAME); + if (status & PHY_STAT_REM_FLT) { + printf ("%s:PHY remote fault detected\n", SMC_DEV_NAME); + printf ("%s:PHY remote fault detected\n", SMC_DEV_NAME); failed = 1; - } + } /* Re-Configure the Receive/Phy Control register */ - SMC_outw( RPC_DEFAULT, RPC_REG ); + SMC_outw (RPC_DEFAULT, RPC_REG); - smc_phy_configure_exit: + smc_phy_configure_exit: } #endif /* !CONFIG_SMC91111_EXT_PHY */ @@ -1400,74 +1364,90 @@ int eth_send(volatile void *packet, int length) { return smc_send_packet(packet, length); } -int smc_get_ethaddr(bd_t *bd) +int smc_get_ethaddr (bd_t * bd) { - int env_size, rom_valid, env_present = 0, reg; - char *s = NULL, *e, *v_mac, es[] = "11:22:33:44:55:66"; - uchar s_env_mac[64], v_env_mac[6], v_rom_mac[6]; - - env_size = getenv_r ("ethaddr", s_env_mac, sizeof (s_env_mac)); - if ((env_size > 0) && (env_size < sizeof(es))) { /* exit if env is bad */ - printf("\n*** ERROR: ethaddr is not set properly!!\n"); - return(-1); - } - - if(env_size > 0){ - env_present = 1; - s = s_env_mac; - } - - for (reg = 0; reg < 6; ++reg) { /* turn string into mac value */ - v_env_mac[reg] = s ? simple_strtoul (s, &e, 16) : 0; - if (s) - s = (*e) ? e + 1 : e; - } - - rom_valid = get_rom_mac(v_rom_mac); /* get ROM mac value if any */ - - if(!env_present){ /* if NO env */ - if(rom_valid){ /* but ROM is valid */ - v_mac = v_rom_mac; - sprintf (s_env_mac, "%02X:%02X:%02X:%02X:%02X:%02X", v_mac[0], - v_mac[1] ,v_mac[2], v_mac[3],v_mac[4], v_mac[5]) ; - setenv ("ethaddr", s_env_mac); - }else{ /* no env, bad ROM */ - printf("\n*** ERROR: ethaddr is NOT set !!\n"); - return(-1); + int env_size, rom_valid, env_present = 0, reg; + char *s = NULL, *e, *v_mac, es[] = "11:22:33:44:55:66"; + uchar s_env_mac[64], v_env_mac[6], v_rom_mac[6]; + + env_size = getenv_r ("ethaddr", s_env_mac, sizeof (s_env_mac)); + if ((env_size > 0) && (env_size < sizeof (es))) { /* exit if env is bad */ + printf ("\n*** ERROR: ethaddr is not set properly!!\n"); + return (-1); + } + + if (env_size > 0) { + env_present = 1; + s = s_env_mac; } - }else /* good env, don't care ROM */ - v_mac = v_env_mac; /* always use a good env over a ROM */ - if(env_present && rom_valid) /* if both env and ROM are good */ - if(memcmp(v_env_mac, v_rom_mac, 6) != 0){ - printf("\n*** Warning: Environment and ROM MAC addresses don't match\n"); - printf("*** Using Environment MAC\n"); + for (reg = 0; reg < 6; ++reg) { /* turn string into mac value */ + v_env_mac[reg] = s ? simple_strtoul (s, &e, 16) : 0; + if (s) + s = (*e) ? e + 1 : e; } - memcpy (bd->bi_enetaddr, v_mac, 6); /* update global address to match env (allows env changing) */ - smc_set_mac_addr(v_mac); /* use old function to update smc default */ - return(0); + + rom_valid = get_rom_mac (v_rom_mac); /* get ROM mac value if any */ + + if (!env_present) { /* if NO env */ + if (rom_valid) { /* but ROM is valid */ + v_mac = v_rom_mac; + sprintf (s_env_mac, "%02X:%02X:%02X:%02X:%02X:%02X", + v_mac[0], v_mac[1], v_mac[2], v_mac[3], + v_mac[4], v_mac[5]); + setenv ("ethaddr", s_env_mac); + } else { /* no env, bad ROM */ + printf ("\n*** ERROR: ethaddr is NOT set !!\n"); + return (-1); + } + } else { /* good env, don't care ROM */ + v_mac = v_env_mac; /* always use a good env over a ROM */ + } + + if (env_present && rom_valid) { /* if both env and ROM are good */ + if (memcmp (v_env_mac, v_rom_mac, 6) != 0) { + printf ("\n*** Warning: Environment and ROM MAC addresses don't match\n"); + printf ("*** Using Environment MAC\n"); + ----- + printf ("\nWarning: MAC addresses don't match:\n"); + printf ("\tHW MAC address: " + "%02X:%02X:%02X:%02X:%02X:%02X\n", + v_rom_mac[0], v_rom_mac[1], + v_rom_mac[2], v_rom_mac[3], + v_rom_mac[4], v_rom_mac[5] ); + printf ("\t\"ethaddr\" value: " + "%02X:%02X:%02X:%02X:%02X:%02X\n", + v_env_mac[0], v_env_mac[1], + v_env_mac[2], v_env_mac[3], + v_env_mac[4], v_env_mac[5]) ; + debug ("### Set MAC addr from environment\n"); + memcpy (addr, env_enetaddr, 6); + } + } + memcpy (bd->bi_enetaddr, v_mac, 6); /* update global address to match env (allows env changing) */ + smc_set_mac_addr (v_mac); /* use old function to update smc default */ + return (0); } -int get_rom_mac(char *v_rom_mac) +int get_rom_mac (char *v_rom_mac) { - int is_rom_present = 0; -#ifdef HARDCODE_MAC /* used for testing or to supress run time warnings */ - char hw_mac_addr[] = {0x02, 0x80, 0xad, 0x20, 0x31, 0xb8}; + int is_rom_present = 0; + +#ifdef HARDCODE_MAC /* used for testing or to supress run time warnings */ + char hw_mac_addr[] = { 0x02, 0x80, 0xad, 0x20, 0x31, 0xb8 }; - memcpy (v_rom_mac, hw_mac_addr, 6); - return(1); + memcpy (v_rom_mac, hw_mac_addr, 6); + return (1); #else - if(is_rom_present) - { - /* if eeprom contents are valid - * extract mac address into hw_mac_addr, 8 or 16 bit accesses - * memcpy (v_rom_mac, hc_mac_addr, 6); - * return(1); - */ - } - memset(v_rom_mac, 0, 6); - return(0); + if (is_rom_present) { + /* if eeprom contents are valid + * extract mac address into hw_mac_addr, 8 or 16 bit accesses + * memcpy (v_rom_mac, hc_mac_addr, 6); + * return(1); + */ + } + memset (v_rom_mac, 0, 6); + return (0); #endif } - #endif /* CONFIG_DRIVER_SMC91111 */ -- 2.39.5