12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008 |
- /*
- * Copyright (c) 2015 - 2016, Freescale Semiconductor, Inc.
- * Copyright 2016-2017 NXP
- *
- * Redistribution and use in source and binary forms, with or without modification,
- * are permitted provided that the following conditions are met:
- *
- * o Redistributions of source code must retain the above copyright notice, this list
- * of conditions and the following disclaimer.
- *
- * o Redistributions in binary form must reproduce the above copyright notice, this
- * list of conditions and the following disclaimer in the documentation and/or
- * other materials provided with the distribution.
- *
- * o Neither the name of the copyright holder nor the names of its
- * contributors may be used to endorse or promote products derived from this
- * software without specific prior written permission.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
- * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
- * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
- * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
- * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
- * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
- * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
- * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
- #include "fsl_enet.h"
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- #include "fsl_cache.h"
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- /*******************************************************************************
- * Definitions
- ******************************************************************************/
- /*! @brief IPv4 PTP message IP version offset. */
- #define ENET_PTP1588_IPVERSION_OFFSET 0x0EU
- /*! @brief IPv4 PTP message UDP protocol offset. */
- #define ENET_PTP1588_IPV4_UDP_PROTOCOL_OFFSET 0x17U
- /*! @brief IPv4 PTP message UDP port offset. */
- #define ENET_PTP1588_IPV4_UDP_PORT_OFFSET 0x24U
- /*! @brief IPv4 PTP message UDP message type offset. */
- #define ENET_PTP1588_IPV4_UDP_MSGTYPE_OFFSET 0x2AU
- /*! @brief IPv4 PTP message UDP version offset. */
- #define ENET_PTP1588_IPV4_UDP_VERSION_OFFSET 0x2BU
- /*! @brief IPv4 PTP message UDP clock id offset. */
- #define ENET_PTP1588_IPV4_UDP_CLKID_OFFSET 0x3EU
- /*! @brief IPv4 PTP message UDP sequence id offset. */
- #define ENET_PTP1588_IPV4_UDP_SEQUENCEID_OFFSET 0x48U
- /*! @brief IPv4 PTP message UDP control offset. */
- #define ENET_PTP1588_IPV4_UDP_CTL_OFFSET 0x4AU
- /*! @brief IPv6 PTP message UDP protocol offset. */
- #define ENET_PTP1588_IPV6_UDP_PROTOCOL_OFFSET 0x14U
- /*! @brief IPv6 PTP message UDP port offset. */
- #define ENET_PTP1588_IPV6_UDP_PORT_OFFSET 0x38U
- /*! @brief IPv6 PTP message UDP message type offset. */
- #define ENET_PTP1588_IPV6_UDP_MSGTYPE_OFFSET 0x3EU
- /*! @brief IPv6 PTP message UDP version offset. */
- #define ENET_PTP1588_IPV6_UDP_VERSION_OFFSET 0x3FU
- /*! @brief IPv6 PTP message UDP clock id offset. */
- #define ENET_PTP1588_IPV6_UDP_CLKID_OFFSET 0x52U
- /*! @brief IPv6 PTP message UDP sequence id offset. */
- #define ENET_PTP1588_IPV6_UDP_SEQUENCEID_OFFSET 0x5CU
- /*! @brief IPv6 PTP message UDP control offset. */
- #define ENET_PTP1588_IPV6_UDP_CTL_OFFSET 0x5EU
- /*! @brief PTPv2 message Ethernet packet type offset. */
- #define ENET_PTP1588_ETHL2_PACKETTYPE_OFFSET 0x0CU
- /*! @brief PTPv2 message Ethernet message type offset. */
- #define ENET_PTP1588_ETHL2_MSGTYPE_OFFSET 0x0EU
- /*! @brief PTPv2 message Ethernet version type offset. */
- #define ENET_PTP1588_ETHL2_VERSION_OFFSET 0X0FU
- /*! @brief PTPv2 message Ethernet clock id offset. */
- #define ENET_PTP1588_ETHL2_CLOCKID_OFFSET 0x22
- /*! @brief PTPv2 message Ethernet sequence id offset. */
- #define ENET_PTP1588_ETHL2_SEQUENCEID_OFFSET 0x2c
- /*! @brief Packet type Ethernet IEEE802.3 for PTPv2. */
- #define ENET_ETHERNETL2 0x88F7U
- /*! @brief Packet type IPv4. */
- #define ENET_IPV4 0x0800U
- /*! @brief Packet type IPv6. */
- #define ENET_IPV6 0x86ddU
- /*! @brief Packet type VLAN. */
- #define ENET_8021QVLAN 0x8100U
- /*! @brief UDP protocol type. */
- #define ENET_UDPVERSION 0x0011U
- /*! @brief Packet IP version IPv4. */
- #define ENET_IPV4VERSION 0x0004U
- /*! @brief Packet IP version IPv6. */
- #define ENET_IPV6VERSION 0x0006U
- /*! @brief Ethernet mac address length. */
- #define ENET_FRAME_MACLEN 6U
- /*! @brief Ethernet VLAN header length. */
- #define ENET_FRAME_VLAN_TAGLEN 4U
- /*! @brief MDC frequency. */
- #define ENET_MDC_FREQUENCY 2500000U
- /*! @brief NanoSecond in one second. */
- #define ENET_NANOSECOND_ONE_SECOND 1000000000U
- /*! @brief Define a common clock cycle delays used for time stamp capture. */
- #define ENET_1588TIME_DELAY_COUNT 38U
- /*! @brief Defines the macro for converting constants from host byte order to network byte order. */
- #define ENET_HTONS(n) __REV16(n)
- #define ENET_HTONL(n) __REV(n)
- #define ENET_NTOHS(n) __REV16(n)
- #define ENET_NTOHL(n) __REV(n)
- /*! @brief Define the ENET ring/class bumber . */
- enum _enet_ring_number
- {
- kENET_Ring0 = 0U, /*!< ENET ring/class 0. */
- #if FSL_FEATURE_ENET_QUEUE > 1
- kENET_Ring1 = 1U, /*!< ENET ring/class 1. */
- kENET_Ring2 = 2U /*!< ENET ring/class 2. */
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- };
- /*! @brief Define interrupt IRQ handler. */
- #if FSL_FEATURE_ENET_QUEUE > 1
- typedef void (*enet_isr_ring_t)(ENET_Type *base, enet_handle_t *handle, uint32_t ringId);
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- typedef void (*enet_isr_t)(ENET_Type *base, enet_handle_t *handle);
- /*******************************************************************************
- * Prototypes
- ******************************************************************************/
- /*!
- * @brief Get the ENET instance from peripheral base address.
- *
- * @param base ENET peripheral base address.
- * @return ENET instance.
- */
- uint32_t ENET_GetInstance(ENET_Type *base);
- /*!
- * @brief Set ENET MAC controller with the configuration.
- *
- * @param base ENET peripheral base address.
- * @param handle The ENET handle pointer.
- * @param config ENET Mac configuration.
- * @param bufferConfig ENET buffer configuration.
- * @param macAddr ENET six-byte mac address.
- * @param srcClock_Hz ENET module clock source, normally it's system clock.
- */
- static void ENET_SetMacController(ENET_Type *base,
- enet_handle_t *handle,
- const enet_config_t *config,
- const enet_buffer_config_t *bufferConfig,
- uint8_t *macAddr,
- uint32_t srcClock_Hz);
- /*!
- * @brief Set ENET handler.
- *
- * @param base ENET peripheral base address.
- * @param handle The ENET handle pointer.
- * @param config ENET configuration stucture pointer.
- * @param bufferConfig ENET buffer configuration.
- */
- static void ENET_SetHandler(ENET_Type *base,
- enet_handle_t *handle,
- const enet_config_t *config,
- const enet_buffer_config_t *bufferConfig);
- /*!
- * @brief Set ENET MAC transmit buffer descriptors.
- *
- * @param handle The ENET handle pointer.
- * @param config The ENET configuration structure.
- * @param bufferConfig The ENET buffer configuration.
- */
- static void ENET_SetTxBufferDescriptors(enet_handle_t *handle, const enet_config_t *config, const enet_buffer_config_t *bufferConfig);
- /*!
- * @brief Set ENET MAC receive buffer descriptors.
- *
- * @param handle The ENET handle pointer.
- * @param config The ENET configuration structure.
- * @param bufferConfig The ENET buffer configuration.
- */
- static void ENET_SetRxBufferDescriptors(enet_handle_t *handle, const enet_config_t *config, const enet_buffer_config_t *bufferConfig);
- /*!
- * @brief Updates the ENET read buffer descriptors.
- *
- * @param base ENET peripheral base address.
- * @param handle The ENET handle pointer.
- * @param ringId The descriptor ring index, range from 0 ~ FSL_FEATURE_ENET_QUEUE - 1.
- * 0 ----- for single ring kinetis platform.
- * 0 ~ 2 for mulit-ring supported IMX8qm.
- */
- static void ENET_UpdateReadBuffers(ENET_Type *base, enet_handle_t *handle, uint32_t ringId);
- /*!
- * @brief Activates ENET send for multiple tx rings.
- *
- * @param base ENET peripheral base address.
- * @param ringId The descriptor ring index, range from 0 ~ FSL_FEATURE_ENET_QUEUE - 1.
- * 0 ----- for single ring kinetis platform.
- * 0 ~ 2 for mulit-ring supported IMX8qm.
- *
- * @note This must be called after the MAC configuration and
- * state are ready. It must be called after the ENET_Init() and
- * this should be called when the ENET receive required.
- */
- static void ENET_ActiveSend(ENET_Type *base, uint32_t ringId);
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /*!
- * @brief Parses the ENET frame for time-stamp process of PTP 1588 frame.
- *
- * @param data The ENET read data for frame parse.
- * @param ptpTsData The ENET PTP message and time-stamp data pointer.
- * @param isFastEnabled The fast parse flag.
- * - true , Fast processing, only check if this is a PTP message.
- * - false, Store the PTP message data after check the PTP message.
- */
- static bool ENET_Ptp1588ParseFrame(const uint8_t *data, enet_ptp_time_data_t *ptpTsData, bool isFastEnabled);
- /*!
- * @brief Updates the new PTP 1588 time-stamp to the time-stamp buffer ring.
- *
- * @param ptpTsDataRing The PTP message and time-stamp data ring pointer.
- * @param ptpTimeData The new PTP 1588 time-stamp data pointer.
- */
- static status_t ENET_Ptp1588UpdateTimeRing(enet_ptp_time_data_ring_t *ptpTsDataRing, enet_ptp_time_data_t *ptpTimeData);
- /*!
- * @brief Search up the right PTP 1588 time-stamp from the time-stamp buffer ring.
- *
- * @param ptpTsDataRing The PTP message and time-stamp data ring pointer.
- * @param ptpTimeData The find out right PTP 1588 time-stamp data pointer with the specific PTP message.
- */
- static status_t ENET_Ptp1588SearchTimeRing(enet_ptp_time_data_ring_t *ptpTsDataRing, enet_ptp_time_data_t *ptpTimedata);
- /*!
- * @brief Store the transmit time-stamp for event PTP frame in the time-stamp buffer ring.
- *
- * @param base ENET peripheral base address.
- * @param handle The ENET handle pointer.
- * @param ringId The descriptor ring index, range from 0 ~ FSL_FEATURE_ENET_QUEUE - 1.
- * 0 ----- for single ring kinetis platform.
- * 0 ~ 2 for mulit-ring supported IMX8qm.
- */
- static status_t ENET_StoreTxFrameTime(ENET_Type *base, enet_handle_t *handle, uint32_t ringId);
- /*!
- * @brief Store the receive time-stamp for event PTP frame in the time-stamp buffer ring.
- *
- * @param base ENET peripheral base address.
- * @param handle The ENET handle pointer.
- * @param ptpTimeData The PTP 1588 time-stamp data pointer.
- */
- static status_t ENET_StoreRxFrameTime(ENET_Type *base, enet_handle_t *handle, enet_ptp_time_data_t *ptpTimeData);
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_AVB
- /*!
- * @brief Gets the ring index for transmission.
- *
- * @param base ENET peripheral base address.
- * @param data The ENET transmit data.
- * @param handle The ENET handle pointer.
- *
- * @note This must be called after the MAC configuration and
- * state are ready. It must be called after the ENET_Init() and
- * this should be called when the ENET receive required.
- */
- static uint8_t ENET_GetTxRingId(ENET_Type *base, uint8_t *data, enet_handle_t *handle);
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /*******************************************************************************
- * Variables
- ******************************************************************************/
- /*! @brief Pointers to enet handles for each instance. */
- static enet_handle_t *s_ENETHandle[FSL_FEATURE_SOC_ENET_COUNT] = {NULL};
- /*! @brief Pointers to enet clocks for each instance. */
- #if !(defined(FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL) && FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL)
- const clock_ip_name_t s_enetClock[] = ENET_CLOCKS;
- #endif /* FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL */
- /*! @brief Pointers to enet transmit IRQ number for each instance. */
- static const IRQn_Type s_enetTxIrqId[] = ENET_Transmit_IRQS;
- /*! @brief Pointers to enet receive IRQ number for each instance. */
- static const IRQn_Type s_enetRxIrqId[] = ENET_Receive_IRQS;
- #if defined(ENET_ENHANCEDBUFFERDESCRIPTOR_MODE) && ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /*! @brief Pointers to enet timestamp IRQ number for each instance. */
- static const IRQn_Type s_enetTsIrqId[] = ENET_1588_Timer_IRQS;
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /*! @brief Pointers to enet error IRQ number for each instance. */
- static const IRQn_Type s_enetErrIrqId[] = ENET_Error_IRQS;
- /*! @brief Pointers to enet bases for each instance. */
- static ENET_Type *const s_enetBases[] = ENET_BASE_PTRS;
- /* ENET ISR for transactional APIs. */
- #if FSL_FEATURE_ENET_QUEUE > 1
- static enet_isr_ring_t s_enetTxIsr;
- static enet_isr_ring_t s_enetRxIsr;
- #else
- static enet_isr_t s_enetTxIsr;
- static enet_isr_t s_enetRxIsr;
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- static enet_isr_t s_enetErrIsr;
- static enet_isr_t s_enetTsIsr;
- /*******************************************************************************
- * Code
- ******************************************************************************/
- uint32_t ENET_GetInstance(ENET_Type *base)
- {
- uint32_t instance;
- /* Find the instance index from base address mappings. */
- for (instance = 0; instance < ARRAY_SIZE(s_enetBases); instance++)
- {
- if (s_enetBases[instance] == base)
- {
- break;
- }
- }
- assert(instance < ARRAY_SIZE(s_enetBases));
- return instance;
- }
- void ENET_GetDefaultConfig(enet_config_t *config)
- {
- /* Checks input parameter. */
- assert(config);
- /* Initializes the MAC configure structure to zero. */
- memset(config, 0, sizeof(enet_config_t));
- /* Sets MII mode, full duplex, 100Mbps for MAC and PHY data interface. */
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- config->miiMode = kENET_RgmiiMode;
- #else
- config->miiMode = kENET_RmiiMode;
- #endif
- config->miiSpeed = kENET_MiiSpeed100M;
- config->miiDuplex = kENET_MiiFullDuplex;
- config->ringNum = 1;
- /* Sets the maximum receive frame length. */
- config->rxMaxFrameLen = ENET_FRAME_MAX_FRAMELEN;
- }
- void ENET_Init(ENET_Type *base,
- enet_handle_t *handle,
- const enet_config_t *config,
- const enet_buffer_config_t *bufferConfig,
- uint8_t *macAddr,
- uint32_t srcClock_Hz)
- {
- /* Checks input parameters. */
- assert(handle);
- assert(config);
- assert(bufferConfig);
- assert(macAddr);
- assert(config->ringNum <= FSL_FEATURE_ENET_QUEUE);
- #if !(defined(FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL) && FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL)
- uint32_t instance = ENET_GetInstance(base);
- /* Ungate ENET clock. */
- CLOCK_EnableClock(s_enetClock[instance]);
- #endif /* FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL */
- /* Reset ENET module. */
- ENET_Reset(base);
- /* Initializes the ENET transmit buffer descriptors. */
- ENET_SetTxBufferDescriptors(handle, config, bufferConfig);
- /* Initializes the ENET receive buffer descriptors. */
- ENET_SetRxBufferDescriptors(handle, config, bufferConfig);
- /* Initializes the ENET MAC controller with basic function. */
- ENET_SetMacController(base, handle, config, bufferConfig, macAddr, srcClock_Hz);
- /* Set all buffers or data in handler for data transmit/receive process. */
- ENET_SetHandler(base, handle, config, bufferConfig);
- }
- void ENET_Deinit(ENET_Type *base)
- {
- /* Disable interrupt. */
- base->EIMR = 0;
- /* Disable ENET. */
- base->ECR &= ~ENET_ECR_ETHEREN_MASK;
- #if !(defined(FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL) && FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL)
- /* Disables the clock source. */
- CLOCK_DisableClock(s_enetClock[ENET_GetInstance(base)]);
- #endif /* FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL */
- }
- void ENET_SetCallback(enet_handle_t *handle, enet_callback_t callback, void *userData)
- {
- assert(handle);
- /* Set callback and userData. */
- handle->callback = callback;
- handle->userData = userData;
- }
- static void ENET_SetHandler(ENET_Type *base,
- enet_handle_t *handle,
- const enet_config_t *config,
- const enet_buffer_config_t *bufferConfig)
- {
- uint8_t count;
- uint32_t instance = ENET_GetInstance(base);
- const enet_buffer_config_t *buffCfg = bufferConfig;
- /* Store transfer parameters in handle pointer. */
- memset(handle, 0, sizeof(enet_handle_t));
- handle->ringNum = (config->ringNum > FSL_FEATURE_ENET_QUEUE) ? FSL_FEATURE_ENET_QUEUE : config->ringNum;
- for (count = 0; count < handle->ringNum; count++)
- {
- assert(buffCfg->rxBuffSizeAlign * buffCfg->rxBdNumber > config->rxMaxFrameLen);
- handle->rxBdBase[count] = buffCfg->rxBdStartAddrAlign;
- handle->rxBdCurrent[count] = buffCfg->rxBdStartAddrAlign;
- handle->rxBuffSizeAlign[count] = buffCfg->rxBuffSizeAlign;
- handle->txBdBase[count] = buffCfg->txBdStartAddrAlign;
- handle->txBdCurrent[count] = buffCfg->txBdStartAddrAlign;
- handle->txBuffSizeAlign[count] = buffCfg->txBuffSizeAlign;
- buffCfg++;
- }
- /* Save the handle pointer in the global variables. */
- s_ENETHandle[instance] = handle;
- /* Set the IRQ handler when the interrupt is enabled. */
- if (config->interrupt & ENET_TX_INTERRUPT)
- {
- s_enetTxIsr = ENET_TransmitIRQHandler;
- EnableIRQ(s_enetTxIrqId[instance]);
- }
- if (config->interrupt & ENET_RX_INTERRUPT)
- {
- s_enetRxIsr = ENET_ReceiveIRQHandler;
- EnableIRQ(s_enetRxIrqId[instance]);
- }
- if (config->interrupt & ENET_ERR_INTERRUPT)
- {
- s_enetErrIsr = ENET_ErrorIRQHandler;
- EnableIRQ(s_enetErrIrqId[instance]);
- }
- }
- static void ENET_SetMacController(ENET_Type *base,
- enet_handle_t *handle,
- const enet_config_t *config,
- const enet_buffer_config_t *bufferConfig,
- uint8_t *macAddr,
- uint32_t srcClock_Hz)
- {
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- /* Check the MII mode/speed/duplex setting. */
- if (config->miiSpeed == kENET_MiiSpeed1000M)
- {
- /* Only RGMII mode has the 1000M bit/s. The 1000M only support full duplex. */
- assert(config->miiMode == kENET_RgmiiMode);
- assert(config->miiDuplex == kENET_MiiFullDuplex);
- }
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- uint32_t rcr = 0;
- uint32_t tcr = 0;
- uint32_t ecr = base->ECR;
- uint32_t macSpecialConfig = config->macSpecialConfig;
- uint32_t maxFrameLen = config->rxMaxFrameLen;
- /* Maximum frame length check. */
- if ((macSpecialConfig & kENET_ControlVLANTagEnable) && (maxFrameLen <= ENET_FRAME_MAX_FRAMELEN))
- {
- maxFrameLen = (ENET_FRAME_MAX_FRAMELEN + ENET_FRAME_VLAN_TAGLEN);
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- if (macSpecialConfig & kENET_ControlSVLANEnable)
- {
- /* Double vlan tag (SVLAN) supported. */
- maxFrameLen += ENET_FRAME_VLAN_TAGLEN;
- }
- ecr |= ((macSpecialConfig & kENET_ControlSVLANEnable) ? (ENET_ECR_SVLANEN_MASK | ENET_ECR_SVLANDBL_MASK) : 0) |
- ((macSpecialConfig & kENET_ControlVLANUseSecondTag) ? ENET_ECR_VLANUSE2ND_MASK : 0);
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- }
- /* Configures MAC receive controller with user configure structure. */
- rcr = ((macSpecialConfig & kENET_ControlRxPayloadCheckEnable) ? ENET_RCR_NLC_MASK : 0) |
- ((macSpecialConfig & kENET_ControlFlowControlEnable) ? ENET_RCR_CFEN_MASK : 0) |
- ((macSpecialConfig & kENET_ControlFlowControlEnable) ? ENET_RCR_FCE_MASK : 0) |
- ((macSpecialConfig & kENET_ControlRxPadRemoveEnable) ? ENET_RCR_PADEN_MASK : 0) |
- ((macSpecialConfig & kENET_ControlRxBroadCastRejectEnable) ? ENET_RCR_BC_REJ_MASK : 0) |
- ((macSpecialConfig & kENET_ControlPromiscuousEnable) ? ENET_RCR_PROM_MASK : 0) |
- ENET_RCR_MAX_FL(maxFrameLen) | ENET_RCR_CRCFWD_MASK;
- /* Set the RGMII or RMII, MII mode and control register. */
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- if (config->miiMode == kENET_RgmiiMode)
- {
- rcr |= ENET_RCR_RGMII_EN_MASK;
- rcr &= ~ENET_RCR_MII_MODE_MASK;
- }
- else
- {
- rcr &= ~ENET_RCR_RGMII_EN_MASK;
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- rcr |= ENET_RCR_MII_MODE_MASK;
- if (config->miiMode == kENET_RmiiMode)
- {
- rcr |= ENET_RCR_RMII_MODE_MASK;
- }
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- }
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- /* Speed. */
- if (config->miiSpeed == kENET_MiiSpeed10M)
- {
- rcr |= ENET_RCR_RMII_10T_MASK;
- }
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- if (config->miiSpeed == kENET_MiiSpeed1000M)
- {
- ecr |= ENET_ECR_SPEED_MASK;
- }
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- /* Receive setting for half duplex. */
- if (config->miiDuplex == kENET_MiiHalfDuplex)
- {
- rcr |= ENET_RCR_DRT_MASK;
- }
- /* Sets internal loop only for MII mode. */
- if ((config->macSpecialConfig & kENET_ControlMIILoopEnable) && (config->miiMode != kENET_RmiiMode))
- {
- rcr |= ENET_RCR_LOOP_MASK;
- rcr &= ~ENET_RCR_DRT_MASK;
- }
- base->RCR = rcr;
- /* Configures MAC transmit controller: duplex mode, mac address insertion. */
- tcr = base->TCR & ~(ENET_TCR_FDEN_MASK | ENET_TCR_ADDINS_MASK);
- tcr |= (config->miiDuplex ? ENET_TCR_FDEN_MASK : 0) |
- ((macSpecialConfig & kENET_ControlMacAddrInsert) ? ENET_TCR_ADDINS_MASK : 0);
- base->TCR = tcr;
- /* Configures receive and transmit accelerator. */
- base->TACC = config->txAccelerConfig;
- base->RACC = config->rxAccelerConfig;
- /* Sets the pause duration and FIFO threshold for the flow control enabled case. */
- if (macSpecialConfig & kENET_ControlFlowControlEnable)
- {
- uint32_t reemReg;
- base->OPD = config->pauseDuration;
- reemReg = ENET_RSEM_RX_SECTION_EMPTY(config->rxFifoEmptyThreshold);
- #if defined(FSL_FEATURE_ENET_HAS_RECEIVE_STATUS_THRESHOLD) && FSL_FEATURE_ENET_HAS_RECEIVE_STATUS_THRESHOLD
- reemReg |= ENET_RSEM_STAT_SECTION_EMPTY(config->rxFifoStatEmptyThreshold);
- #endif /* FSL_FEATURE_ENET_HAS_RECEIVE_STATUS_THRESHOLD */
- base->RSEM = reemReg;
- }
- /* FIFO threshold setting for store and forward enable/disable case. */
- if (macSpecialConfig & kENET_ControlStoreAndFwdDisable)
- {
- /* Transmit fifo watermark settings. */
- base->TFWR = config->txFifoWatermark & ENET_TFWR_TFWR_MASK;
- /* Receive fifo full threshold settings. */
- base->RSFL = config->rxFifoFullThreshold & ENET_RSFL_RX_SECTION_FULL_MASK;
- }
- else
- {
- /* Transmit fifo watermark settings. */
- base->TFWR = ENET_TFWR_STRFWD_MASK;
- base->RSFL = 0;
- }
- /* Enable store and forward when accelerator is enabled */
- if (config->txAccelerConfig & (kENET_TxAccelIpCheckEnabled | kENET_TxAccelProtoCheckEnabled))
- {
- base->TFWR = ENET_TFWR_STRFWD_MASK;
- }
- if (config->rxAccelerConfig & (kENET_RxAccelIpCheckEnabled | kENET_RxAccelProtoCheckEnabled))
- {
- base->RSFL = 0;
- }
- /* Initializes the ring 0. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- base->TDSR = MEMORY_ConvertMemoryMapAddress((uint32_t)bufferConfig->txBdStartAddrAlign, kMEMORY_Local2DMA);
- base->RDSR = MEMORY_ConvertMemoryMapAddress((uint32_t)bufferConfig->rxBdStartAddrAlign, kMEMORY_Local2DMA);
- #else
- base->TDSR = (uint32_t)bufferConfig->txBdStartAddrAlign;
- base->RDSR = (uint32_t)bufferConfig->rxBdStartAddrAlign;
- #endif
- base->MRBR = bufferConfig->rxBuffSizeAlign;
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- const enet_buffer_config_t *buffCfg = bufferConfig;
- if (config->ringNum > 1)
- {
- /* Initializes the ring 1. */
- buffCfg++;
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- base->TDSR1 = MEMORY_ConvertMemoryMapAddress((uint32_t)buffCfg->txBdStartAddrAlign, kMEMORY_Local2DMA);
- base->RDSR1 = MEMORY_ConvertMemoryMapAddress((uint32_t)buffCfg->rxBdStartAddrAlign, kMEMORY_Local2DMA);
- #else
- base->TDSR1 = (uint32_t)buffCfg->txBdStartAddrAlign;
- base->RDSR1 = (uint32_t)buffCfg->rxBdStartAddrAlign;
- #endif
- base->MRBR1 = buffCfg->rxBuffSizeAlign;
- /* Enable the DMAC for ring 1 and with no rx classification set. */
- base->DMACFG[0] = ENET_DMACFG_DMA_CLASS_EN_MASK;
- }
- if (config->ringNum > 2)
- {
- /* Initializes the ring 2. */
- buffCfg++;
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- base->TDSR2 = MEMORY_ConvertMemoryMapAddress((uint32_t)buffCfg->txBdStartAddrAlign, kMEMORY_Local2DMA);
- base->RDSR2 = MEMORY_ConvertMemoryMapAddress((uint32_t)buffCfg->rxBdStartAddrAlign, kMEMORY_Local2DMA);
- #else
- base->TDSR2 = (uint32_t)buffCfg->txBdStartAddrAlign;
- base->RDSR2 = (uint32_t)buffCfg->rxBdStartAddrAlign;
- #endif
- base->MRBR2 = buffCfg->rxBuffSizeAlign;
- /* Enable the DMAC for ring 2 and with no rx classification set. */
- base->DMACFG[1] = ENET_DMACFG_DMA_CLASS_EN_MASK;
- }
- /* Default the class/ring 1 and 2 are not enabled and the receive classification is disabled
- * so we set the default transmit scheme with the round-robin mode. beacuse the legacy bd mode
- * only support the round-robin mode. if the avb feature is required, just call the setup avb
- * feature API. */
- base->QOS |= ENET_QOS_TX_SCHEME(1);
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- /* Configures the Mac address. */
- ENET_SetMacAddr(base, macAddr);
- /* Initialize the SMI if uninitialized. */
- if (!ENET_GetSMI(base))
- {
- ENET_SetSMI(base, srcClock_Hz, !!(config->macSpecialConfig & kENET_ControlSMIPreambleDisable));
- }
- /* Enables Ethernet interrupt, enables the interrupt coalsecing if it is required. */
- #if defined(FSL_FEATURE_ENET_HAS_INTERRUPT_COALESCE) && FSL_FEATURE_ENET_HAS_INTERRUPT_COALESCE
- if (config->intCoalesceCfg)
- {
- uint32_t intMask = (ENET_EIMR_TXB_MASK | ENET_EIMR_RXB_MASK);
- #if FSL_FEATURE_ENET_QUEUE > 1
- uint8_t queue = 0;
- intMask |= ENET_EIMR_TXB2_MASK | ENET_EIMR_RXB2_MASK | ENET_EIMR_TXB1_MASK | ENET_EIMR_RXB1_MASK;
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- /* Clear all buffer interrupts. */
- base->EIMR &= ~intMask;
- /* Set the interrupt coalescence. */
- #if FSL_FEATURE_ENET_QUEUE > 1
- for (queue = 0; queue < FSL_FEATURE_ENET_QUEUE; queue++)
- {
- base->TXIC[queue] = ENET_TXIC_ICFT(config->intCoalesceCfg->txCoalesceFrameCount[queue]) |
- config->intCoalesceCfg->txCoalesceTimeCount[queue] | ENET_TXIC_ICCS_MASK |
- ENET_TXIC_ICEN_MASK;
- base->RXIC[queue] = ENET_RXIC_ICFT(config->intCoalesceCfg->rxCoalesceFrameCount[queue]) |
- config->intCoalesceCfg->rxCoalesceTimeCount[queue] | ENET_RXIC_ICCS_MASK |
- ENET_RXIC_ICEN_MASK;
- }
- #else
- base->TXIC = ENET_TXIC_ICFT(config->intCoalesceCfg->txCoalesceFrameCount[0]) |
- config->intCoalesceCfg->txCoalesceTimeCount[0] | ENET_TXIC_ICCS_MASK | ENET_TXIC_ICEN_MASK;
- base->RXIC = ENET_RXIC_ICFT(config->intCoalesceCfg->rxCoalesceFrameCount[0]) |
- config->intCoalesceCfg->rxCoalesceTimeCount[0] | ENET_RXIC_ICCS_MASK | ENET_RXIC_ICEN_MASK;
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- }
- #endif /* FSL_FEATURE_ENET_HAS_INTERRUPT_COALESCE */
- ENET_EnableInterrupts(base, config->interrupt);
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /* Sets the 1588 enhanced feature. */
- ecr |= ENET_ECR_EN1588_MASK;
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* Enables Ethernet module after all configuration except the buffer descriptor active. */
- ecr |= ENET_ECR_ETHEREN_MASK | ENET_ECR_DBSWP_MASK;
- base->ECR = ecr;
- }
- static void ENET_SetTxBufferDescriptors(enet_handle_t *handle, const enet_config_t *config, const enet_buffer_config_t *bufferConfig)
- {
- assert(config);
- assert(bufferConfig);
- /* Default single ring is supported. */
- uint8_t ringNum;
- uint32_t count;
- uint32_t txBuffSizeAlign;
- uint8_t *txBuffer;
- const enet_buffer_config_t *buffCfg = bufferConfig;
- /* Check the input parameters. */
- for (ringNum = 0; ringNum < config->ringNum; ringNum++)
- {
- if ((buffCfg->txBdStartAddrAlign > 0) && (buffCfg->txBufferAlign > 0))
- {
- volatile enet_tx_bd_struct_t *curBuffDescrip = buffCfg->txBdStartAddrAlign;
- txBuffSizeAlign = buffCfg->txBuffSizeAlign;
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- txBuffer = (uint8_t *)MEMORY_ConvertMemoryMapAddress((uint32_t)buffCfg->txBufferAlign, kMEMORY_Local2DMA);
- #else
- txBuffer = buffCfg->txBufferAlign;
- #endif
- for (count = 0; count < buffCfg->txBdNumber; count++)
- {
- /* Set data buffer address. */
- curBuffDescrip->buffer = (uint8_t *)((uint32_t)&txBuffer[count * txBuffSizeAlign]);
- /* Initializes data length. */
- curBuffDescrip->length = 0;
- /* Sets the crc. */
- curBuffDescrip->control = ENET_BUFFDESCRIPTOR_TX_TRANMITCRC_MASK;
- /* Sets the last buffer descriptor with the wrap flag. */
- if (count == buffCfg->txBdNumber - 1)
- {
- curBuffDescrip->control |= ENET_BUFFDESCRIPTOR_TX_WRAP_MASK;
- }
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /* Enable transmit interrupt for store the transmit timestamp. */
- curBuffDescrip->controlExtend1 |= ENET_BUFFDESCRIPTOR_TX_INTERRUPT_MASK;
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- /* Set the type of the frame when the credit-based scheme is used. */
- curBuffDescrip->controlExtend1 |= ENET_BD_FTYPE(ringNum);
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* Increase the index. */
- curBuffDescrip++;
- }
- }
- buffCfg++;
- }
- }
- static void ENET_SetRxBufferDescriptors(enet_handle_t *handle, const enet_config_t *config, const enet_buffer_config_t *bufferConfig)
- {
- assert(config);
- assert(bufferConfig);
- /* Default single ring is supported. */
- uint8_t ringNum;
- uint32_t count;
- uint32_t rxBuffSizeAlign;
- uint8_t *rxBuffer;
- const enet_buffer_config_t *buffCfg = bufferConfig;
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- uint32_t mask = (kENET_RxFrameInterrupt | kENET_RxBufferInterrupt);
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* Check the input parameters. */
- for (ringNum = 0; ringNum < config->ringNum; ringNum++)
- {
- assert(buffCfg->rxBuffSizeAlign >= ENET_RX_MIN_BUFFERSIZE);
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- #if FSL_FEATURE_ENET_QUEUE > 1
- if (ringNum == 1)
- {
- mask = (kENET_RxFrame1Interrupt | kENET_RxBuffer1Interrupt);
- }
- else if (ringNum == 2)
- {
- mask = (kENET_RxFrame2Interrupt | kENET_RxBuffer2Interrupt);
- }
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- if ((buffCfg->rxBdStartAddrAlign > 0) && (buffCfg->rxBufferAlign > 0))
- {
- volatile enet_rx_bd_struct_t *curBuffDescrip = buffCfg->rxBdStartAddrAlign;
- rxBuffSizeAlign = buffCfg->rxBuffSizeAlign;
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- rxBuffer = (uint8_t *)MEMORY_ConvertMemoryMapAddress((uint32_t)buffCfg->rxBufferAlign, kMEMORY_Local2DMA);
- #else
- rxBuffer = buffCfg->rxBufferAlign;
- #endif
- for (count = 0; count < buffCfg->rxBdNumber; count++)
- {
- /* Set data buffer and the length. */
- curBuffDescrip->buffer = (uint8_t *)((uint32_t)&rxBuffer[count * rxBuffSizeAlign]);
- curBuffDescrip->length = 0;
- /* Initializes the buffer descriptors with empty bit. */
- curBuffDescrip->control = ENET_BUFFDESCRIPTOR_RX_EMPTY_MASK;
- /* Sets the last buffer descriptor with the wrap flag. */
- if (count == buffCfg->rxBdNumber - 1)
- {
- curBuffDescrip->control |= ENET_BUFFDESCRIPTOR_RX_WRAP_MASK;
- }
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- if (config->interrupt & mask)
- {
- /* Enable receive interrupt. */
- curBuffDescrip->controlExtend1 |= ENET_BUFFDESCRIPTOR_RX_INTERRUPT_MASK;
- }
- else
- {
- curBuffDescrip->controlExtend1 = 0;
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* Increase the index. */
- curBuffDescrip++;
- }
- }
- buffCfg++;
- }
- }
- static void ENET_ActiveSend(ENET_Type *base, uint32_t ringId)
- {
- assert(ringId < FSL_FEATURE_ENET_QUEUE);
- switch (ringId)
- {
- case kENET_Ring0:
- base->TDAR = ENET_TDAR_TDAR_MASK;
- break;
- #if FSL_FEATURE_ENET_QUEUE > 1
- case kENET_Ring1:
- base->TDAR1 = ENET_TDAR1_TDAR_MASK;
- break;
- case kENET_Ring2:
- base->TDAR2 = ENET_TDAR2_TDAR_MASK;
- break;
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- default:
- base->TDAR = ENET_TDAR_TDAR_MASK;
- break;
- }
- }
- void ENET_SetMII(ENET_Type *base, enet_mii_speed_t speed, enet_mii_duplex_t duplex)
- {
- uint32_t rcr = base->RCR;
- uint32_t tcr = base->TCR;
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- uint32_t ecr = base->ECR;
- if (kENET_MiiSpeed1000M == speed)
- {
- assert(duplex == kENET_MiiFullDuplex);
- ecr |= ENET_ECR_SPEED_MASK;
- }
- else
- {
- ecr &= ~ENET_ECR_SPEED_MASK;
- }
- base->ECR = ecr;
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- /* Sets speed mode. */
- if (kENET_MiiSpeed10M == speed)
- {
- rcr |= ENET_RCR_RMII_10T_MASK;
- }
- else
- {
- rcr &= ~ENET_RCR_RMII_10T_MASK;
- }
- /* Set duplex mode. */
- if (duplex == kENET_MiiHalfDuplex)
- {
- rcr |= ENET_RCR_DRT_MASK;
- tcr &= ~ENET_TCR_FDEN_MASK;
- }
- else
- {
- rcr &= ~ENET_RCR_DRT_MASK;
- tcr |= ENET_TCR_FDEN_MASK;
- }
- base->RCR = rcr;
- base->TCR = tcr;
- }
- void ENET_SetMacAddr(ENET_Type *base, uint8_t *macAddr)
- {
- uint32_t address;
- /* Set physical address lower register. */
- address = (uint32_t)(((uint32_t)macAddr[0] << 24U) | ((uint32_t)macAddr[1] << 16U) | ((uint32_t)macAddr[2] << 8U) |
- (uint32_t)macAddr[3]);
- base->PALR = address;
- /* Set physical address high register. */
- address = (uint32_t)(((uint32_t)macAddr[4] << 8U) | ((uint32_t)macAddr[5]));
- base->PAUR = address << ENET_PAUR_PADDR2_SHIFT;
- }
- void ENET_GetMacAddr(ENET_Type *base, uint8_t *macAddr)
- {
- assert(macAddr);
- uint32_t address;
- /* Get from physical address lower register. */
- address = base->PALR;
- macAddr[0] = 0xFFU & (address >> 24U);
- macAddr[1] = 0xFFU & (address >> 16U);
- macAddr[2] = 0xFFU & (address >> 8U);
- macAddr[3] = 0xFFU & address;
- /* Get from physical address high register. */
- address = (base->PAUR & ENET_PAUR_PADDR2_MASK) >> ENET_PAUR_PADDR2_SHIFT;
- macAddr[4] = 0xFFU & (address >> 8U);
- macAddr[5] = 0xFFU & address;
- }
- void ENET_SetSMI(ENET_Type *base, uint32_t srcClock_Hz, bool isPreambleDisabled)
- {
- assert(srcClock_Hz);
- uint32_t clkCycle = 0;
- uint32_t speed = 0;
- uint32_t mscr = 0;
- /* Calculate the MII speed which controls the frequency of the MDC. */
- speed = srcClock_Hz / (2 * ENET_MDC_FREQUENCY);
- /* Calculate the hold time on the MDIO output. */
- clkCycle = (10 + ENET_NANOSECOND_ONE_SECOND / srcClock_Hz - 1) / (ENET_NANOSECOND_ONE_SECOND / srcClock_Hz) - 1;
- /* Build the configuration for MDC/MDIO control. */
- mscr = ENET_MSCR_MII_SPEED(speed) | ENET_MSCR_HOLDTIME(clkCycle) | (isPreambleDisabled ? ENET_MSCR_DIS_PRE_MASK : 0);
- base->MSCR = mscr;
- }
- void ENET_StartSMIWrite(ENET_Type *base, uint32_t phyAddr, uint32_t phyReg, enet_mii_write_t operation, uint32_t data)
- {
- uint32_t mmfr = 0;
- /* Build MII write command. */
- mmfr = ENET_MMFR_ST(1) | ENET_MMFR_OP(operation) | ENET_MMFR_PA(phyAddr) | ENET_MMFR_RA(phyReg) | ENET_MMFR_TA(2) |
- (data & 0xFFFF);
- base->MMFR = mmfr;
- }
- void ENET_StartSMIRead(ENET_Type *base, uint32_t phyAddr, uint32_t phyReg, enet_mii_read_t operation)
- {
- uint32_t mmfr = 0;
- /* Build MII read command. */
- mmfr = ENET_MMFR_ST(1) | ENET_MMFR_OP(operation) | ENET_MMFR_PA(phyAddr) | ENET_MMFR_RA(phyReg) | ENET_MMFR_TA(2);
- base->MMFR = mmfr;
- }
- #if defined(FSL_FEATURE_ENET_HAS_EXTEND_MDIO) && FSL_FEATURE_ENET_HAS_EXTEND_MDIO
- void ENET_StartExtC45SMIWrite(ENET_Type *base, uint32_t phyAddr, uint32_t phyReg, uint32_t data)
- {
- uint32_t mmfr = 0;
- /* Parse the address from the input register. */
- uint16_t devAddr = (phyReg >> ENET_MMFR_TA_SHIFT) & 0x1FU;
- uint16_t regAddr = (uint16_t)(phyReg & 0xFFFFU);
- /* Address write firstly. */
- mmfr = ENET_MMFR_ST(0) | ENET_MMFR_OP(kENET_MiiAddrWrite_C45) | ENET_MMFR_PA(phyAddr) | ENET_MMFR_RA(devAddr) |
- ENET_MMFR_TA(2) | ENET_MMFR_DATA(regAddr);
- base->MMFR = mmfr;
- /* Build MII write command. */
- mmfr = ENET_MMFR_ST(0) | ENET_MMFR_OP(kENET_MiiWriteFrame_C45) | ENET_MMFR_PA(phyAddr) | ENET_MMFR_RA(devAddr) |
- ENET_MMFR_TA(2) | ENET_MMFR_DATA(data);
- base->MMFR = mmfr;
- }
- void ENET_StartExtC45SMIRead(ENET_Type *base, uint32_t phyAddr, uint32_t phyReg)
- {
- uint32_t mmfr = 0;
- /* Parse the address from the input register. */
- uint16_t devAddr = (phyReg >> ENET_MMFR_TA_SHIFT) & 0x1FU;
- uint16_t regAddr = (uint16_t)(phyReg & 0xFFFFU);
- /* Address write firstly. */
- mmfr = ENET_MMFR_ST(0) | ENET_MMFR_OP(kENET_MiiAddrWrite_C45) | ENET_MMFR_PA(phyAddr) | ENET_MMFR_RA(devAddr) |
- ENET_MMFR_TA(2) | ENET_MMFR_DATA(regAddr);
- base->MMFR = mmfr;
- /* Build MII read command. */
- mmfr = ENET_MMFR_ST(0) | ENET_MMFR_OP(kENET_MiiReadFrame_C45) | ENET_MMFR_PA(phyAddr) | ENET_MMFR_RA(devAddr) |
- ENET_MMFR_TA(2);
- base->MMFR = mmfr;
- }
- #endif /* FSL_FEATURE_ENET_HAS_EXTEND_MDIO */
- void ENET_GetRxErrBeforeReadFrame(enet_handle_t *handle, enet_data_error_stats_t *eErrorStatic)
- {
- assert(handle);
- assert(handle->rxBdCurrent[0]);
- assert(eErrorStatic);
- uint16_t control = 0;
- volatile enet_rx_bd_struct_t *curBuffDescrip = handle->rxBdCurrent[0];
- do
- {
- /* The last buffer descriptor of a frame. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_LAST_MASK)
- {
- control = curBuffDescrip->control;
- if (control & ENET_BUFFDESCRIPTOR_RX_TRUNC_MASK)
- {
- /* The receive truncate error. */
- eErrorStatic->statsRxTruncateErr++;
- }
- if (control & ENET_BUFFDESCRIPTOR_RX_OVERRUN_MASK)
- {
- /* The receive over run error. */
- eErrorStatic->statsRxOverRunErr++;
- }
- if (control & ENET_BUFFDESCRIPTOR_RX_LENVLIOLATE_MASK)
- {
- /* The receive length violation error. */
- eErrorStatic->statsRxLenGreaterErr++;
- }
- if (control & ENET_BUFFDESCRIPTOR_RX_NOOCTET_MASK)
- {
- /* The receive alignment error. */
- eErrorStatic->statsRxAlignErr++;
- }
- if (control & ENET_BUFFDESCRIPTOR_RX_CRC_MASK)
- {
- /* The receive CRC error. */
- eErrorStatic->statsRxFcsErr++;
- }
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- uint16_t controlExt = curBuffDescrip->controlExtend1;
- if (controlExt & ENET_BUFFDESCRIPTOR_RX_MACERR_MASK)
- {
- /* The MAC error. */
- eErrorStatic->statsRxMacErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_RX_PHYERR_MASK)
- {
- /* The PHY error. */
- eErrorStatic->statsRxPhyErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_RX_COLLISION_MASK)
- {
- /* The receive collision error. */
- eErrorStatic->statsRxCollisionErr++;
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- break;
- }
- /* Increase the buffer descriptor, if it is the last one, increase to first one of the ring buffer. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_WRAP_MASK)
- {
- curBuffDescrip = handle->rxBdBase[0];
- }
- else
- {
- curBuffDescrip++;
- }
- } while (curBuffDescrip != handle->rxBdCurrent[0]);
- }
- status_t ENET_GetRxFrameSize(enet_handle_t *handle, uint32_t *length)
- {
- assert(handle);
- assert(handle->rxBdCurrent[0]);
- assert(length);
- /* Reset the length to zero. */
- *length = 0;
- uint16_t validLastMask = ENET_BUFFDESCRIPTOR_RX_LAST_MASK | ENET_BUFFDESCRIPTOR_RX_EMPTY_MASK;
- volatile enet_rx_bd_struct_t *curBuffDescrip = handle->rxBdCurrent[0];
- /* Check the current buffer descriptor's empty flag. if empty means there is no frame received. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_EMPTY_MASK)
- {
- return kStatus_ENET_RxFrameEmpty;
- }
- do
- {
- /* Add check for abnormal case. */
- if ((!(curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_EMPTY_MASK)) && (!curBuffDescrip->length))
- {
- return kStatus_ENET_RxFrameError;
- }
- /* Find the last buffer descriptor. */
- if ((curBuffDescrip->control & validLastMask) == ENET_BUFFDESCRIPTOR_RX_LAST_MASK)
- {
- /* The last buffer descriptor in the frame check the status of the received frame. */
- if ((curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_ERR_MASK)
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- || (curBuffDescrip->controlExtend1 & ENET_BUFFDESCRIPTOR_RX_EXT_ERR_MASK)
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- )
- {
- return kStatus_ENET_RxFrameError;
- }
- /* FCS is removed by MAC. */
- *length = curBuffDescrip->length;
- return kStatus_Success;
- }
- /* Increase the buffer descriptor, if it is the last one, increase to first one of the ring buffer. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_WRAP_MASK)
- {
- curBuffDescrip = handle->rxBdBase[0];
- }
- else
- {
- curBuffDescrip++;
- }
- } while (curBuffDescrip != handle->rxBdCurrent[0]);
- /* The frame is on processing - set to empty status to make application to receive it next time. */
- return kStatus_ENET_RxFrameEmpty;
- }
- status_t ENET_ReadFrame(ENET_Type *base, enet_handle_t *handle, uint8_t *data, uint32_t length)
- {
- assert(handle);
- assert(handle->rxBdCurrent[0]);
- uint32_t len = 0;
- uint32_t offset = 0;
- uint16_t control;
- bool isLastBuff = false;
- volatile enet_rx_bd_struct_t *curBuffDescrip = handle->rxBdCurrent[0];
- status_t result = kStatus_Success;
- uint32_t address;
- /* For data-NULL input, only update the buffer descriptor. */
- if (!data)
- {
- do
- {
- /* Update the control flag. */
- control = handle->rxBdCurrent[0]->control;
- /* Updates the receive buffer descriptors. */
- ENET_UpdateReadBuffers(base, handle, 0);
- /* Find the last buffer descriptor for the frame. */
- if (control & ENET_BUFFDESCRIPTOR_RX_LAST_MASK)
- {
- break;
- }
- } while (handle->rxBdCurrent[0] != curBuffDescrip);
- return result;
- }
- else
- {
- /* A frame on one buffer or several receive buffers are both considered. */
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache invalidate maintain. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- DCACHE_InvalidateByRange(address, handle->rxBuffSizeAlign[0]);
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- /* A frame on one buffer or several receive buffers are both considered. */
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- enet_ptp_time_data_t ptpTimestamp;
- bool isPtpEventMessage = false;
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- /* Parse the PTP message according to the header message. */
- isPtpEventMessage = ENET_Ptp1588ParseFrame((uint8_t *)address, &ptpTimestamp, false);
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- while (!isLastBuff)
- {
- /* The last buffer descriptor of a frame. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_LAST_MASK)
- {
- /* This is a valid frame. */
- isLastBuff = true;
- if (length == curBuffDescrip->length)
- {
- /* Copy the frame to user's buffer without FCS. */
- len = curBuffDescrip->length - offset;
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- memcpy(data + offset, (void *)address, len);
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /* Store the PTP 1588 timestamp for received PTP event frame. */
- if (isPtpEventMessage)
- {
- /* Set the timestamp to the timestamp ring. */
- ptpTimestamp.timeStamp.nanosecond = curBuffDescrip->timestamp;
- result = ENET_StoreRxFrameTime(base, handle, &ptpTimestamp);
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* Updates the receive buffer descriptors. */
- ENET_UpdateReadBuffers(base, handle, 0);
- return result;
- }
- else
- {
- /* Updates the receive buffer descriptors. */
- ENET_UpdateReadBuffers(base, handle, 0);
- }
- }
- else
- {
- /* Store a frame on several buffer descriptors. */
- isLastBuff = false;
- /* Length check. */
- if (offset >= length)
- {
- break;
- }
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- memcpy(data + offset, (void *)address, handle->rxBuffSizeAlign[0]);
- offset += handle->rxBuffSizeAlign[0];
- /* Updates the receive buffer descriptors. */
- ENET_UpdateReadBuffers(base, handle, 0);
- }
- /* Get the current buffer descriptor. */
- curBuffDescrip = handle->rxBdCurrent[0];
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache invalidate maintain. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- DCACHE_InvalidateByRange(address, handle->rxBuffSizeAlign[0]);
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- }
- }
- return kStatus_ENET_RxFrameFail;
- }
- static void ENET_UpdateReadBuffers(ENET_Type *base, enet_handle_t *handle, uint32_t ringId)
- {
- assert(handle);
- assert(ringId < FSL_FEATURE_ENET_QUEUE);
- /* Clears status. */
- handle->rxBdCurrent[ringId]->control &= ENET_BUFFDESCRIPTOR_RX_WRAP_MASK;
- /* Sets the receive buffer descriptor with the empty flag. */
- handle->rxBdCurrent[ringId]->control |= ENET_BUFFDESCRIPTOR_RX_EMPTY_MASK;
- /* Increase current buffer descriptor to the next one. */
- if (handle->rxBdCurrent[ringId]->control & ENET_BUFFDESCRIPTOR_RX_WRAP_MASK)
- {
- handle->rxBdCurrent[ringId] = handle->rxBdBase[ringId];
- }
- else
- {
- handle->rxBdCurrent[ringId]++;
- }
- /* Actives the receive buffer descriptor. */
- switch (ringId)
- {
- case kENET_Ring0:
- base->RDAR = ENET_RDAR_RDAR_MASK;
- break;
- #if FSL_FEATURE_ENET_QUEUE > 1
- case kENET_Ring1:
- base->RDAR1 = ENET_RDAR1_RDAR_MASK;
- break;
- case kENET_Ring2:
- base->RDAR2 = ENET_RDAR2_RDAR_MASK;
- break;
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- default:
- base->RDAR = ENET_RDAR_RDAR_MASK;
- break;
- }
- }
- status_t ENET_SendFrame(ENET_Type *base, enet_handle_t *handle, const uint8_t *data, uint32_t length)
- {
- assert(handle);
- assert(data);
- volatile enet_tx_bd_struct_t *curBuffDescrip;
- uint32_t len = 0;
- uint32_t sizeleft = 0;
- uint32_t address;
- /* Check the frame length. */
- if (length > ENET_FRAME_MAX_FRAMELEN)
- {
- return kStatus_ENET_TxFrameOverLen;
- }
- /* Check if the transmit buffer is ready. */
- curBuffDescrip = handle->txBdCurrent[0];
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_READY_MASK)
- {
- return kStatus_ENET_TxFrameBusy;
- }
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- bool isPtpEventMessage = false;
- /* Check PTP message with the PTP header. */
- isPtpEventMessage = ENET_Ptp1588ParseFrame(data, NULL, true);
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* One transmit buffer is enough for one frame. */
- if (handle->txBuffSizeAlign[0] >= length)
- {
- /* Copy data to the buffer for uDMA transfer. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
-
- {
- // Change SDK to reduce memory copy
- extern void pbuf2mem(const uint8_t *data, void *dataptr, uint32_t len);
- pbuf2mem(data, (void *)address, length);
- }
- //memcpy((void *)address, data, length);
- /* Set data length. */
- curBuffDescrip->length = length;
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /* For enable the timestamp. */
- if (isPtpEventMessage)
- {
- curBuffDescrip->controlExtend1 |= ENET_BUFFDESCRIPTOR_TX_TIMESTAMP_MASK;
- }
- else
- {
- curBuffDescrip->controlExtend1 &= ~ENET_BUFFDESCRIPTOR_TX_TIMESTAMP_MASK;
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- curBuffDescrip->control |= (ENET_BUFFDESCRIPTOR_TX_READY_MASK | ENET_BUFFDESCRIPTOR_TX_LAST_MASK);
- /* Increase the buffer descriptor address. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_WRAP_MASK)
- {
- handle->txBdCurrent[0] = handle->txBdBase[0];
- }
- else
- {
- handle->txBdCurrent[0]++;
- }
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache clean maintain. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- DCACHE_CleanByRange(address, length);
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- /* Active the transmit buffer descriptor. */
- ENET_ActiveSend(base, 0);
- return kStatus_Success;
- }
- else
- {
- /* One frame requires more than one transmit buffers. */
- do
- {
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /* For enable the timestamp. */
- if (isPtpEventMessage)
- {
- curBuffDescrip->controlExtend1 |= ENET_BUFFDESCRIPTOR_TX_TIMESTAMP_MASK;
- }
- else
- {
- curBuffDescrip->controlExtend1 &= ~ENET_BUFFDESCRIPTOR_TX_TIMESTAMP_MASK;
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* Increase the buffer descriptor address. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_WRAP_MASK)
- {
- handle->txBdCurrent[0] = handle->txBdBase[0];
- }
- else
- {
- handle->txBdCurrent[0]++;
- }
- /* update the size left to be transmit. */
- sizeleft = length - len;
- if (sizeleft > handle->txBuffSizeAlign[0])
- {
- /* Data copy. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- memcpy((void *)address, data + len, handle->txBuffSizeAlign[0]);
- /* Data length update. */
- curBuffDescrip->length = handle->txBuffSizeAlign[0];
- len += handle->txBuffSizeAlign[0];
- /* Sets the control flag. */
- curBuffDescrip->control &= ~ENET_BUFFDESCRIPTOR_TX_LAST_MASK;
- curBuffDescrip->control |= ENET_BUFFDESCRIPTOR_TX_READY_MASK;
- /* Active the transmit buffer descriptor*/
- ENET_ActiveSend(base, 0);
- }
- else
- {
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- memcpy((void *)address, data + len, sizeleft);
- curBuffDescrip->length = sizeleft;
- /* Set Last buffer wrap flag. */
- curBuffDescrip->control |= ENET_BUFFDESCRIPTOR_TX_READY_MASK | ENET_BUFFDESCRIPTOR_TX_LAST_MASK;
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache clean maintain. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- DCACHE_CleanByRange(address, handle->txBuffSizeAlign[0]);
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- /* Active the transmit buffer descriptor. */
- ENET_ActiveSend(base, 0);
- return kStatus_Success;
- }
- /* Get the current buffer descriptor address. */
- curBuffDescrip = handle->txBdCurrent[0];
- } while (!(curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_READY_MASK));
- return kStatus_ENET_TxFrameBusy;
- }
- }
- #if FSL_FEATURE_ENET_QUEUE > 1
- void ENET_GetRxErrBeforeReadFrameMultiRing(enet_handle_t *handle,
- enet_data_error_stats_t *eErrorStatic,
- uint32_t ringId)
- {
- assert(handle);
- assert(eErrorStatic);
- assert(ringId < FSL_FEATURE_ENET_QUEUE);
- uint16_t control = 0;
- volatile enet_rx_bd_struct_t *curBuffDescrip = handle->rxBdCurrent[ringId];
- do
- {
- /* The last buffer descriptor of a frame. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_LAST_MASK)
- {
- control = curBuffDescrip->control;
- if (control & ENET_BUFFDESCRIPTOR_RX_TRUNC_MASK)
- {
- /* The receive truncate error. */
- eErrorStatic->statsRxTruncateErr++;
- }
- if (control & ENET_BUFFDESCRIPTOR_RX_OVERRUN_MASK)
- {
- /* The receive over run error. */
- eErrorStatic->statsRxOverRunErr++;
- }
- if (control & ENET_BUFFDESCRIPTOR_RX_LENVLIOLATE_MASK)
- {
- /* The receive length violation error. */
- eErrorStatic->statsRxLenGreaterErr++;
- }
- if (control & ENET_BUFFDESCRIPTOR_RX_NOOCTET_MASK)
- {
- /* The receive alignment error. */
- eErrorStatic->statsRxAlignErr++;
- }
- if (control & ENET_BUFFDESCRIPTOR_RX_CRC_MASK)
- {
- /* The receive CRC error. */
- eErrorStatic->statsRxFcsErr++;
- }
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- uint16_t controlExt = curBuffDescrip->controlExtend1;
- if (controlExt & ENET_BUFFDESCRIPTOR_RX_MACERR_MASK)
- {
- /* The MAC error. */
- eErrorStatic->statsRxMacErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_RX_PHYERR_MASK)
- {
- /* The PHY error. */
- eErrorStatic->statsRxPhyErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_RX_COLLISION_MASK)
- {
- /* The receive collision error. */
- eErrorStatic->statsRxCollisionErr++;
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- break;
- }
- /* Increase the buffer descriptor, if it is the last one, increase to first one of the ring buffer. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_WRAP_MASK)
- {
- curBuffDescrip = handle->rxBdBase[ringId];
- }
- else
- {
- curBuffDescrip++;
- }
- } while (curBuffDescrip != handle->rxBdCurrent[ringId]);
- }
- status_t ENET_GetRxFrameSizeMultiRing(enet_handle_t *handle, uint32_t *length, uint32_t ringId)
- {
- assert(handle);
- assert(length);
- assert(ringId < FSL_FEATURE_ENET_QUEUE);
- /* Reset the length to zero. */
- *length = 0;
- uint16_t validLastMask = ENET_BUFFDESCRIPTOR_RX_LAST_MASK | ENET_BUFFDESCRIPTOR_RX_EMPTY_MASK;
- volatile enet_rx_bd_struct_t *curBuffDescrip;
- curBuffDescrip = handle->rxBdCurrent[ringId];
- /* Check the current buffer descriptor's empty flag. if empty means there is no frame received. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_EMPTY_MASK)
- {
- return kStatus_ENET_RxFrameEmpty;
- }
- do
- {
- /* Add check for abnormal case. */
- if ((!(curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_EMPTY_MASK)) && (!curBuffDescrip->length))
- {
- return kStatus_ENET_RxFrameError;
- }
- /* Find the last buffer descriptor. */
- if ((curBuffDescrip->control & validLastMask) == ENET_BUFFDESCRIPTOR_RX_LAST_MASK)
- {
- /* The last buffer descriptor in the frame check the status of the received frame. */
- if ((curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_ERR_MASK)
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- || (curBuffDescrip->controlExtend1 & ENET_BUFFDESCRIPTOR_RX_EXT_ERR_MASK)
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- )
- {
- return kStatus_ENET_RxFrameError;
- }
- /* FCS is removed by MAC. */
- *length = curBuffDescrip->length;
- return kStatus_Success;
- }
- /* Increase the buffer descriptor, if it is the last one, increase to first one of the ring buffer. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_WRAP_MASK)
- {
- curBuffDescrip = handle->rxBdBase[ringId];
- }
- else
- {
- curBuffDescrip++;
- }
- } while (curBuffDescrip != handle->rxBdCurrent[ringId]);
- /* The frame is on processing - set to empty status to make application to receive it next time. */
- return kStatus_ENET_RxFrameEmpty;
- }
- status_t ENET_ReadFrameMultiRing(
- ENET_Type *base, enet_handle_t *handle, uint8_t *data, uint32_t length, uint32_t ringId)
- {
- assert(handle);
- assert(ringId < FSL_FEATURE_ENET_QUEUE);
- uint32_t len = 0;
- uint32_t offset = 0;
- uint16_t control;
- bool isLastBuff = false;
- volatile enet_rx_bd_struct_t *curBuffDescrip = handle->rxBdCurrent[ringId];
- status_t result = kStatus_Success;
- uint32_t address;
- /* For data-NULL input, only update the buffer descriptor. */
- if (!data)
- {
- do
- {
- /* Update the control flag. */
- control = handle->rxBdCurrent[ringId]->control;
- /* Updates the receive buffer descriptors. */
- ENET_UpdateReadBuffers(base, handle, ringId);
- /* Find the last buffer descriptor for the frame. */
- if (control & ENET_BUFFDESCRIPTOR_RX_LAST_MASK)
- {
- break;
- }
- } while (handle->rxBdCurrent[ringId] != curBuffDescrip);
- return result;
- }
- else
- {
- /* A frame on one buffer or several receive buffers are both considered. */
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache invalidate maintain. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- DCACHE_InvalidateByRange(address, handle->rxBuffSizeAlign[ringId]);
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- enet_ptp_time_data_t ptpTimestamp;
- bool isPtpEventMessage = false;
- /* Parse the PTP message according to the header message. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- isPtpEventMessage = ENET_Ptp1588ParseFrame((uint8_t *)address, &ptpTimestamp, false);
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- while (!isLastBuff)
- {
- /* The last buffer descriptor of a frame. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_RX_LAST_MASK)
- {
- /* This is a valid frame. */
- isLastBuff = true;
- if (length == curBuffDescrip->length)
- {
- /* Copy the frame to user's buffer without FCS. */
- len = curBuffDescrip->length - offset;
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- memcpy(data + offset, (void *)address, len);
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /* Store the PTP 1588 timestamp for received PTP event frame. */
- if (isPtpEventMessage)
- {
- /* Set the timestamp to the timestamp ring. */
- ptpTimestamp.timeStamp.nanosecond = curBuffDescrip->timestamp;
- result = ENET_StoreRxFrameTime(base, handle, &ptpTimestamp);
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* Updates the receive buffer descriptors. */
- ENET_UpdateReadBuffers(base, handle, ringId);
- return result;
- }
- else
- {
- /* Updates the receive buffer descriptors. */
- ENET_UpdateReadBuffers(base, handle, ringId);
- }
- }
- else
- {
- /* Store a frame on several buffer descriptors. */
- isLastBuff = false;
- /* Length check. */
- if (offset >= length)
- {
- break;
- }
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- memcpy(data + offset, (void *)address, handle->rxBuffSizeAlign[ringId]);
- offset += handle->rxBuffSizeAlign[ringId];
- /* Updates the receive buffer descriptors. */
- ENET_UpdateReadBuffers(base, handle, ringId);
- }
- /* Get the current buffer descriptor. */
- curBuffDescrip = handle->rxBdCurrent[ringId];
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache invalidate maintain. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- DCACHE_InvalidateByRange(address, handle->rxBuffSizeAlign[ringId]);
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- }
- }
- return kStatus_ENET_RxFrameFail;
- }
- status_t ENET_SendFrameMultiRing(
- ENET_Type *base, enet_handle_t *handle, uint8_t *data, uint32_t length, uint32_t ringId)
- {
- assert(handle);
- assert(data);
- assert(ringId < FSL_FEATURE_ENET_QUEUE);
- volatile enet_tx_bd_struct_t *curBuffDescrip;
- uint32_t len = 0;
- uint32_t sizeleft = 0;
- uint32_t address;
- /* Check the frame length. */
- if (length > ENET_FRAME_MAX_FRAMELEN)
- {
- return kStatus_ENET_TxFrameOverLen;
- }
- /* Check if the transmit buffer is ready. */
- curBuffDescrip = handle->txBdCurrent[ringId];
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_READY_MASK)
- {
- return kStatus_ENET_TxFrameBusy;
- }
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- bool isPtpEventMessage = false;
- /* Check PTP message with the PTP header. */
- isPtpEventMessage = ENET_Ptp1588ParseFrame(data, NULL, true);
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* One transmit buffer is enough for one frame. */
- if (handle->txBuffSizeAlign[ringId] >= length)
- {
- /* Copy data to the buffer for uDMA transfer. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- memcpy((void *)address, data, length);
- /* Set data length. */
- curBuffDescrip->length = length;
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /* For enable the timestamp. */
- if (isPtpEventMessage)
- {
- curBuffDescrip->controlExtend1 |= ENET_BUFFDESCRIPTOR_TX_TIMESTAMP_MASK;
- }
- else
- {
- curBuffDescrip->controlExtend1 &= ~ENET_BUFFDESCRIPTOR_TX_TIMESTAMP_MASK;
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- curBuffDescrip->control |= (ENET_BUFFDESCRIPTOR_TX_READY_MASK | ENET_BUFFDESCRIPTOR_TX_LAST_MASK);
- /* Increase the buffer descriptor address. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_WRAP_MASK)
- {
- handle->txBdCurrent[ringId] = handle->txBdBase[ringId];
- }
- else
- {
- handle->txBdCurrent[ringId]++;
- }
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache clean maintain. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- DCACHE_CleanByRange(address, length);
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- /* Active the transmit buffer descriptor. */
- ENET_ActiveSend(base, ringId);
- return kStatus_Success;
- }
- else
- {
- /* One frame requires more than one transmit buffers. */
- do
- {
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- /* For enable the timestamp. */
- if (isPtpEventMessage)
- {
- curBuffDescrip->controlExtend1 |= ENET_BUFFDESCRIPTOR_TX_TIMESTAMP_MASK;
- }
- else
- {
- curBuffDescrip->controlExtend1 &= ~ENET_BUFFDESCRIPTOR_TX_TIMESTAMP_MASK;
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* Increase the buffer descriptor address. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_WRAP_MASK)
- {
- handle->txBdCurrent[ringId] = handle->txBdBase[ringId];
- }
- else
- {
- handle->txBdCurrent[ringId]++;
- }
- /* update the size left to be transmit. */
- sizeleft = length - len;
- if (sizeleft > handle->txBuffSizeAlign[ringId])
- {
- /* Data copy. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- memcpy((void*)address, data + len, handle->txBuffSizeAlign[ringId]);
- /* Data length update. */
- curBuffDescrip->length = handle->txBuffSizeAlign[ringId];
- len += handle->txBuffSizeAlign[ringId];
- /* Sets the control flag. */
- curBuffDescrip->control &= ~ENET_BUFFDESCRIPTOR_TX_LAST_MASK;
- curBuffDescrip->control |= ENET_BUFFDESCRIPTOR_TX_READY_MASK;
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache clean maintain. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- DCACHE_CleanByRange(address, handle->txBuffSizeAlign[ringId]);
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- /* Active the transmit buffer descriptor*/
- ENET_ActiveSend(base, ringId);
- }
- else
- {
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- memcpy((void *)address, data + len, sizeleft);
- curBuffDescrip->length = sizeleft;
- /* Set Last buffer wrap flag. */
- curBuffDescrip->control |= ENET_BUFFDESCRIPTOR_TX_READY_MASK | ENET_BUFFDESCRIPTOR_TX_LAST_MASK;
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache clean maintain. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- DCACHE_CleanByRange(address, sizeleft);
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- /* Active the transmit buffer descriptor. */
- ENET_ActiveSend(base, ringId);
- return kStatus_Success;
- }
- /* Get the current buffer descriptor address. */
- curBuffDescrip = handle->txBdCurrent[ringId];
- #if defined(FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL) && FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL
- /* Add the cache invalidate maintain. */
- #endif /* FSL_SDK_ENABLE_DRIVER_CACHE_CONTROL */
- } while (!(curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_READY_MASK));
- return kStatus_ENET_TxFrameBusy;
- }
- }
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- void ENET_AddMulticastGroup(ENET_Type *base, uint8_t *address)
- {
- assert(address);
- uint32_t crc = 0xFFFFFFFFU;
- uint32_t count1 = 0;
- uint32_t count2 = 0;
- /* Calculates the CRC-32 polynomial on the multicast group address. */
- for (count1 = 0; count1 < ENET_FRAME_MACLEN; count1++)
- {
- uint8_t c = address[count1];
- for (count2 = 0; count2 < 0x08U; count2++)
- {
- if ((c ^ crc) & 1U)
- {
- crc >>= 1U;
- c >>= 1U;
- crc ^= 0xEDB88320U;
- }
- else
- {
- crc >>= 1U;
- c >>= 1U;
- }
- }
- }
- /* Enable a multicast group address. */
- if (!((crc >> 0x1FU) & 1U))
- {
- base->GALR |= 1U << ((crc >> 0x1AU) & 0x1FU);
- }
- else
- {
- base->GAUR |= 1U << ((crc >> 0x1AU) & 0x1FU);
- }
- }
- void ENET_LeaveMulticastGroup(ENET_Type *base, uint8_t *address)
- {
- assert(address);
- uint32_t crc = 0xFFFFFFFFU;
- uint32_t count1 = 0;
- uint32_t count2 = 0;
- /* Calculates the CRC-32 polynomial on the multicast group address. */
- for (count1 = 0; count1 < ENET_FRAME_MACLEN; count1++)
- {
- uint8_t c = address[count1];
- for (count2 = 0; count2 < 0x08U; count2++)
- {
- if ((c ^ crc) & 1U)
- {
- crc >>= 1U;
- c >>= 1U;
- crc ^= 0xEDB88320U;
- }
- else
- {
- crc >>= 1U;
- c >>= 1U;
- }
- }
- }
- /* Set the hash table. */
- if (!((crc >> 0x1FU) & 1U))
- {
- base->GALR &= ~(1U << ((crc >> 0x1AU) & 0x1FU));
- }
- else
- {
- base->GAUR &= ~(1U << ((crc >> 0x1AU) & 0x1FU));
- }
- }
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- status_t ENET_GetTxErrAfterSendFrame(enet_handle_t *handle, enet_data_error_stats_t *eErrorStatic)
- {
- assert(handle);
- assert(eErrorStatic);
- uint16_t control = 0;
- uint16_t controlExt = 0;
- do
- {
- /* Get the current dirty transmit buffer descriptor. */
- control = handle->txBdDirtyStatic[0]->control;
- controlExt = handle->txBdDirtyStatic[0]->controlExtend0;
- /* Get the control status data, If the buffer descriptor has not been processed break out. */
- if (control & ENET_BUFFDESCRIPTOR_TX_READY_MASK)
- {
- return kStatus_ENET_TxFrameBusy;
- }
- /* Increase the transmit dirty static pointer. */
- if (handle->txBdDirtyStatic[0]->control & ENET_BUFFDESCRIPTOR_TX_WRAP_MASK)
- {
- handle->txBdDirtyStatic[0] = handle->txBdBase[0];
- }
- else
- {
- handle->txBdDirtyStatic[0]++;
- }
- /* If the transmit buffer descriptor is ready and the last buffer descriptor, store packet statistic. */
- if (control & ENET_BUFFDESCRIPTOR_TX_LAST_MASK)
- {
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_ERR_MASK)
- {
- /* Transmit error. */
- eErrorStatic->statsTxErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_EXCCOLLISIONERR_MASK)
- {
- /* Transmit excess collision error. */
- eErrorStatic->statsTxExcessCollisionErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_LATECOLLISIONERR_MASK)
- {
- /* Transmit late collision error. */
- eErrorStatic->statsTxLateCollisionErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_UNDERFLOWERR_MASK)
- {
- /* Transmit under flow error. */
- eErrorStatic->statsTxUnderFlowErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_OVERFLOWERR_MASK)
- {
- /* Transmit over flow error. */
- eErrorStatic->statsTxOverFlowErr++;
- }
- return kStatus_Success;
- }
- } while (handle->txBdDirtyStatic[0] != handle->txBdCurrent[0]);
- return kStatus_ENET_TxFrameFail;
- }
- #if FSL_FEATURE_ENET_QUEUE > 1
- status_t ENET_GetTxErrAfterSendFrameMultiRing(enet_handle_t *handle, enet_data_error_stats_t *eErrorStatic,
- uint32_t ringId)
- {
- assert(handle);
- assert(eErrorStatic);
- assert(ringId < FSL_FEATURE_ENET_QUEUE);
- uint16_t control = 0;
- uint16_t controlExt = 0;
- do
- {
- /* Get the current dirty transmit buffer descriptor. */
- control = handle->txBdDirtyStatic[ringId]->control;
- controlExt = handle->txBdDirtyStatic[ringId]->controlExtend0;
- /* Get the control status data, If the buffer descriptor has not been processed break out. */
- if (control & ENET_BUFFDESCRIPTOR_TX_READY_MASK)
- {
- return kStatus_ENET_TxFrameBusy;
- }
- /* Increase the transmit dirty static pointer. */
- if (handle->txBdDirtyStatic[ringId]->control & ENET_BUFFDESCRIPTOR_TX_WRAP_MASK)
- {
- handle->txBdDirtyStatic[ringId] = handle->txBdBase[ringId];
- }
- else
- {
- handle->txBdDirtyStatic[ringId]++;
- }
- /* If the transmit buffer descriptor is ready and the last buffer descriptor, store packet statistic. */
- if (control & ENET_BUFFDESCRIPTOR_TX_LAST_MASK)
- {
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_ERR_MASK)
- {
- /* Transmit error. */
- eErrorStatic->statsTxErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_EXCCOLLISIONERR_MASK)
- {
- /* Transmit excess collision error. */
- eErrorStatic->statsTxExcessCollisionErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_LATECOLLISIONERR_MASK)
- {
- /* Transmit late collision error. */
- eErrorStatic->statsTxLateCollisionErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_UNDERFLOWERR_MASK)
- {
- /* Transmit under flow error. */
- eErrorStatic->statsTxUnderFlowErr++;
- }
- if (controlExt & ENET_BUFFDESCRIPTOR_TX_OVERFLOWERR_MASK)
- {
- /* Transmit over flow error. */
- eErrorStatic->statsTxOverFlowErr++;
- }
- return kStatus_Success;
- }
- } while (handle->txBdDirtyStatic[ringId] != handle->txBdCurrent[ringId]);
- return kStatus_ENET_TxFrameFail;
- }
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- static bool ENET_Ptp1588ParseFrame(const uint8_t *data, enet_ptp_time_data_t *ptpTsData, bool isFastEnabled)
- {
- assert(data);
- if (!isFastEnabled)
- {
- assert(ptpTsData);
- }
- bool isPtpMsg = false;
- const uint8_t *buffer = data;
- uint16_t ptpType;
- /* Check for VLAN frame.
- * Add Double vlan tag check for receiving extended QIN vlan frame. */
- if (*(uint16_t *)(buffer + ENET_PTP1588_ETHL2_PACKETTYPE_OFFSET) == (ENET_HTONS(ENET_8021QVLAN)
- #if defined(FSL_FEATUR_ENET_HAS_AVB) && FSL_FEATURE_HAS_AVB
- || ENET_HTONS(ENET_8021QSVLAN)
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- ))
- {
- buffer += ENET_FRAME_VLAN_TAGLEN;
- #if defined(FSL_FEATUR_ENET_HAS_AVB) && FSL_FEATURE_HAS_AVB
- if (*(uint16_t *)(buffer + ENET_PTP1588_ETHL2_PACKETTYPE_OFFSET) == ENET_HTONS(ENET_8021QVLAN)
- {
- buffer += ENET_FRAME_VLAN_TAGLEN;
- }
- #endif /* FSL_FEATURE_ENET_HAS_AVB */
- }
- ptpType = *(uint16_t *)(buffer + ENET_PTP1588_ETHL2_PACKETTYPE_OFFSET);
- switch (ENET_HTONS(ptpType))
- { /* Ethernet layer 2. */
- case ENET_ETHERNETL2:
- if (*(uint8_t *)(buffer + ENET_PTP1588_ETHL2_MSGTYPE_OFFSET) <= kENET_PtpEventMsgType)
- {
- isPtpMsg = true;
- if (!isFastEnabled)
- {
- /* It's a ptpv2 message and store the ptp header information. */
- ptpTsData->version = (*(uint8_t *)(buffer + ENET_PTP1588_ETHL2_VERSION_OFFSET)) & 0x0F;
- ptpTsData->messageType = (*(uint8_t *)(buffer + ENET_PTP1588_ETHL2_MSGTYPE_OFFSET)) & 0x0F;
- ptpTsData->sequenceId = ENET_HTONS(*(uint16_t *)(buffer + ENET_PTP1588_ETHL2_SEQUENCEID_OFFSET));
- memcpy((void *)&ptpTsData->sourcePortId[0], (void *)(buffer + ENET_PTP1588_ETHL2_CLOCKID_OFFSET),
- kENET_PtpSrcPortIdLen);
- }
- }
- break;
- /* IPV4. */
- case ENET_IPV4:
- if ((*(uint8_t *)(buffer + ENET_PTP1588_IPVERSION_OFFSET) >> 4) == ENET_IPV4VERSION)
- {
- if (((*(uint16_t *)(buffer + ENET_PTP1588_IPV4_UDP_PORT_OFFSET)) == ENET_HTONS(kENET_PtpEventPort)) &&
- (*(uint8_t *)(buffer + ENET_PTP1588_IPV4_UDP_PROTOCOL_OFFSET) == ENET_UDPVERSION))
- {
- /* Set the PTP message flag. */
- isPtpMsg = true;
- if (!isFastEnabled)
- {
- /* It's a IPV4 ptp message and store the ptp header information. */
- ptpTsData->version = (*(uint8_t *)(buffer + ENET_PTP1588_IPV4_UDP_VERSION_OFFSET)) & 0x0F;
- ptpTsData->messageType = (*(uint8_t *)(buffer + ENET_PTP1588_IPV4_UDP_MSGTYPE_OFFSET)) & 0x0F;
- ptpTsData->sequenceId =
- ENET_HTONS(*(uint16_t *)(buffer + ENET_PTP1588_IPV4_UDP_SEQUENCEID_OFFSET));
- memcpy((void *)&ptpTsData->sourcePortId[0],
- (void *)(buffer + ENET_PTP1588_IPV4_UDP_CLKID_OFFSET), kENET_PtpSrcPortIdLen);
- }
- }
- }
- break;
- /* IPV6. */
- case ENET_IPV6:
- if ((*(uint8_t *)(buffer + ENET_PTP1588_IPVERSION_OFFSET) >> 4) == ENET_IPV6VERSION)
- {
- if (((*(uint16_t *)(buffer + ENET_PTP1588_IPV6_UDP_PORT_OFFSET)) == ENET_HTONS(kENET_PtpEventPort)) &&
- (*(uint8_t *)(buffer + ENET_PTP1588_IPV6_UDP_PROTOCOL_OFFSET) == ENET_UDPVERSION))
- {
- /* Set the PTP message flag. */
- isPtpMsg = true;
- if (!isFastEnabled)
- {
- /* It's a IPV6 ptp message and store the ptp header information. */
- ptpTsData->version = (*(uint8_t *)(buffer + ENET_PTP1588_IPV6_UDP_VERSION_OFFSET)) & 0x0F;
- ptpTsData->messageType = (*(uint8_t *)(buffer + ENET_PTP1588_IPV6_UDP_MSGTYPE_OFFSET)) & 0x0F;
- ptpTsData->sequenceId =
- ENET_HTONS(*(uint16_t *)(buffer + ENET_PTP1588_IPV6_UDP_SEQUENCEID_OFFSET));
- memcpy((void *)&ptpTsData->sourcePortId[0],
- (void *)(buffer + ENET_PTP1588_IPV6_UDP_CLKID_OFFSET), kENET_PtpSrcPortIdLen);
- }
- }
- }
- break;
- default:
- break;
- }
- return isPtpMsg;
- }
- void ENET_Ptp1588Configure(ENET_Type *base, enet_handle_t *handle, enet_ptp_config_t *ptpConfig)
- {
- assert(handle);
- assert(ptpConfig);
- uint8_t count;
- uint32_t instance = ENET_GetInstance(base);
- uint32_t mask = kENET_TxBufferInterrupt;
- #if FSL_FEATURE_ENET_QUEUE > 1
- mask |= kENET_TxBuffer1Interrupt | kENET_TxBuffer2Interrupt;
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- /* Start the 1588 timer. */
- ENET_Ptp1588StartTimer(base, ptpConfig->ptp1588ClockSrc_Hz);
- for (count = 0; count < handle->ringNum; count++)
- {
- handle->txBdDirtyTime[count] = handle->txBdBase[count];
- handle->txBdDirtyStatic[count] = handle->txBdBase[count];
- }
- /* Setting the receive and transmit state for transaction. */
- handle->rxPtpTsDataRing.ptpTsData = ptpConfig->rxPtpTsData;
- handle->rxPtpTsDataRing.size = ptpConfig->ptpTsRxBuffNum;
- handle->rxPtpTsDataRing.front = 0;
- handle->rxPtpTsDataRing.end = 0;
- handle->txPtpTsDataRing.ptpTsData = ptpConfig->txPtpTsData;
- handle->txPtpTsDataRing.size = ptpConfig->ptpTsTxBuffNum;
- handle->txPtpTsDataRing.front = 0;
- handle->txPtpTsDataRing.end = 0;
- handle->msTimerSecond = 0;
- /* Set the IRQ handler when the interrupt is enabled. */
- s_enetTxIsr = ENET_TransmitIRQHandler;
- s_enetTsIsr = ENET_Ptp1588TimerIRQHandler;
- /* Enables the time stamp interrupt and transmit frame interrupt to
- * handle the time-stamp . */
- ENET_EnableInterrupts(base, (ENET_TS_INTERRUPT | ENET_TX_INTERRUPT));
- ENET_DisableInterrupts(base, mask);
- EnableIRQ(s_enetTsIrqId[instance]);
- EnableIRQ(s_enetTxIrqId[instance]);
- }
- void ENET_Ptp1588StartTimer(ENET_Type *base, uint32_t ptpClkSrc)
- {
- /* Restart PTP 1588 timer, master clock. */
- base->ATCR = ENET_ATCR_RESTART_MASK;
- /* Initializes PTP 1588 timer. */
- base->ATINC = ENET_ATINC_INC(ENET_NANOSECOND_ONE_SECOND / ptpClkSrc);
- base->ATPER = ENET_NANOSECOND_ONE_SECOND;
- /* Sets periodical event and the event signal output assertion and Actives PTP 1588 timer. */
- base->ATCR = ENET_ATCR_PEREN_MASK | ENET_ATCR_PINPER_MASK | ENET_ATCR_EN_MASK;
- }
- void ENET_Ptp1588GetTimer(ENET_Type *base, enet_handle_t *handle, enet_ptp_time_t *ptpTime)
- {
- assert(handle);
- assert(ptpTime);
- uint16_t count = ENET_1588TIME_DELAY_COUNT;
- uint32_t primask;
- /* Disables the interrupt. */
- primask = DisableGlobalIRQ();
- /* Get the current PTP time. */
- ptpTime->second = handle->msTimerSecond;
- /* Get the nanosecond from the master timer. */
- base->ATCR |= ENET_ATCR_CAPTURE_MASK;
- /* Add at least six clock cycle delay to get accurate time.
- It's the requirement when the 1588 clock source is slower
- than the register clock.
- */
- while (count--)
- {
- __NOP();
- }
- /* Get the captured time. */
- ptpTime->nanosecond = base->ATVR;
- /* Enables the interrupt. */
- EnableGlobalIRQ(primask);
- }
- void ENET_Ptp1588SetTimer(ENET_Type *base, enet_handle_t *handle, enet_ptp_time_t *ptpTime)
- {
- assert(handle);
- assert(ptpTime);
- uint32_t primask;
- /* Disables the interrupt. */
- primask = DisableGlobalIRQ();
- /* Sets PTP timer. */
- handle->msTimerSecond = ptpTime->second;
- base->ATVR = ptpTime->nanosecond;
- /* Enables the interrupt. */
- EnableGlobalIRQ(primask);
- }
- void ENET_Ptp1588AdjustTimer(ENET_Type *base, uint32_t corrIncrease, uint32_t corrPeriod)
- {
- /* Set correction for PTP timer increment. */
- base->ATINC = (base->ATINC & ~ENET_ATINC_INC_CORR_MASK) | (corrIncrease << ENET_ATINC_INC_CORR_SHIFT);
- /* Set correction for PTP timer period. */
- base->ATCOR = (base->ATCOR & ~ENET_ATCOR_COR_MASK) | (corrPeriod << ENET_ATCOR_COR_SHIFT);
- }
- static status_t ENET_Ptp1588UpdateTimeRing(enet_ptp_time_data_ring_t *ptpTsDataRing, enet_ptp_time_data_t *ptpTimeData)
- {
- assert(ptpTsDataRing);
- assert(ptpTsDataRing->ptpTsData);
- assert(ptpTimeData);
- uint16_t usedBuffer = 0;
- /* Check if the buffers ring is full. */
- if (ptpTsDataRing->end >= ptpTsDataRing->front)
- {
- usedBuffer = ptpTsDataRing->end - ptpTsDataRing->front;
- }
- else
- {
- usedBuffer = ptpTsDataRing->size - (ptpTsDataRing->front - ptpTsDataRing->end);
- }
- if (usedBuffer == ptpTsDataRing->size)
- {
- return kStatus_ENET_PtpTsRingFull;
- }
- /* Copy the new data into the buffer. */
- memcpy((ptpTsDataRing->ptpTsData + ptpTsDataRing->end), ptpTimeData, sizeof(enet_ptp_time_data_t));
- /* Increase the buffer pointer to the next empty one. */
- ptpTsDataRing->end = (ptpTsDataRing->end + 1) % ptpTsDataRing->size;
- return kStatus_Success;
- }
- static status_t ENET_Ptp1588SearchTimeRing(enet_ptp_time_data_ring_t *ptpTsDataRing, enet_ptp_time_data_t *ptpTimedata)
- {
- assert(ptpTsDataRing);
- assert(ptpTsDataRing->ptpTsData);
- assert(ptpTimedata);
- uint32_t index;
- uint32_t size;
- uint16_t usedBuffer = 0;
- /* Check the PTP 1588 timestamp ring. */
- if (ptpTsDataRing->front == ptpTsDataRing->end)
- {
- return kStatus_ENET_PtpTsRingEmpty;
- }
- /* Search the element in the ring buffer */
- index = ptpTsDataRing->front;
- size = ptpTsDataRing->size;
- while (index != ptpTsDataRing->end)
- {
- if (((ptpTsDataRing->ptpTsData + index)->sequenceId == ptpTimedata->sequenceId) &&
- (!memcmp(((void *)&(ptpTsDataRing->ptpTsData + index)->sourcePortId[0]),
- (void *)&ptpTimedata->sourcePortId[0], kENET_PtpSrcPortIdLen)) &&
- ((ptpTsDataRing->ptpTsData + index)->version == ptpTimedata->version) &&
- ((ptpTsDataRing->ptpTsData + index)->messageType == ptpTimedata->messageType))
- {
- break;
- }
- /* Increase the ptp ring index. */
- index = (index + 1) % size;
- }
- if (index == ptpTsDataRing->end)
- {
- /* Check if buffers is full. */
- if (ptpTsDataRing->end >= ptpTsDataRing->front)
- {
- usedBuffer = ptpTsDataRing->end - ptpTsDataRing->front;
- }
- else
- {
- usedBuffer = ptpTsDataRing->size - (ptpTsDataRing->front - ptpTsDataRing->end);
- }
- if (usedBuffer == ptpTsDataRing->size)
- { /* Drop one in the front. */
- ptpTsDataRing->front = (ptpTsDataRing->front + 1) % size;
- }
- return kStatus_ENET_PtpTsRingFull;
- }
- /* Get the right timestamp of the required ptp messag. */
- ptpTimedata->timeStamp.second = (ptpTsDataRing->ptpTsData + index)->timeStamp.second;
- ptpTimedata->timeStamp.nanosecond = (ptpTsDataRing->ptpTsData + index)->timeStamp.nanosecond;
- /* Increase the index. */
- ptpTsDataRing->front = (ptpTsDataRing->front + 1) % size;
- return kStatus_Success;
- }
- static status_t ENET_StoreRxFrameTime(ENET_Type *base, enet_handle_t *handle, enet_ptp_time_data_t *ptpTimeData)
- {
- assert(handle);
- assert(ptpTimeData);
- bool ptpTimerWrap = false;
- enet_ptp_time_t ptpTimer;
- uint32_t primask;
- /* Disables the interrupt. */
- primask = DisableGlobalIRQ();
- /* Get current PTP timer nanosecond value. */
- ENET_Ptp1588GetTimer(base, handle, &ptpTimer);
- /* Get PTP timer wrap event. */
- ptpTimerWrap = base->EIR & kENET_TsTimerInterrupt;
- /* Get transmit time stamp second. */
- if ((ptpTimer.nanosecond > ptpTimeData->timeStamp.nanosecond) ||
- ((ptpTimer.nanosecond < ptpTimeData->timeStamp.nanosecond) && ptpTimerWrap))
- {
- ptpTimeData->timeStamp.second = handle->msTimerSecond;
- }
- else
- {
- ptpTimeData->timeStamp.second = handle->msTimerSecond - 1;
- }
- /* Enable the interrupt. */
- EnableGlobalIRQ(primask);
- /* Store the timestamp to the receive time stamp ring. */
- /* Check if the buffers ring is full. */
- return ENET_Ptp1588UpdateTimeRing(&handle->rxPtpTsDataRing, ptpTimeData);
- }
- static status_t ENET_StoreTxFrameTime(ENET_Type *base, enet_handle_t *handle, uint32_t ringId)
- {
- assert(handle);
- uint32_t primask;
- bool ptpTimerWrap;
- bool isPtpEventMessage = false;
- enet_ptp_time_data_t ptpTimeData;
- volatile enet_tx_bd_struct_t *curBuffDescrip = handle->txBdDirtyTime[ringId];
- uint32_t address;
- /* Get the control status data, If the buffer descriptor has not been processed break out. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_READY_MASK)
- {
- return kStatus_ENET_TxFrameBusy;
- }
- /* Parse the PTP message. */
- #if defined(FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET) && FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET
- address = MEMORY_ConvertMemoryMapAddress((uint32_t)curBuffDescrip->buffer,kMEMORY_DMA2Local);
- #else
- address = (uint32_t)curBuffDescrip->buffer;
- #endif /* FSL_FEATURE_MEMORY_HAS_ADDRESS_OFFSET */
- isPtpEventMessage = ENET_Ptp1588ParseFrame((uint8_t *)address, &ptpTimeData, false);
- if (isPtpEventMessage)
- {
- do
- {
- /* Increase current buffer descriptor to the next one. */
- if (handle->txBdDirtyTime[ringId]->control & ENET_BUFFDESCRIPTOR_TX_WRAP_MASK)
- {
- handle->txBdDirtyTime[ringId] = handle->txBdBase[ringId];
- }
- else
- {
- handle->txBdDirtyTime[ringId]++;
- }
- /* Do time stamp check on the last buffer descriptor of the frame. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_LAST_MASK)
- {
- /* Disables the interrupt. */
- primask = DisableGlobalIRQ();
- /* Get current PTP timer nanosecond value. */
- ENET_Ptp1588GetTimer(base, handle, &ptpTimeData.timeStamp);
- /* Get PTP timer wrap event. */
- ptpTimerWrap = base->EIR & kENET_TsTimerInterrupt;
- /* Get transmit time stamp second. */
- if ((ptpTimeData.timeStamp.nanosecond > curBuffDescrip->timestamp) ||
- ((ptpTimeData.timeStamp.nanosecond < curBuffDescrip->timestamp) && ptpTimerWrap))
- {
- ptpTimeData.timeStamp.second = handle->msTimerSecond;
- }
- else
- {
- ptpTimeData.timeStamp.second = handle->msTimerSecond - 1;
- }
- /* Enable the interrupt. */
- EnableGlobalIRQ(primask);
- /* Store the timestamp to the transmit timestamp ring. */
- return ENET_Ptp1588UpdateTimeRing(&handle->txPtpTsDataRing, &ptpTimeData);
- }
- /* Get the current transmit buffer descriptor. */
- curBuffDescrip = handle->txBdDirtyTime[ringId];
- /* Get the control status data, If the buffer descriptor has not been processed break out. */
- if (curBuffDescrip->control & ENET_BUFFDESCRIPTOR_TX_READY_MASK)
- {
- return kStatus_ENET_TxFrameBusy;
- }
- } while (handle->txBdDirtyTime[ringId] != handle->txBdCurrent[ringId]);
- return kStatus_ENET_TxFrameFail;
- }
- return kStatus_Success;
- }
- status_t ENET_GetTxFrameTime(enet_handle_t *handle, enet_ptp_time_data_t *ptpTimeData)
- {
- assert(handle);
- assert(ptpTimeData);
- return ENET_Ptp1588SearchTimeRing(&handle->txPtpTsDataRing, ptpTimeData);
- }
- status_t ENET_GetRxFrameTime(enet_handle_t *handle, enet_ptp_time_data_t *ptpTimeData)
- {
- assert(handle);
- assert(ptpTimeData);
- return ENET_Ptp1588SearchTimeRing(&handle->rxPtpTsDataRing, ptpTimeData);
- }
- #if defined(FSL_FEATURE_ENET_HAS_AVB) && FSL_FEATURE_ENET_HAS_AVB
- void ENET_AVBConfigure(ENET_Type *base, enet_handle_t *handle, const enet_avb_config_t *config)
- {
- assert(config);
- uint8_t count = 0;
- for (count = 0; count < FSL_FEATURE_ENET_QUEUE - 1; count++)
- {
- /* Set the AVB receive ring classification match when the match is not 0. */
- if (config->rxClassifyMatch[count])
- {
- base->RCMR[count] = (config->rxClassifyMatch[count] & 0xFFFF) | ENET_RCMR_MATCHEN_MASK;
- }
- /* Set the dma controller for the extended ring. */
- base->DMACFG[count] |= ENET_DMACFG_IDLE_SLOPE(config->idleSlope[count]);
- }
- /* Shall use the credit-based scheme for avb. */
- base->QOS &= ~ENET_QOS_TX_SCHEME_MASK;
- base->QOS |= ENET_QOS_RX_FLUSH0_MASK;
- }
- #endif /* FSL_FETAURE_ENET_HAS_AVB */
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- #if FSL_FEATURE_ENET_QUEUE > 1
- void ENET_TransmitIRQHandler(ENET_Type *base, enet_handle_t *handle, uint32_t ringId)
- #else
- void ENET_TransmitIRQHandler(ENET_Type *base, enet_handle_t *handle)
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- {
- assert(handle);
- uint32_t mask = kENET_TxBufferInterrupt | kENET_TxFrameInterrupt;
- #if defined(ENET_ENHANCEDBUFFERDESCRIPTOR_MODE) || (FSL_FEATURE_ENET_QUEUE > 1)
- uint32_t index = 0;
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTORMODE || (FSL_FEATURE_ENET_QUEUE > 1) */
- /* Check if the transmit interrupt happen. */
- #if FSL_FEATURE_ENET_QUEUE > 1
- switch (ringId)
- {
- case kENET_Ring1:
- mask = (kENET_TxFrame1Interrupt | kENET_TxBuffer1Interrupt);
- break;
- case kENET_Ring2:
- mask = (kENET_TxFrame2Interrupt | kENET_TxBuffer2Interrupt);
- break;
- default:
- break;
- }
- index = ringId;
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- while (mask & base->EIR)
- {
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- if (base->EIR & kENET_TxFrameInterrupt)
- {
- /* Store the transmit timestamp from the buffer descriptor should be done here. */
- ENET_StoreTxFrameTime(base, handle, index);
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- /* Clear the transmit interrupt event. */
- base->EIR = mask;
- /* Callback function. */
- if (handle->callback)
- {
- #if FSL_FEATURE_ENET_QUEUE > 1
- handle->callback(base, handle, index, kENET_TxEvent, handle->userData);
- #else
- handle->callback(base, handle, kENET_TxEvent, handle->userData);
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- }
- }
- }
- #if FSL_FEATURE_ENET_QUEUE > 1
- void ENET_ReceiveIRQHandler(ENET_Type *base, enet_handle_t *handle, uint32_t ringId)
- #else
- void ENET_ReceiveIRQHandler(ENET_Type *base, enet_handle_t *handle)
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- {
- assert(handle);
- uint32_t mask = kENET_RxFrameInterrupt | kENET_RxBufferInterrupt;
- /* Check if the receive interrupt happen. */
- #if FSL_FEATURE_ENET_QUEUE > 1
- switch (ringId)
- {
- case kENET_Ring1:
- mask = (kENET_RxFrame1Interrupt | kENET_RxBuffer1Interrupt);
- break;
- case kENET_Ring2:
- mask = (kENET_RxFrame2Interrupt | kENET_RxBuffer2Interrupt);
- break;
- default:
- break;
- }
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- while (mask & base->EIR)
- {
- /* Clear the transmit interrupt event. */
- base->EIR = mask;
- /* Callback function. */
- if (handle->callback)
- {
- #if FSL_FEATURE_ENET_QUEUE > 1
- handle->callback(base, handle, ringId, kENET_RxEvent, handle->userData);
- #else
- handle->callback(base, handle, kENET_RxEvent, handle->userData);
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- }
- }
- }
- void ENET_ErrorIRQHandler(ENET_Type *base, enet_handle_t *handle)
- {
- assert(handle);
- uint32_t errMask = kENET_BabrInterrupt | kENET_BabtInterrupt | kENET_EBusERInterrupt | kENET_PayloadRxInterrupt |
- kENET_LateCollisionInterrupt | kENET_RetryLimitInterrupt | kENET_UnderrunInterrupt;
- /* Check if the error interrupt happen. */
- if (kENET_WakeupInterrupt & base->EIR)
- {
- /* Clear the wakeup interrupt. */
- base->EIR = kENET_WakeupInterrupt;
- /* wake up and enter the normal mode. */
- ENET_EnableSleepMode(base, false);
- /* Callback function. */
- if (handle->callback)
- {
- #if FSL_FEATURE_ENET_QUEUE > 1
- handle->callback(base, handle, 0, kENET_WakeUpEvent, handle->userData);
- #else
- handle->callback(base, handle, kENET_WakeUpEvent, handle->userData);
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- }
- }
- else
- {
- /* Clear the error interrupt event status. */
- errMask &= base->EIR;
- base->EIR = errMask;
- /* Callback function. */
- if (handle->callback)
- {
- #if FSL_FEATURE_ENET_QUEUE > 1
- handle->callback(base, handle, 0, kENET_ErrEvent, handle->userData);
- #else
- handle->callback(base, handle, kENET_ErrEvent, handle->userData);
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- }
- }
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #ifdef ENET_ENHANCEDBUFFERDESCRIPTOR_MODE
- void ENET_Ptp1588TimerIRQHandler(ENET_Type *base, enet_handle_t *handle)
- {
- assert(handle);
- /* Check if the PTP time stamp interrupt happen. */
- if (kENET_TsTimerInterrupt & base->EIR)
- {
- /* Clear the time stamp interrupt. */
- base->EIR = kENET_TsTimerInterrupt;
- /* Increase timer second counter. */
- handle->msTimerSecond++;
- /* Callback function. */
- if (handle->callback)
- {
- #if FSL_FEATURE_ENET_QUEUE > 1
- handle->callback(base, handle, 0, kENET_TimeStampEvent, handle->userData);
- #else
- handle->callback(base, handle, kENET_TimeStampEvent, handle->userData);
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- }
- }
- else
- {
- /* Clear the time stamp interrupt. */
- base->EIR = kENET_TsAvailInterrupt;
- /* Callback function. */
- if (handle->callback)
- {
- #if FSL_FEATURE_ENET_QUEUE > 1
- handle->callback(base, handle, 0, kENET_TimeStampAvailEvent, handle->userData);
- #else
- handle->callback(base, handle, kENET_TimeStampAvailEvent, handle->userData);
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- }
- }
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #endif /* ENET_ENHANCEDBUFFERDESCRIPTOR_MODE */
- void ENET_CommonFrame0IRQHandler(ENET_Type *base)
- {
- uint32_t event = base->EIR;
- uint32_t instance = ENET_GetInstance(base);
- if (event & (kENET_TxBufferInterrupt | kENET_TxFrameInterrupt))
- {
- #if FSL_FEATURE_ENET_QUEUE > 1
- s_enetTxIsr(base, s_ENETHandle[instance], 0);
- #else
- s_enetTxIsr(base, s_ENETHandle[instance]);
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- }
- if (event & (kENET_RxBufferInterrupt | kENET_RxFrameInterrupt))
- {
- #if FSL_FEATURE_ENET_QUEUE > 1
- s_enetRxIsr(base, s_ENETHandle[instance], 0);
- #else
- s_enetRxIsr(base, s_ENETHandle[instance]);
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- }
- if (event & ENET_TS_INTERRUPT)
- {
- s_enetTsIsr(base, s_ENETHandle[instance]);
- }
- if (event & ENET_ERR_INTERRUPT)
- {
- s_enetErrIsr(base, s_ENETHandle[instance]);
- }
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #if FSL_FEATURE_ENET_QUEUE > 1
- void ENET_CommonFrame1IRQHandler(ENET_Type *base)
- {
- uint32_t event = base->EIR;
- uint32_t instance = ENET_GetInstance(base);
- if (event & (kENET_TxBuffer1Interrupt | kENET_TxFrame1Interrupt))
- {
- s_enetTxIsr(base, s_ENETHandle[instance], 1);
- }
- if (event & (kENET_RxBuffer1Interrupt | kENET_RxFrame1Interrupt))
- {
- s_enetRxIsr(base, s_ENETHandle[instance], 1);
- }
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- void ENET_CommonFrame2IRQHandler(ENET_Type *base)
- {
- uint32_t event = base->EIR;
- uint32_t instance = ENET_GetInstance(base);
- if (event & (kENET_TxBuffer2Interrupt | kENET_TxFrame2Interrupt))
- {
- s_enetTxIsr(base, s_ENETHandle[instance], 2);
- }
- if (event & (kENET_RxBuffer2Interrupt | kENET_RxFrame2Interrupt))
- {
- s_enetRxIsr(base, s_ENETHandle[instance], 2);
- }
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #endif /* FSL_FEATURE_ENET_QUEUE > 1 */
- #if defined(ENET)
- void ENET_Transmit_IRQHandler(void)
- {
- s_enetTxIsr(ENET, s_ENETHandle[0]);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- void ENET_Receive_IRQHandler(void)
- {
- s_enetRxIsr(ENET, s_ENETHandle[0]);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- void ENET_Error_IRQHandler(void)
- {
- s_enetErrIsr(ENET, s_ENETHandle[0]);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- void ENET_1588_Timer_IRQHandler(void)
- {
- s_enetTsIsr(ENET, s_ENETHandle[0]);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- void ENET_DriverIRQHandler(void)
- {
- ENET_CommonFrame0IRQHandler(ENET);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #endif
- #if defined(ENET1)
- void ENET1_DriverIRQHandler(void)
- {
- ENET_CommonFrame0IRQHandler(ENET1);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #endif
- #if defined(ENET2)
- void ENET2_DriverIRQHandler(void)
- {
- ENET_CommonFrame0IRQHandler(ENET2);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #endif
- #if defined(CONNECTIVITY__ENET0)
- void CONNECTIVITY_ENET0_FRAME0_EVENT_INT_DriverIRQHandler(void)
- {
- ENET_CommonFrame0IRQHandler(CONNECTIVITY__ENET0);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #if FSL_FEATURE_ENET_QUEUE > 1
- void CONNECTIVITY_ENET0_FRAME1_INT_DriverIRQHandler(void)
- {
- ENET_CommonFrame1IRQHandler(CONNECTIVITY__ENET0);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- void CONNECTIVITY_ENET0_FRAME2_INT_DriverIRQHandler(void)
- {
- ENET_CommonFrame2IRQHandler(CONNECTIVITY__ENET0);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #endif
- #endif
- #if defined(CONNECTIVITY__ENET1)
- void CONNECTIVITY_ENET1_FRAME0_EVENT_INT_DriverIRQHandler(void)
- {
- ENET_CommonFrame0IRQHandler(CONNECTIVITY__ENET1);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #if FSL_FEATURE_ENET_QUEUE > 1
- void CONNECTIVITY_ENET1_FRAME1_INT_DriverIRQHandler(void)
- {
- ENET_CommonFrame1IRQHandler(CONNECTIVITY__ENET1);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- void CONNECTIVITY_ENET1_FRAME2_INT_DriverIRQHandler(void)
- {
- ENET_CommonFrame2IRQHandler(CONNECTIVITY__ENET1);
- /* Add for ARM errata 838869, affects Cortex-M4, Cortex-M4F Store immediate overlapping
- exception return operation might vector to incorrect interrupt */
- #if defined __CORTEX_M && (__CORTEX_M == 4U)
- __DSB();
- #endif
- }
- #endif
- #endif
|