git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_LPC1768_IAR/webserver/emac.c

   1 /*\r
   2     FreeRTOS V9.0.0rc1 - Copyright (C) 2016 Real Time Engineers Ltd.\r
   3     All rights reserved\r
   4 \r
   5     VISIT http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.\r
   6 \r
   7     This file is part of the FreeRTOS distribution.\r
   8 \r
   9     FreeRTOS is free software; you can redistribute it and/or modify it under\r
  10     the terms of the GNU General Public License (version 2) as published by the\r
  11     Free Software Foundation >>>> AND MODIFIED BY <<<< the FreeRTOS exception.\r
  12 \r
  13     ***************************************************************************\r
  14     >>!   NOTE: The modification to the GPL is included to allow you to     !<<\r
  15     >>!   distribute a combined work that includes FreeRTOS without being   !<<\r
  16     >>!   obliged to provide the source code for proprietary components     !<<\r
  17     >>!   outside of the FreeRTOS kernel.                                   !<<\r
  18     ***************************************************************************\r
  19 \r
  20     FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY\r
  21     WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS\r
  22     FOR A PARTICULAR PURPOSE.  Full license text is available on the following\r
  23     link: http://www.freertos.org/a00114.html\r
  24 \r
  25     ***************************************************************************\r
  26      *                                                                       *\r
  27      *    FreeRTOS provides completely free yet professionally developed,    *\r
  28      *    robust, strictly quality controlled, supported, and cross          *\r
  29      *    platform software that is more than just the market leader, it     *\r
  30      *    is the industry's de facto standard.                               *\r
  31      *                                                                       *\r
  32      *    Help yourself get started quickly while simultaneously helping     *\r
  33      *    to support the FreeRTOS project by purchasing a FreeRTOS           *\r
  34      *    tutorial book, reference manual, or both:                          *\r
  35      *    http://www.FreeRTOS.org/Documentation                              *\r
  36      *                                                                       *\r
  37     ***************************************************************************\r
  38 \r
  39     http://www.FreeRTOS.org/FAQHelp.html - Having a problem?  Start by reading\r
  40     the FAQ page "My application does not run, what could be wrong?".  Have you\r
  41     defined configASSERT()?\r
  42 \r
  43     http://www.FreeRTOS.org/support - In return for receiving this top quality\r
  44     embedded software for free we request you assist our global community by\r
  45     participating in the support forum.\r
  46 \r
  47     http://www.FreeRTOS.org/training - Investing in training allows your team to\r
  48     be as productive as possible as early as possible.  Now you can receive\r
  49     FreeRTOS training directly from Richard Barry, CEO of Real Time Engineers\r
  50     Ltd, and the world's leading authority on the world's leading RTOS.\r
  51 \r
  52     http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,\r
  53     including FreeRTOS+Trace - an indispensable productivity tool, a DOS\r
  54     compatible FAT file system, and our tiny thread aware UDP/IP stack.\r
  55 \r
  56     http://www.FreeRTOS.org/labs - Where new FreeRTOS products go to incubate.\r
  57     Come and try FreeRTOS+TCP, our new open source TCP/IP stack for FreeRTOS.\r
  58 \r
  59     http://www.OpenRTOS.com - Real Time Engineers ltd. license FreeRTOS to High\r
  60     Integrity Systems ltd. to sell under the OpenRTOS brand.  Low cost OpenRTOS\r
  61     licenses offer ticketed support, indemnification and commercial middleware.\r
  62 \r
  63     http://www.SafeRTOS.com - High Integrity Systems also provide a safety\r
  64     engineered and independently SIL3 certified version for use in safety and\r
  65     mission critical applications that require provable dependability.\r
  66 \r
  67     1 tab == 4 spaces!\r
  68 */\r
  69 \r
  70 /* Originally adapted from file written by Andreas Dannenberg.  Supplied with permission. */\r
  71 \r
  72 /* Kernel includes. */\r
  73 #include "FreeRTOS.h"\r
  74 #include "task.h"\r
  75 #include "semphr.h"\r
  76 \r
  77 /* Hardware specific includes. */\r
  78 #include "EthDev_LPC17xx.h"\r
  79 \r
  80 /* Time to wait between each inspection of the link status. */\r
  81 #define emacWAIT_FOR_LINK_TO_ESTABLISH ( 500 / portTICK_PERIOD_MS )\r
  82 \r
  83 /* Short delay used in several places during the initialisation process. */\r
  84 #define emacSHORT_DELAY                            ( 2 )\r
  85 \r
  86 /* Hardware specific bit definitions. */\r
  87 #define emacLINK_ESTABLISHED            ( 0x0020)\r
  88 #define emacFULL_DUPLEX_ENABLED         ( 0x0010 )\r
  89 #define emac10BASE_T_MODE                       ( 0x0004 )\r
  90 #define emacPINSEL2_VALUE                       ( 0x50150105 )\r
  91 #define emacDIV_44                                      ( 0x28 )\r
  92 \r
  93 /* If no buffers are available, then wait this long before looking again.... */\r
  94 #define emacBUFFER_WAIT_DELAY   ( 3 / portTICK_PERIOD_MS )\r
  95 \r
  96 /* ...and don't look more than this many times. */\r
  97 #define emacBUFFER_WAIT_ATTEMPTS        ( 30 )\r
  98 \r
  99 /* Index to the Tx descriptor that is always used first for every Tx.  The second\r
 100 descriptor is then used to re-send in order to speed up the uIP Tx process. */\r
 101 #define emacTX_DESC_INDEX                       ( 0 )\r
 102 \r
 103 /*-----------------------------------------------------------*/\r
 104 \r
 105 /*\r
 106  * Configure both the Rx and Tx descriptors during the init process.\r
 107  */\r
 108 static void prvInitDescriptors( void );\r
 109 \r
 110 /*\r
 111  * Setup the IO and peripherals required for Ethernet communication.\r
 112  */\r
 113 static void prvSetupEMACHardware( void );\r
 114 \r
 115 /*\r
 116  * Control the auto negotiate process.\r
 117  */\r
 118 static void prvConfigurePHY( void );\r
 119 \r
 120 /*\r
 121  * Wait for a link to be established, then setup the PHY according to the link\r
 122  * parameters.\r
 123  */\r
 124 static long prvSetupLinkStatus( void );\r
 125 \r
 126 /*\r
 127  * Search the pool of buffers to find one that is free.  If a buffer is found\r
 128  * mark it as in use before returning its address.\r
 129  */\r
 130 static unsigned char *prvGetNextBuffer( void );\r
 131 \r
 132 /*\r
 133  * Return an allocated buffer to the pool of free buffers.\r
 134  */\r
 135 static void prvReturnBuffer( unsigned char *pucBuffer );\r
 136 \r
 137 /*\r
 138  * Send lValue to the lPhyReg within the PHY.\r
 139  */\r
 140 static long prvWritePHY( long lPhyReg, long lValue );\r
 141 \r
 142 /*\r
 143  * Read a value from ucPhyReg within the PHY.  *plStatus will be set to\r
 144  * pdFALSE if there is an error.\r
 145  */\r
 146 static unsigned short prvReadPHY( unsigned char ucPhyReg, long *plStatus );\r
 147 \r
 148 /*-----------------------------------------------------------*/\r
 149 \r
 150 /* The semaphore used to wake the uIP task when data arrives. */\r
 151 extern SemaphoreHandle_t xEMACSemaphore;\r
 152 \r
 153 /* Each ucBufferInUse index corresponds to a position in the pool of buffers.\r
 154 If the index contains a 1 then the buffer within pool is in use, if it\r
 155 contains a 0 then the buffer is free. */\r
 156 static unsigned char ucBufferInUse[ ETH_NUM_BUFFERS ] = { pdFALSE };\r
 157 \r
 158 /* The uip_buffer is not a fixed array, but instead gets pointed to the buffers\r
 159 allocated within this file. */\r
 160 unsigned char * uip_buf;\r
 161 \r
 162 /* Store the length of the data being sent so the data can be sent twice.  The\r
 163 value will be set back to 0 once the data has been sent twice. */\r
 164 static unsigned short usSendLen = 0;\r
 165 \r
 166 /*-----------------------------------------------------------*/\r
 167 \r
 168 long lEMACInit( void )\r
 169 {\r
 170 long lReturn = pdPASS;\r
 171 unsigned long ulID1, ulID2;\r
 172 \r
 173         /* Reset peripherals, configure port pins and registers. */\r
 174         prvSetupEMACHardware();\r
 175 \r
 176         /* Check the PHY part number is as expected. */\r
 177         ulID1 = prvReadPHY( PHY_REG_IDR1, &lReturn );\r
 178         ulID2 = prvReadPHY( PHY_REG_IDR2, &lReturn );\r
 179         if( ( (ulID1 << 16UL ) | ( ulID2 & 0xFFFFUL ) ) == KS8721_ID )\r
 180         {\r
 181                 /* Set the Ethernet MAC Address registers */\r
 182                 EMAC->SA0 = ( configMAC_ADDR0 << 8 ) | configMAC_ADDR1;\r
 183                 EMAC->SA1 = ( configMAC_ADDR2 << 8 ) | configMAC_ADDR3;\r
 184                 EMAC->SA2 = ( configMAC_ADDR4 << 8 ) | configMAC_ADDR5;\r
 185 \r
 186                 /* Initialize Tx and Rx DMA Descriptors */\r
 187                 prvInitDescriptors();\r
 188 \r
 189                 /* Receive broadcast and perfect match packets */\r
 190                 EMAC->RxFilterCtrl = RFC_UCAST_EN | RFC_BCAST_EN | RFC_PERFECT_EN;\r
 191 \r
 192                 /* Setup the PHY. */\r
 193                 prvConfigurePHY();\r
 194         }\r
 195         else\r
 196         {\r
 197                 lReturn = pdFAIL;\r
 198         }\r
 199 \r
 200         /* Check the link status. */\r
 201         if( lReturn == pdPASS )\r
 202         {\r
 203                 lReturn = prvSetupLinkStatus();\r
 204         }\r
 205 \r
 206         if( lReturn == pdPASS )\r
 207         {\r
 208                 /* Initialise uip_buf to ensure it points somewhere valid. */\r
 209                 uip_buf = prvGetNextBuffer();\r
 210 \r
 211                 /* Reset all interrupts */\r
 212                 EMAC->IntClear = ( INT_RX_OVERRUN | INT_RX_ERR | INT_RX_FIN | INT_RX_DONE | INT_TX_UNDERRUN | INT_TX_ERR | INT_TX_FIN | INT_TX_DONE | INT_SOFT_INT | INT_WAKEUP );\r
 213 \r
 214                 /* Enable receive and transmit mode of MAC Ethernet core */\r
 215                 EMAC->Command |= ( CR_RX_EN | CR_TX_EN );\r
 216                 EMAC->MAC1 |= MAC1_REC_EN;\r
 217         }\r
 218 \r
 219         return lReturn;\r
 220 }\r
 221 /*-----------------------------------------------------------*/\r
 222 \r
 223 static unsigned char *prvGetNextBuffer( void )\r
 224 {\r
 225 long x;\r
 226 unsigned char *pucReturn = NULL;\r
 227 unsigned long ulAttempts = 0;\r
 228 \r
 229         while( pucReturn == NULL )\r
 230         {\r
 231                 /* Look through the buffers to find one that is not in use by\r
 232                 anything else. */\r
 233                 for( x = 0; x < ETH_NUM_BUFFERS; x++ )\r
 234                 {\r
 235                         if( ucBufferInUse[ x ] == pdFALSE )\r
 236                         {\r
 237                                 ucBufferInUse[ x ] = pdTRUE;\r
 238                                 pucReturn = ( unsigned char * ) ETH_BUF( x );\r
 239                                 break;\r
 240                         }\r
 241                 }\r
 242 \r
 243                 /* Was a buffer found? */\r
 244                 if( pucReturn == NULL )\r
 245                 {\r
 246                         ulAttempts++;\r
 247 \r
 248                         if( ulAttempts >= emacBUFFER_WAIT_ATTEMPTS )\r
 249                         {\r
 250                                 break;\r
 251                         }\r
 252 \r
 253                         /* Wait then look again. */\r
 254                         vTaskDelay( emacBUFFER_WAIT_DELAY );\r
 255                 }\r
 256         }\r
 257 \r
 258         return pucReturn;\r
 259 }\r
 260 /*-----------------------------------------------------------*/\r
 261 \r
 262 static void prvInitDescriptors( void )\r
 263 {\r
 264 long x, lNextBuffer = 0;\r
 265 \r
 266         for( x = 0; x < NUM_RX_FRAG; x++ )\r
 267         {\r
 268                 /* Allocate the next Ethernet buffer to this descriptor. */\r
 269                 RX_DESC_PACKET( x ) = ETH_BUF( lNextBuffer );\r
 270                 RX_DESC_CTRL( x ) = RCTRL_INT | ( ETH_FRAG_SIZE - 1 );\r
 271                 RX_STAT_INFO( x ) = 0;\r
 272                 RX_STAT_HASHCRC( x ) = 0;\r
 273 \r
 274                 /* The Ethernet buffer is now in use. */\r
 275                 ucBufferInUse[ lNextBuffer ] = pdTRUE;\r
 276                 lNextBuffer++;\r
 277         }\r
 278 \r
 279         /* Set EMAC Receive Descriptor Registers. */\r
 280         EMAC->RxDescriptor = RX_DESC_BASE;\r
 281         EMAC->RxStatus = RX_STAT_BASE;\r
 282         EMAC->RxDescriptorNumber = NUM_RX_FRAG - 1;\r
 283 \r
 284         /* Rx Descriptors Point to 0 */\r
 285         EMAC->RxConsumeIndex = 0;\r
 286 \r
 287         /* A buffer is not allocated to the Tx descriptors until they are actually\r
 288         used. */\r
 289         for( x = 0; x < NUM_TX_FRAG; x++ )\r
 290         {\r
 291                 TX_DESC_PACKET( x ) = ( unsigned long ) NULL;\r
 292                 TX_DESC_CTRL( x ) = 0;\r
 293                 TX_STAT_INFO( x ) = 0;\r
 294         }\r
 295 \r
 296         /* Set EMAC Transmit Descriptor Registers. */\r
 297         EMAC->TxDescriptor = TX_DESC_BASE;\r
 298         EMAC->TxStatus = TX_STAT_BASE;\r
 299         EMAC->TxDescriptorNumber = NUM_TX_FRAG - 1;\r
 300 \r
 301         /* Tx Descriptors Point to 0 */\r
 302         EMAC->TxProduceIndex = 0;\r
 303 }\r
 304 /*-----------------------------------------------------------*/\r
 305 \r
 306 static void prvSetupEMACHardware( void )\r
 307 {\r
 308 unsigned short us;\r
 309 long x, lDummy;\r
 310 \r
 311         /* Enable P1 Ethernet Pins. */\r
 312         PINCON->PINSEL2 = emacPINSEL2_VALUE;\r
 313         PINCON->PINSEL3 = ( PINCON->PINSEL3 & ~0x0000000F ) | 0x00000005;\r
 314 \r
 315         /* Power Up the EMAC controller. */\r
 316         SC->PCONP |= PCONP_PCENET;\r
 317         vTaskDelay( emacSHORT_DELAY );\r
 318 \r
 319         /* Reset all EMAC internal modules. */\r
 320         EMAC->MAC1 = MAC1_RES_TX | MAC1_RES_MCS_TX | MAC1_RES_RX | MAC1_RES_MCS_RX | MAC1_SIM_RES | MAC1_SOFT_RES;\r
 321         EMAC->Command = CR_REG_RES | CR_TX_RES | CR_RX_RES | CR_PASS_RUNT_FRM;\r
 322 \r
 323         /* A short delay after reset. */\r
 324         vTaskDelay( emacSHORT_DELAY );\r
 325 \r
 326         /* Initialize MAC control registers. */\r
 327         EMAC->MAC1 = MAC1_PASS_ALL;\r
 328         EMAC->MAC2 = MAC2_CRC_EN | MAC2_PAD_EN;\r
 329         EMAC->MAXF = ETH_MAX_FLEN;\r
 330         EMAC->CLRT = CLRT_DEF;\r
 331         EMAC->IPGR = IPGR_DEF;\r
 332         EMAC->MCFG = emacDIV_44;\r
 333 \r
 334         /* Enable Reduced MII interface. */\r
 335         EMAC->Command = CR_RMII | CR_PASS_RUNT_FRM;\r
 336 \r
 337         /* Reset Reduced MII Logic. */\r
 338         EMAC->SUPP = SUPP_RES_RMII;\r
 339         vTaskDelay( emacSHORT_DELAY );\r
 340         EMAC->SUPP = 0;\r
 341 \r
 342         /* Put the PHY in reset mode */\r
 343         prvWritePHY( PHY_REG_BMCR, MCFG_RES_MII );\r
 344         prvWritePHY( PHY_REG_BMCR, MCFG_RES_MII );\r
 345 \r
 346         /* Wait for hardware reset to end. */\r
 347         for( x = 0; x < 100; x++ )\r
 348         {\r
 349                 vTaskDelay( emacSHORT_DELAY * 5 );\r
 350                 us = prvReadPHY( PHY_REG_BMCR, &lDummy );\r
 351                 if( !( us & MCFG_RES_MII ) )\r
 352                 {\r
 353                         /* Reset complete */\r
 354                         break;\r
 355                 }\r
 356         }\r
 357 }\r
 358 /*-----------------------------------------------------------*/\r
 359 \r
 360 static void prvConfigurePHY( void )\r
 361 {\r
 362 unsigned short us;\r
 363 long x, lDummy;\r
 364 \r
 365         /* Auto negotiate the configuration. */\r
 366         if( prvWritePHY( PHY_REG_BMCR, PHY_AUTO_NEG ) )\r
 367         {\r
 368                 vTaskDelay( emacSHORT_DELAY * 5 );\r
 369 \r
 370                 for( x = 0; x < 10; x++ )\r
 371                 {\r
 372                         us = prvReadPHY( PHY_REG_BMSR, &lDummy );\r
 373 \r
 374                         if( us & PHY_AUTO_NEG_COMPLETE )\r
 375                         {\r
 376                                 break;\r
 377                         }\r
 378 \r
 379                         vTaskDelay( emacWAIT_FOR_LINK_TO_ESTABLISH );\r
 380                 }\r
 381         }\r
 382 }\r
 383 /*-----------------------------------------------------------*/\r
 384 \r
 385 static long prvSetupLinkStatus( void )\r
 386 {\r
 387 long lReturn = pdFAIL, x;\r
 388 unsigned short usLinkStatus;\r
 389 \r
 390         /* Wait with timeout for the link to be established. */\r
 391         for( x = 0; x < 10; x++ )\r
 392         {\r
 393                 usLinkStatus = prvReadPHY( PHY_CTRLER, &lReturn );\r
 394                 if( usLinkStatus != 0x00 )\r
 395                 {\r
 396                         /* Link is established. */\r
 397                         lReturn = pdPASS;\r
 398                         break;\r
 399                 }\r
 400 \r
 401         vTaskDelay( emacWAIT_FOR_LINK_TO_ESTABLISH );\r
 402         }\r
 403 \r
 404         if( lReturn == pdPASS )\r
 405         {\r
 406                 /* Configure Full/Half Duplex mode. */\r
 407                 if( usLinkStatus & emacFULL_DUPLEX_ENABLED )\r
 408                 {\r
 409                         /* Full duplex is enabled. */\r
 410                         EMAC->MAC2 |= MAC2_FULL_DUP;\r
 411                         EMAC->Command |= CR_FULL_DUP;\r
 412                         EMAC->IPGT = IPGT_FULL_DUP;\r
 413                 }\r
 414                 else\r
 415                 {\r
 416                         /* Half duplex mode. */\r
 417                         EMAC->IPGT = IPGT_HALF_DUP;\r
 418                 }\r
 419 \r
 420                 /* Configure 100MBit/10MBit mode. */\r
 421                 if( usLinkStatus & emac10BASE_T_MODE )\r
 422                 {\r
 423                         /* 10MBit mode. */\r
 424                         EMAC->SUPP = 0;\r
 425                 }\r
 426                 else\r
 427                 {\r
 428                         /* 100MBit mode. */\r
 429                         EMAC->SUPP = SUPP_SPEED;\r
 430                 }\r
 431         }\r
 432 \r
 433         return lReturn;\r
 434 }\r
 435 /*-----------------------------------------------------------*/\r
 436 \r
 437 static void prvReturnBuffer( unsigned char *pucBuffer )\r
 438 {\r
 439 unsigned long ul;\r
 440 \r
 441         /* Return a buffer to the pool of free buffers. */\r
 442         for( ul = 0; ul < ETH_NUM_BUFFERS; ul++ )\r
 443         {\r
 444                 if( ETH_BUF( ul ) == ( unsigned long ) pucBuffer )\r
 445                 {\r
 446                         ucBufferInUse[ ul ] = pdFALSE;\r
 447                         break;\r
 448                 }\r
 449         }\r
 450 }\r
 451 /*-----------------------------------------------------------*/\r
 452 \r
 453 unsigned long ulGetEMACRxData( void )\r
 454 {\r
 455 unsigned long ulLen = 0;\r
 456 long lIndex;\r
 457 \r
 458         if( EMAC->RxProduceIndex != EMAC->RxConsumeIndex )\r
 459         {\r
 460                 /* Mark the current buffer as free as uip_buf is going to be set to\r
 461                 the buffer that contains the received data. */\r
 462                 prvReturnBuffer( uip_buf );\r
 463 \r
 464                 ulLen = ( RX_STAT_INFO( EMAC->RxConsumeIndex ) & RINFO_SIZE ) - 3;\r
 465                 uip_buf = ( unsigned char * ) RX_DESC_PACKET( EMAC->RxConsumeIndex );\r
 466 \r
 467                 /* Allocate a new buffer to the descriptor. */\r
 468         RX_DESC_PACKET( EMAC->RxConsumeIndex ) = ( unsigned long ) prvGetNextBuffer();\r
 469 \r
 470                 /* Move the consume index onto the next position, ensuring it wraps to\r
 471                 the beginning at the appropriate place. */\r
 472                 lIndex = EMAC->RxConsumeIndex;\r
 473 \r
 474                 lIndex++;\r
 475                 if( lIndex >= NUM_RX_FRAG )\r
 476                 {\r
 477                         lIndex = 0;\r
 478                 }\r
 479 \r
 480                 EMAC->RxConsumeIndex = lIndex;\r
 481         }\r
 482 \r
 483         return ulLen;\r
 484 }\r
 485 /*-----------------------------------------------------------*/\r
 486 \r
 487 void vSendEMACTxData( unsigned short usTxDataLen )\r
 488 {\r
 489 unsigned long ulAttempts = 0UL;\r
 490 \r
 491         /* Check to see if the Tx descriptor is free, indicated by its buffer being\r
 492         NULL. */\r
 493         while( TX_DESC_PACKET( emacTX_DESC_INDEX ) != ( unsigned long ) NULL )\r
 494         {\r
 495                 /* Wait for the Tx descriptor to become available. */\r
 496                 vTaskDelay( emacBUFFER_WAIT_DELAY );\r
 497 \r
 498                 ulAttempts++;\r
 499                 if( ulAttempts > emacBUFFER_WAIT_ATTEMPTS )\r
 500                 {\r
 501                         /* Something has gone wrong as the Tx descriptor is still in use.\r
 502                         Clear it down manually, the data it was sending will probably be\r
 503                         lost. */\r
 504                         prvReturnBuffer( ( unsigned char * ) TX_DESC_PACKET( emacTX_DESC_INDEX ) );\r
 505                         break;\r
 506                 }\r
 507         }\r
 508 \r
 509         /* Setup the Tx descriptor for transmission.  Remember the length of the\r
 510         data being sent so the second descriptor can be used to send it again from\r
 511         within the ISR. */\r
 512         usSendLen = usTxDataLen;\r
 513         TX_DESC_PACKET( emacTX_DESC_INDEX ) = ( unsigned long ) uip_buf;\r
 514         TX_DESC_CTRL( emacTX_DESC_INDEX ) = ( usTxDataLen | TCTRL_LAST | TCTRL_INT );\r
 515         EMAC->TxProduceIndex = ( emacTX_DESC_INDEX + 1 );\r
 516 \r
 517         /* uip_buf is being sent by the Tx descriptor.  Allocate a new buffer. */\r
 518         uip_buf = prvGetNextBuffer();\r
 519 }\r
 520 /*-----------------------------------------------------------*/\r
 521 \r
 522 static long prvWritePHY( long lPhyReg, long lValue )\r
 523 {\r
 524 const long lMaxTime = 10;\r
 525 long x;\r
 526 \r
 527         EMAC->MADR = KS8721_DEF_ADR | lPhyReg;\r
 528         EMAC->MWTD = lValue;\r
 529 \r
 530         x = 0;\r
 531         for( x = 0; x < lMaxTime; x++ )\r
 532         {\r
 533                 if( ( EMAC->MIND & MIND_BUSY ) == 0 )\r
 534                 {\r
 535                         /* Operation has finished. */\r
 536                         break;\r
 537                 }\r
 538 \r
 539                 vTaskDelay( emacSHORT_DELAY );\r
 540         }\r
 541 \r
 542         if( x < lMaxTime )\r
 543         {\r
 544                 return pdPASS;\r
 545         }\r
 546         else\r
 547         {\r
 548                 return pdFAIL;\r
 549         }\r
 550 }\r
 551 /*-----------------------------------------------------------*/\r
 552 \r
 553 static unsigned short prvReadPHY( unsigned char ucPhyReg, long *plStatus )\r
 554 {\r
 555 long x;\r
 556 const long lMaxTime = 10;\r
 557 \r
 558         EMAC->MADR = KS8721_DEF_ADR | ucPhyReg;\r
 559         EMAC->MCMD = MCMD_READ;\r
 560 \r
 561         for( x = 0; x < lMaxTime; x++ )\r
 562         {\r
 563                 /* Operation has finished. */\r
 564                 if( ( EMAC->MIND & MIND_BUSY ) == 0 )\r
 565                 {\r
 566                         break;\r
 567                 }\r
 568 \r
 569                 vTaskDelay( emacSHORT_DELAY );\r
 570         }\r
 571 \r
 572         EMAC->MCMD = 0;\r
 573 \r
 574         if( x >= lMaxTime )\r
 575         {\r
 576                 *plStatus = pdFAIL;\r
 577         }\r
 578 \r
 579         return( EMAC->MRDD );\r
 580 }\r
 581 /*-----------------------------------------------------------*/\r
 582 \r
 583 void vEMAC_ISR( void )\r
 584 {\r
 585 unsigned long ulStatus;\r
 586 long lHigherPriorityTaskWoken = pdFALSE;\r
 587 \r
 588         ulStatus = EMAC->IntStatus;\r
 589 \r
 590         /* Clear the interrupt. */\r
 591         EMAC->IntClear = ulStatus;\r
 592 \r
 593         if( ulStatus & INT_RX_DONE )\r
 594         {\r
 595                 /* Ensure the uIP task is not blocked as data has arrived. */\r
 596                 xSemaphoreGiveFromISR( xEMACSemaphore, &lHigherPriorityTaskWoken );\r
 597         }\r
 598 \r
 599         if( ulStatus & INT_TX_DONE )\r
 600         {\r
 601                 if( usSendLen > 0 )\r
 602                 {\r
 603                         /* Send the data again, using the second descriptor.  As there are\r
 604                         only two descriptors the index is set back to 0. */\r
 605                         TX_DESC_PACKET( ( emacTX_DESC_INDEX + 1 ) ) = TX_DESC_PACKET( emacTX_DESC_INDEX );\r
 606                         TX_DESC_CTRL( ( emacTX_DESC_INDEX + 1 ) ) = ( usSendLen | TCTRL_LAST | TCTRL_INT );\r
 607                         EMAC->TxProduceIndex = ( emacTX_DESC_INDEX );\r
 608 \r
 609                         /* This is the second Tx so set usSendLen to 0 to indicate that the\r
 610                         Tx descriptors will be free again. */\r
 611                         usSendLen = 0UL;\r
 612                 }\r
 613                 else\r
 614                 {\r
 615                         /* The Tx buffer is no longer required. */\r
 616                         prvReturnBuffer( ( unsigned char * ) TX_DESC_PACKET( emacTX_DESC_INDEX ) );\r
 617             TX_DESC_PACKET( emacTX_DESC_INDEX ) = ( unsigned long ) NULL;\r
 618                 }\r
 619         }\r
 620 \r
 621         portEND_SWITCHING_ISR( lHigherPriorityTaskWoken );\r
 622 }\r