4xx_enet.c 52 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804
  1. /*-----------------------------------------------------------------------------+
  2. *
  3. * This source code has been made available to you by IBM on an AS-IS
  4. * basis. Anyone receiving this source is licensed under IBM
  5. * copyrights to use it in any way he or she deems fit, including
  6. * copying it, modifying it, compiling it, and redistributing it either
  7. * with or without modifications. No license under IBM patents or
  8. * patent applications is to be implied by the copyright license.
  9. *
  10. * Any user of this software should understand that IBM cannot provide
  11. * technical support for this software and will not be responsible for
  12. * any consequences resulting from the use of this software.
  13. *
  14. * Any person who transfers this source code or any derivative work
  15. * must include the IBM copyright notice, this paragraph, and the
  16. * preceding two paragraphs in the transferred software.
  17. *
  18. * COPYRIGHT I B M CORPORATION 1995
  19. * LICENSED MATERIAL - PROGRAM PROPERTY OF I B M
  20. *-----------------------------------------------------------------------------*/
  21. /*-----------------------------------------------------------------------------+
  22. *
  23. * File Name: enetemac.c
  24. *
  25. * Function: Device driver for the ethernet EMAC3 macro on the 405GP.
  26. *
  27. * Author: Mark Wisner
  28. *
  29. * Change Activity-
  30. *
  31. * Date Description of Change BY
  32. * --------- --------------------- ---
  33. * 05-May-99 Created MKW
  34. * 27-Jun-99 Clean up JWB
  35. * 16-Jul-99 Added MAL error recovery and better IP packet handling MKW
  36. * 29-Jul-99 Added Full duplex support MKW
  37. * 06-Aug-99 Changed names for Mal CR reg MKW
  38. * 23-Aug-99 Turned off SYE when running at 10Mbs MKW
  39. * 24-Aug-99 Marked descriptor empty after call_xlc MKW
  40. * 07-Sep-99 Set MAL RX buffer size reg to ENET_MAX_MTU_ALIGNED / 16 MCG
  41. * to avoid chaining maximum sized packets. Push starting
  42. * RX descriptor address up to the next cache line boundary.
  43. * 16-Jan-00 Added support for booting with IP of 0x0 MKW
  44. * 15-Mar-00 Updated enetInit() to enable broadcast addresses in the
  45. * EMAC_RXM register. JWB
  46. * 12-Mar-01 anne-sophie.harnois@nextream.fr
  47. * - Variables are compatible with those already defined in
  48. * include/net.h
  49. * - Receive buffer descriptor ring is used to send buffers
  50. * to the user
  51. * - Info print about send/received/handled packet number if
  52. * INFO_405_ENET is set
  53. * 17-Apr-01 stefan.roese@esd-electronics.com
  54. * - MAL reset in "eth_halt" included
  55. * - Enet speed and duplex output now in one line
  56. * 08-May-01 stefan.roese@esd-electronics.com
  57. * - MAL error handling added (eth_init called again)
  58. * 13-Nov-01 stefan.roese@esd-electronics.com
  59. * - Set IST bit in EMAC_M1 reg upon 100MBit or full duplex
  60. * 04-Jan-02 stefan.roese@esd-electronics.com
  61. * - Wait for PHY auto negotiation to complete added
  62. * 06-Feb-02 stefan.roese@esd-electronics.com
  63. * - Bug fixed in waiting for auto negotiation to complete
  64. * 26-Feb-02 stefan.roese@esd-electronics.com
  65. * - rx and tx buffer descriptors now allocated (no fixed address
  66. * used anymore)
  67. * 17-Jun-02 stefan.roese@esd-electronics.com
  68. * - MAL error debug printf 'M' removed (rx de interrupt may
  69. * occur upon many incoming packets with only 4 rx buffers).
  70. *-----------------------------------------------------------------------------*
  71. * 17-Nov-03 travis.sawyer@sandburst.com
  72. * - ported from 405gp_enet.c to utilized upto 4 EMAC ports
  73. * in the 440GX. This port should work with the 440GP
  74. * (2 EMACs) also
  75. * 15-Aug-05 sr@denx.de
  76. * - merged 405gp_enet.c and 440gx_enet.c to generic 4xx_enet.c
  77. now handling all 4xx cpu's.
  78. *-----------------------------------------------------------------------------*/
  79. #include <config.h>
  80. #include <common.h>
  81. #include <net.h>
  82. #include <asm/processor.h>
  83. #include <asm/io.h>
  84. #include <asm/cache.h>
  85. #include <asm/mmu.h>
  86. #include <commproc.h>
  87. #include <ppc4xx.h>
  88. #include <ppc4xx_enet.h>
  89. #include <405_mal.h>
  90. #include <miiphy.h>
  91. #include <malloc.h>
  92. #include "vecnum.h"
  93. /*
  94. * Only compile for platform with AMCC EMAC ethernet controller and
  95. * network support enabled.
  96. * Remark: CONFIG_405 describes Xilinx PPC405 FPGA without EMAC controller!
  97. */
  98. #if defined(CONFIG_CMD_NET) && !defined(CONFIG_405) && !defined(CONFIG_IOP480)
  99. #if !(defined(CONFIG_MII) || defined(CONFIG_CMD_MII))
  100. #error "CONFIG_MII has to be defined!"
  101. #endif
  102. #if defined(CONFIG_NETCONSOLE) && !defined(CONFIG_NET_MULTI)
  103. #error "CONFIG_NET_MULTI has to be defined for NetConsole"
  104. #endif
  105. #define EMAC_RESET_TIMEOUT 1000 /* 1000 ms reset timeout */
  106. #define PHY_AUTONEGOTIATE_TIMEOUT 5000 /* 5000 ms autonegotiate timeout */
  107. /* Ethernet Transmit and Receive Buffers */
  108. /* AS.HARNOIS
  109. * In the same way ENET_MAX_MTU and ENET_MAX_MTU_ALIGNED are set from
  110. * PKTSIZE and PKTSIZE_ALIGN (include/net.h)
  111. */
  112. #define ENET_MAX_MTU PKTSIZE
  113. #define ENET_MAX_MTU_ALIGNED PKTSIZE_ALIGN
  114. /*-----------------------------------------------------------------------------+
  115. * Defines for MAL/EMAC interrupt conditions as reported in the UIC (Universal
  116. * Interrupt Controller).
  117. *-----------------------------------------------------------------------------*/
  118. #define MAL_UIC_ERR ( UIC_MAL_SERR | UIC_MAL_TXDE | UIC_MAL_RXDE)
  119. #define MAL_UIC_DEF (UIC_MAL_RXEOB | MAL_UIC_ERR)
  120. #define EMAC_UIC_DEF UIC_ENET
  121. #define EMAC_UIC_DEF1 UIC_ENET1
  122. #define SEL_UIC_DEF(p) (p ? UIC_ENET1 : UIC_ENET )
  123. #undef INFO_4XX_ENET
  124. #define BI_PHYMODE_NONE 0
  125. #define BI_PHYMODE_ZMII 1
  126. #define BI_PHYMODE_RGMII 2
  127. #define BI_PHYMODE_GMII 3
  128. #define BI_PHYMODE_RTBI 4
  129. #define BI_PHYMODE_TBI 5
  130. #if defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  131. defined(CONFIG_405EX)
  132. #define BI_PHYMODE_SMII 6
  133. #define BI_PHYMODE_MII 7
  134. #endif
  135. #if defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
  136. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  137. defined(CONFIG_405EX)
  138. #define SDR0_MFR_ETH_CLK_SEL_V(n) ((0x01<<27) / (n+1))
  139. #endif
  140. /*-----------------------------------------------------------------------------+
  141. * Global variables. TX and RX descriptors and buffers.
  142. *-----------------------------------------------------------------------------*/
  143. /* IER globals */
  144. static uint32_t mal_ier;
  145. #if !defined(CONFIG_NET_MULTI)
  146. struct eth_device *emac0_dev = NULL;
  147. #endif
  148. /*
  149. * Get count of EMAC devices (doesn't have to be the max. possible number
  150. * supported by the cpu)
  151. *
  152. * CONFIG_BOARD_EMAC_COUNT added so now a "dynamic" way to configure the
  153. * EMAC count is possible. As it is needed for the Kilauea/Haleakala
  154. * 405EX/405EXr eval board, using the same binary.
  155. */
  156. #if defined(CONFIG_BOARD_EMAC_COUNT)
  157. #define LAST_EMAC_NUM board_emac_count()
  158. #else /* CONFIG_BOARD_EMAC_COUNT */
  159. #if defined(CONFIG_HAS_ETH3)
  160. #define LAST_EMAC_NUM 4
  161. #elif defined(CONFIG_HAS_ETH2)
  162. #define LAST_EMAC_NUM 3
  163. #elif defined(CONFIG_HAS_ETH1)
  164. #define LAST_EMAC_NUM 2
  165. #else
  166. #define LAST_EMAC_NUM 1
  167. #endif
  168. #endif /* CONFIG_BOARD_EMAC_COUNT */
  169. /* normal boards start with EMAC0 */
  170. #if !defined(CONFIG_EMAC_NR_START)
  171. #define CONFIG_EMAC_NR_START 0
  172. #endif
  173. #if defined(CONFIG_405EX) || defined(CONFIG_440EPX)
  174. #define ETH_IRQ_NUM(dev) (VECNUM_ETH0 + ((dev)))
  175. #else
  176. #define ETH_IRQ_NUM(dev) (VECNUM_ETH0 + ((dev) * 2))
  177. #endif
  178. #define MAL_RX_DESC_SIZE 2048
  179. #define MAL_TX_DESC_SIZE 2048
  180. #define MAL_ALLOC_SIZE (MAL_TX_DESC_SIZE + MAL_RX_DESC_SIZE)
  181. /*-----------------------------------------------------------------------------+
  182. * Prototypes and externals.
  183. *-----------------------------------------------------------------------------*/
  184. static void enet_rcv (struct eth_device *dev, unsigned long malisr);
  185. int enetInt (struct eth_device *dev);
  186. static void mal_err (struct eth_device *dev, unsigned long isr,
  187. unsigned long uic, unsigned long maldef,
  188. unsigned long mal_errr);
  189. static void emac_err (struct eth_device *dev, unsigned long isr);
  190. extern int phy_setup_aneg (char *devname, unsigned char addr);
  191. extern int emac4xx_miiphy_read (char *devname, unsigned char addr,
  192. unsigned char reg, unsigned short *value);
  193. extern int emac4xx_miiphy_write (char *devname, unsigned char addr,
  194. unsigned char reg, unsigned short value);
  195. int board_emac_count(void);
  196. /*-----------------------------------------------------------------------------+
  197. | ppc_4xx_eth_halt
  198. | Disable MAL channel, and EMACn
  199. +-----------------------------------------------------------------------------*/
  200. static void ppc_4xx_eth_halt (struct eth_device *dev)
  201. {
  202. EMAC_4XX_HW_PST hw_p = dev->priv;
  203. uint32_t failsafe = 10000;
  204. #if defined(CONFIG_440SPE) || \
  205. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  206. defined(CONFIG_405EX)
  207. unsigned long mfr;
  208. #endif
  209. out_be32((void *)EMAC_IER + hw_p->hw_addr, 0x00000000); /* disable emac interrupts */
  210. /* 1st reset MAL channel */
  211. /* Note: writing a 0 to a channel has no effect */
  212. #if defined(CONFIG_405EP) || defined(CONFIG_440EP) || defined(CONFIG_440GR)
  213. mtdcr (maltxcarr, (MAL_CR_MMSR >> (hw_p->devnum * 2)));
  214. #else
  215. mtdcr (maltxcarr, (MAL_CR_MMSR >> hw_p->devnum));
  216. #endif
  217. mtdcr (malrxcarr, (MAL_CR_MMSR >> hw_p->devnum));
  218. /* wait for reset */
  219. while (mfdcr (malrxcasr) & (MAL_CR_MMSR >> hw_p->devnum)) {
  220. udelay (1000); /* Delay 1 MS so as not to hammer the register */
  221. failsafe--;
  222. if (failsafe == 0)
  223. break;
  224. }
  225. /* EMAC RESET */
  226. #if defined(CONFIG_440SPE) || \
  227. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  228. defined(CONFIG_405EX)
  229. /* provide clocks for EMAC internal loopback */
  230. mfsdr (sdr_mfr, mfr);
  231. mfr |= SDR0_MFR_ETH_CLK_SEL_V(hw_p->devnum);
  232. mtsdr(sdr_mfr, mfr);
  233. #endif
  234. out_be32((void *)EMAC_M0 + hw_p->hw_addr, EMAC_M0_SRST);
  235. #if defined(CONFIG_440SPE) || \
  236. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  237. defined(CONFIG_405EX)
  238. /* remove clocks for EMAC internal loopback */
  239. mfsdr (sdr_mfr, mfr);
  240. mfr &= ~SDR0_MFR_ETH_CLK_SEL_V(hw_p->devnum);
  241. mtsdr(sdr_mfr, mfr);
  242. #endif
  243. #ifndef CONFIG_NETCONSOLE
  244. hw_p->print_speed = 1; /* print speed message again next time */
  245. #endif
  246. return;
  247. }
  248. #if defined (CONFIG_440GX)
  249. int ppc_4xx_eth_setup_bridge(int devnum, bd_t * bis)
  250. {
  251. unsigned long pfc1;
  252. unsigned long zmiifer;
  253. unsigned long rmiifer;
  254. mfsdr(sdr_pfc1, pfc1);
  255. pfc1 = SDR0_PFC1_EPS_DECODE(pfc1);
  256. zmiifer = 0;
  257. rmiifer = 0;
  258. switch (pfc1) {
  259. case 1:
  260. zmiifer |= ZMII_FER_RMII << ZMII_FER_V(0);
  261. zmiifer |= ZMII_FER_RMII << ZMII_FER_V(1);
  262. zmiifer |= ZMII_FER_RMII << ZMII_FER_V(2);
  263. zmiifer |= ZMII_FER_RMII << ZMII_FER_V(3);
  264. bis->bi_phymode[0] = BI_PHYMODE_ZMII;
  265. bis->bi_phymode[1] = BI_PHYMODE_ZMII;
  266. bis->bi_phymode[2] = BI_PHYMODE_ZMII;
  267. bis->bi_phymode[3] = BI_PHYMODE_ZMII;
  268. break;
  269. case 2:
  270. zmiifer |= ZMII_FER_SMII << ZMII_FER_V(0);
  271. zmiifer |= ZMII_FER_SMII << ZMII_FER_V(1);
  272. zmiifer |= ZMII_FER_SMII << ZMII_FER_V(2);
  273. zmiifer |= ZMII_FER_SMII << ZMII_FER_V(3);
  274. bis->bi_phymode[0] = BI_PHYMODE_ZMII;
  275. bis->bi_phymode[1] = BI_PHYMODE_ZMII;
  276. bis->bi_phymode[2] = BI_PHYMODE_ZMII;
  277. bis->bi_phymode[3] = BI_PHYMODE_ZMII;
  278. break;
  279. case 3:
  280. zmiifer |= ZMII_FER_RMII << ZMII_FER_V(0);
  281. rmiifer |= RGMII_FER_RGMII << RGMII_FER_V(2);
  282. bis->bi_phymode[0] = BI_PHYMODE_ZMII;
  283. bis->bi_phymode[1] = BI_PHYMODE_NONE;
  284. bis->bi_phymode[2] = BI_PHYMODE_RGMII;
  285. bis->bi_phymode[3] = BI_PHYMODE_NONE;
  286. break;
  287. case 4:
  288. zmiifer |= ZMII_FER_SMII << ZMII_FER_V(0);
  289. zmiifer |= ZMII_FER_SMII << ZMII_FER_V(1);
  290. rmiifer |= RGMII_FER_RGMII << RGMII_FER_V (2);
  291. rmiifer |= RGMII_FER_RGMII << RGMII_FER_V (3);
  292. bis->bi_phymode[0] = BI_PHYMODE_ZMII;
  293. bis->bi_phymode[1] = BI_PHYMODE_ZMII;
  294. bis->bi_phymode[2] = BI_PHYMODE_RGMII;
  295. bis->bi_phymode[3] = BI_PHYMODE_RGMII;
  296. break;
  297. case 5:
  298. zmiifer |= ZMII_FER_SMII << ZMII_FER_V (0);
  299. zmiifer |= ZMII_FER_SMII << ZMII_FER_V (1);
  300. zmiifer |= ZMII_FER_SMII << ZMII_FER_V (2);
  301. rmiifer |= RGMII_FER_RGMII << RGMII_FER_V(3);
  302. bis->bi_phymode[0] = BI_PHYMODE_ZMII;
  303. bis->bi_phymode[1] = BI_PHYMODE_ZMII;
  304. bis->bi_phymode[2] = BI_PHYMODE_ZMII;
  305. bis->bi_phymode[3] = BI_PHYMODE_RGMII;
  306. break;
  307. case 6:
  308. zmiifer |= ZMII_FER_SMII << ZMII_FER_V (0);
  309. zmiifer |= ZMII_FER_SMII << ZMII_FER_V (1);
  310. rmiifer |= RGMII_FER_RGMII << RGMII_FER_V(2);
  311. bis->bi_phymode[0] = BI_PHYMODE_ZMII;
  312. bis->bi_phymode[1] = BI_PHYMODE_ZMII;
  313. bis->bi_phymode[2] = BI_PHYMODE_RGMII;
  314. break;
  315. case 0:
  316. default:
  317. zmiifer = ZMII_FER_MII << ZMII_FER_V(devnum);
  318. rmiifer = 0x0;
  319. bis->bi_phymode[0] = BI_PHYMODE_ZMII;
  320. bis->bi_phymode[1] = BI_PHYMODE_ZMII;
  321. bis->bi_phymode[2] = BI_PHYMODE_ZMII;
  322. bis->bi_phymode[3] = BI_PHYMODE_ZMII;
  323. break;
  324. }
  325. /* Ensure we setup mdio for this devnum and ONLY this devnum */
  326. zmiifer |= (ZMII_FER_MDI) << ZMII_FER_V(devnum);
  327. out_be32((void *)ZMII_FER, zmiifer);
  328. out_be32((void *)RGMII_FER, rmiifer);
  329. return ((int)pfc1);
  330. }
  331. #endif /* CONFIG_440_GX */
  332. #if defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
  333. int ppc_4xx_eth_setup_bridge(int devnum, bd_t * bis)
  334. {
  335. unsigned long zmiifer=0x0;
  336. unsigned long pfc1;
  337. mfsdr(sdr_pfc1, pfc1);
  338. pfc1 &= SDR0_PFC1_SELECT_MASK;
  339. switch (pfc1) {
  340. case SDR0_PFC1_SELECT_CONFIG_2:
  341. /* 1 x GMII port */
  342. out_be32((void *)ZMII_FER, 0x00);
  343. out_be32((void *)RGMII_FER, 0x00000037);
  344. bis->bi_phymode[0] = BI_PHYMODE_GMII;
  345. bis->bi_phymode[1] = BI_PHYMODE_NONE;
  346. break;
  347. case SDR0_PFC1_SELECT_CONFIG_4:
  348. /* 2 x RGMII ports */
  349. out_be32((void *)ZMII_FER, 0x00);
  350. out_be32((void *)RGMII_FER, 0x00000055);
  351. bis->bi_phymode[0] = BI_PHYMODE_RGMII;
  352. bis->bi_phymode[1] = BI_PHYMODE_RGMII;
  353. break;
  354. case SDR0_PFC1_SELECT_CONFIG_6:
  355. /* 2 x SMII ports */
  356. out_be32((void *)ZMII_FER,
  357. ((ZMII_FER_SMII) << ZMII_FER_V(0)) |
  358. ((ZMII_FER_SMII) << ZMII_FER_V(1)));
  359. out_be32((void *)RGMII_FER, 0x00000000);
  360. bis->bi_phymode[0] = BI_PHYMODE_SMII;
  361. bis->bi_phymode[1] = BI_PHYMODE_SMII;
  362. break;
  363. case SDR0_PFC1_SELECT_CONFIG_1_2:
  364. /* only 1 x MII supported */
  365. out_be32((void *)ZMII_FER, (ZMII_FER_MII) << ZMII_FER_V(0));
  366. out_be32((void *)RGMII_FER, 0x00000000);
  367. bis->bi_phymode[0] = BI_PHYMODE_MII;
  368. bis->bi_phymode[1] = BI_PHYMODE_NONE;
  369. break;
  370. default:
  371. break;
  372. }
  373. /* Ensure we setup mdio for this devnum and ONLY this devnum */
  374. zmiifer = in_be32((void *)ZMII_FER);
  375. zmiifer |= (ZMII_FER_MDI) << ZMII_FER_V(devnum);
  376. out_be32((void *)ZMII_FER, zmiifer);
  377. return ((int)0x0);
  378. }
  379. #endif /* CONFIG_440EPX */
  380. #if defined(CONFIG_405EX)
  381. int ppc_4xx_eth_setup_bridge(int devnum, bd_t * bis)
  382. {
  383. u32 gmiifer = 0;
  384. /*
  385. * Right now only 2*RGMII is supported. Please extend when needed.
  386. * sr - 2007-09-19
  387. */
  388. switch (1) {
  389. case 1:
  390. /* 2 x RGMII ports */
  391. out_be32((void *)RGMII_FER, 0x00000055);
  392. bis->bi_phymode[0] = BI_PHYMODE_RGMII;
  393. bis->bi_phymode[1] = BI_PHYMODE_RGMII;
  394. break;
  395. case 2:
  396. /* 2 x SMII ports */
  397. break;
  398. default:
  399. break;
  400. }
  401. /* Ensure we setup mdio for this devnum and ONLY this devnum */
  402. gmiifer = in_be32((void *)RGMII_FER);
  403. gmiifer |= (1 << (19-devnum));
  404. out_be32((void *)RGMII_FER, gmiifer);
  405. return ((int)0x0);
  406. }
  407. #endif /* CONFIG_405EX */
  408. static inline void *malloc_aligned(u32 size, u32 align)
  409. {
  410. return (void *)(((u32)malloc(size + align) + align - 1) &
  411. ~(align - 1));
  412. }
  413. static int ppc_4xx_eth_init (struct eth_device *dev, bd_t * bis)
  414. {
  415. int i;
  416. unsigned long reg = 0;
  417. unsigned long msr;
  418. unsigned long speed;
  419. unsigned long duplex;
  420. unsigned long failsafe;
  421. unsigned mode_reg;
  422. unsigned short devnum;
  423. unsigned short reg_short;
  424. #if defined(CONFIG_440GX) || \
  425. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  426. defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
  427. defined(CONFIG_405EX)
  428. sys_info_t sysinfo;
  429. #if defined(CONFIG_440GX) || defined(CONFIG_440SPE) || \
  430. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  431. defined(CONFIG_405EX)
  432. int ethgroup = -1;
  433. #endif
  434. #endif
  435. #if defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  436. defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
  437. defined(CONFIG_405EX)
  438. unsigned long mfr;
  439. #endif
  440. u32 bd_cached;
  441. u32 bd_uncached = 0;
  442. EMAC_4XX_HW_PST hw_p = dev->priv;
  443. /* before doing anything, figure out if we have a MAC address */
  444. /* if not, bail */
  445. if (memcmp (dev->enetaddr, "\0\0\0\0\0\0", 6) == 0) {
  446. printf("ERROR: ethaddr not set!\n");
  447. return -1;
  448. }
  449. #if defined(CONFIG_440GX) || \
  450. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  451. defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
  452. defined(CONFIG_405EX)
  453. /* Need to get the OPB frequency so we can access the PHY */
  454. get_sys_info (&sysinfo);
  455. #endif
  456. msr = mfmsr ();
  457. mtmsr (msr & ~(MSR_EE)); /* disable interrupts */
  458. devnum = hw_p->devnum;
  459. #ifdef INFO_4XX_ENET
  460. /* AS.HARNOIS
  461. * We should have :
  462. * hw_p->stats.pkts_handled <= hw_p->stats.pkts_rx <= hw_p->stats.pkts_handled+PKTBUFSRX
  463. * In the most cases hw_p->stats.pkts_handled = hw_p->stats.pkts_rx, but it
  464. * is possible that new packets (without relationship with
  465. * current transfer) have got the time to arrived before
  466. * netloop calls eth_halt
  467. */
  468. printf ("About preceeding transfer (eth%d):\n"
  469. "- Sent packet number %d\n"
  470. "- Received packet number %d\n"
  471. "- Handled packet number %d\n",
  472. hw_p->devnum,
  473. hw_p->stats.pkts_tx,
  474. hw_p->stats.pkts_rx, hw_p->stats.pkts_handled);
  475. hw_p->stats.pkts_tx = 0;
  476. hw_p->stats.pkts_rx = 0;
  477. hw_p->stats.pkts_handled = 0;
  478. hw_p->print_speed = 1; /* print speed message again next time */
  479. #endif
  480. hw_p->tx_err_index = 0; /* Transmit Error Index for tx_err_log */
  481. hw_p->rx_err_index = 0; /* Receive Error Index for rx_err_log */
  482. hw_p->rx_slot = 0; /* MAL Receive Slot */
  483. hw_p->rx_i_index = 0; /* Receive Interrupt Queue Index */
  484. hw_p->rx_u_index = 0; /* Receive User Queue Index */
  485. hw_p->tx_slot = 0; /* MAL Transmit Slot */
  486. hw_p->tx_i_index = 0; /* Transmit Interrupt Queue Index */
  487. hw_p->tx_u_index = 0; /* Transmit User Queue Index */
  488. #if defined(CONFIG_440) && !defined(CONFIG_440SP) && !defined(CONFIG_440SPE)
  489. /* set RMII mode */
  490. /* NOTE: 440GX spec states that mode is mutually exclusive */
  491. /* NOTE: Therefore, disable all other EMACS, since we handle */
  492. /* NOTE: only one emac at a time */
  493. reg = 0;
  494. out_be32((void *)ZMII_FER, 0);
  495. udelay (100);
  496. #if defined(CONFIG_440EP) || defined(CONFIG_440GR)
  497. out_be32((void *)ZMII_FER, (ZMII_FER_RMII | ZMII_FER_MDI) << ZMII_FER_V (devnum));
  498. #elif defined(CONFIG_440GX) || defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
  499. ethgroup = ppc_4xx_eth_setup_bridge(devnum, bis);
  500. #elif defined(CONFIG_440GP)
  501. /* set RMII mode */
  502. out_be32((void *)ZMII_FER, ZMII_RMII | ZMII_MDI0);
  503. #else
  504. if ((devnum == 0) || (devnum == 1)) {
  505. out_be32((void *)ZMII_FER, (ZMII_FER_SMII | ZMII_FER_MDI) << ZMII_FER_V (devnum));
  506. } else { /* ((devnum == 2) || (devnum == 3)) */
  507. out_be32((void *)ZMII_FER, ZMII_FER_MDI << ZMII_FER_V (devnum));
  508. out_be32((void *)RGMII_FER, ((RGMII_FER_RGMII << RGMII_FER_V (2)) |
  509. (RGMII_FER_RGMII << RGMII_FER_V (3))));
  510. }
  511. #endif
  512. out_be32((void *)ZMII_SSR, ZMII_SSR_SP << ZMII_SSR_V(devnum));
  513. #endif /* defined(CONFIG_440) && !defined(CONFIG_440SP) */
  514. #if defined(CONFIG_405EX)
  515. ethgroup = ppc_4xx_eth_setup_bridge(devnum, bis);
  516. #endif
  517. __asm__ volatile ("eieio");
  518. /* reset emac so we have access to the phy */
  519. #if defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
  520. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  521. defined(CONFIG_405EX)
  522. /* provide clocks for EMAC internal loopback */
  523. mfsdr (sdr_mfr, mfr);
  524. mfr |= SDR0_MFR_ETH_CLK_SEL_V(devnum);
  525. mtsdr(sdr_mfr, mfr);
  526. #endif
  527. out_be32((void *)EMAC_M0 + hw_p->hw_addr, EMAC_M0_SRST);
  528. failsafe = 1000;
  529. while ((in_be32((void *)EMAC_M0 + hw_p->hw_addr) & (EMAC_M0_SRST)) && failsafe) {
  530. udelay (1000);
  531. failsafe--;
  532. }
  533. if (failsafe <= 0)
  534. printf("\nProblem resetting EMAC!\n");
  535. #if defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
  536. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  537. defined(CONFIG_405EX)
  538. /* remove clocks for EMAC internal loopback */
  539. mfsdr (sdr_mfr, mfr);
  540. mfr &= ~SDR0_MFR_ETH_CLK_SEL_V(devnum);
  541. mtsdr(sdr_mfr, mfr);
  542. #endif
  543. #if defined(CONFIG_440GX) || \
  544. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  545. defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
  546. defined(CONFIG_405EX)
  547. /* Whack the M1 register */
  548. mode_reg = 0x0;
  549. mode_reg &= ~0x00000038;
  550. if (sysinfo.freqOPB <= 50000000);
  551. else if (sysinfo.freqOPB <= 66666667)
  552. mode_reg |= EMAC_M1_OBCI_66;
  553. else if (sysinfo.freqOPB <= 83333333)
  554. mode_reg |= EMAC_M1_OBCI_83;
  555. else if (sysinfo.freqOPB <= 100000000)
  556. mode_reg |= EMAC_M1_OBCI_100;
  557. else
  558. mode_reg |= EMAC_M1_OBCI_GT100;
  559. out_be32((void *)EMAC_M1 + hw_p->hw_addr, mode_reg);
  560. #endif /* defined(CONFIG_440GX) || defined(CONFIG_440SP) */
  561. /* wait for PHY to complete auto negotiation */
  562. reg_short = 0;
  563. #ifndef CONFIG_CS8952_PHY
  564. switch (devnum) {
  565. case 0:
  566. reg = CONFIG_PHY_ADDR;
  567. break;
  568. #if defined (CONFIG_PHY1_ADDR)
  569. case 1:
  570. reg = CONFIG_PHY1_ADDR;
  571. break;
  572. #endif
  573. #if defined (CONFIG_440GX)
  574. case 2:
  575. reg = CONFIG_PHY2_ADDR;
  576. break;
  577. case 3:
  578. reg = CONFIG_PHY3_ADDR;
  579. break;
  580. #endif
  581. default:
  582. reg = CONFIG_PHY_ADDR;
  583. break;
  584. }
  585. bis->bi_phynum[devnum] = reg;
  586. #if defined(CONFIG_PHY_RESET)
  587. /*
  588. * Reset the phy, only if its the first time through
  589. * otherwise, just check the speeds & feeds
  590. */
  591. if (hw_p->first_init == 0) {
  592. #if defined(CONFIG_M88E1111_PHY)
  593. miiphy_write (dev->name, reg, 0x14, 0x0ce3);
  594. miiphy_write (dev->name, reg, 0x18, 0x4101);
  595. miiphy_write (dev->name, reg, 0x09, 0x0e00);
  596. miiphy_write (dev->name, reg, 0x04, 0x01e1);
  597. #endif
  598. miiphy_reset (dev->name, reg);
  599. #if defined(CONFIG_440GX) || \
  600. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  601. defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
  602. defined(CONFIG_405EX)
  603. #if defined(CONFIG_CIS8201_PHY)
  604. /*
  605. * Cicada 8201 PHY needs to have an extended register whacked
  606. * for RGMII mode.
  607. */
  608. if (((devnum == 2) || (devnum == 3)) && (4 == ethgroup)) {
  609. #if defined(CONFIG_CIS8201_SHORT_ETCH)
  610. miiphy_write (dev->name, reg, 23, 0x1300);
  611. #else
  612. miiphy_write (dev->name, reg, 23, 0x1000);
  613. #endif
  614. /*
  615. * Vitesse VSC8201/Cicada CIS8201 errata:
  616. * Interoperability problem with Intel 82547EI phys
  617. * This work around (provided by Vitesse) changes
  618. * the default timer convergence from 8ms to 12ms
  619. */
  620. miiphy_write (dev->name, reg, 0x1f, 0x2a30);
  621. miiphy_write (dev->name, reg, 0x08, 0x0200);
  622. miiphy_write (dev->name, reg, 0x1f, 0x52b5);
  623. miiphy_write (dev->name, reg, 0x02, 0x0004);
  624. miiphy_write (dev->name, reg, 0x01, 0x0671);
  625. miiphy_write (dev->name, reg, 0x00, 0x8fae);
  626. miiphy_write (dev->name, reg, 0x1f, 0x2a30);
  627. miiphy_write (dev->name, reg, 0x08, 0x0000);
  628. miiphy_write (dev->name, reg, 0x1f, 0x0000);
  629. /* end Vitesse/Cicada errata */
  630. }
  631. #endif
  632. #if defined(CONFIG_ET1011C_PHY)
  633. /*
  634. * Agere ET1011c PHY needs to have an extended register whacked
  635. * for RGMII mode.
  636. */
  637. if (((devnum == 2) || (devnum ==3)) && (4 == ethgroup)) {
  638. miiphy_read (dev->name, reg, 0x16, &reg_short);
  639. reg_short &= ~(0x7);
  640. reg_short |= 0x6; /* RGMII DLL Delay*/
  641. miiphy_write (dev->name, reg, 0x16, reg_short);
  642. miiphy_read (dev->name, reg, 0x17, &reg_short);
  643. reg_short &= ~(0x40);
  644. miiphy_write (dev->name, reg, 0x17, reg_short);
  645. miiphy_write(dev->name, reg, 0x1c, 0x74f0);
  646. }
  647. #endif
  648. #endif
  649. /* Start/Restart autonegotiation */
  650. phy_setup_aneg (dev->name, reg);
  651. udelay (1000);
  652. }
  653. #endif /* defined(CONFIG_PHY_RESET) */
  654. miiphy_read (dev->name, reg, PHY_BMSR, &reg_short);
  655. /*
  656. * Wait if PHY is capable of autonegotiation and autonegotiation is not complete
  657. */
  658. if ((reg_short & PHY_BMSR_AUTN_ABLE)
  659. && !(reg_short & PHY_BMSR_AUTN_COMP)) {
  660. puts ("Waiting for PHY auto negotiation to complete");
  661. i = 0;
  662. while (!(reg_short & PHY_BMSR_AUTN_COMP)) {
  663. /*
  664. * Timeout reached ?
  665. */
  666. if (i > PHY_AUTONEGOTIATE_TIMEOUT) {
  667. puts (" TIMEOUT !\n");
  668. break;
  669. }
  670. if ((i++ % 1000) == 0) {
  671. putc ('.');
  672. }
  673. udelay (1000); /* 1 ms */
  674. miiphy_read (dev->name, reg, PHY_BMSR, &reg_short);
  675. }
  676. puts (" done\n");
  677. udelay (500000); /* another 500 ms (results in faster booting) */
  678. }
  679. #endif /* #ifndef CONFIG_CS8952_PHY */
  680. speed = miiphy_speed (dev->name, reg);
  681. duplex = miiphy_duplex (dev->name, reg);
  682. if (hw_p->print_speed) {
  683. hw_p->print_speed = 0;
  684. printf ("ENET Speed is %d Mbps - %s duplex connection (EMAC%d)\n",
  685. (int) speed, (duplex == HALF) ? "HALF" : "FULL",
  686. hw_p->devnum);
  687. }
  688. #if defined(CONFIG_440) && !defined(CONFIG_440SP) && !defined(CONFIG_440SPE) && \
  689. !defined(CONFIG_440EPX) && !defined(CONFIG_440GRX)
  690. #if defined(CONFIG_440EP) || defined(CONFIG_440GR)
  691. mfsdr(sdr_mfr, reg);
  692. if (speed == 100) {
  693. reg = (reg & ~SDR0_MFR_ZMII_MODE_MASK) | SDR0_MFR_ZMII_MODE_RMII_100M;
  694. } else {
  695. reg = (reg & ~SDR0_MFR_ZMII_MODE_MASK) | SDR0_MFR_ZMII_MODE_RMII_10M;
  696. }
  697. mtsdr(sdr_mfr, reg);
  698. #endif
  699. /* Set ZMII/RGMII speed according to the phy link speed */
  700. reg = in_be32((void *)ZMII_SSR);
  701. if ( (speed == 100) || (speed == 1000) )
  702. out_be32((void *)ZMII_SSR, reg | (ZMII_SSR_SP << ZMII_SSR_V (devnum)));
  703. else
  704. out_be32((void *)ZMII_SSR, reg & (~(ZMII_SSR_SP << ZMII_SSR_V (devnum))));
  705. if ((devnum == 2) || (devnum == 3)) {
  706. if (speed == 1000)
  707. reg = (RGMII_SSR_SP_1000MBPS << RGMII_SSR_V (devnum));
  708. else if (speed == 100)
  709. reg = (RGMII_SSR_SP_100MBPS << RGMII_SSR_V (devnum));
  710. else if (speed == 10)
  711. reg = (RGMII_SSR_SP_10MBPS << RGMII_SSR_V (devnum));
  712. else {
  713. printf("Error in RGMII Speed\n");
  714. return -1;
  715. }
  716. out_be32((void *)RGMII_SSR, reg);
  717. }
  718. #endif /* defined(CONFIG_440) && !defined(CONFIG_440SP) */
  719. #if defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  720. defined(CONFIG_405EX)
  721. if (speed == 1000)
  722. reg = (RGMII_SSR_SP_1000MBPS << RGMII_SSR_V (devnum));
  723. else if (speed == 100)
  724. reg = (RGMII_SSR_SP_100MBPS << RGMII_SSR_V (devnum));
  725. else if (speed == 10)
  726. reg = (RGMII_SSR_SP_10MBPS << RGMII_SSR_V (devnum));
  727. else {
  728. printf("Error in RGMII Speed\n");
  729. return -1;
  730. }
  731. out_be32((void *)RGMII_SSR, reg);
  732. #endif
  733. /* set the Mal configuration reg */
  734. #if defined(CONFIG_440GX) || \
  735. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  736. defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
  737. defined(CONFIG_405EX)
  738. mtdcr (malmcr, MAL_CR_PLBB | MAL_CR_OPBBL | MAL_CR_LEA |
  739. MAL_CR_PLBLT_DEFAULT | MAL_CR_EOPIE | 0x00330000);
  740. #else
  741. mtdcr (malmcr, MAL_CR_PLBB | MAL_CR_OPBBL | MAL_CR_LEA | MAL_CR_PLBLT_DEFAULT);
  742. /* Errata 1.12: MAL_1 -- Disable MAL bursting */
  743. if (get_pvr() == PVR_440GP_RB) {
  744. mtdcr (malmcr, mfdcr(malmcr) & ~MAL_CR_PLBB);
  745. }
  746. #endif
  747. /*
  748. * Malloc MAL buffer desciptors, make sure they are
  749. * aligned on cache line boundary size
  750. * (401/403/IOP480 = 16, 405 = 32)
  751. * and doesn't cross cache block boundaries.
  752. */
  753. if (hw_p->first_init == 0) {
  754. debug("*** Allocating descriptor memory ***\n");
  755. bd_cached = (u32)malloc_aligned(MAL_ALLOC_SIZE, 4096);
  756. if (!bd_cached) {
  757. printf("%s: Error allocating MAL descriptor buffers!\n");
  758. return -1;
  759. }
  760. #ifdef CONFIG_4xx_DCACHE
  761. flush_dcache_range(bd_cached, bd_cached + MAL_ALLOC_SIZE);
  762. hw_p->tx_phys = bd_cached;
  763. hw_p->rx_phys = bd_cached + MAL_TX_DESC_SIZE;
  764. bd_uncached = bis->bi_memsize;
  765. program_tlb(bd_cached, bd_uncached, MAL_ALLOC_SIZE,
  766. TLB_WORD2_I_ENABLE);
  767. #else
  768. bd_uncached = bd_cached;
  769. #endif
  770. hw_p->tx_phys = bd_cached;
  771. hw_p->rx_phys = bd_cached + MAL_TX_DESC_SIZE;
  772. hw_p->tx = (mal_desc_t *)(bd_uncached);
  773. hw_p->rx = (mal_desc_t *)(bd_uncached + MAL_TX_DESC_SIZE);
  774. debug("hw_p->tx=%08x, hw_p->rx=%08x\n", hw_p->tx, hw_p->rx);
  775. }
  776. for (i = 0; i < NUM_TX_BUFF; i++) {
  777. hw_p->tx[i].ctrl = 0;
  778. hw_p->tx[i].data_len = 0;
  779. if (hw_p->first_init == 0)
  780. hw_p->txbuf_ptr = malloc_aligned(MAL_ALLOC_SIZE,
  781. L1_CACHE_BYTES);
  782. hw_p->tx[i].data_ptr = hw_p->txbuf_ptr;
  783. if ((NUM_TX_BUFF - 1) == i)
  784. hw_p->tx[i].ctrl |= MAL_TX_CTRL_WRAP;
  785. hw_p->tx_run[i] = -1;
  786. debug("TX_BUFF %d @ 0x%08lx\n", i, (u32)hw_p->tx[i].data_ptr);
  787. }
  788. for (i = 0; i < NUM_RX_BUFF; i++) {
  789. hw_p->rx[i].ctrl = 0;
  790. hw_p->rx[i].data_len = 0;
  791. hw_p->rx[i].data_ptr = (char *)NetRxPackets[i];
  792. if ((NUM_RX_BUFF - 1) == i)
  793. hw_p->rx[i].ctrl |= MAL_RX_CTRL_WRAP;
  794. hw_p->rx[i].ctrl |= MAL_RX_CTRL_EMPTY | MAL_RX_CTRL_INTR;
  795. hw_p->rx_ready[i] = -1;
  796. debug("RX_BUFF %d @ 0x%08lx\n", i, (u32)hw_p->rx[i].data_ptr);
  797. }
  798. reg = 0x00000000;
  799. reg |= dev->enetaddr[0]; /* set high address */
  800. reg = reg << 8;
  801. reg |= dev->enetaddr[1];
  802. out_be32((void *)EMAC_IAH + hw_p->hw_addr, reg);
  803. reg = 0x00000000;
  804. reg |= dev->enetaddr[2]; /* set low address */
  805. reg = reg << 8;
  806. reg |= dev->enetaddr[3];
  807. reg = reg << 8;
  808. reg |= dev->enetaddr[4];
  809. reg = reg << 8;
  810. reg |= dev->enetaddr[5];
  811. out_be32((void *)EMAC_IAL + hw_p->hw_addr, reg);
  812. switch (devnum) {
  813. case 1:
  814. /* setup MAL tx & rx channel pointers */
  815. #if defined (CONFIG_405EP) || defined (CONFIG_440EP) || defined (CONFIG_440GR)
  816. mtdcr (maltxctp2r, hw_p->tx_phys);
  817. #else
  818. mtdcr (maltxctp1r, hw_p->tx_phys);
  819. #endif
  820. #if defined(CONFIG_440)
  821. mtdcr (maltxbattr, 0x0);
  822. mtdcr (malrxbattr, 0x0);
  823. #endif
  824. mtdcr (malrxctp1r, hw_p->rx_phys);
  825. /* set RX buffer size */
  826. mtdcr (malrcbs1, ENET_MAX_MTU_ALIGNED / 16);
  827. break;
  828. #if defined (CONFIG_440GX)
  829. case 2:
  830. /* setup MAL tx & rx channel pointers */
  831. mtdcr (maltxbattr, 0x0);
  832. mtdcr (malrxbattr, 0x0);
  833. mtdcr (maltxctp2r, hw_p->tx_phys);
  834. mtdcr (malrxctp2r, hw_p->rx_phys);
  835. /* set RX buffer size */
  836. mtdcr (malrcbs2, ENET_MAX_MTU_ALIGNED / 16);
  837. break;
  838. case 3:
  839. /* setup MAL tx & rx channel pointers */
  840. mtdcr (maltxbattr, 0x0);
  841. mtdcr (maltxctp3r, hw_p->tx_phys);
  842. mtdcr (malrxbattr, 0x0);
  843. mtdcr (malrxctp3r, hw_p->rx_phys);
  844. /* set RX buffer size */
  845. mtdcr (malrcbs3, ENET_MAX_MTU_ALIGNED / 16);
  846. break;
  847. #endif /* CONFIG_440GX */
  848. case 0:
  849. default:
  850. /* setup MAL tx & rx channel pointers */
  851. #if defined(CONFIG_440)
  852. mtdcr (maltxbattr, 0x0);
  853. mtdcr (malrxbattr, 0x0);
  854. #endif
  855. mtdcr (maltxctp0r, hw_p->tx_phys);
  856. mtdcr (malrxctp0r, hw_p->rx_phys);
  857. /* set RX buffer size */
  858. mtdcr (malrcbs0, ENET_MAX_MTU_ALIGNED / 16);
  859. break;
  860. }
  861. /* Enable MAL transmit and receive channels */
  862. #if defined(CONFIG_405EP) || defined(CONFIG_440EP) || defined(CONFIG_440GR)
  863. mtdcr (maltxcasr, (MAL_TXRX_CASR >> (hw_p->devnum*2)));
  864. #else
  865. mtdcr (maltxcasr, (MAL_TXRX_CASR >> hw_p->devnum));
  866. #endif
  867. mtdcr (malrxcasr, (MAL_TXRX_CASR >> hw_p->devnum));
  868. /* set transmit enable & receive enable */
  869. out_be32((void *)EMAC_M0 + hw_p->hw_addr, EMAC_M0_TXE | EMAC_M0_RXE);
  870. /* set receive fifo to 4k and tx fifo to 2k */
  871. mode_reg = in_be32((void *)EMAC_M1 + hw_p->hw_addr);
  872. mode_reg |= EMAC_M1_RFS_4K | EMAC_M1_TX_FIFO_2K;
  873. /* set speed */
  874. if (speed == _1000BASET) {
  875. #if defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  876. defined(CONFIG_440SP) || defined(CONFIG_440SPE)
  877. unsigned long pfc1;
  878. mfsdr (sdr_pfc1, pfc1);
  879. pfc1 |= SDR0_PFC1_EM_1000;
  880. mtsdr (sdr_pfc1, pfc1);
  881. #endif
  882. mode_reg = mode_reg | EMAC_M1_MF_1000MBPS | EMAC_M1_IST;
  883. } else if (speed == _100BASET)
  884. mode_reg = mode_reg | EMAC_M1_MF_100MBPS | EMAC_M1_IST;
  885. else
  886. mode_reg = mode_reg & ~0x00C00000; /* 10 MBPS */
  887. if (duplex == FULL)
  888. mode_reg = mode_reg | 0x80000000 | EMAC_M1_IST;
  889. out_be32((void *)EMAC_M1 + hw_p->hw_addr, mode_reg);
  890. /* Enable broadcast and indvidual address */
  891. /* TBS: enabling runts as some misbehaved nics will send runts */
  892. out_be32((void *)EMAC_RXM + hw_p->hw_addr, EMAC_RMR_BAE | EMAC_RMR_IAE);
  893. /* we probably need to set the tx mode1 reg? maybe at tx time */
  894. /* set transmit request threshold register */
  895. out_be32((void *)EMAC_TRTR + hw_p->hw_addr, 0x18000000); /* 256 byte threshold */
  896. /* set receive low/high water mark register */
  897. #if defined(CONFIG_440)
  898. /* 440s has a 64 byte burst length */
  899. out_be32((void *)EMAC_RX_HI_LO_WMARK + hw_p->hw_addr, 0x80009000);
  900. #else
  901. /* 405s have a 16 byte burst length */
  902. out_be32((void *)EMAC_RX_HI_LO_WMARK + hw_p->hw_addr, 0x0f002000);
  903. #endif /* defined(CONFIG_440) */
  904. out_be32((void *)EMAC_TXM1 + hw_p->hw_addr, 0xf8640000);
  905. /* Set fifo limit entry in tx mode 0 */
  906. out_be32((void *)EMAC_TXM0 + hw_p->hw_addr, 0x00000003);
  907. /* Frame gap set */
  908. out_be32((void *)EMAC_I_FRAME_GAP_REG + hw_p->hw_addr, 0x00000008);
  909. /* Set EMAC IER */
  910. hw_p->emac_ier = EMAC_ISR_PTLE | EMAC_ISR_BFCS | EMAC_ISR_ORE | EMAC_ISR_IRE;
  911. if (speed == _100BASET)
  912. hw_p->emac_ier = hw_p->emac_ier | EMAC_ISR_SYE;
  913. out_be32((void *)EMAC_ISR + hw_p->hw_addr, 0xffffffff); /* clear pending interrupts */
  914. out_be32((void *)EMAC_IER + hw_p->hw_addr, hw_p->emac_ier);
  915. if (hw_p->first_init == 0) {
  916. /*
  917. * Connect interrupt service routines
  918. */
  919. irq_install_handler(ETH_IRQ_NUM(hw_p->devnum),
  920. (interrupt_handler_t *) enetInt, dev);
  921. }
  922. mtmsr (msr); /* enable interrupts again */
  923. hw_p->bis = bis;
  924. hw_p->first_init = 1;
  925. return (1);
  926. }
  927. static int ppc_4xx_eth_send (struct eth_device *dev, volatile void *ptr,
  928. int len)
  929. {
  930. struct enet_frame *ef_ptr;
  931. ulong time_start, time_now;
  932. unsigned long temp_txm0;
  933. EMAC_4XX_HW_PST hw_p = dev->priv;
  934. ef_ptr = (struct enet_frame *) ptr;
  935. /*-----------------------------------------------------------------------+
  936. * Copy in our address into the frame.
  937. *-----------------------------------------------------------------------*/
  938. (void) memcpy (ef_ptr->source_addr, dev->enetaddr, ENET_ADDR_LENGTH);
  939. /*-----------------------------------------------------------------------+
  940. * If frame is too long or too short, modify length.
  941. *-----------------------------------------------------------------------*/
  942. /* TBS: where does the fragment go???? */
  943. if (len > ENET_MAX_MTU)
  944. len = ENET_MAX_MTU;
  945. /* memcpy ((void *) &tx_buff[tx_slot], (const void *) ptr, len); */
  946. memcpy ((void *) hw_p->txbuf_ptr, (const void *) ptr, len);
  947. flush_dcache_range((u32)hw_p->txbuf_ptr, (u32)hw_p->txbuf_ptr + len);
  948. /*-----------------------------------------------------------------------+
  949. * set TX Buffer busy, and send it
  950. *-----------------------------------------------------------------------*/
  951. hw_p->tx[hw_p->tx_slot].ctrl = (MAL_TX_CTRL_LAST |
  952. EMAC_TX_CTRL_GFCS | EMAC_TX_CTRL_GP) &
  953. ~(EMAC_TX_CTRL_ISA | EMAC_TX_CTRL_RSA);
  954. if ((NUM_TX_BUFF - 1) == hw_p->tx_slot)
  955. hw_p->tx[hw_p->tx_slot].ctrl |= MAL_TX_CTRL_WRAP;
  956. hw_p->tx[hw_p->tx_slot].data_len = (short) len;
  957. hw_p->tx[hw_p->tx_slot].ctrl |= MAL_TX_CTRL_READY;
  958. __asm__ volatile ("eieio");
  959. out_be32((void *)EMAC_TXM0 + hw_p->hw_addr,
  960. in_be32((void *)EMAC_TXM0 + hw_p->hw_addr) | EMAC_TXM0_GNP0);
  961. #ifdef INFO_4XX_ENET
  962. hw_p->stats.pkts_tx++;
  963. #endif
  964. /*-----------------------------------------------------------------------+
  965. * poll unitl the packet is sent and then make sure it is OK
  966. *-----------------------------------------------------------------------*/
  967. time_start = get_timer (0);
  968. while (1) {
  969. temp_txm0 = in_be32((void *)EMAC_TXM0 + hw_p->hw_addr);
  970. /* loop until either TINT turns on or 3 seconds elapse */
  971. if ((temp_txm0 & EMAC_TXM0_GNP0) != 0) {
  972. /* transmit is done, so now check for errors
  973. * If there is an error, an interrupt should
  974. * happen when we return
  975. */
  976. time_now = get_timer (0);
  977. if ((time_now - time_start) > 3000) {
  978. return (-1);
  979. }
  980. } else {
  981. return (len);
  982. }
  983. }
  984. }
  985. #if defined (CONFIG_440) || defined(CONFIG_405EX)
  986. #if defined(CONFIG_440SP) || defined(CONFIG_440SPE)
  987. /*
  988. * Hack: On 440SP all enet irq sources are located on UIC1
  989. * Needs some cleanup. --sr
  990. */
  991. #define UIC0MSR uic1msr
  992. #define UIC0SR uic1sr
  993. #else
  994. #define UIC0MSR uic0msr
  995. #define UIC0SR uic0sr
  996. #endif
  997. #if defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  998. defined(CONFIG_405EX)
  999. #define UICMSR_ETHX uic0msr
  1000. #define UICSR_ETHX uic0sr
  1001. #else
  1002. #define UICMSR_ETHX uic1msr
  1003. #define UICSR_ETHX uic1sr
  1004. #endif
  1005. int enetInt (struct eth_device *dev)
  1006. {
  1007. int serviced;
  1008. int rc = -1; /* default to not us */
  1009. unsigned long mal_isr;
  1010. unsigned long emac_isr = 0;
  1011. unsigned long mal_rx_eob;
  1012. unsigned long my_uic0msr, my_uic1msr;
  1013. unsigned long my_uicmsr_ethx;
  1014. #if defined(CONFIG_440GX)
  1015. unsigned long my_uic2msr;
  1016. #endif
  1017. EMAC_4XX_HW_PST hw_p;
  1018. /*
  1019. * Because the mal is generic, we need to get the current
  1020. * eth device
  1021. */
  1022. #if defined(CONFIG_NET_MULTI)
  1023. dev = eth_get_dev();
  1024. #else
  1025. dev = emac0_dev;
  1026. #endif
  1027. hw_p = dev->priv;
  1028. /* enter loop that stays in interrupt code until nothing to service */
  1029. do {
  1030. serviced = 0;
  1031. my_uic0msr = mfdcr (UIC0MSR);
  1032. my_uic1msr = mfdcr (uic1msr);
  1033. #if defined(CONFIG_440GX)
  1034. my_uic2msr = mfdcr (uic2msr);
  1035. #endif
  1036. my_uicmsr_ethx = mfdcr (UICMSR_ETHX);
  1037. if (!(my_uic0msr & (UIC_MRE | UIC_MTE))
  1038. && !(my_uic1msr & (UIC_MS | UIC_MTDE | UIC_MRDE))
  1039. && !(my_uicmsr_ethx & (UIC_ETH0 | UIC_ETH1))) {
  1040. /* not for us */
  1041. return (rc);
  1042. }
  1043. #if defined (CONFIG_440GX)
  1044. if (!(my_uic0msr & (UIC_MRE | UIC_MTE))
  1045. && !(my_uic2msr & (UIC_ETH2 | UIC_ETH3))) {
  1046. /* not for us */
  1047. return (rc);
  1048. }
  1049. #endif
  1050. /* get and clear controller status interrupts */
  1051. /* look at Mal and EMAC interrupts */
  1052. if ((my_uic0msr & (UIC_MRE | UIC_MTE))
  1053. || (my_uic1msr & (UIC_MS | UIC_MTDE | UIC_MRDE))) {
  1054. /* we have a MAL interrupt */
  1055. mal_isr = mfdcr (malesr);
  1056. /* look for mal error */
  1057. if (my_uic1msr & (UIC_MS | UIC_MTDE | UIC_MRDE)) {
  1058. mal_err (dev, mal_isr, my_uic1msr, MAL_UIC_DEF, MAL_UIC_ERR);
  1059. serviced = 1;
  1060. rc = 0;
  1061. }
  1062. }
  1063. /* port by port dispatch of emac interrupts */
  1064. if (hw_p->devnum == 0) {
  1065. if (UIC_ETH0 & my_uicmsr_ethx) { /* look for EMAC errors */
  1066. emac_isr = in_be32((void *)EMAC_ISR + hw_p->hw_addr);
  1067. if ((hw_p->emac_ier & emac_isr) != 0) {
  1068. emac_err (dev, emac_isr);
  1069. serviced = 1;
  1070. rc = 0;
  1071. }
  1072. }
  1073. if ((hw_p->emac_ier & emac_isr)
  1074. || (my_uic1msr & (UIC_MS | UIC_MTDE | UIC_MRDE))) {
  1075. mtdcr (UIC0SR, UIC_MRE | UIC_MTE); /* Clear */
  1076. mtdcr (uic1sr, UIC_MS | UIC_MTDE | UIC_MRDE); /* Clear */
  1077. mtdcr (UICSR_ETHX, UIC_ETH0); /* Clear */
  1078. return (rc); /* we had errors so get out */
  1079. }
  1080. }
  1081. #if !defined(CONFIG_440SP)
  1082. if (hw_p->devnum == 1) {
  1083. if (UIC_ETH1 & my_uicmsr_ethx) { /* look for EMAC errors */
  1084. emac_isr = in_be32((void *)EMAC_ISR + hw_p->hw_addr);
  1085. if ((hw_p->emac_ier & emac_isr) != 0) {
  1086. emac_err (dev, emac_isr);
  1087. serviced = 1;
  1088. rc = 0;
  1089. }
  1090. }
  1091. if ((hw_p->emac_ier & emac_isr)
  1092. || (my_uic1msr & (UIC_MS | UIC_MTDE | UIC_MRDE))) {
  1093. mtdcr (UIC0SR, UIC_MRE | UIC_MTE); /* Clear */
  1094. mtdcr (uic1sr, UIC_MS | UIC_MTDE | UIC_MRDE); /* Clear */
  1095. mtdcr (UICSR_ETHX, UIC_ETH1); /* Clear */
  1096. return (rc); /* we had errors so get out */
  1097. }
  1098. }
  1099. #if defined (CONFIG_440GX)
  1100. if (hw_p->devnum == 2) {
  1101. if (UIC_ETH2 & my_uic2msr) { /* look for EMAC errors */
  1102. emac_isr = in_be32((void *)EMAC_ISR + hw_p->hw_addr);
  1103. if ((hw_p->emac_ier & emac_isr) != 0) {
  1104. emac_err (dev, emac_isr);
  1105. serviced = 1;
  1106. rc = 0;
  1107. }
  1108. }
  1109. if ((hw_p->emac_ier & emac_isr)
  1110. || (my_uic1msr & (UIC_MS | UIC_MTDE | UIC_MRDE))) {
  1111. mtdcr (UIC0SR, UIC_MRE | UIC_MTE); /* Clear */
  1112. mtdcr (uic1sr, UIC_MS | UIC_MTDE | UIC_MRDE); /* Clear */
  1113. mtdcr (uic2sr, UIC_ETH2);
  1114. return (rc); /* we had errors so get out */
  1115. }
  1116. }
  1117. if (hw_p->devnum == 3) {
  1118. if (UIC_ETH3 & my_uic2msr) { /* look for EMAC errors */
  1119. emac_isr = in_be32((void *)EMAC_ISR + hw_p->hw_addr);
  1120. if ((hw_p->emac_ier & emac_isr) != 0) {
  1121. emac_err (dev, emac_isr);
  1122. serviced = 1;
  1123. rc = 0;
  1124. }
  1125. }
  1126. if ((hw_p->emac_ier & emac_isr)
  1127. || (my_uic1msr & (UIC_MS | UIC_MTDE | UIC_MRDE))) {
  1128. mtdcr (UIC0SR, UIC_MRE | UIC_MTE); /* Clear */
  1129. mtdcr (uic1sr, UIC_MS | UIC_MTDE | UIC_MRDE); /* Clear */
  1130. mtdcr (uic2sr, UIC_ETH3);
  1131. return (rc); /* we had errors so get out */
  1132. }
  1133. }
  1134. #endif /* CONFIG_440GX */
  1135. #endif /* !CONFIG_440SP */
  1136. /* handle MAX TX EOB interrupt from a tx */
  1137. if (my_uic0msr & UIC_MTE) {
  1138. mal_rx_eob = mfdcr (maltxeobisr);
  1139. mtdcr (maltxeobisr, mal_rx_eob);
  1140. mtdcr (UIC0SR, UIC_MTE);
  1141. }
  1142. /* handle MAL RX EOB interupt from a receive */
  1143. /* check for EOB on valid channels */
  1144. if (my_uic0msr & UIC_MRE) {
  1145. mal_rx_eob = mfdcr (malrxeobisr);
  1146. if ((mal_rx_eob & (0x80000000 >> hw_p->devnum)) != 0) { /* call emac routine for channel x */
  1147. /* clear EOB
  1148. mtdcr(malrxeobisr, mal_rx_eob); */
  1149. enet_rcv (dev, emac_isr);
  1150. /* indicate that we serviced an interrupt */
  1151. serviced = 1;
  1152. rc = 0;
  1153. }
  1154. }
  1155. mtdcr (UIC0SR, UIC_MRE); /* Clear */
  1156. mtdcr (uic1sr, UIC_MS | UIC_MTDE | UIC_MRDE); /* Clear */
  1157. switch (hw_p->devnum) {
  1158. case 0:
  1159. mtdcr (UICSR_ETHX, UIC_ETH0);
  1160. break;
  1161. case 1:
  1162. mtdcr (UICSR_ETHX, UIC_ETH1);
  1163. break;
  1164. #if defined (CONFIG_440GX)
  1165. case 2:
  1166. mtdcr (uic2sr, UIC_ETH2);
  1167. break;
  1168. case 3:
  1169. mtdcr (uic2sr, UIC_ETH3);
  1170. break;
  1171. #endif /* CONFIG_440GX */
  1172. default:
  1173. break;
  1174. }
  1175. } while (serviced);
  1176. return (rc);
  1177. }
  1178. #else /* CONFIG_440 */
  1179. int enetInt (struct eth_device *dev)
  1180. {
  1181. int serviced;
  1182. int rc = -1; /* default to not us */
  1183. unsigned long mal_isr;
  1184. unsigned long emac_isr = 0;
  1185. unsigned long mal_rx_eob;
  1186. unsigned long my_uicmsr;
  1187. EMAC_4XX_HW_PST hw_p;
  1188. /*
  1189. * Because the mal is generic, we need to get the current
  1190. * eth device
  1191. */
  1192. #if defined(CONFIG_NET_MULTI)
  1193. dev = eth_get_dev();
  1194. #else
  1195. dev = emac0_dev;
  1196. #endif
  1197. hw_p = dev->priv;
  1198. /* enter loop that stays in interrupt code until nothing to service */
  1199. do {
  1200. serviced = 0;
  1201. my_uicmsr = mfdcr (uicmsr);
  1202. if ((my_uicmsr & (MAL_UIC_DEF | EMAC_UIC_DEF)) == 0) { /* not for us */
  1203. return (rc);
  1204. }
  1205. /* get and clear controller status interrupts */
  1206. /* look at Mal and EMAC interrupts */
  1207. if ((MAL_UIC_DEF & my_uicmsr) != 0) { /* we have a MAL interrupt */
  1208. mal_isr = mfdcr (malesr);
  1209. /* look for mal error */
  1210. if ((my_uicmsr & MAL_UIC_ERR) != 0) {
  1211. mal_err (dev, mal_isr, my_uicmsr, MAL_UIC_DEF, MAL_UIC_ERR);
  1212. serviced = 1;
  1213. rc = 0;
  1214. }
  1215. }
  1216. /* port by port dispatch of emac interrupts */
  1217. if ((SEL_UIC_DEF(hw_p->devnum) & my_uicmsr) != 0) { /* look for EMAC errors */
  1218. emac_isr = in_be32((void *)EMAC_ISR + hw_p->hw_addr);
  1219. if ((hw_p->emac_ier & emac_isr) != 0) {
  1220. emac_err (dev, emac_isr);
  1221. serviced = 1;
  1222. rc = 0;
  1223. }
  1224. }
  1225. if (((hw_p->emac_ier & emac_isr) != 0) || ((MAL_UIC_ERR & my_uicmsr) != 0)) {
  1226. mtdcr (uicsr, MAL_UIC_DEF | SEL_UIC_DEF(hw_p->devnum)); /* Clear */
  1227. return (rc); /* we had errors so get out */
  1228. }
  1229. /* handle MAX TX EOB interrupt from a tx */
  1230. if (my_uicmsr & UIC_MAL_TXEOB) {
  1231. mal_rx_eob = mfdcr (maltxeobisr);
  1232. mtdcr (maltxeobisr, mal_rx_eob);
  1233. mtdcr (uicsr, UIC_MAL_TXEOB);
  1234. }
  1235. /* handle MAL RX EOB interupt from a receive */
  1236. /* check for EOB on valid channels */
  1237. if (my_uicmsr & UIC_MAL_RXEOB)
  1238. {
  1239. mal_rx_eob = mfdcr (malrxeobisr);
  1240. if ((mal_rx_eob & (0x80000000 >> hw_p->devnum)) != 0) { /* call emac routine for channel x */
  1241. /* clear EOB
  1242. mtdcr(malrxeobisr, mal_rx_eob); */
  1243. enet_rcv (dev, emac_isr);
  1244. /* indicate that we serviced an interrupt */
  1245. serviced = 1;
  1246. rc = 0;
  1247. }
  1248. }
  1249. mtdcr (uicsr, MAL_UIC_DEF|EMAC_UIC_DEF|EMAC_UIC_DEF1); /* Clear */
  1250. #if defined(CONFIG_405EZ)
  1251. mtsdr (sdricintstat, SDR_ICRX_STAT | SDR_ICTX0_STAT | SDR_ICTX1_STAT);
  1252. #endif /* defined(CONFIG_405EZ) */
  1253. }
  1254. while (serviced);
  1255. return (rc);
  1256. }
  1257. #endif /* CONFIG_440 */
  1258. /*-----------------------------------------------------------------------------+
  1259. * MAL Error Routine
  1260. *-----------------------------------------------------------------------------*/
  1261. static void mal_err (struct eth_device *dev, unsigned long isr,
  1262. unsigned long uic, unsigned long maldef,
  1263. unsigned long mal_errr)
  1264. {
  1265. EMAC_4XX_HW_PST hw_p = dev->priv;
  1266. mtdcr (malesr, isr); /* clear interrupt */
  1267. /* clear DE interrupt */
  1268. mtdcr (maltxdeir, 0xC0000000);
  1269. mtdcr (malrxdeir, 0x80000000);
  1270. #ifdef INFO_4XX_ENET
  1271. printf ("\nMAL error occured.... ISR = %lx UIC = = %lx MAL_DEF = %lx MAL_ERR= %lx \n", isr, uic, maldef, mal_errr);
  1272. #endif
  1273. eth_init (hw_p->bis); /* start again... */
  1274. }
  1275. /*-----------------------------------------------------------------------------+
  1276. * EMAC Error Routine
  1277. *-----------------------------------------------------------------------------*/
  1278. static void emac_err (struct eth_device *dev, unsigned long isr)
  1279. {
  1280. EMAC_4XX_HW_PST hw_p = dev->priv;
  1281. printf ("EMAC%d error occured.... ISR = %lx\n", hw_p->devnum, isr);
  1282. out_be32((void *)EMAC_ISR + hw_p->hw_addr, isr);
  1283. }
  1284. /*-----------------------------------------------------------------------------+
  1285. * enet_rcv() handles the ethernet receive data
  1286. *-----------------------------------------------------------------------------*/
  1287. static void enet_rcv (struct eth_device *dev, unsigned long malisr)
  1288. {
  1289. struct enet_frame *ef_ptr;
  1290. unsigned long data_len;
  1291. unsigned long rx_eob_isr;
  1292. EMAC_4XX_HW_PST hw_p = dev->priv;
  1293. int handled = 0;
  1294. int i;
  1295. int loop_count = 0;
  1296. rx_eob_isr = mfdcr (malrxeobisr);
  1297. if ((0x80000000 >> hw_p->devnum) & rx_eob_isr) {
  1298. /* clear EOB */
  1299. mtdcr (malrxeobisr, rx_eob_isr);
  1300. /* EMAC RX done */
  1301. while (1) { /* do all */
  1302. i = hw_p->rx_slot;
  1303. if ((MAL_RX_CTRL_EMPTY & hw_p->rx[i].ctrl)
  1304. || (loop_count >= NUM_RX_BUFF))
  1305. break;
  1306. loop_count++;
  1307. handled++;
  1308. data_len = (unsigned long) hw_p->rx[i].data_len; /* Get len */
  1309. if (data_len) {
  1310. if (data_len > ENET_MAX_MTU) /* Check len */
  1311. data_len = 0;
  1312. else {
  1313. if (EMAC_RX_ERRORS & hw_p->rx[i].ctrl) { /* Check Errors */
  1314. data_len = 0;
  1315. hw_p->stats.rx_err_log[hw_p->
  1316. rx_err_index]
  1317. = hw_p->rx[i].ctrl;
  1318. hw_p->rx_err_index++;
  1319. if (hw_p->rx_err_index ==
  1320. MAX_ERR_LOG)
  1321. hw_p->rx_err_index =
  1322. 0;
  1323. } /* emac_erros */
  1324. } /* data_len < max mtu */
  1325. } /* if data_len */
  1326. if (!data_len) { /* no data */
  1327. hw_p->rx[i].ctrl |= MAL_RX_CTRL_EMPTY; /* Free Recv Buffer */
  1328. hw_p->stats.data_len_err++; /* Error at Rx */
  1329. }
  1330. /* !data_len */
  1331. /* AS.HARNOIS */
  1332. /* Check if user has already eaten buffer */
  1333. /* if not => ERROR */
  1334. else if (hw_p->rx_ready[hw_p->rx_i_index] != -1) {
  1335. if (hw_p->is_receiving)
  1336. printf ("ERROR : Receive buffers are full!\n");
  1337. break;
  1338. } else {
  1339. hw_p->stats.rx_frames++;
  1340. hw_p->stats.rx += data_len;
  1341. ef_ptr = (struct enet_frame *) hw_p->rx[i].
  1342. data_ptr;
  1343. #ifdef INFO_4XX_ENET
  1344. hw_p->stats.pkts_rx++;
  1345. #endif
  1346. /* AS.HARNOIS
  1347. * use ring buffer
  1348. */
  1349. hw_p->rx_ready[hw_p->rx_i_index] = i;
  1350. hw_p->rx_i_index++;
  1351. if (NUM_RX_BUFF == hw_p->rx_i_index)
  1352. hw_p->rx_i_index = 0;
  1353. hw_p->rx_slot++;
  1354. if (NUM_RX_BUFF == hw_p->rx_slot)
  1355. hw_p->rx_slot = 0;
  1356. /* AS.HARNOIS
  1357. * free receive buffer only when
  1358. * buffer has been handled (eth_rx)
  1359. rx[i].ctrl |= MAL_RX_CTRL_EMPTY;
  1360. */
  1361. } /* if data_len */
  1362. } /* while */
  1363. } /* if EMACK_RXCHL */
  1364. }
  1365. static int ppc_4xx_eth_rx (struct eth_device *dev)
  1366. {
  1367. int length;
  1368. int user_index;
  1369. unsigned long msr;
  1370. EMAC_4XX_HW_PST hw_p = dev->priv;
  1371. hw_p->is_receiving = 1; /* tell driver */
  1372. for (;;) {
  1373. /* AS.HARNOIS
  1374. * use ring buffer and
  1375. * get index from rx buffer desciptor queue
  1376. */
  1377. user_index = hw_p->rx_ready[hw_p->rx_u_index];
  1378. if (user_index == -1) {
  1379. length = -1;
  1380. break; /* nothing received - leave for() loop */
  1381. }
  1382. msr = mfmsr ();
  1383. mtmsr (msr & ~(MSR_EE));
  1384. length = hw_p->rx[user_index].data_len;
  1385. /* Pass the packet up to the protocol layers. */
  1386. /* NetReceive(NetRxPackets[rxIdx], length - 4); */
  1387. /* NetReceive(NetRxPackets[i], length); */
  1388. invalidate_dcache_range((u32)hw_p->rx[user_index].data_ptr,
  1389. (u32)hw_p->rx[user_index].data_ptr +
  1390. length - 4);
  1391. NetReceive (NetRxPackets[user_index], length - 4);
  1392. /* Free Recv Buffer */
  1393. hw_p->rx[user_index].ctrl |= MAL_RX_CTRL_EMPTY;
  1394. /* Free rx buffer descriptor queue */
  1395. hw_p->rx_ready[hw_p->rx_u_index] = -1;
  1396. hw_p->rx_u_index++;
  1397. if (NUM_RX_BUFF == hw_p->rx_u_index)
  1398. hw_p->rx_u_index = 0;
  1399. #ifdef INFO_4XX_ENET
  1400. hw_p->stats.pkts_handled++;
  1401. #endif
  1402. mtmsr (msr); /* Enable IRQ's */
  1403. }
  1404. hw_p->is_receiving = 0; /* tell driver */
  1405. return length;
  1406. }
  1407. int ppc_4xx_eth_initialize (bd_t * bis)
  1408. {
  1409. static int virgin = 0;
  1410. struct eth_device *dev;
  1411. int eth_num = 0;
  1412. EMAC_4XX_HW_PST hw = NULL;
  1413. u8 ethaddr[4 + CONFIG_EMAC_NR_START][6];
  1414. u32 hw_addr[4];
  1415. #if defined(CONFIG_440GX)
  1416. unsigned long pfc1;
  1417. mfsdr (sdr_pfc1, pfc1);
  1418. pfc1 &= ~(0x01e00000);
  1419. pfc1 |= 0x01200000;
  1420. mtsdr (sdr_pfc1, pfc1);
  1421. #endif
  1422. /* first clear all mac-addresses */
  1423. for (eth_num = 0; eth_num < LAST_EMAC_NUM; eth_num++)
  1424. memcpy(ethaddr[eth_num], "\0\0\0\0\0\0", 6);
  1425. for (eth_num = 0; eth_num < LAST_EMAC_NUM; eth_num++) {
  1426. switch (eth_num) {
  1427. default: /* fall through */
  1428. case 0:
  1429. memcpy(ethaddr[eth_num + CONFIG_EMAC_NR_START],
  1430. bis->bi_enetaddr, 6);
  1431. hw_addr[eth_num] = 0x0;
  1432. break;
  1433. #ifdef CONFIG_HAS_ETH1
  1434. case 1:
  1435. memcpy(ethaddr[eth_num + CONFIG_EMAC_NR_START],
  1436. bis->bi_enet1addr, 6);
  1437. hw_addr[eth_num] = 0x100;
  1438. break;
  1439. #endif
  1440. #ifdef CONFIG_HAS_ETH2
  1441. case 2:
  1442. memcpy(ethaddr[eth_num + CONFIG_EMAC_NR_START],
  1443. bis->bi_enet2addr, 6);
  1444. hw_addr[eth_num] = 0x400;
  1445. break;
  1446. #endif
  1447. #ifdef CONFIG_HAS_ETH3
  1448. case 3:
  1449. memcpy(ethaddr[eth_num + CONFIG_EMAC_NR_START],
  1450. bis->bi_enet3addr, 6);
  1451. hw_addr[eth_num] = 0x600;
  1452. break;
  1453. #endif
  1454. }
  1455. }
  1456. /* set phy num and mode */
  1457. bis->bi_phynum[0] = CONFIG_PHY_ADDR;
  1458. bis->bi_phymode[0] = 0;
  1459. #if defined(CONFIG_PHY1_ADDR)
  1460. bis->bi_phynum[1] = CONFIG_PHY1_ADDR;
  1461. bis->bi_phymode[1] = 0;
  1462. #endif
  1463. #if defined(CONFIG_440GX)
  1464. bis->bi_phynum[2] = CONFIG_PHY2_ADDR;
  1465. bis->bi_phynum[3] = CONFIG_PHY3_ADDR;
  1466. bis->bi_phymode[2] = 2;
  1467. bis->bi_phymode[3] = 2;
  1468. #endif
  1469. #if defined(CONFIG_440GX) || \
  1470. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  1471. defined(CONFIG_405EX)
  1472. ppc_4xx_eth_setup_bridge(0, bis);
  1473. #endif
  1474. for (eth_num = 0; eth_num < LAST_EMAC_NUM; eth_num++) {
  1475. /*
  1476. * See if we can actually bring up the interface,
  1477. * otherwise, skip it
  1478. */
  1479. if (memcmp (ethaddr[eth_num], "\0\0\0\0\0\0", 6) == 0) {
  1480. bis->bi_phymode[eth_num] = BI_PHYMODE_NONE;
  1481. continue;
  1482. }
  1483. /* Allocate device structure */
  1484. dev = (struct eth_device *) malloc (sizeof (*dev));
  1485. if (dev == NULL) {
  1486. printf ("ppc_4xx_eth_initialize: "
  1487. "Cannot allocate eth_device %d\n", eth_num);
  1488. return (-1);
  1489. }
  1490. memset(dev, 0, sizeof(*dev));
  1491. /* Allocate our private use data */
  1492. hw = (EMAC_4XX_HW_PST) malloc (sizeof (*hw));
  1493. if (hw == NULL) {
  1494. printf ("ppc_4xx_eth_initialize: "
  1495. "Cannot allocate private hw data for eth_device %d",
  1496. eth_num);
  1497. free (dev);
  1498. return (-1);
  1499. }
  1500. memset(hw, 0, sizeof(*hw));
  1501. hw->hw_addr = hw_addr[eth_num];
  1502. memcpy (dev->enetaddr, ethaddr[eth_num], 6);
  1503. hw->devnum = eth_num;
  1504. hw->print_speed = 1;
  1505. sprintf (dev->name, "ppc_4xx_eth%d", eth_num - CONFIG_EMAC_NR_START);
  1506. dev->priv = (void *) hw;
  1507. dev->init = ppc_4xx_eth_init;
  1508. dev->halt = ppc_4xx_eth_halt;
  1509. dev->send = ppc_4xx_eth_send;
  1510. dev->recv = ppc_4xx_eth_rx;
  1511. if (0 == virgin) {
  1512. /* set the MAL IER ??? names may change with new spec ??? */
  1513. #if defined(CONFIG_440SPE) || \
  1514. defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
  1515. defined(CONFIG_405EX)
  1516. mal_ier =
  1517. MAL_IER_PT | MAL_IER_PRE | MAL_IER_PWE |
  1518. MAL_IER_DE | MAL_IER_OTE | MAL_IER_OE | MAL_IER_PE ;
  1519. #else
  1520. mal_ier =
  1521. MAL_IER_DE | MAL_IER_NE | MAL_IER_TE |
  1522. MAL_IER_OPBE | MAL_IER_PLBE;
  1523. #endif
  1524. mtdcr (malesr, 0xffffffff); /* clear pending interrupts */
  1525. mtdcr (maltxdeir, 0xffffffff); /* clear pending interrupts */
  1526. mtdcr (malrxdeir, 0xffffffff); /* clear pending interrupts */
  1527. mtdcr (malier, mal_ier);
  1528. /* install MAL interrupt handler */
  1529. irq_install_handler (VECNUM_MS,
  1530. (interrupt_handler_t *) enetInt,
  1531. dev);
  1532. irq_install_handler (VECNUM_MTE,
  1533. (interrupt_handler_t *) enetInt,
  1534. dev);
  1535. irq_install_handler (VECNUM_MRE,
  1536. (interrupt_handler_t *) enetInt,
  1537. dev);
  1538. irq_install_handler (VECNUM_TXDE,
  1539. (interrupt_handler_t *) enetInt,
  1540. dev);
  1541. irq_install_handler (VECNUM_RXDE,
  1542. (interrupt_handler_t *) enetInt,
  1543. dev);
  1544. virgin = 1;
  1545. }
  1546. #if defined(CONFIG_NET_MULTI)
  1547. eth_register (dev);
  1548. #else
  1549. emac0_dev = dev;
  1550. #endif
  1551. #if defined(CONFIG_NET_MULTI)
  1552. #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
  1553. miiphy_register (dev->name,
  1554. emac4xx_miiphy_read, emac4xx_miiphy_write);
  1555. #endif
  1556. #endif
  1557. } /* end for each supported device */
  1558. return (1);
  1559. }
  1560. #if !defined(CONFIG_NET_MULTI)
  1561. void eth_halt (void) {
  1562. if (emac0_dev) {
  1563. ppc_4xx_eth_halt(emac0_dev);
  1564. free(emac0_dev);
  1565. emac0_dev = NULL;
  1566. }
  1567. }
  1568. int eth_init (bd_t *bis)
  1569. {
  1570. ppc_4xx_eth_initialize(bis);
  1571. if (emac0_dev) {
  1572. return ppc_4xx_eth_init(emac0_dev, bis);
  1573. } else {
  1574. printf("ERROR: ethaddr not set!\n");
  1575. return -1;
  1576. }
  1577. }
  1578. int eth_send(volatile void *packet, int length)
  1579. {
  1580. return (ppc_4xx_eth_send(emac0_dev, packet, length));
  1581. }
  1582. int eth_rx(void)
  1583. {
  1584. return (ppc_4xx_eth_rx(emac0_dev));
  1585. }
  1586. int emac4xx_miiphy_initialize (bd_t * bis)
  1587. {
  1588. #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
  1589. miiphy_register ("ppc_4xx_eth0",
  1590. emac4xx_miiphy_read, emac4xx_miiphy_write);
  1591. #endif
  1592. return 0;
  1593. }
  1594. #endif /* !defined(CONFIG_NET_MULTI) */
  1595. #endif