IxEthAccMac.c 74 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641
  1. /**
  2. * @file IxEthAccMac.c
  3. *
  4. * @author Intel Corporation
  5. * @date
  6. *
  7. * @brief MAC control functions
  8. *
  9. * Design Notes:
  10. *
  11. * @par
  12. * IXP400 SW Release version 2.0
  13. *
  14. * -- Copyright Notice --
  15. *
  16. * @par
  17. * Copyright 2001-2005, Intel Corporation.
  18. * All rights reserved.
  19. *
  20. * @par
  21. * Redistribution and use in source and binary forms, with or without
  22. * modification, are permitted provided that the following conditions
  23. * are met:
  24. * 1. Redistributions of source code must retain the above copyright
  25. * notice, this list of conditions and the following disclaimer.
  26. * 2. Redistributions in binary form must reproduce the above copyright
  27. * notice, this list of conditions and the following disclaimer in the
  28. * documentation and/or other materials provided with the distribution.
  29. * 3. Neither the name of the Intel Corporation nor the names of its contributors
  30. * may be used to endorse or promote products derived from this software
  31. * without specific prior written permission.
  32. *
  33. * @par
  34. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS ``AS IS''
  35. * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  36. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  37. * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE
  38. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  39. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  40. * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  41. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  42. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  43. * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  44. * SUCH DAMAGE.
  45. *
  46. * @par
  47. * -- End of Copyright Notice --
  48. */
  49. #include "IxOsal.h"
  50. #include "IxNpeMh.h"
  51. #ifdef CONFIG_IXP425_COMPONENT_ETHDB
  52. #include "IxEthDB.h"
  53. #endif
  54. #include "IxEthDBPortDefs.h"
  55. #include "IxEthNpe.h"
  56. #include "IxEthAcc.h"
  57. #include "IxEthAccDataPlane_p.h"
  58. #include "IxEthAcc_p.h"
  59. #include "IxEthAccMac_p.h"
  60. /* Maximum number of retries during ixEthAccPortDisable, which
  61. * is approximately 10 seconds
  62. */
  63. #define IX_ETH_ACC_MAX_RETRY 500
  64. /* Maximum number of retries during ixEthAccPortDisable when expecting
  65. * timeout
  66. */
  67. #define IX_ETH_ACC_MAX_RETRY_TIMEOUT 5
  68. #define IX_ETH_ACC_VALIDATE_PORT_ID(portId) \
  69. do \
  70. { \
  71. if(!IX_ETH_ACC_IS_PORT_VALID(portId)) \
  72. { \
  73. return IX_ETH_ACC_INVALID_PORT; \
  74. } \
  75. } while(0)
  76. PUBLIC IxEthAccMacState ixEthAccMacState[IX_ETH_ACC_NUMBER_OF_PORTS];
  77. PRIVATE UINT32 ixEthAccMacBase[IX_ETH_ACC_NUMBER_OF_PORTS];
  78. /*Forward function declarations*/
  79. PRIVATE void
  80. ixEthAccPortDisableRx (IxEthAccPortId portId,
  81. IX_OSAL_MBUF * mBufPtr,
  82. BOOL useMultiBufferCallback);
  83. PRIVATE void
  84. ixEthAccPortDisableRxAndReplenish (IxEthAccPortId portId,
  85. IX_OSAL_MBUF * mBufPtr,
  86. BOOL useMultiBufferCallback);
  87. PRIVATE void
  88. ixEthAccPortDisableTxDone (UINT32 cbTag,
  89. IX_OSAL_MBUF *mbuf);
  90. PRIVATE void
  91. ixEthAccPortDisableTxDoneAndSubmit (UINT32 cbTag,
  92. IX_OSAL_MBUF *mbuf);
  93. PRIVATE void
  94. ixEthAccPortDisableRxCallback (UINT32 cbTag,
  95. IX_OSAL_MBUF * mBufPtr,
  96. UINT32 learnedPortId);
  97. PRIVATE void
  98. ixEthAccPortDisableMultiBufferRxCallback (UINT32 cbTag,
  99. IX_OSAL_MBUF **mBufPtr);
  100. PRIVATE IxEthAccStatus
  101. ixEthAccPortDisableTryTransmit(UINT32 portId);
  102. PRIVATE IxEthAccStatus
  103. ixEthAccPortDisableTryReplenish(UINT32 portId);
  104. PRIVATE IxEthAccStatus
  105. ixEthAccPortMulticastMacAddressGet (IxEthAccPortId portId,
  106. IxEthAccMacAddr *macAddr);
  107. PRIVATE IxEthAccStatus
  108. ixEthAccPortMulticastMacFilterGet (IxEthAccPortId portId,
  109. IxEthAccMacAddr *macAddr);
  110. PRIVATE void
  111. ixEthAccMacNpeStatsMessageCallback (IxNpeMhNpeId npeId,
  112. IxNpeMhMessage msg);
  113. PRIVATE void
  114. ixEthAccMacNpeStatsResetMessageCallback (IxNpeMhNpeId npeId,
  115. IxNpeMhMessage msg);
  116. PRIVATE void
  117. ixEthAccNpeLoopbackMessageCallback (IxNpeMhNpeId npeId,
  118. IxNpeMhMessage msg);
  119. PRIVATE void
  120. ixEthAccMulticastAddressSet(IxEthAccPortId portId);
  121. PRIVATE BOOL
  122. ixEthAccMacEqual(IxEthAccMacAddr *macAddr1,
  123. IxEthAccMacAddr *macAddr2);
  124. PRIVATE void
  125. ixEthAccMacPrint(IxEthAccMacAddr *m);
  126. PRIVATE void
  127. ixEthAccMacStateUpdate(IxEthAccPortId portId);
  128. IxEthAccStatus
  129. ixEthAccMacMemInit(void)
  130. {
  131. ixEthAccMacBase[IX_ETH_PORT_1] =
  132. (UINT32) IX_OSAL_MEM_MAP(IX_ETH_ACC_MAC_0_BASE,
  133. IX_OSAL_IXP400_ETHA_MAP_SIZE);
  134. ixEthAccMacBase[IX_ETH_PORT_2] =
  135. (UINT32) IX_OSAL_MEM_MAP(IX_ETH_ACC_MAC_1_BASE,
  136. IX_OSAL_IXP400_ETHB_MAP_SIZE);
  137. #ifdef __ixp46X
  138. ixEthAccMacBase[IX_ETH_PORT_3] =
  139. (UINT32) IX_OSAL_MEM_MAP(IX_ETH_ACC_MAC_2_BASE,
  140. IX_OSAL_IXP400_ETH_NPEA_MAP_SIZE);
  141. if (ixEthAccMacBase[IX_ETH_PORT_3] == 0)
  142. {
  143. ixOsalLog(IX_OSAL_LOG_LVL_FATAL,
  144. IX_OSAL_LOG_DEV_STDOUT,
  145. "EthAcc: Could not map MAC I/O memory\n",
  146. 0, 0, 0, 0, 0 ,0);
  147. return IX_ETH_ACC_FAIL;
  148. }
  149. #endif
  150. if (ixEthAccMacBase[IX_ETH_PORT_1] == 0
  151. || ixEthAccMacBase[IX_ETH_PORT_2] == 0)
  152. {
  153. ixOsalLog(IX_OSAL_LOG_LVL_FATAL,
  154. IX_OSAL_LOG_DEV_STDOUT,
  155. "EthAcc: Could not map MAC I/O memory\n",
  156. 0, 0, 0, 0, 0 ,0);
  157. return IX_ETH_ACC_FAIL;
  158. }
  159. return IX_ETH_ACC_SUCCESS;
  160. }
  161. void
  162. ixEthAccMacUnload(void)
  163. {
  164. IX_OSAL_MEM_UNMAP(ixEthAccMacBase[IX_ETH_PORT_1]);
  165. IX_OSAL_MEM_UNMAP(ixEthAccMacBase[IX_ETH_PORT_2]);
  166. #ifdef __ixp46X
  167. IX_OSAL_MEM_UNMAP(ixEthAccMacBase[IX_ETH_PORT_3]);
  168. ixEthAccMacBase[IX_ETH_PORT_3] = 0;
  169. #endif
  170. ixEthAccMacBase[IX_ETH_PORT_2] = 0;
  171. ixEthAccMacBase[IX_ETH_PORT_1] = 0;
  172. }
  173. IxEthAccStatus
  174. ixEthAccPortEnablePriv(IxEthAccPortId portId)
  175. {
  176. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  177. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  178. {
  179. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot enable port.\n",(INT32)portId,0,0,0,0,0);
  180. return IX_ETH_ACC_SUCCESS ;
  181. }
  182. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  183. {
  184. printf("EthAcc: (Mac) cannot enable port %d, port not initialized\n", portId);
  185. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  186. }
  187. if (ixEthAccPortData[portId].ixEthAccTxData.txBufferDoneCallbackFn == NULL)
  188. {
  189. /* TxDone callback not registered */
  190. printf("EthAcc: (Mac) cannot enable port %d, TxDone callback not registered\n", portId);
  191. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  192. }
  193. if ((ixEthAccPortData[portId].ixEthAccRxData.rxCallbackFn == NULL)
  194. && (ixEthAccPortData[portId].ixEthAccRxData.rxMultiBufferCallbackFn == NULL))
  195. {
  196. /* Receive callback not registered */
  197. printf("EthAcc: (Mac) cannot enable port %d, Rx callback not registered\n", portId);
  198. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  199. }
  200. if(!ixEthAccMacState[portId].initDone)
  201. {
  202. printf("EthAcc: (Mac) cannot enable port %d, MAC address not set\n", portId);
  203. return (IX_ETH_ACC_MAC_UNINITIALIZED);
  204. }
  205. /* if the state is being set to what it is already at, do nothing*/
  206. if (ixEthAccMacState[portId].enabled)
  207. {
  208. return IX_ETH_ACC_SUCCESS;
  209. }
  210. #ifdef CONFIG_IXP425_COMPONENT_ETHDB
  211. /* enable ethernet database for this port */
  212. if (ixEthDBPortEnable(portId) != IX_ETH_DB_SUCCESS)
  213. {
  214. printf("EthAcc: (Mac) cannot enable port %d, EthDB failure\n", portId);
  215. return IX_ETH_ACC_FAIL;
  216. }
  217. #endif
  218. /* set the MAC core registers */
  219. REG_WRITE(ixEthAccMacBase[portId],
  220. IX_ETH_ACC_MAC_TX_CNTRL2,
  221. IX_ETH_ACC_TX_CNTRL2_RETRIES_MASK);
  222. REG_WRITE(ixEthAccMacBase[portId],
  223. IX_ETH_ACC_MAC_RANDOM_SEED,
  224. IX_ETH_ACC_RANDOM_SEED_DEFAULT);
  225. REG_WRITE(ixEthAccMacBase[portId],
  226. IX_ETH_ACC_MAC_THRESH_P_EMPTY,
  227. IX_ETH_ACC_MAC_THRESH_P_EMPTY_DEFAULT);
  228. REG_WRITE(ixEthAccMacBase[portId],
  229. IX_ETH_ACC_MAC_THRESH_P_FULL,
  230. IX_ETH_ACC_MAC_THRESH_P_FULL_DEFAULT);
  231. REG_WRITE(ixEthAccMacBase[portId],
  232. IX_ETH_ACC_MAC_TX_DEFER,
  233. IX_ETH_ACC_MAC_TX_DEFER_DEFAULT);
  234. REG_WRITE(ixEthAccMacBase[portId],
  235. IX_ETH_ACC_MAC_TX_TWO_DEFER_1,
  236. IX_ETH_ACC_MAC_TX_TWO_DEFER_1_DEFAULT);
  237. REG_WRITE(ixEthAccMacBase[portId],
  238. IX_ETH_ACC_MAC_TX_TWO_DEFER_2,
  239. IX_ETH_ACC_MAC_TX_TWO_DEFER_2_DEFAULT);
  240. REG_WRITE(ixEthAccMacBase[portId],
  241. IX_ETH_ACC_MAC_SLOT_TIME,
  242. IX_ETH_ACC_MAC_SLOT_TIME_DEFAULT);
  243. REG_WRITE(ixEthAccMacBase[portId],
  244. IX_ETH_ACC_MAC_INT_CLK_THRESH,
  245. IX_ETH_ACC_MAC_INT_CLK_THRESH_DEFAULT);
  246. REG_WRITE(ixEthAccMacBase[portId],
  247. IX_ETH_ACC_MAC_BUF_SIZE_TX,
  248. IX_ETH_ACC_MAC_BUF_SIZE_TX_DEFAULT);
  249. REG_WRITE(ixEthAccMacBase[portId],
  250. IX_ETH_ACC_MAC_TX_CNTRL1,
  251. IX_ETH_ACC_TX_CNTRL1_DEFAULT);
  252. REG_WRITE(ixEthAccMacBase[portId],
  253. IX_ETH_ACC_MAC_RX_CNTRL1,
  254. IX_ETH_ACC_RX_CNTRL1_DEFAULT);
  255. /* set the global state */
  256. ixEthAccMacState[portId].portDisableState = ACTIVE;
  257. ixEthAccMacState[portId].enabled = TRUE;
  258. /* rewrite the setup (including mac filtering) depending
  259. * on current options
  260. */
  261. ixEthAccMacStateUpdate(portId);
  262. return IX_ETH_ACC_SUCCESS;
  263. }
  264. /*
  265. * PortDisable local variables. They contain the intermediate steps
  266. * while the port is being disabled and the buffers being drained out
  267. * of the NPE.
  268. */
  269. typedef void (*IxEthAccPortDisableRx)(IxEthAccPortId portId,
  270. IX_OSAL_MBUF * mBufPtr,
  271. BOOL useMultiBufferCallback);
  272. static IxEthAccPortRxCallback
  273. ixEthAccPortDisableFn[IX_ETH_ACC_NUMBER_OF_PORTS];
  274. static IxEthAccPortMultiBufferRxCallback
  275. ixEthAccPortDisableMultiBufferFn[IX_ETH_ACC_NUMBER_OF_PORTS];
  276. static IxEthAccPortDisableRx
  277. ixEthAccPortDisableRxTable[IX_ETH_ACC_NUMBER_OF_PORTS];
  278. static UINT32
  279. ixEthAccPortDisableCbTag[IX_ETH_ACC_NUMBER_OF_PORTS];
  280. static UINT32
  281. ixEthAccPortDisableMultiBufferCbTag[IX_ETH_ACC_NUMBER_OF_PORTS];
  282. static IxEthAccPortTxDoneCallback
  283. ixEthAccPortDisableTxDoneFn[IX_ETH_ACC_NUMBER_OF_PORTS];
  284. static UINT32
  285. ixEthAccPortDisableTxDoneCbTag[IX_ETH_ACC_NUMBER_OF_PORTS];
  286. static UINT32
  287. ixEthAccPortDisableUserBufferCount[IX_ETH_ACC_NUMBER_OF_PORTS];
  288. /*
  289. * PortDisable private callbacks functions. They handle the user
  290. * traffic, and the special buffers (one for tx, one for rx) used
  291. * in portDisable.
  292. */
  293. PRIVATE void
  294. ixEthAccPortDisableTxDone(UINT32 cbTag,
  295. IX_OSAL_MBUF *mbuf)
  296. {
  297. IxEthAccPortId portId = (IxEthAccPortId)cbTag;
  298. volatile IxEthAccPortDisableState *txState = &ixEthAccMacState[portId].txState;
  299. /* check for the special mbuf used in portDisable */
  300. if (mbuf == ixEthAccMacState[portId].portDisableTxMbufPtr)
  301. {
  302. *txState = TRANSMIT_DONE;
  303. }
  304. else
  305. {
  306. /* increment the count of user traffic during portDisable */
  307. ixEthAccPortDisableUserBufferCount[portId]++;
  308. /* call client TxDone function */
  309. ixEthAccPortDisableTxDoneFn[portId](ixEthAccPortDisableTxDoneCbTag[portId], mbuf);
  310. }
  311. }
  312. PRIVATE IxEthAccStatus
  313. ixEthAccPortDisableTryTransmit(UINT32 portId)
  314. {
  315. int key;
  316. IxEthAccStatus status = IX_ETH_ACC_SUCCESS;
  317. volatile IxEthAccPortDisableState *txState = &ixEthAccMacState[portId].txState;
  318. /* transmit the special buffer again if it is transmitted
  319. * and update the txState
  320. * This section is protected because the portDisable context
  321. * run an identical code, so the system keeps transmitting at the
  322. * maximum rate.
  323. */
  324. key = ixOsalIrqLock();
  325. if (*txState == TRANSMIT_DONE)
  326. {
  327. IX_OSAL_MBUF *mbufTxPtr = ixEthAccMacState[portId].portDisableTxMbufPtr;
  328. *txState = TRANSMIT;
  329. status = ixEthAccPortTxFrameSubmit(portId,
  330. mbufTxPtr,
  331. IX_ETH_ACC_TX_DEFAULT_PRIORITY);
  332. }
  333. ixOsalIrqUnlock(key);
  334. return status;
  335. }
  336. PRIVATE void
  337. ixEthAccPortDisableTxDoneAndSubmit(UINT32 cbTag,
  338. IX_OSAL_MBUF *mbuf)
  339. {
  340. IxEthAccPortId portId = (IxEthAccPortId)cbTag;
  341. /* call the callback which forwards the traffic to the client */
  342. ixEthAccPortDisableTxDone(cbTag, mbuf);
  343. /* try to transmit the buffer used in portDisable
  344. * if seen in TxDone
  345. */
  346. ixEthAccPortDisableTryTransmit(portId);
  347. }
  348. PRIVATE void
  349. ixEthAccPortDisableRx (IxEthAccPortId portId,
  350. IX_OSAL_MBUF * mBufPtr,
  351. BOOL useMultiBufferCallback)
  352. {
  353. volatile IxEthAccPortDisableState *rxState = &ixEthAccMacState[portId].rxState;
  354. IX_OSAL_MBUF *mNextPtr;
  355. while (mBufPtr)
  356. {
  357. mNextPtr = IX_OSAL_MBUF_NEXT_BUFFER_IN_PKT_PTR(mBufPtr);
  358. IX_OSAL_MBUF_NEXT_BUFFER_IN_PKT_PTR(mBufPtr) = NULL;
  359. /* check for the special mbuf used in portDisable */
  360. if (mBufPtr == ixEthAccMacState[portId].portDisableRxMbufPtr)
  361. {
  362. *rxState = RECEIVE;
  363. }
  364. else
  365. {
  366. /* increment the count of user traffic during portDisable */
  367. ixEthAccPortDisableUserBufferCount[portId]++;
  368. /* reset the received payload length during portDisable */
  369. IX_OSAL_MBUF_MLEN(mBufPtr) = 0;
  370. IX_OSAL_MBUF_PKT_LEN(mBufPtr) = 0;
  371. if (useMultiBufferCallback)
  372. {
  373. /* call the user callback with one unchained
  374. * buffer, without payload. A small array is built
  375. * to be used as a parameter (the user callback expects
  376. * to receive an array ended by a NULL pointer.
  377. */
  378. IX_OSAL_MBUF *mBufPtrArray[2];
  379. mBufPtrArray[0] = mBufPtr;
  380. mBufPtrArray[1] = NULL;
  381. ixEthAccPortDisableMultiBufferFn[portId](
  382. ixEthAccPortDisableMultiBufferCbTag[portId],
  383. mBufPtrArray);
  384. }
  385. else
  386. {
  387. /* call the user callback with a unchained
  388. * buffer, without payload and the destination port is
  389. * unknown.
  390. */
  391. ixEthAccPortDisableFn[portId](
  392. ixEthAccPortDisableCbTag[portId],
  393. mBufPtr,
  394. IX_ETH_DB_UNKNOWN_PORT /* port not found */);
  395. }
  396. }
  397. mBufPtr = mNextPtr;
  398. }
  399. }
  400. PRIVATE IxEthAccStatus
  401. ixEthAccPortDisableTryReplenish(UINT32 portId)
  402. {
  403. int key;
  404. IxEthAccStatus status = IX_ETH_ACC_SUCCESS;
  405. volatile IxEthAccPortDisableState *rxState = &ixEthAccMacState[portId].rxState;
  406. /* replenish with the special buffer again if it is received
  407. * and update the rxState
  408. * This section is protected because the portDisable context
  409. * run an identical code, so the system keeps replenishing at the
  410. * maximum rate.
  411. */
  412. key = ixOsalIrqLock();
  413. if (*rxState == RECEIVE)
  414. {
  415. IX_OSAL_MBUF *mbufRxPtr = ixEthAccMacState[portId].portDisableRxMbufPtr;
  416. *rxState = REPLENISH;
  417. IX_OSAL_MBUF_MLEN(mbufRxPtr) = IX_ETHACC_RX_MBUF_MIN_SIZE;
  418. status = ixEthAccPortRxFreeReplenish(portId, mbufRxPtr);
  419. }
  420. ixOsalIrqUnlock(key);
  421. return status;
  422. }
  423. PRIVATE void
  424. ixEthAccPortDisableRxAndReplenish (IxEthAccPortId portId,
  425. IX_OSAL_MBUF * mBufPtr,
  426. BOOL useMultiBufferCallback)
  427. {
  428. /* call the callback which forwards the traffic to the client */
  429. ixEthAccPortDisableRx(portId, mBufPtr, useMultiBufferCallback);
  430. /* try to replenish with the buffer used in portDisable
  431. * if seen in Rx
  432. */
  433. ixEthAccPortDisableTryReplenish(portId);
  434. }
  435. PRIVATE void
  436. ixEthAccPortDisableRxCallback (UINT32 cbTag,
  437. IX_OSAL_MBUF * mBufPtr,
  438. UINT32 learnedPortId)
  439. {
  440. IxEthAccPortId portId = (IxEthAccPortId)cbTag;
  441. /* call the portDisable receive callback */
  442. (ixEthAccPortDisableRxTable[portId])(portId, mBufPtr, FALSE);
  443. }
  444. PRIVATE void
  445. ixEthAccPortDisableMultiBufferRxCallback (UINT32 cbTag,
  446. IX_OSAL_MBUF **mBufPtr)
  447. {
  448. IxEthAccPortId portId = (IxEthAccPortId)cbTag;
  449. while (*mBufPtr)
  450. {
  451. /* call the portDisable receive callback with one buffer at a time */
  452. (ixEthAccPortDisableRxTable[portId])(portId, *mBufPtr++, TRUE);
  453. }
  454. }
  455. IxEthAccStatus
  456. ixEthAccPortDisablePriv(IxEthAccPortId portId)
  457. {
  458. IxEthAccStatus status = IX_ETH_ACC_SUCCESS;
  459. int key;
  460. int retry, retryTimeout;
  461. volatile IxEthAccPortDisableState *state = &ixEthAccMacState[portId].portDisableState;
  462. volatile IxEthAccPortDisableState *rxState = &ixEthAccMacState[portId].rxState;
  463. volatile IxEthAccPortDisableState *txState = &ixEthAccMacState[portId].txState;
  464. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  465. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  466. {
  467. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot disable port.\n",(INT32)portId,0,0,0,0,0);
  468. return IX_ETH_ACC_SUCCESS ;
  469. }
  470. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  471. {
  472. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  473. }
  474. /* if the state is being set to what it is already at, do nothing */
  475. if (!ixEthAccMacState[portId].enabled)
  476. {
  477. return IX_ETH_ACC_SUCCESS;
  478. }
  479. *state = DISABLED;
  480. /* disable MAC receive first */
  481. ixEthAccPortRxDisablePriv(portId);
  482. #ifdef CONFIG_IXP425_COMPONENT_ETHDB
  483. /* disable ethernet database for this port - It is done now to avoid
  484. * issuing ELT maintenance after requesting 'port disable' in an NPE
  485. */
  486. if (ixEthDBPortDisable(portId) != IX_ETH_DB_SUCCESS)
  487. {
  488. status = IX_ETH_ACC_FAIL;
  489. IX_ETH_ACC_FATAL_LOG("ixEthAccPortDisable: failed to disable EthDB for this port\n", 0, 0, 0, 0, 0, 0);
  490. }
  491. #endif
  492. /* enter the critical section */
  493. key = ixOsalIrqLock();
  494. /* swap the Rx and TxDone callbacks */
  495. ixEthAccPortDisableFn[portId] = ixEthAccPortData[portId].ixEthAccRxData.rxCallbackFn;
  496. ixEthAccPortDisableMultiBufferFn[portId] = ixEthAccPortData[portId].ixEthAccRxData.rxMultiBufferCallbackFn;
  497. ixEthAccPortDisableCbTag[portId] = ixEthAccPortData[portId].ixEthAccRxData.rxCallbackTag;
  498. ixEthAccPortDisableMultiBufferCbTag[portId] = ixEthAccPortData[portId].ixEthAccRxData.rxMultiBufferCallbackTag;
  499. ixEthAccPortDisableTxDoneFn[portId] = ixEthAccPortData[portId].ixEthAccTxData.txBufferDoneCallbackFn;
  500. ixEthAccPortDisableTxDoneCbTag[portId] = ixEthAccPortData[portId].ixEthAccTxData.txCallbackTag;
  501. ixEthAccPortDisableRxTable[portId] = ixEthAccPortDisableRx;
  502. /* register temporary callbacks */
  503. ixEthAccPortData[portId].ixEthAccRxData.rxCallbackFn = ixEthAccPortDisableRxCallback;
  504. ixEthAccPortData[portId].ixEthAccRxData.rxCallbackTag = portId;
  505. ixEthAccPortData[portId].ixEthAccRxData.rxMultiBufferCallbackFn = ixEthAccPortDisableMultiBufferRxCallback;
  506. ixEthAccPortData[portId].ixEthAccRxData.rxMultiBufferCallbackTag = portId;
  507. ixEthAccPortData[portId].ixEthAccTxData.txBufferDoneCallbackFn = ixEthAccPortDisableTxDone;
  508. ixEthAccPortData[portId].ixEthAccTxData.txCallbackTag = portId;
  509. /* initialise the Rx state and Tx states */
  510. *txState = TRANSMIT_DONE;
  511. *rxState = RECEIVE;
  512. /* exit the critical section */
  513. ixOsalIrqUnlock(key);
  514. /* enable a NPE loopback */
  515. if (ixEthAccNpeLoopbackEnablePriv(portId) != IX_ETH_ACC_SUCCESS)
  516. {
  517. status = IX_ETH_ACC_FAIL;
  518. }
  519. if (status == IX_ETH_ACC_SUCCESS)
  520. {
  521. retry = 0;
  522. /* Step 1 : Drain Tx traffic and TxDone queues :
  523. *
  524. * Transmit and replenish at least once with the
  525. * special buffers until both of them are seen
  526. * in the callback hook
  527. *
  528. * (the receive callback keeps replenishing, so once we see
  529. * the special Tx buffer, we can be sure that Tx drain is complete)
  530. */
  531. ixEthAccPortDisableRxTable[portId]
  532. = ixEthAccPortDisableRxAndReplenish;
  533. ixEthAccPortData[portId].ixEthAccTxData.txBufferDoneCallbackFn
  534. = ixEthAccPortDisableTxDone;
  535. do
  536. {
  537. /* keep replenishing */
  538. status = ixEthAccPortDisableTryReplenish(portId);
  539. if (status == IX_ETH_ACC_SUCCESS)
  540. {
  541. /* keep transmitting */
  542. status = ixEthAccPortDisableTryTransmit(portId);
  543. }
  544. if (status == IX_ETH_ACC_SUCCESS)
  545. {
  546. /* wait for some traffic being processed */
  547. ixOsalSleep(IX_ETH_ACC_PORT_DISABLE_DELAY_MSECS);
  548. }
  549. }
  550. while ((status == IX_ETH_ACC_SUCCESS)
  551. && (retry++ < IX_ETH_ACC_MAX_RETRY)
  552. && (*txState == TRANSMIT));
  553. /* Step 2 : Drain Rx traffic, RxFree and Rx queues :
  554. *
  555. * Transmit and replenish at least once with the
  556. * special buffers until both of them are seen
  557. * in the callback hook
  558. * (the transmit callback keeps transmitting, and when we see
  559. * the special Rx buffer, we can be sure that rxFree drain
  560. * is complete)
  561. *
  562. * The nested loop helps to retry if the user was keeping
  563. * replenishing or transmitting during portDisable.
  564. *
  565. * The 2 nested loops ensure more retries if user traffic is
  566. * seen during portDisable : the user should not replenish
  567. * or transmit while portDisable is running. However, because of
  568. * the queueing possibilities in ethAcc dataplane, it is possible
  569. * that a lot of traffic is left in the queues (e.g. when
  570. * transmitting over a low speed link) and therefore, more
  571. * retries are allowed to help flushing the buffers out.
  572. */
  573. ixEthAccPortDisableRxTable[portId]
  574. = ixEthAccPortDisableRx;
  575. ixEthAccPortData[portId].ixEthAccTxData.txBufferDoneCallbackFn
  576. = ixEthAccPortDisableTxDoneAndSubmit;
  577. do
  578. {
  579. do
  580. {
  581. ixEthAccPortDisableUserBufferCount[portId] = 0;
  582. /* keep replenishing */
  583. status = ixEthAccPortDisableTryReplenish(portId);
  584. if (status == IX_ETH_ACC_SUCCESS)
  585. {
  586. /* keep transmitting */
  587. status = ixEthAccPortDisableTryTransmit(portId);
  588. }
  589. if (status == IX_ETH_ACC_SUCCESS)
  590. {
  591. /* wait for some traffic being processed */
  592. ixOsalSleep(IX_ETH_ACC_PORT_DISABLE_DELAY_MSECS);
  593. }
  594. }
  595. while ((status == IX_ETH_ACC_SUCCESS)
  596. && (retry++ < IX_ETH_ACC_MAX_RETRY)
  597. && ((ixEthAccPortDisableUserBufferCount[portId] != 0)
  598. || (*rxState == REPLENISH)));
  599. /* After the first iteration, change the receive callbacks,
  600. * to process only 1 buffer at a time
  601. */
  602. ixEthAccPortDisableRxTable[portId]
  603. = ixEthAccPortDisableRx;
  604. ixEthAccPortData[portId].ixEthAccTxData.txBufferDoneCallbackFn
  605. = ixEthAccPortDisableTxDone;
  606. /* repeat the whole process while user traffic is seen in TxDone
  607. *
  608. * The conditions to stop the loop are
  609. * - Xscale has both Rx and Tx special buffers
  610. * (txState = transmit, rxState = receive)
  611. * - any error in txSubmit or rxReplenish
  612. * - no user traffic seen
  613. * - an excessive amount of retries
  614. */
  615. }
  616. while ((status == IX_ETH_ACC_SUCCESS)
  617. && (retry < IX_ETH_ACC_MAX_RETRY)
  618. && (*txState == TRANSMIT));
  619. /* check the loop exit conditions. The NPE should not hold
  620. * the special buffers.
  621. */
  622. if ((*rxState == REPLENISH) || (*txState == TRANSMIT))
  623. {
  624. status = IX_ETH_ACC_FAIL;
  625. }
  626. if (status == IX_ETH_ACC_SUCCESS)
  627. {
  628. /* Step 3 : Replenish without transmitting until a timeout
  629. * occurs, in order to drain the internal NPE fifos
  630. *
  631. * we can expect a few frames srill held
  632. * in the NPE.
  633. *
  634. * The 2 nested loops take care about the NPE dropping traffic
  635. * (including loopback traffic) when the Rx queue is full.
  636. *
  637. * The timeout value is very conservative
  638. * since the loopback used keeps replenishhing.
  639. *
  640. */
  641. do
  642. {
  643. ixEthAccPortDisableRxTable[portId] = ixEthAccPortDisableRxAndReplenish;
  644. ixEthAccPortDisableUserBufferCount[portId] = 0;
  645. retryTimeout = 0;
  646. do
  647. {
  648. /* keep replenishing */
  649. status = ixEthAccPortDisableTryReplenish(portId);
  650. if (status == IX_ETH_ACC_SUCCESS)
  651. {
  652. /* wait for some traffic being processed */
  653. ixOsalSleep(IX_ETH_ACC_PORT_DISABLE_DELAY_MSECS);
  654. }
  655. }
  656. while ((status == IX_ETH_ACC_SUCCESS)
  657. && (retryTimeout++ < IX_ETH_ACC_MAX_RETRY_TIMEOUT));
  658. /* Step 4 : Transmit once. Stop replenish
  659. *
  660. * After the Rx timeout, we are sure that the NPE does not
  661. * hold any frame in its internal NPE fifos.
  662. *
  663. * At this point, the NPE still holds the last rxFree buffer.
  664. * By transmitting a single frame, this should unblock the
  665. * last rxFree buffer. This code just transmit once and
  666. * wait for both frames seen in TxDone and in rxFree.
  667. *
  668. */
  669. ixEthAccPortDisableRxTable[portId] = ixEthAccPortDisableRx;
  670. status = ixEthAccPortDisableTryTransmit(portId);
  671. /* the NPE should immediatelyt release
  672. * the last Rx buffer and the last transmitted buffer
  673. * unless the last Tx frame was dropped (rx queue full)
  674. */
  675. if (status == IX_ETH_ACC_SUCCESS)
  676. {
  677. retryTimeout = 0;
  678. do
  679. {
  680. ixOsalSleep(IX_ETH_ACC_PORT_DISABLE_DELAY_MSECS);
  681. }
  682. while ((*rxState == REPLENISH)
  683. && (retryTimeout++ < IX_ETH_ACC_MAX_RETRY_TIMEOUT));
  684. }
  685. /* the NPE may have dropped the traffic because of Rx
  686. * queue being full. This code ensures that the last
  687. * Tx and Rx frames are both received.
  688. */
  689. }
  690. while ((status == IX_ETH_ACC_SUCCESS)
  691. && (retry++ < IX_ETH_ACC_MAX_RETRY)
  692. && ((*txState == TRANSMIT)
  693. || (*rxState == REPLENISH)
  694. || (ixEthAccPortDisableUserBufferCount[portId] != 0)));
  695. /* Step 5 : check the final states : the NPE has
  696. * no buffer left, nor in Tx , nor in Rx directions.
  697. */
  698. if ((*rxState == REPLENISH) || (*txState == TRANSMIT))
  699. {
  700. status = IX_ETH_ACC_FAIL;
  701. }
  702. }
  703. /* now all the buffers are drained, disable NPE loopback
  704. * This is done regardless of the logic to drain the queues and
  705. * the internal buffers held by the NPE.
  706. */
  707. if (ixEthAccNpeLoopbackDisablePriv(portId) != IX_ETH_ACC_SUCCESS)
  708. {
  709. status = IX_ETH_ACC_FAIL;
  710. }
  711. }
  712. /* disable MAC Tx and Rx services */
  713. ixEthAccMacState[portId].enabled = FALSE;
  714. ixEthAccMacStateUpdate(portId);
  715. /* restore the Rx and TxDone callbacks (within a critical section) */
  716. key = ixOsalIrqLock();
  717. ixEthAccPortData[portId].ixEthAccRxData.rxCallbackFn = ixEthAccPortDisableFn[portId];
  718. ixEthAccPortData[portId].ixEthAccRxData.rxCallbackTag = ixEthAccPortDisableCbTag[portId];
  719. ixEthAccPortData[portId].ixEthAccRxData.rxMultiBufferCallbackFn = ixEthAccPortDisableMultiBufferFn[portId];
  720. ixEthAccPortData[portId].ixEthAccRxData.rxMultiBufferCallbackTag = ixEthAccPortDisableMultiBufferCbTag[portId];
  721. ixEthAccPortData[portId].ixEthAccTxData.txBufferDoneCallbackFn = ixEthAccPortDisableTxDoneFn[portId];
  722. ixEthAccPortData[portId].ixEthAccTxData.txCallbackTag = ixEthAccPortDisableTxDoneCbTag[portId];
  723. ixOsalIrqUnlock(key);
  724. /* the MAC core rx/tx disable may left the MAC hardware in an
  725. * unpredictable state. A hw reset is executed before resetting
  726. * all the MAC parameters to a known value.
  727. */
  728. REG_WRITE(ixEthAccMacBase[portId],
  729. IX_ETH_ACC_MAC_CORE_CNTRL,
  730. IX_ETH_ACC_CORE_RESET);
  731. ixOsalSleep(IX_ETH_ACC_MAC_RESET_DELAY);
  732. /* rewrite all parameters to their current value */
  733. ixEthAccMacStateUpdate(portId);
  734. REG_WRITE(ixEthAccMacBase[portId],
  735. IX_ETH_ACC_MAC_INT_CLK_THRESH,
  736. IX_ETH_ACC_MAC_INT_CLK_THRESH_DEFAULT);
  737. REG_WRITE(ixEthAccMacBase[portId],
  738. IX_ETH_ACC_MAC_CORE_CNTRL,
  739. IX_ETH_ACC_CORE_MDC_EN);
  740. return status;
  741. }
  742. IxEthAccStatus
  743. ixEthAccPortEnabledQueryPriv(IxEthAccPortId portId, BOOL *enabled)
  744. {
  745. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  746. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  747. {
  748. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot enable port.\n",(INT32)portId,0,0,0,0,0);
  749. /* Since Eth NPE is not available, port must be disabled */
  750. *enabled = FALSE ;
  751. return IX_ETH_ACC_SUCCESS ;
  752. }
  753. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  754. {
  755. /* Since Eth NPE is not available, port must be disabled */
  756. *enabled = FALSE ;
  757. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  758. }
  759. *enabled = ixEthAccMacState[portId].enabled;
  760. return IX_ETH_ACC_SUCCESS;
  761. }
  762. IxEthAccStatus
  763. ixEthAccPortMacResetPriv(IxEthAccPortId portId)
  764. {
  765. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  766. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  767. {
  768. IX_ETH_ACC_WARNING_LOG("EthAcc: Eth %d: Cannot reset Ethernet coprocessor.\n",(INT32)portId,0,0,0,0,0);
  769. return IX_ETH_ACC_SUCCESS ;
  770. }
  771. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  772. {
  773. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  774. }
  775. REG_WRITE(ixEthAccMacBase[portId],
  776. IX_ETH_ACC_MAC_CORE_CNTRL,
  777. IX_ETH_ACC_CORE_RESET);
  778. ixOsalSleep(IX_ETH_ACC_MAC_RESET_DELAY);
  779. /* rewrite all parameters to their current value */
  780. ixEthAccMacStateUpdate(portId);
  781. REG_WRITE(ixEthAccMacBase[portId],
  782. IX_ETH_ACC_MAC_INT_CLK_THRESH,
  783. IX_ETH_ACC_MAC_INT_CLK_THRESH_DEFAULT);
  784. REG_WRITE(ixEthAccMacBase[portId],
  785. IX_ETH_ACC_MAC_CORE_CNTRL,
  786. IX_ETH_ACC_CORE_MDC_EN);
  787. return IX_ETH_ACC_SUCCESS;
  788. }
  789. IxEthAccStatus
  790. ixEthAccPortLoopbackEnable(IxEthAccPortId portId)
  791. {
  792. UINT32 regval;
  793. /* Turn off promiscuous mode */
  794. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  795. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  796. {
  797. IX_ETH_ACC_WARNING_LOG("EthAcc: Eth %d: Cannot enable loopback.\n",(INT32)portId,0,0,0,0,0);
  798. return IX_ETH_ACC_SUCCESS ;
  799. }
  800. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  801. {
  802. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  803. }
  804. /* read register */
  805. REG_READ(ixEthAccMacBase[portId],
  806. IX_ETH_ACC_MAC_RX_CNTRL1,
  807. regval);
  808. /* update register */
  809. REG_WRITE(ixEthAccMacBase[portId],
  810. IX_ETH_ACC_MAC_RX_CNTRL1,
  811. regval | IX_ETH_ACC_RX_CNTRL1_LOOP_EN);
  812. return IX_ETH_ACC_SUCCESS;
  813. }
  814. PRIVATE void
  815. ixEthAccNpeLoopbackMessageCallback (IxNpeMhNpeId npeId,
  816. IxNpeMhMessage msg)
  817. {
  818. IxEthAccPortId portId = IX_ETH_ACC_NPE_TO_PORT_ID(npeId);
  819. #ifndef NDEBUG
  820. /* Prudent to at least check the port is within range */
  821. if (portId >= IX_ETH_ACC_NUMBER_OF_PORTS)
  822. {
  823. IX_ETH_ACC_FATAL_LOG("IXETHACC:ixEthAccPortDisableMessageCallback: Illegal port: %u\n",
  824. (UINT32) portId, 0, 0, 0, 0, 0);
  825. return;
  826. }
  827. #endif
  828. /* unlock message reception mutex */
  829. ixOsalMutexUnlock(&ixEthAccMacState[portId].npeLoopbackMessageLock);
  830. }
  831. IxEthAccStatus
  832. ixEthAccNpeLoopbackEnablePriv(IxEthAccPortId portId)
  833. {
  834. IX_STATUS npeMhStatus;
  835. IxNpeMhMessage message;
  836. IxEthAccStatus status = IX_ETH_ACC_SUCCESS;
  837. /* Turn off promiscuous mode */
  838. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  839. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  840. {
  841. IX_ETH_ACC_WARNING_LOG("EthAcc: Eth %d: Cannot enable NPE loopback.\n",(INT32)portId,0,0,0,0,0);
  842. return IX_ETH_ACC_SUCCESS ;
  843. }
  844. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  845. {
  846. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  847. }
  848. /* enable NPE loopback (lsb of the message contains the value 1) */
  849. message.data[0] = (IX_ETHNPE_SETLOOPBACK_MODE << IX_ETH_ACC_MAC_MSGID_SHL)
  850. | 0x01;
  851. message.data[1] = 0;
  852. npeMhStatus = ixNpeMhMessageWithResponseSend(IX_ETH_ACC_PORT_TO_NPE_ID(portId),
  853. message,
  854. IX_ETHNPE_SETLOOPBACK_MODE_ACK,
  855. ixEthAccNpeLoopbackMessageCallback,
  856. IX_NPEMH_SEND_RETRIES_DEFAULT);
  857. if (npeMhStatus != IX_SUCCESS)
  858. {
  859. status = IX_ETH_ACC_FAIL;
  860. }
  861. else
  862. {
  863. /* wait for NPE loopbackEnable response */
  864. if (ixOsalMutexLock(&ixEthAccMacState[portId]. npeLoopbackMessageLock,
  865. IX_ETH_ACC_PORT_DISABLE_DELAY_MSECS)
  866. != IX_SUCCESS)
  867. {
  868. status = IX_ETH_ACC_FAIL;
  869. }
  870. }
  871. return status;
  872. }
  873. IxEthAccStatus
  874. ixEthAccPortTxEnablePriv(IxEthAccPortId portId)
  875. {
  876. UINT32 regval;
  877. /* Turn off promiscuous mode */
  878. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  879. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  880. {
  881. IX_ETH_ACC_WARNING_LOG("EthAcc: Eth %d: Cannot enable TX.\n",(INT32)portId,0,0,0,0,0);
  882. return IX_ETH_ACC_SUCCESS ;
  883. }
  884. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  885. {
  886. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  887. }
  888. /* read register */
  889. REG_READ(ixEthAccMacBase[portId],
  890. IX_ETH_ACC_MAC_TX_CNTRL1,
  891. regval);
  892. /* update register */
  893. REG_WRITE(ixEthAccMacBase[portId],
  894. IX_ETH_ACC_MAC_TX_CNTRL1,
  895. regval | IX_ETH_ACC_TX_CNTRL1_TX_EN);
  896. return IX_ETH_ACC_SUCCESS;
  897. }
  898. IxEthAccStatus
  899. ixEthAccPortRxEnablePriv(IxEthAccPortId portId)
  900. {
  901. UINT32 regval;
  902. /* Turn off promiscuous mode */
  903. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  904. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  905. {
  906. IX_ETH_ACC_WARNING_LOG("EthAcc: Eth %d: Cannot enable RX.\n",(INT32)portId,0,0,0,0,0);
  907. return IX_ETH_ACC_SUCCESS ;
  908. }
  909. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  910. {
  911. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  912. }
  913. /* read register */
  914. REG_READ(ixEthAccMacBase[portId],
  915. IX_ETH_ACC_MAC_RX_CNTRL1,
  916. regval);
  917. /* update register */
  918. REG_WRITE(ixEthAccMacBase[portId],
  919. IX_ETH_ACC_MAC_RX_CNTRL1,
  920. regval | IX_ETH_ACC_RX_CNTRL1_RX_EN);
  921. return IX_ETH_ACC_SUCCESS;
  922. }
  923. IxEthAccStatus
  924. ixEthAccPortLoopbackDisable(IxEthAccPortId portId)
  925. {
  926. UINT32 regval;
  927. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  928. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  929. {
  930. IX_ETH_ACC_WARNING_LOG("EthAcc: Eth %d: Cannot disable loopback.\n",(INT32)portId,0,0,0,0,0);
  931. return IX_ETH_ACC_SUCCESS ;
  932. }
  933. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  934. {
  935. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  936. }
  937. /*disable MAC loopabck */
  938. REG_READ(ixEthAccMacBase[portId],
  939. IX_ETH_ACC_MAC_RX_CNTRL1,
  940. regval);
  941. REG_WRITE(ixEthAccMacBase[portId],
  942. IX_ETH_ACC_MAC_RX_CNTRL1,
  943. (regval & ~IX_ETH_ACC_RX_CNTRL1_LOOP_EN));
  944. return IX_ETH_ACC_SUCCESS;
  945. }
  946. IxEthAccStatus
  947. ixEthAccNpeLoopbackDisablePriv(IxEthAccPortId portId)
  948. {
  949. IX_STATUS npeMhStatus;
  950. IxNpeMhMessage message;
  951. IxEthAccStatus status = IX_ETH_ACC_SUCCESS;
  952. /* Turn off promiscuous mode */
  953. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  954. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  955. {
  956. IX_ETH_ACC_WARNING_LOG("EthAcc: Eth %d: Cannot enable NPE loopback.\n",(INT32)portId,0,0,0,0,0);
  957. return IX_ETH_ACC_SUCCESS ;
  958. }
  959. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  960. {
  961. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  962. }
  963. /* disable NPE loopback (lsb of the message contains the value 0) */
  964. message.data[0] = (IX_ETHNPE_SETLOOPBACK_MODE << IX_ETH_ACC_MAC_MSGID_SHL);
  965. message.data[1] = 0;
  966. npeMhStatus = ixNpeMhMessageWithResponseSend(IX_ETH_ACC_PORT_TO_NPE_ID(portId),
  967. message,
  968. IX_ETHNPE_SETLOOPBACK_MODE_ACK,
  969. ixEthAccNpeLoopbackMessageCallback,
  970. IX_NPEMH_SEND_RETRIES_DEFAULT);
  971. if (npeMhStatus != IX_SUCCESS)
  972. {
  973. status = IX_ETH_ACC_FAIL;
  974. }
  975. else
  976. {
  977. /* wait for NPE loopbackEnable response */
  978. if (ixOsalMutexLock(&ixEthAccMacState[portId].npeLoopbackMessageLock,
  979. IX_ETH_ACC_PORT_DISABLE_DELAY_MSECS)
  980. != IX_SUCCESS)
  981. {
  982. status = IX_ETH_ACC_FAIL;
  983. }
  984. }
  985. return status;
  986. }
  987. IxEthAccStatus
  988. ixEthAccPortTxDisablePriv(IxEthAccPortId portId)
  989. {
  990. UINT32 regval;
  991. /* Turn off promiscuous mode */
  992. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  993. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  994. {
  995. IX_ETH_ACC_WARNING_LOG("EthAcc: Eth %d: Cannot disable TX.\n", (INT32)portId,0,0,0,0,0);
  996. return IX_ETH_ACC_SUCCESS ;
  997. }
  998. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  999. {
  1000. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1001. }
  1002. /* read register */
  1003. REG_READ(ixEthAccMacBase[portId],
  1004. IX_ETH_ACC_MAC_TX_CNTRL1,
  1005. regval);
  1006. /* update register */
  1007. REG_WRITE(ixEthAccMacBase[portId],
  1008. IX_ETH_ACC_MAC_TX_CNTRL1,
  1009. (regval & ~IX_ETH_ACC_TX_CNTRL1_TX_EN));
  1010. return IX_ETH_ACC_SUCCESS;
  1011. }
  1012. IxEthAccStatus
  1013. ixEthAccPortRxDisablePriv(IxEthAccPortId portId)
  1014. {
  1015. UINT32 regval;
  1016. /* Turn off promiscuous mode */
  1017. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1018. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1019. {
  1020. IX_ETH_ACC_WARNING_LOG("EthAcc: Eth %d: Cannot disable RX.\n", (INT32)portId,0,0,0,0,0);
  1021. return IX_ETH_ACC_SUCCESS ;
  1022. }
  1023. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1024. {
  1025. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1026. }
  1027. /* read register */
  1028. REG_READ(ixEthAccMacBase[portId],
  1029. IX_ETH_ACC_MAC_RX_CNTRL1,
  1030. regval);
  1031. /* update register */
  1032. REG_WRITE(ixEthAccMacBase[portId],
  1033. IX_ETH_ACC_MAC_RX_CNTRL1,
  1034. (regval & ~IX_ETH_ACC_RX_CNTRL1_RX_EN));
  1035. return IX_ETH_ACC_SUCCESS;
  1036. }
  1037. IxEthAccStatus
  1038. ixEthAccPortPromiscuousModeClearPriv(IxEthAccPortId portId)
  1039. {
  1040. UINT32 regval;
  1041. /* Turn off promiscuous mode */
  1042. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1043. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1044. {
  1045. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot clear promiscuous mode.\n",(INT32)portId,0,0,0,0,0);
  1046. return IX_ETH_ACC_SUCCESS ;
  1047. }
  1048. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1049. {
  1050. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1051. }
  1052. /*set bit 5 of Rx control 1 - enable address filtering*/
  1053. REG_READ(ixEthAccMacBase[portId],
  1054. IX_ETH_ACC_MAC_RX_CNTRL1,
  1055. regval);
  1056. REG_WRITE(ixEthAccMacBase[portId],
  1057. IX_ETH_ACC_MAC_RX_CNTRL1,
  1058. regval | IX_ETH_ACC_RX_CNTRL1_ADDR_FLTR_EN);
  1059. ixEthAccMacState[portId].promiscuous = FALSE;
  1060. ixEthAccMulticastAddressSet(portId);
  1061. return IX_ETH_ACC_SUCCESS;
  1062. }
  1063. IxEthAccStatus
  1064. ixEthAccPortPromiscuousModeSetPriv(IxEthAccPortId portId)
  1065. {
  1066. UINT32 regval;
  1067. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1068. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1069. {
  1070. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot set promiscuous mode.\n",(INT32)portId,0,0,0,0,0);
  1071. return IX_ETH_ACC_SUCCESS ;
  1072. }
  1073. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1074. {
  1075. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1076. }
  1077. /*
  1078. * Set bit 5 of Rx control 1 - We enable address filtering even in
  1079. * promiscuous mode because we want the MAC to set the appropriate
  1080. * bits in m_flags which doesn't happen if we turn off filtering.
  1081. */
  1082. REG_READ(ixEthAccMacBase[portId],
  1083. IX_ETH_ACC_MAC_RX_CNTRL1,
  1084. regval);
  1085. REG_WRITE(ixEthAccMacBase[portId],
  1086. IX_ETH_ACC_MAC_RX_CNTRL1,
  1087. regval | IX_ETH_ACC_RX_CNTRL1_ADDR_FLTR_EN);
  1088. ixEthAccMacState[portId].promiscuous = TRUE;
  1089. ixEthAccMulticastAddressSet(portId);
  1090. return IX_ETH_ACC_SUCCESS;
  1091. }
  1092. IxEthAccStatus
  1093. ixEthAccPortUnicastMacAddressSetPriv (IxEthAccPortId portId,
  1094. IxEthAccMacAddr *macAddr)
  1095. {
  1096. UINT32 i;
  1097. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1098. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1099. {
  1100. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot set Unicast Mac Address.\n",(INT32)portId,0,0,0,0,0);
  1101. return IX_ETH_ACC_SUCCESS ;
  1102. }
  1103. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1104. {
  1105. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1106. }
  1107. if (macAddr == NULL)
  1108. {
  1109. return IX_ETH_ACC_FAIL;
  1110. }
  1111. if ( macAddr->macAddress[0] & IX_ETH_ACC_ETH_MAC_BCAST_MCAST_BIT )
  1112. {
  1113. /* This is a multicast/broadcast address cant set it ! */
  1114. return IX_ETH_ACC_FAIL;
  1115. }
  1116. if ( macAddr->macAddress[0] == 0 &&
  1117. macAddr->macAddress[1] == 0 &&
  1118. macAddr->macAddress[2] == 0 &&
  1119. macAddr->macAddress[3] == 0 &&
  1120. macAddr->macAddress[4] == 0 &&
  1121. macAddr->macAddress[5] == 0 )
  1122. {
  1123. /* This is an invalid mac address cant set it ! */
  1124. return IX_ETH_ACC_FAIL;
  1125. }
  1126. #ifdef CONFIG_IXP425_COMPONENT_ETHDB
  1127. /* update the MAC address in the ethernet database */
  1128. if (ixEthDBPortAddressSet(portId, (IxEthDBMacAddr *) macAddr) != IX_ETH_DB_SUCCESS)
  1129. {
  1130. return IX_ETH_ACC_FAIL;
  1131. }
  1132. #endif
  1133. /*Set the Unicast MAC to the specified value*/
  1134. for(i=0;i<IX_IEEE803_MAC_ADDRESS_SIZE;i++)
  1135. {
  1136. REG_WRITE(ixEthAccMacBase[portId],
  1137. IX_ETH_ACC_MAC_UNI_ADDR_1 + i*sizeof(UINT32),
  1138. macAddr->macAddress[i]);
  1139. }
  1140. ixEthAccMacState[portId].initDone = TRUE;
  1141. return IX_ETH_ACC_SUCCESS;
  1142. }
  1143. IxEthAccStatus
  1144. ixEthAccPortUnicastMacAddressGetPriv (IxEthAccPortId portId,
  1145. IxEthAccMacAddr *macAddr)
  1146. {
  1147. /*Return the current value of the Unicast MAC from h/w
  1148. for the specified port*/
  1149. UINT32 i;
  1150. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1151. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1152. {
  1153. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot get Unicast Mac Address.\n",(INT32)portId,0,0,0,0,0);
  1154. /* Since Eth Npe is unavailable, return invalid MAC Address = 00:00:00:00:00:00 */
  1155. for(i=0;i<IX_IEEE803_MAC_ADDRESS_SIZE;i++)
  1156. {
  1157. macAddr->macAddress[i] = 0;
  1158. }
  1159. return IX_ETH_ACC_SUCCESS ;
  1160. }
  1161. if(!ixEthAccMacState[portId].initDone)
  1162. {
  1163. return (IX_ETH_ACC_MAC_UNINITIALIZED);
  1164. }
  1165. if (macAddr == NULL)
  1166. {
  1167. return IX_ETH_ACC_FAIL;
  1168. }
  1169. for(i=0;i<IX_IEEE803_MAC_ADDRESS_SIZE;i++)
  1170. {
  1171. REG_READ(ixEthAccMacBase[portId],
  1172. IX_ETH_ACC_MAC_UNI_ADDR_1 + i*sizeof(UINT32),
  1173. macAddr->macAddress[i]);
  1174. }
  1175. return IX_ETH_ACC_SUCCESS;
  1176. }
  1177. PRIVATE IxEthAccStatus
  1178. ixEthAccPortMulticastMacAddressGet (IxEthAccPortId portId,
  1179. IxEthAccMacAddr *macAddr)
  1180. {
  1181. /*Return the current value of the Multicast MAC from h/w
  1182. for the specified port*/
  1183. UINT32 i;
  1184. for(i=0;i<IX_IEEE803_MAC_ADDRESS_SIZE;i++)
  1185. {
  1186. REG_READ(ixEthAccMacBase[portId],
  1187. IX_ETH_ACC_MAC_ADDR_1 + i*sizeof(UINT32),
  1188. macAddr->macAddress[i]);
  1189. }
  1190. return IX_ETH_ACC_SUCCESS;
  1191. }
  1192. PRIVATE IxEthAccStatus
  1193. ixEthAccPortMulticastMacFilterGet (IxEthAccPortId portId,
  1194. IxEthAccMacAddr *macAddr)
  1195. {
  1196. /*Return the current value of the Multicast MAC from h/w
  1197. for the specified port*/
  1198. UINT32 i;
  1199. for(i=0;i<IX_IEEE803_MAC_ADDRESS_SIZE;i++)
  1200. {
  1201. REG_READ(ixEthAccMacBase[portId],
  1202. IX_ETH_ACC_MAC_ADDR_MASK_1 + i*sizeof(UINT32),
  1203. macAddr->macAddress[i]);
  1204. }
  1205. return IX_ETH_ACC_SUCCESS;
  1206. }
  1207. IxEthAccStatus
  1208. ixEthAccPortMulticastAddressJoinPriv (IxEthAccPortId portId,
  1209. IxEthAccMacAddr *macAddr)
  1210. {
  1211. UINT32 i;
  1212. IxEthAccMacAddr broadcastAddr = {{0xff,0xff,0xff,0xff,0xff,0xff}};
  1213. /*Check that the port parameter is valid*/
  1214. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1215. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1216. {
  1217. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot join Multicast Mac Address.\n",(INT32)portId,0,0,0,0,0);
  1218. return IX_ETH_ACC_SUCCESS ;
  1219. }
  1220. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1221. {
  1222. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1223. }
  1224. /*Check that the mac address is valid*/
  1225. if(macAddr == NULL)
  1226. {
  1227. return IX_ETH_ACC_FAIL;
  1228. }
  1229. /* Check that this is a multicast address */
  1230. if (!(macAddr->macAddress[0] & IX_ETH_ACC_ETH_MAC_BCAST_MCAST_BIT))
  1231. {
  1232. return IX_ETH_ACC_FAIL;
  1233. }
  1234. /* We don't add the Broadcast address */
  1235. if(ixEthAccMacEqual(&broadcastAddr, macAddr))
  1236. {
  1237. return IX_ETH_ACC_FAIL;
  1238. }
  1239. for (i = 0;
  1240. i<ixEthAccMacState[portId].mcastAddrIndex;
  1241. i++)
  1242. {
  1243. /*Check if the current entry already match an existing matches*/
  1244. if(ixEthAccMacEqual(&ixEthAccMacState[portId].mcastAddrsTable[i], macAddr))
  1245. {
  1246. /* Address found in the list and already configured,
  1247. * return a success status
  1248. */
  1249. return IX_ETH_ACC_SUCCESS;
  1250. }
  1251. }
  1252. /* check for availability at the end of the current table */
  1253. if(ixEthAccMacState[portId].mcastAddrIndex >= IX_ETH_ACC_MAX_MULTICAST_ADDRESSES)
  1254. {
  1255. return IX_ETH_ACC_FAIL;
  1256. }
  1257. /*First add the address to the multicast table for the
  1258. specified port*/
  1259. i=ixEthAccMacState[portId].mcastAddrIndex;
  1260. memcpy(&ixEthAccMacState[portId].mcastAddrsTable[i],
  1261. &macAddr->macAddress,
  1262. IX_IEEE803_MAC_ADDRESS_SIZE);
  1263. /*Increment the index into the table, this must be done here
  1264. as MulticastAddressSet below needs to know about the latest
  1265. entry.
  1266. */
  1267. ixEthAccMacState[portId].mcastAddrIndex++;
  1268. /*Then calculate the new value to be written to the address and
  1269. address mask registers*/
  1270. ixEthAccMulticastAddressSet(portId);
  1271. return IX_ETH_ACC_SUCCESS;
  1272. }
  1273. IxEthAccStatus
  1274. ixEthAccPortMulticastAddressJoinAllPriv (IxEthAccPortId portId)
  1275. {
  1276. IxEthAccMacAddr mcastMacAddr = {{0x1,0x0,0x0,0x0,0x0,0x0}};
  1277. /*Check that the port parameter is valid*/
  1278. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1279. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1280. {
  1281. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot join all Multicast Address.\n",(INT32)portId,0,0,0,0,0);
  1282. return IX_ETH_ACC_SUCCESS ;
  1283. }
  1284. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1285. {
  1286. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1287. }
  1288. /* remove all entries from the database and
  1289. * insert a multicast entry
  1290. */
  1291. memcpy(&ixEthAccMacState[portId].mcastAddrsTable[0],
  1292. &mcastMacAddr.macAddress,
  1293. IX_IEEE803_MAC_ADDRESS_SIZE);
  1294. ixEthAccMacState[portId].mcastAddrIndex = 1;
  1295. ixEthAccMacState[portId].joinAll = TRUE;
  1296. ixEthAccMulticastAddressSet(portId);
  1297. return IX_ETH_ACC_SUCCESS;
  1298. }
  1299. IxEthAccStatus
  1300. ixEthAccPortMulticastAddressLeavePriv (IxEthAccPortId portId,
  1301. IxEthAccMacAddr *macAddr)
  1302. {
  1303. UINT32 i;
  1304. IxEthAccMacAddr mcastMacAddr = {{0x1,0x0,0x0,0x0,0x0,0x0}};
  1305. /*Check that the port parameter is valid*/
  1306. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1307. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1308. {
  1309. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot leave Multicast Address.\n",(INT32)portId,0,0,0,0,0);
  1310. return IX_ETH_ACC_SUCCESS ;
  1311. }
  1312. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1313. {
  1314. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1315. }
  1316. /*Check that the mac address is valid*/
  1317. if(macAddr == NULL)
  1318. {
  1319. return IX_ETH_ACC_FAIL;
  1320. }
  1321. /* Remove this mac address from the mask for the specified port
  1322. * we copy down all entries above the blanked entry, and
  1323. * decrement the index
  1324. */
  1325. i=0;
  1326. while(i<ixEthAccMacState[portId].mcastAddrIndex)
  1327. {
  1328. /*Check if the current entry matches*/
  1329. if(ixEthAccMacEqual(&ixEthAccMacState[portId].mcastAddrsTable[i],
  1330. macAddr))
  1331. {
  1332. if(ixEthAccMacEqual(macAddr, &mcastMacAddr))
  1333. {
  1334. ixEthAccMacState[portId].joinAll = FALSE;
  1335. }
  1336. /*Decrement the index into the multicast address table
  1337. for the current port*/
  1338. ixEthAccMacState[portId].mcastAddrIndex--;
  1339. /*Copy down all entries above the current entry*/
  1340. while(i<ixEthAccMacState[portId].mcastAddrIndex)
  1341. {
  1342. memcpy(&ixEthAccMacState[portId].mcastAddrsTable[i],
  1343. &ixEthAccMacState[portId].mcastAddrsTable[i+1],
  1344. IX_IEEE803_MAC_ADDRESS_SIZE);
  1345. i++;
  1346. }
  1347. /*recalculate the mask and write it to the MAC*/
  1348. ixEthAccMulticastAddressSet(portId);
  1349. return IX_ETH_ACC_SUCCESS;
  1350. }
  1351. /* search the next entry */
  1352. i++;
  1353. }
  1354. /* no matching entry found */
  1355. return IX_ETH_ACC_NO_SUCH_ADDR;
  1356. }
  1357. IxEthAccStatus
  1358. ixEthAccPortMulticastAddressLeaveAllPriv (IxEthAccPortId portId)
  1359. {
  1360. /*Check that the port parameter is valid*/
  1361. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1362. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1363. {
  1364. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot leave all Multicast Address.\n",(INT32)portId,0,0,0,0,0);
  1365. return IX_ETH_ACC_SUCCESS ;
  1366. }
  1367. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1368. {
  1369. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1370. }
  1371. ixEthAccMacState[portId].mcastAddrIndex = 0;
  1372. ixEthAccMacState[portId].joinAll = FALSE;
  1373. ixEthAccMulticastAddressSet(portId);
  1374. return IX_ETH_ACC_SUCCESS;
  1375. }
  1376. IxEthAccStatus
  1377. ixEthAccPortUnicastAddressShowPriv (IxEthAccPortId portId)
  1378. {
  1379. IxEthAccMacAddr macAddr;
  1380. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1381. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1382. {
  1383. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot show Unicast Address.\n",(INT32)portId,0,0,0,0,0);
  1384. return IX_ETH_ACC_SUCCESS ;
  1385. }
  1386. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1387. {
  1388. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1389. }
  1390. /*Get the MAC (UINICAST) address from hardware*/
  1391. if(ixEthAccPortUnicastMacAddressGetPriv(portId, &macAddr) != IX_ETH_ACC_SUCCESS)
  1392. {
  1393. IX_ETH_ACC_WARNING_LOG("EthAcc: MAC address uninitialised port %u\n",
  1394. (INT32)portId,0,0,0,0,0);
  1395. return IX_ETH_ACC_MAC_UNINITIALIZED;
  1396. }
  1397. /*print it out*/
  1398. ixEthAccMacPrint(&macAddr);
  1399. printf("\n");
  1400. return IX_ETH_ACC_SUCCESS;
  1401. }
  1402. void
  1403. ixEthAccPortMulticastAddressShowPriv(IxEthAccPortId portId)
  1404. {
  1405. IxEthAccMacAddr macAddr;
  1406. UINT32 i;
  1407. if(!IX_ETH_ACC_IS_PORT_VALID(portId))
  1408. {
  1409. return;
  1410. }
  1411. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1412. {
  1413. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot show Multicast Address.\n",(INT32)portId,0,0,0,0,0);
  1414. return ;
  1415. }
  1416. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1417. {
  1418. return;
  1419. }
  1420. printf("Multicast MAC: ");
  1421. /*Get the MAC (MULTICAST) address from hardware*/
  1422. ixEthAccPortMulticastMacAddressGet(portId, &macAddr);
  1423. /*print it out*/
  1424. ixEthAccMacPrint(&macAddr);
  1425. /*Get the MAC (MULTICAST) filter from hardware*/
  1426. ixEthAccPortMulticastMacFilterGet(portId, &macAddr);
  1427. /*print it out*/
  1428. printf(" ( ");
  1429. ixEthAccMacPrint(&macAddr);
  1430. printf(" )\n");
  1431. printf("Constituent Addresses:\n");
  1432. for(i=0;i<ixEthAccMacState[portId].mcastAddrIndex;i++)
  1433. {
  1434. ixEthAccMacPrint(&ixEthAccMacState[portId].mcastAddrsTable[i]);
  1435. printf("\n");
  1436. }
  1437. return;
  1438. }
  1439. /*Set the duplex mode*/
  1440. IxEthAccStatus
  1441. ixEthAccPortDuplexModeSetPriv (IxEthAccPortId portId,
  1442. IxEthAccDuplexMode mode)
  1443. {
  1444. UINT32 txregval;
  1445. UINT32 rxregval;
  1446. /*This is bit 1 of the transmit control reg, set to 1 for half
  1447. duplex, 0 for full duplex*/
  1448. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1449. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1450. {
  1451. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot set Duplex Mode.\n",(INT32)portId,0,0,0,0,0);
  1452. return IX_ETH_ACC_SUCCESS ;
  1453. }
  1454. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1455. {
  1456. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1457. }
  1458. REG_READ(ixEthAccMacBase[portId],
  1459. IX_ETH_ACC_MAC_TX_CNTRL1,
  1460. txregval);
  1461. REG_READ(ixEthAccMacBase[portId],
  1462. IX_ETH_ACC_MAC_RX_CNTRL1,
  1463. rxregval);
  1464. if (mode == IX_ETH_ACC_FULL_DUPLEX)
  1465. {
  1466. /*Clear half duplex bit in TX*/
  1467. REG_WRITE(ixEthAccMacBase[portId],
  1468. IX_ETH_ACC_MAC_TX_CNTRL1,
  1469. txregval & ~IX_ETH_ACC_TX_CNTRL1_DUPLEX);
  1470. /*We must set the pause enable in the receive logic when in
  1471. full duplex mode*/
  1472. REG_WRITE(ixEthAccMacBase[portId],
  1473. IX_ETH_ACC_MAC_RX_CNTRL1,
  1474. rxregval | IX_ETH_ACC_RX_CNTRL1_PAUSE_EN);
  1475. ixEthAccMacState[portId].fullDuplex = TRUE;
  1476. }
  1477. else if (mode == IX_ETH_ACC_HALF_DUPLEX)
  1478. {
  1479. /*Set half duplex bit in TX*/
  1480. REG_WRITE(ixEthAccMacBase[portId],
  1481. IX_ETH_ACC_MAC_TX_CNTRL1,
  1482. txregval | IX_ETH_ACC_TX_CNTRL1_DUPLEX);
  1483. /*We must clear pause enable in the receive logic when in
  1484. half duplex mode*/
  1485. REG_WRITE(ixEthAccMacBase[portId],
  1486. IX_ETH_ACC_MAC_RX_CNTRL1,
  1487. rxregval & ~IX_ETH_ACC_RX_CNTRL1_PAUSE_EN);
  1488. ixEthAccMacState[portId].fullDuplex = FALSE;
  1489. }
  1490. else
  1491. {
  1492. return IX_ETH_ACC_FAIL;
  1493. }
  1494. return IX_ETH_ACC_SUCCESS;
  1495. }
  1496. IxEthAccStatus
  1497. ixEthAccPortDuplexModeGetPriv (IxEthAccPortId portId,
  1498. IxEthAccDuplexMode *mode)
  1499. {
  1500. /*Return the duplex mode for the specified port*/
  1501. UINT32 regval;
  1502. /*This is bit 1 of the transmit control reg, set to 1 for half
  1503. duplex, 0 for full duplex*/
  1504. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1505. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1506. {
  1507. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot get Duplex Mode.\n",(INT32)portId,0,0,0,0,0);
  1508. /* return hald duplex */
  1509. *mode = IX_ETH_ACC_HALF_DUPLEX ;
  1510. return IX_ETH_ACC_SUCCESS ;
  1511. }
  1512. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1513. {
  1514. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1515. }
  1516. if (mode == NULL)
  1517. {
  1518. return (IX_ETH_ACC_FAIL);
  1519. }
  1520. REG_READ(ixEthAccMacBase[portId],
  1521. IX_ETH_ACC_MAC_TX_CNTRL1,
  1522. regval);
  1523. if( regval & IX_ETH_ACC_TX_CNTRL1_DUPLEX)
  1524. {
  1525. *mode = IX_ETH_ACC_HALF_DUPLEX;
  1526. }
  1527. else
  1528. {
  1529. *mode = IX_ETH_ACC_FULL_DUPLEX;
  1530. }
  1531. return IX_ETH_ACC_SUCCESS;
  1532. }
  1533. IxEthAccStatus
  1534. ixEthAccPortTxFrameAppendPaddingEnablePriv (IxEthAccPortId portId)
  1535. {
  1536. UINT32 regval;
  1537. /*Enable FCS computation by the MAC and appending to the
  1538. frame*/
  1539. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1540. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1541. {
  1542. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot enable Tx Frame Append Padding.\n",(INT32)portId,0,0,0,0,0);
  1543. return IX_ETH_ACC_SUCCESS ;
  1544. }
  1545. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1546. {
  1547. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1548. }
  1549. REG_READ(ixEthAccMacBase[portId],
  1550. IX_ETH_ACC_MAC_TX_CNTRL1,
  1551. regval);
  1552. REG_WRITE(ixEthAccMacBase[portId],
  1553. IX_ETH_ACC_MAC_TX_CNTRL1,
  1554. regval |
  1555. IX_ETH_ACC_TX_CNTRL1_PAD_EN);
  1556. ixEthAccMacState[portId].txPADAppend = TRUE;
  1557. return IX_ETH_ACC_SUCCESS;
  1558. }
  1559. IxEthAccStatus
  1560. ixEthAccPortTxFrameAppendPaddingDisablePriv (IxEthAccPortId portId)
  1561. {
  1562. UINT32 regval;
  1563. /*disable FCS computation and appending*/
  1564. /*Set bit 4 of Tx control register one to zero*/
  1565. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1566. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1567. {
  1568. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot disble Tx Frame Append Padding.\n",(INT32)portId,0,0,0,0,0);
  1569. return IX_ETH_ACC_SUCCESS ;
  1570. }
  1571. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1572. {
  1573. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1574. }
  1575. REG_READ(ixEthAccMacBase[portId],
  1576. IX_ETH_ACC_MAC_TX_CNTRL1,
  1577. regval);
  1578. REG_WRITE(ixEthAccMacBase[portId],
  1579. IX_ETH_ACC_MAC_TX_CNTRL1,
  1580. regval & ~IX_ETH_ACC_TX_CNTRL1_PAD_EN);
  1581. ixEthAccMacState[portId].txPADAppend = FALSE;
  1582. return IX_ETH_ACC_SUCCESS;
  1583. }
  1584. IxEthAccStatus
  1585. ixEthAccPortTxFrameAppendFCSEnablePriv (IxEthAccPortId portId)
  1586. {
  1587. UINT32 regval;
  1588. /*Enable FCS computation by the MAC and appending to the
  1589. frame*/
  1590. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1591. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1592. {
  1593. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot enable Tx Frame Append FCS.\n",(INT32)portId,0,0,0,0,0);
  1594. return IX_ETH_ACC_SUCCESS ;
  1595. }
  1596. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1597. {
  1598. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1599. }
  1600. REG_READ(ixEthAccMacBase[portId],
  1601. IX_ETH_ACC_MAC_TX_CNTRL1,
  1602. regval);
  1603. REG_WRITE(ixEthAccMacBase[portId],
  1604. IX_ETH_ACC_MAC_TX_CNTRL1,
  1605. regval | IX_ETH_ACC_TX_CNTRL1_FCS_EN);
  1606. ixEthAccMacState[portId].txFCSAppend = TRUE;
  1607. return IX_ETH_ACC_SUCCESS;
  1608. }
  1609. IxEthAccStatus
  1610. ixEthAccPortTxFrameAppendFCSDisablePriv (IxEthAccPortId portId)
  1611. {
  1612. UINT32 regval;
  1613. /*disable FCS computation and appending*/
  1614. /*Set bit 4 of Tx control register one to zero*/
  1615. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1616. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1617. {
  1618. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot disable Tx Frame Append FCS.\n",(INT32)portId,0,0,0,0,0);
  1619. return IX_ETH_ACC_SUCCESS ;
  1620. }
  1621. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1622. {
  1623. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1624. }
  1625. REG_READ(ixEthAccMacBase[portId],
  1626. IX_ETH_ACC_MAC_TX_CNTRL1,
  1627. regval);
  1628. REG_WRITE(ixEthAccMacBase[portId],
  1629. IX_ETH_ACC_MAC_TX_CNTRL1,
  1630. regval & ~IX_ETH_ACC_TX_CNTRL1_FCS_EN);
  1631. ixEthAccMacState[portId].txFCSAppend = FALSE;
  1632. return IX_ETH_ACC_SUCCESS;
  1633. }
  1634. IxEthAccStatus
  1635. ixEthAccPortRxFrameAppendFCSEnablePriv (IxEthAccPortId portId)
  1636. {
  1637. /*Set bit 2 of Rx control 1*/
  1638. UINT32 regval;
  1639. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1640. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1641. {
  1642. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot enable Rx Frame Append FCS.\n",(INT32)portId,0,0,0,0,0);
  1643. return IX_ETH_ACC_SUCCESS ;
  1644. }
  1645. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1646. {
  1647. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1648. }
  1649. REG_READ(ixEthAccMacBase[portId],
  1650. IX_ETH_ACC_MAC_RX_CNTRL1,
  1651. regval);
  1652. REG_WRITE(ixEthAccMacBase[portId],
  1653. IX_ETH_ACC_MAC_RX_CNTRL1,
  1654. regval | IX_ETH_ACC_RX_CNTRL1_CRC_EN);
  1655. ixEthAccMacState[portId].rxFCSAppend = TRUE;
  1656. return IX_ETH_ACC_SUCCESS;
  1657. }
  1658. IxEthAccStatus
  1659. ixEthAccPortRxFrameAppendFCSDisablePriv (IxEthAccPortId portId)
  1660. {
  1661. UINT32 regval;
  1662. /*Clear bit 2 of Rx control 1*/
  1663. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1664. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1665. {
  1666. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot disable Rx Frame Append FCS.\n",(INT32)portId,0,0,0,0,0);
  1667. return IX_ETH_ACC_SUCCESS ;
  1668. }
  1669. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1670. {
  1671. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1672. }
  1673. REG_READ(ixEthAccMacBase[portId],
  1674. IX_ETH_ACC_MAC_RX_CNTRL1,
  1675. regval);
  1676. REG_WRITE(ixEthAccMacBase[portId],
  1677. IX_ETH_ACC_MAC_RX_CNTRL1,
  1678. regval & ~IX_ETH_ACC_RX_CNTRL1_CRC_EN);
  1679. ixEthAccMacState[portId].rxFCSAppend = FALSE;
  1680. return IX_ETH_ACC_SUCCESS;
  1681. }
  1682. PRIVATE void
  1683. ixEthAccMacNpeStatsMessageCallback (IxNpeMhNpeId npeId,
  1684. IxNpeMhMessage msg)
  1685. {
  1686. IxEthAccPortId portId = IX_ETH_ACC_NPE_TO_PORT_ID(npeId);
  1687. #ifndef NDEBUG
  1688. /* Prudent to at least check the port is within range */
  1689. if (portId >= IX_ETH_ACC_NUMBER_OF_PORTS)
  1690. {
  1691. IX_ETH_ACC_FATAL_LOG(
  1692. "IXETHACC:ixEthAccMacNpeStatsMessageCallback: Illegal port: %u\n",
  1693. (UINT32)portId, 0, 0, 0, 0, 0);
  1694. return;
  1695. }
  1696. #endif
  1697. /*Unblock Stats Get call*/
  1698. ixOsalMutexUnlock(&ixEthAccMacState[portId].ackMIBStatsLock);
  1699. }
  1700. PRIVATE void
  1701. ixEthAccMibIIStatsEndianConvert (IxEthEthObjStats *retStats)
  1702. {
  1703. /* endianness conversion */
  1704. /* Rx stats */
  1705. retStats->dot3StatsAlignmentErrors =
  1706. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsAlignmentErrors);
  1707. retStats->dot3StatsFCSErrors =
  1708. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsFCSErrors);
  1709. retStats->dot3StatsInternalMacReceiveErrors =
  1710. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsInternalMacReceiveErrors);
  1711. retStats->RxOverrunDiscards =
  1712. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxOverrunDiscards);
  1713. retStats->RxLearnedEntryDiscards =
  1714. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxLearnedEntryDiscards);
  1715. retStats->RxLargeFramesDiscards =
  1716. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxLargeFramesDiscards);
  1717. retStats->RxSTPBlockedDiscards =
  1718. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxSTPBlockedDiscards);
  1719. retStats->RxVLANTypeFilterDiscards =
  1720. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxVLANTypeFilterDiscards);
  1721. retStats->RxVLANIdFilterDiscards =
  1722. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxVLANIdFilterDiscards);
  1723. retStats->RxInvalidSourceDiscards =
  1724. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxInvalidSourceDiscards);
  1725. retStats->RxBlackListDiscards =
  1726. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxBlackListDiscards);
  1727. retStats->RxWhiteListDiscards =
  1728. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxWhiteListDiscards);
  1729. retStats->RxUnderflowEntryDiscards =
  1730. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->RxUnderflowEntryDiscards);
  1731. /* Tx stats */
  1732. retStats->dot3StatsSingleCollisionFrames =
  1733. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsSingleCollisionFrames);
  1734. retStats->dot3StatsMultipleCollisionFrames =
  1735. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsMultipleCollisionFrames);
  1736. retStats->dot3StatsDeferredTransmissions =
  1737. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsDeferredTransmissions);
  1738. retStats->dot3StatsLateCollisions =
  1739. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsLateCollisions);
  1740. retStats->dot3StatsExcessiveCollsions =
  1741. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsExcessiveCollsions);
  1742. retStats->dot3StatsInternalMacTransmitErrors =
  1743. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsInternalMacTransmitErrors);
  1744. retStats->dot3StatsCarrierSenseErrors =
  1745. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->dot3StatsCarrierSenseErrors);
  1746. retStats->TxLargeFrameDiscards =
  1747. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->TxLargeFrameDiscards);
  1748. retStats->TxVLANIdFilterDiscards =
  1749. IX_OSAL_SWAP_BE_SHARED_LONG(retStats->TxVLANIdFilterDiscards);
  1750. }
  1751. IxEthAccStatus
  1752. ixEthAccMibIIStatsGet (IxEthAccPortId portId,
  1753. IxEthEthObjStats *retStats )
  1754. {
  1755. IxNpeMhMessage message;
  1756. if (!IX_ETH_ACC_IS_SERVICE_INITIALIZED())
  1757. {
  1758. printf("EthAcc: ixEthAccMibIIStatsGet (Mac) EthAcc service is not initialized\n");
  1759. return (IX_ETH_ACC_FAIL);
  1760. }
  1761. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1762. if (retStats == NULL)
  1763. {
  1764. printf("EthAcc: ixEthAccMibIIStatsGet (Mac) NULL argument\n");
  1765. return (IX_ETH_ACC_FAIL);
  1766. }
  1767. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1768. {
  1769. printf("EthAcc: ixEthAccMibIIStatsGet (Mac) NPE for port %d is not available\n", portId);
  1770. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot get MIB II Stats.\n",(INT32)portId,0,0,0,0,0);
  1771. /* Return all zero stats */
  1772. IX_ETH_ACC_MEMSET(retStats, 0, sizeof(IxEthEthObjStats));
  1773. return IX_ETH_ACC_SUCCESS ;
  1774. }
  1775. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1776. {
  1777. printf("EthAcc: ixEthAccMibIIStatsGet (Mac) port %d is not initialized\n", portId);
  1778. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1779. }
  1780. IX_OSAL_CACHE_INVALIDATE(retStats, sizeof(IxEthEthObjStats));
  1781. message.data[0] = IX_ETHNPE_GETSTATS << IX_ETH_ACC_MAC_MSGID_SHL;
  1782. message.data[1] = (UINT32) IX_OSAL_MMU_VIRT_TO_PHYS(retStats);
  1783. /* Permit only one task to request MIB statistics Get operation
  1784. at a time */
  1785. ixOsalMutexLock(&ixEthAccMacState[portId].MIBStatsGetAccessLock, IX_OSAL_WAIT_FOREVER);
  1786. if(ixNpeMhMessageWithResponseSend(IX_ETH_ACC_PORT_TO_NPE_ID(portId),
  1787. message,
  1788. IX_ETHNPE_GETSTATS,
  1789. ixEthAccMacNpeStatsMessageCallback,
  1790. IX_NPEMH_SEND_RETRIES_DEFAULT)
  1791. != IX_SUCCESS)
  1792. {
  1793. ixOsalMutexUnlock(&ixEthAccMacState[portId].MIBStatsGetAccessLock);
  1794. printf("EthAcc: (Mac) StatsGet failed to send NPE message\n");
  1795. return IX_ETH_ACC_FAIL;
  1796. }
  1797. /* Wait for callback invocation indicating response to
  1798. this request - we need this mutex in order to ensure
  1799. that the return from this function is synchronous */
  1800. ixOsalMutexLock(&ixEthAccMacState[portId].ackMIBStatsLock, IX_ETH_ACC_MIB_STATS_DELAY_MSECS);
  1801. /* Permit other tasks to perform MIB statistics Get operation */
  1802. ixOsalMutexUnlock(&ixEthAccMacState[portId].MIBStatsGetAccessLock);
  1803. ixEthAccMibIIStatsEndianConvert (retStats);
  1804. return IX_ETH_ACC_SUCCESS;
  1805. }
  1806. PRIVATE void
  1807. ixEthAccMacNpeStatsResetMessageCallback (IxNpeMhNpeId npeId,
  1808. IxNpeMhMessage msg)
  1809. {
  1810. IxEthAccPortId portId = IX_ETH_ACC_NPE_TO_PORT_ID(npeId);
  1811. #ifndef NDEBUG
  1812. /* Prudent to at least check the port is within range */
  1813. if (portId >= IX_ETH_ACC_NUMBER_OF_PORTS)
  1814. {
  1815. IX_ETH_ACC_FATAL_LOG(
  1816. "IXETHACC:ixEthAccMacNpeStatsResetMessageCallback: Illegal port: %u\n",
  1817. (UINT32)portId, 0, 0, 0, 0, 0);
  1818. return;
  1819. }
  1820. #endif
  1821. /*Unblock Stats Get & reset call*/
  1822. ixOsalMutexUnlock(&ixEthAccMacState[portId].ackMIBStatsResetLock);
  1823. }
  1824. IxEthAccStatus
  1825. ixEthAccMibIIStatsGetClear (IxEthAccPortId portId,
  1826. IxEthEthObjStats *retStats)
  1827. {
  1828. IxNpeMhMessage message;
  1829. if (!IX_ETH_ACC_IS_SERVICE_INITIALIZED())
  1830. {
  1831. printf("EthAcc: ixEthAccMibIIStatsGetClear (Mac) EthAcc service is not initialized\n");
  1832. return (IX_ETH_ACC_FAIL);
  1833. }
  1834. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1835. if (retStats == NULL)
  1836. {
  1837. printf("EthAcc: ixEthAccMibIIStatsGetClear (Mac) NULL argument\n");
  1838. return (IX_ETH_ACC_FAIL);
  1839. }
  1840. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1841. {
  1842. printf("EthAcc: ixEthAccMibIIStatsGetClear (Mac) NPE for port %d is not available\n", portId);
  1843. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot get and clear MIB II Stats.\n", (INT32)portId, 0, 0, 0, 0, 0);
  1844. /* Return all zero stats */
  1845. IX_ETH_ACC_MEMSET(retStats, 0, sizeof(IxEthEthObjStats));
  1846. return IX_ETH_ACC_SUCCESS ;
  1847. }
  1848. if (!IX_ETH_IS_PORT_INITIALIZED(portId))
  1849. {
  1850. printf("EthAcc: ixEthAccMibIIStatsGetClear (Mac) port %d is not initialized\n", portId);
  1851. return (IX_ETH_ACC_PORT_UNINITIALIZED);
  1852. }
  1853. IX_OSAL_CACHE_INVALIDATE(retStats, sizeof(IxEthEthObjStats));
  1854. message.data[0] = IX_ETHNPE_RESETSTATS << IX_ETH_ACC_MAC_MSGID_SHL;
  1855. message.data[1] = (UINT32) IX_OSAL_MMU_VIRT_TO_PHYS(retStats);
  1856. /* Permit only one task to request MIB statistics Get-Reset operation at a time */
  1857. ixOsalMutexLock(&ixEthAccMacState[portId].MIBStatsGetResetAccessLock, IX_OSAL_WAIT_FOREVER);
  1858. if(ixNpeMhMessageWithResponseSend(IX_ETH_ACC_PORT_TO_NPE_ID(portId),
  1859. message,
  1860. IX_ETHNPE_RESETSTATS,
  1861. ixEthAccMacNpeStatsResetMessageCallback,
  1862. IX_NPEMH_SEND_RETRIES_DEFAULT)
  1863. != IX_SUCCESS)
  1864. {
  1865. ixOsalMutexUnlock(&ixEthAccMacState[portId].MIBStatsGetResetAccessLock);
  1866. printf("EthAcc: (Mac) ixEthAccMibIIStatsGetClear failed to send NPE message\n");
  1867. return IX_ETH_ACC_FAIL;
  1868. }
  1869. /* Wait for callback invocation indicating response to this request */
  1870. ixOsalMutexLock(&ixEthAccMacState[portId].ackMIBStatsResetLock, IX_ETH_ACC_MIB_STATS_DELAY_MSECS);
  1871. /* permit other tasks to get and reset MIB stats*/
  1872. ixOsalMutexUnlock(&ixEthAccMacState[portId].MIBStatsGetResetAccessLock);
  1873. ixEthAccMibIIStatsEndianConvert(retStats);
  1874. return IX_ETH_ACC_SUCCESS;
  1875. }
  1876. IxEthAccStatus
  1877. ixEthAccMibIIStatsClear (IxEthAccPortId portId)
  1878. {
  1879. static IxEthEthObjStats retStats;
  1880. IxEthAccStatus status;
  1881. if (!IX_ETH_ACC_IS_SERVICE_INITIALIZED())
  1882. {
  1883. return (IX_ETH_ACC_FAIL);
  1884. }
  1885. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1886. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1887. {
  1888. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot clear MIB II Stats.\n",(INT32)portId,0,0,0,0,0);
  1889. return IX_ETH_ACC_SUCCESS ;
  1890. }
  1891. /* there is no reset operation without a corresponding Get */
  1892. status = ixEthAccMibIIStatsGetClear(portId, &retStats);
  1893. return status;
  1894. }
  1895. /* Initialize the ethernet MAC settings */
  1896. IxEthAccStatus
  1897. ixEthAccMacInit(IxEthAccPortId portId)
  1898. {
  1899. IX_OSAL_MBUF_POOL* portDisablePool;
  1900. UINT8 *data;
  1901. IX_ETH_ACC_VALIDATE_PORT_ID(portId);
  1902. if (IX_ETH_ACC_SUCCESS != ixEthAccSingleEthNpeCheck(portId))
  1903. {
  1904. IX_ETH_ACC_WARNING_LOG("EthAcc: Unavailable Eth %d: Cannot initialize Mac.\n",(INT32)portId,0,0,0,0,0);
  1905. return IX_ETH_ACC_SUCCESS ;
  1906. }
  1907. if(ixEthAccMacState[portId].macInitialised == FALSE)
  1908. {
  1909. ixEthAccMacState[portId].fullDuplex = TRUE;
  1910. ixEthAccMacState[portId].rxFCSAppend = TRUE;
  1911. ixEthAccMacState[portId].txFCSAppend = TRUE;
  1912. ixEthAccMacState[portId].txPADAppend = TRUE;
  1913. ixEthAccMacState[portId].enabled = FALSE;
  1914. ixEthAccMacState[portId].promiscuous = TRUE;
  1915. ixEthAccMacState[portId].joinAll = FALSE;
  1916. ixEthAccMacState[portId].initDone = FALSE;
  1917. ixEthAccMacState[portId].macInitialised = TRUE;
  1918. /* initialize MIB stats mutexes */
  1919. ixOsalMutexInit(&ixEthAccMacState[portId].ackMIBStatsLock);
  1920. ixOsalMutexLock(&ixEthAccMacState[portId].ackMIBStatsLock, IX_OSAL_WAIT_FOREVER);
  1921. ixOsalMutexInit(&ixEthAccMacState[portId].ackMIBStatsResetLock);
  1922. ixOsalMutexLock(&ixEthAccMacState[portId].ackMIBStatsResetLock, IX_OSAL_WAIT_FOREVER);
  1923. ixOsalMutexInit(&ixEthAccMacState[portId].MIBStatsGetAccessLock);
  1924. ixOsalMutexInit(&ixEthAccMacState[portId].MIBStatsGetResetAccessLock);
  1925. ixOsalMutexInit(&ixEthAccMacState[portId].npeLoopbackMessageLock);
  1926. ixEthAccMacState[portId].portDisableRxMbufPtr = NULL;
  1927. ixEthAccMacState[portId].portDisableTxMbufPtr = NULL;
  1928. portDisablePool = IX_OSAL_MBUF_POOL_INIT(2,
  1929. IX_ETHACC_RX_MBUF_MIN_SIZE,
  1930. "portDisable Pool");
  1931. IX_OSAL_ENSURE(portDisablePool != NULL, "Failed to initialize PortDisable pool");
  1932. ixEthAccMacState[portId].portDisableRxMbufPtr = IX_OSAL_MBUF_POOL_GET(portDisablePool);
  1933. ixEthAccMacState[portId].portDisableTxMbufPtr = IX_OSAL_MBUF_POOL_GET(portDisablePool);
  1934. IX_OSAL_ENSURE(ixEthAccMacState[portId].portDisableRxMbufPtr != NULL,
  1935. "Pool allocation failed");
  1936. IX_OSAL_ENSURE(ixEthAccMacState[portId].portDisableTxMbufPtr != NULL,
  1937. "Pool allocation failed");
  1938. /* fill the payload of the Rx mbuf used in portDisable */
  1939. IX_OSAL_MBUF_MLEN(ixEthAccMacState[portId].portDisableRxMbufPtr) = IX_ETHACC_RX_MBUF_MIN_SIZE;
  1940. memset(IX_OSAL_MBUF_MDATA(ixEthAccMacState[portId].portDisableRxMbufPtr),
  1941. 0xAA,
  1942. IX_ETHACC_RX_MBUF_MIN_SIZE);
  1943. /* fill the payload of the Tx mbuf used in portDisable (64 bytes) */
  1944. IX_OSAL_MBUF_MLEN(ixEthAccMacState[portId].portDisableTxMbufPtr) = 64;
  1945. IX_OSAL_MBUF_PKT_LEN(ixEthAccMacState[portId].portDisableTxMbufPtr) = 64;
  1946. data = (UINT8 *) IX_OSAL_MBUF_MDATA(ixEthAccMacState[portId].portDisableTxMbufPtr);
  1947. memset(data, 0xBB, 64);
  1948. data[0] = 0x00; /* unicast destination MAC address */
  1949. data[6] = 0x00; /* unicast source MAC address */
  1950. data[12] = 0x08; /* typelength : IP frame */
  1951. data[13] = 0x00; /* typelength : IP frame */
  1952. IX_OSAL_CACHE_FLUSH(data, 64);
  1953. }
  1954. IX_OSAL_ASSERT (ixEthAccMacBase[portId] != 0);
  1955. REG_WRITE(ixEthAccMacBase[portId],
  1956. IX_ETH_ACC_MAC_CORE_CNTRL,
  1957. IX_ETH_ACC_CORE_RESET);
  1958. ixOsalSleep(IX_ETH_ACC_MAC_RESET_DELAY);
  1959. REG_WRITE(ixEthAccMacBase[portId],
  1960. IX_ETH_ACC_MAC_CORE_CNTRL,
  1961. IX_ETH_ACC_CORE_MDC_EN);
  1962. REG_WRITE(ixEthAccMacBase[portId],
  1963. IX_ETH_ACC_MAC_INT_CLK_THRESH,
  1964. IX_ETH_ACC_MAC_INT_CLK_THRESH_DEFAULT);
  1965. ixEthAccMacStateUpdate(portId);
  1966. return IX_ETH_ACC_SUCCESS;
  1967. }
  1968. /* PRIVATE Functions*/
  1969. PRIVATE void
  1970. ixEthAccMacStateUpdate(IxEthAccPortId portId)
  1971. {
  1972. UINT32 regval;
  1973. if ( ixEthAccMacState[portId].enabled == FALSE )
  1974. {
  1975. /* Just disable both the transmitter and reciver in the MAC. */
  1976. REG_READ(ixEthAccMacBase[portId],
  1977. IX_ETH_ACC_MAC_RX_CNTRL1,
  1978. regval);
  1979. REG_WRITE(ixEthAccMacBase[portId],
  1980. IX_ETH_ACC_MAC_RX_CNTRL1,
  1981. regval & ~IX_ETH_ACC_RX_CNTRL1_RX_EN);
  1982. REG_READ(ixEthAccMacBase[portId],
  1983. IX_ETH_ACC_MAC_TX_CNTRL1,
  1984. regval);
  1985. REG_WRITE(ixEthAccMacBase[portId],
  1986. IX_ETH_ACC_MAC_TX_CNTRL1,
  1987. regval & ~IX_ETH_ACC_TX_CNTRL1_TX_EN);
  1988. }
  1989. if(ixEthAccMacState[portId].fullDuplex)
  1990. {
  1991. ixEthAccPortDuplexModeSetPriv (portId, IX_ETH_ACC_FULL_DUPLEX);
  1992. }
  1993. else
  1994. {
  1995. ixEthAccPortDuplexModeSetPriv (portId, IX_ETH_ACC_HALF_DUPLEX);
  1996. }
  1997. if(ixEthAccMacState[portId].rxFCSAppend)
  1998. {
  1999. ixEthAccPortRxFrameAppendFCSEnablePriv (portId);
  2000. }
  2001. else
  2002. {
  2003. ixEthAccPortRxFrameAppendFCSDisablePriv (portId);
  2004. }
  2005. if(ixEthAccMacState[portId].txFCSAppend)
  2006. {
  2007. ixEthAccPortTxFrameAppendFCSEnablePriv (portId);
  2008. }
  2009. else
  2010. {
  2011. ixEthAccPortTxFrameAppendFCSDisablePriv (portId);
  2012. }
  2013. if(ixEthAccMacState[portId].txPADAppend)
  2014. {
  2015. ixEthAccPortTxFrameAppendPaddingEnablePriv (portId);
  2016. }
  2017. else
  2018. {
  2019. ixEthAccPortTxFrameAppendPaddingDisablePriv (portId);
  2020. }
  2021. if(ixEthAccMacState[portId].promiscuous)
  2022. {
  2023. ixEthAccPortPromiscuousModeSetPriv(portId);
  2024. }
  2025. else
  2026. {
  2027. ixEthAccPortPromiscuousModeClearPriv(portId);
  2028. }
  2029. if ( ixEthAccMacState[portId].enabled == TRUE )
  2030. {
  2031. /* Enable both the transmitter and reciver in the MAC. */
  2032. REG_READ(ixEthAccMacBase[portId],
  2033. IX_ETH_ACC_MAC_RX_CNTRL1,
  2034. regval);
  2035. REG_WRITE(ixEthAccMacBase[portId],
  2036. IX_ETH_ACC_MAC_RX_CNTRL1,
  2037. regval | IX_ETH_ACC_RX_CNTRL1_RX_EN);
  2038. REG_READ(ixEthAccMacBase[portId],
  2039. IX_ETH_ACC_MAC_TX_CNTRL1,
  2040. regval);
  2041. REG_WRITE(ixEthAccMacBase[portId],
  2042. IX_ETH_ACC_MAC_TX_CNTRL1,
  2043. regval | IX_ETH_ACC_TX_CNTRL1_TX_EN);
  2044. }
  2045. }
  2046. PRIVATE BOOL
  2047. ixEthAccMacEqual(IxEthAccMacAddr *macAddr1,
  2048. IxEthAccMacAddr *macAddr2)
  2049. {
  2050. UINT32 i;
  2051. for(i=0;i<IX_IEEE803_MAC_ADDRESS_SIZE; i++)
  2052. {
  2053. if(macAddr1->macAddress[i] != macAddr2->macAddress[i])
  2054. {
  2055. return FALSE;
  2056. }
  2057. }
  2058. return TRUE;
  2059. }
  2060. PRIVATE void
  2061. ixEthAccMacPrint(IxEthAccMacAddr *m)
  2062. {
  2063. printf("%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x",
  2064. m->macAddress[0], m->macAddress[1],
  2065. m->macAddress[2], m->macAddress[3],
  2066. m->macAddress[4], m->macAddress[5]);
  2067. }
  2068. /* Set the multicast address and address mask registers
  2069. *
  2070. * A bit in the address mask register must be set if
  2071. * all multicast addresses always have that bit set, or if
  2072. * all multicast addresses always have that bit cleared.
  2073. *
  2074. * A bit in the address register must be set if all multicast
  2075. * addresses have that bit set, otherwise, it should be cleared
  2076. */
  2077. PRIVATE void
  2078. ixEthAccMulticastAddressSet(IxEthAccPortId portId)
  2079. {
  2080. UINT32 i;
  2081. UINT32 j;
  2082. IxEthAccMacAddr addressMask;
  2083. IxEthAccMacAddr address;
  2084. IxEthAccMacAddr alwaysClearBits;
  2085. IxEthAccMacAddr alwaysSetBits;
  2086. /* calculate alwaysClearBits and alwaysSetBits:
  2087. * alwaysClearBits is calculated by ORing all
  2088. * multicast addresses, those bits that are always
  2089. * clear are clear in the result
  2090. *
  2091. * alwaysSetBits is calculated by ANDing all
  2092. * multicast addresses, those bits that are always set
  2093. * are set in the result
  2094. */
  2095. if (ixEthAccMacState[portId].promiscuous == TRUE)
  2096. {
  2097. /* Promiscuous Mode is set, and filtering
  2098. * allow all packets, and enable the mcast and
  2099. * bcast detection.
  2100. */
  2101. memset(&addressMask.macAddress,
  2102. 0,
  2103. IX_IEEE803_MAC_ADDRESS_SIZE);
  2104. memset(&address.macAddress,
  2105. 0,
  2106. IX_IEEE803_MAC_ADDRESS_SIZE);
  2107. }
  2108. else
  2109. {
  2110. if(ixEthAccMacState[portId].joinAll == TRUE)
  2111. {
  2112. /* Join all is set. The mask and address are
  2113. * the multicast settings.
  2114. */
  2115. IxEthAccMacAddr macAddr = {{0x1,0x0,0x0,0x0,0x0,0x0}};
  2116. memcpy(addressMask.macAddress,
  2117. macAddr.macAddress,
  2118. IX_IEEE803_MAC_ADDRESS_SIZE);
  2119. memcpy(address.macAddress,
  2120. macAddr.macAddress,
  2121. IX_IEEE803_MAC_ADDRESS_SIZE);
  2122. }
  2123. else if(ixEthAccMacState[portId].mcastAddrIndex == 0)
  2124. {
  2125. /* No entry in the filtering database,
  2126. * Promiscuous Mode is cleared, Broadcast filtering
  2127. * is configured.
  2128. */
  2129. memset(addressMask.macAddress,
  2130. IX_ETH_ACC_MAC_ALL_BITS_SET,
  2131. IX_IEEE803_MAC_ADDRESS_SIZE);
  2132. memset(address.macAddress,
  2133. IX_ETH_ACC_MAC_ALL_BITS_SET,
  2134. IX_IEEE803_MAC_ADDRESS_SIZE);
  2135. }
  2136. else
  2137. {
  2138. /* build a mask and an address which mix all entreis
  2139. * from the list of multicast addresses
  2140. */
  2141. memset(alwaysClearBits.macAddress,
  2142. 0,
  2143. IX_IEEE803_MAC_ADDRESS_SIZE);
  2144. memset(alwaysSetBits.macAddress,
  2145. IX_ETH_ACC_MAC_ALL_BITS_SET,
  2146. IX_IEEE803_MAC_ADDRESS_SIZE);
  2147. for(i=0;i<ixEthAccMacState[portId].mcastAddrIndex;i++)
  2148. {
  2149. for(j=0;j<IX_IEEE803_MAC_ADDRESS_SIZE;j++)
  2150. {
  2151. alwaysClearBits.macAddress[j] |=
  2152. ixEthAccMacState[portId].mcastAddrsTable[i].macAddress[j];
  2153. alwaysSetBits.macAddress[j] &=
  2154. ixEthAccMacState[portId].mcastAddrsTable[i].macAddress[j];
  2155. }
  2156. }
  2157. for(i=0;i<IX_IEEE803_MAC_ADDRESS_SIZE;i++)
  2158. {
  2159. addressMask.macAddress[i] = alwaysSetBits.macAddress[i]
  2160. | ~alwaysClearBits.macAddress[i];
  2161. address.macAddress[i] = alwaysSetBits.macAddress[i];
  2162. }
  2163. }
  2164. }
  2165. /*write the new addr filtering to h/w*/
  2166. for(i=0;i<IX_IEEE803_MAC_ADDRESS_SIZE;i++)
  2167. {
  2168. REG_WRITE(ixEthAccMacBase[portId],
  2169. IX_ETH_ACC_MAC_ADDR_MASK_1+i*sizeof(UINT32),
  2170. addressMask.macAddress[i]);
  2171. REG_WRITE(ixEthAccMacBase[portId],
  2172. IX_ETH_ACC_MAC_ADDR_1+i*sizeof(UINT32),
  2173. address.macAddress[i]);
  2174. }
  2175. }