4xx_enet.c 52 KB

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