eth.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520
  1. /*
  2. * (C) Copyright 2001-2004
  3. * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  4. *
  5. * See file CREDITS for list of people who contributed to this
  6. * project.
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License as
  10. * published by the Free Software Foundation; either version 2 of
  11. * the License, or (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21. * MA 02111-1307 USA
  22. */
  23. #include <common.h>
  24. #include <command.h>
  25. #include <net.h>
  26. #include <miiphy.h>
  27. void eth_parse_enetaddr(const char *addr, uchar *enetaddr)
  28. {
  29. char *end;
  30. int i;
  31. for (i = 0; i < 6; ++i) {
  32. enetaddr[i] = addr ? simple_strtoul(addr, &end, 16) : 0;
  33. if (addr)
  34. addr = (*end) ? end + 1 : end;
  35. }
  36. }
  37. int eth_getenv_enetaddr(char *name, uchar *enetaddr)
  38. {
  39. eth_parse_enetaddr(getenv(name), enetaddr);
  40. return is_valid_ether_addr(enetaddr);
  41. }
  42. int eth_setenv_enetaddr(char *name, const uchar *enetaddr)
  43. {
  44. char buf[20];
  45. sprintf(buf, "%pM", enetaddr);
  46. return setenv(name, buf);
  47. }
  48. int eth_getenv_enetaddr_by_index(int index, uchar *enetaddr)
  49. {
  50. char enetvar[32];
  51. sprintf(enetvar, index ? "eth%daddr" : "ethaddr", index);
  52. return eth_getenv_enetaddr(enetvar, enetaddr);
  53. }
  54. #ifdef CONFIG_NET_MULTI
  55. /*
  56. * CPU and board-specific Ethernet initializations. Aliased function
  57. * signals caller to move on
  58. */
  59. static int __def_eth_init(bd_t *bis)
  60. {
  61. return -1;
  62. }
  63. int cpu_eth_init(bd_t *bis) __attribute__((weak, alias("__def_eth_init")));
  64. int board_eth_init(bd_t *bis) __attribute__((weak, alias("__def_eth_init")));
  65. extern int mv6436x_eth_initialize(bd_t *);
  66. extern int mv6446x_eth_initialize(bd_t *);
  67. #ifdef CONFIG_API
  68. extern void (*push_packet)(volatile void *, int);
  69. static struct {
  70. uchar data[PKTSIZE];
  71. int length;
  72. } eth_rcv_bufs[PKTBUFSRX];
  73. static unsigned int eth_rcv_current = 0, eth_rcv_last = 0;
  74. #endif
  75. static struct eth_device *eth_devices, *eth_current;
  76. struct eth_device *eth_get_dev(void)
  77. {
  78. return eth_current;
  79. }
  80. struct eth_device *eth_get_dev_by_name(char *devname)
  81. {
  82. struct eth_device *dev, *target_dev;
  83. if (!eth_devices)
  84. return NULL;
  85. dev = eth_devices;
  86. target_dev = NULL;
  87. do {
  88. if (strcmp(devname, dev->name) == 0) {
  89. target_dev = dev;
  90. break;
  91. }
  92. dev = dev->next;
  93. } while (dev != eth_devices);
  94. return target_dev;
  95. }
  96. struct eth_device *eth_get_dev_by_index(int index)
  97. {
  98. struct eth_device *dev, *target_dev;
  99. int idx = 0;
  100. if (!eth_devices)
  101. return NULL;
  102. dev = eth_devices;
  103. target_dev = NULL;
  104. do {
  105. if (idx == index) {
  106. target_dev = dev;
  107. break;
  108. }
  109. dev = dev->next;
  110. idx++;
  111. } while (dev != eth_devices);
  112. return target_dev;
  113. }
  114. int eth_get_dev_index (void)
  115. {
  116. struct eth_device *dev;
  117. int num = 0;
  118. if (!eth_devices) {
  119. return (-1);
  120. }
  121. for (dev = eth_devices; dev; dev = dev->next) {
  122. if (dev == eth_current)
  123. break;
  124. ++num;
  125. }
  126. if (dev) {
  127. return (num);
  128. }
  129. return (0);
  130. }
  131. int eth_register(struct eth_device* dev)
  132. {
  133. struct eth_device *d;
  134. if (!eth_devices) {
  135. eth_current = eth_devices = dev;
  136. #ifdef CONFIG_NET_MULTI
  137. /* update current ethernet name */
  138. {
  139. char *act = getenv("ethact");
  140. if (act == NULL || strcmp(act, eth_current->name) != 0)
  141. setenv("ethact", eth_current->name);
  142. }
  143. #endif
  144. } else {
  145. for (d=eth_devices; d->next!=eth_devices; d=d->next);
  146. d->next = dev;
  147. }
  148. dev->state = ETH_STATE_INIT;
  149. dev->next = eth_devices;
  150. return 0;
  151. }
  152. int eth_initialize(bd_t *bis)
  153. {
  154. unsigned char env_enetaddr[6];
  155. int eth_number = 0;
  156. eth_devices = NULL;
  157. eth_current = NULL;
  158. show_boot_progress (64);
  159. #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
  160. miiphy_init();
  161. #endif
  162. /* Try board-specific initialization first. If it fails or isn't
  163. * present, try the cpu-specific initialization */
  164. if (board_eth_init(bis) < 0)
  165. cpu_eth_init(bis);
  166. #if defined(CONFIG_DB64360) || defined(CONFIG_CPCI750)
  167. mv6436x_eth_initialize(bis);
  168. #endif
  169. #if defined(CONFIG_DB64460) || defined(CONFIG_P3Mx)
  170. mv6446x_eth_initialize(bis);
  171. #endif
  172. if (!eth_devices) {
  173. puts ("No ethernet found.\n");
  174. show_boot_progress (-64);
  175. } else {
  176. struct eth_device *dev = eth_devices;
  177. char *ethprime = getenv ("ethprime");
  178. show_boot_progress (65);
  179. do {
  180. if (eth_number)
  181. puts (", ");
  182. printf("%s", dev->name);
  183. if (ethprime && strcmp (dev->name, ethprime) == 0) {
  184. eth_current = dev;
  185. puts (" [PRIME]");
  186. }
  187. eth_getenv_enetaddr_by_index(eth_number, env_enetaddr);
  188. if (memcmp(env_enetaddr, "\0\0\0\0\0\0", 6)) {
  189. if (memcmp(dev->enetaddr, "\0\0\0\0\0\0", 6) &&
  190. memcmp(dev->enetaddr, env_enetaddr, 6))
  191. {
  192. printf ("\nWarning: %s MAC addresses don't match:\n",
  193. dev->name);
  194. printf ("Address in SROM is %pM\n",
  195. dev->enetaddr);
  196. printf ("Address in environment is %pM\n",
  197. env_enetaddr);
  198. }
  199. memcpy(dev->enetaddr, env_enetaddr, 6);
  200. }
  201. eth_number++;
  202. dev = dev->next;
  203. } while(dev != eth_devices);
  204. #ifdef CONFIG_NET_MULTI
  205. /* update current ethernet name */
  206. if (eth_current) {
  207. char *act = getenv("ethact");
  208. if (act == NULL || strcmp(act, eth_current->name) != 0)
  209. setenv("ethact", eth_current->name);
  210. } else
  211. setenv("ethact", NULL);
  212. #endif
  213. putc ('\n');
  214. }
  215. return eth_number;
  216. }
  217. #ifdef CONFIG_MCAST_TFTP
  218. /* Multicast.
  219. * mcast_addr: multicast ipaddr from which multicast Mac is made
  220. * join: 1=join, 0=leave.
  221. */
  222. int eth_mcast_join( IPaddr_t mcast_ip, u8 join)
  223. {
  224. u8 mcast_mac[6];
  225. if (!eth_current || !eth_current->mcast)
  226. return -1;
  227. mcast_mac[5] = htonl(mcast_ip) & 0xff;
  228. mcast_mac[4] = (htonl(mcast_ip)>>8) & 0xff;
  229. mcast_mac[3] = (htonl(mcast_ip)>>16) & 0x7f;
  230. mcast_mac[2] = 0x5e;
  231. mcast_mac[1] = 0x0;
  232. mcast_mac[0] = 0x1;
  233. return eth_current->mcast(eth_current, mcast_mac, join);
  234. }
  235. /* the 'way' for ethernet-CRC-32. Spliced in from Linux lib/crc32.c
  236. * and this is the ethernet-crc method needed for TSEC -- and perhaps
  237. * some other adapter -- hash tables
  238. */
  239. #define CRCPOLY_LE 0xedb88320
  240. u32 ether_crc (size_t len, unsigned char const *p)
  241. {
  242. int i;
  243. u32 crc;
  244. crc = ~0;
  245. while (len--) {
  246. crc ^= *p++;
  247. for (i = 0; i < 8; i++)
  248. crc = (crc >> 1) ^ ((crc & 1) ? CRCPOLY_LE : 0);
  249. }
  250. /* an reverse the bits, cuz of way they arrive -- last-first */
  251. crc = (crc >> 16) | (crc << 16);
  252. crc = (crc >> 8 & 0x00ff00ff) | (crc << 8 & 0xff00ff00);
  253. crc = (crc >> 4 & 0x0f0f0f0f) | (crc << 4 & 0xf0f0f0f0);
  254. crc = (crc >> 2 & 0x33333333) | (crc << 2 & 0xcccccccc);
  255. crc = (crc >> 1 & 0x55555555) | (crc << 1 & 0xaaaaaaaa);
  256. return crc;
  257. }
  258. #endif
  259. int eth_init(bd_t *bis)
  260. {
  261. int eth_number;
  262. struct eth_device *old_current, *dev;
  263. if (!eth_current) {
  264. puts ("No ethernet found.\n");
  265. return -1;
  266. }
  267. /* Sync environment with network devices */
  268. eth_number = 0;
  269. dev = eth_devices;
  270. do {
  271. uchar env_enetaddr[6];
  272. if (eth_getenv_enetaddr_by_index(eth_number, env_enetaddr))
  273. memcpy(dev->enetaddr, env_enetaddr, 6);
  274. ++eth_number;
  275. dev = dev->next;
  276. } while (dev != eth_devices);
  277. old_current = eth_current;
  278. do {
  279. debug("Trying %s\n", eth_current->name);
  280. if (eth_current->init(eth_current,bis) >= 0) {
  281. eth_current->state = ETH_STATE_ACTIVE;
  282. return 0;
  283. }
  284. debug("FAIL\n");
  285. eth_try_another(0);
  286. } while (old_current != eth_current);
  287. return -1;
  288. }
  289. void eth_halt(void)
  290. {
  291. if (!eth_current)
  292. return;
  293. eth_current->halt(eth_current);
  294. eth_current->state = ETH_STATE_PASSIVE;
  295. }
  296. int eth_send(volatile void *packet, int length)
  297. {
  298. if (!eth_current)
  299. return -1;
  300. return eth_current->send(eth_current, packet, length);
  301. }
  302. int eth_rx(void)
  303. {
  304. if (!eth_current)
  305. return -1;
  306. return eth_current->recv(eth_current);
  307. }
  308. #ifdef CONFIG_API
  309. static void eth_save_packet(volatile void *packet, int length)
  310. {
  311. volatile char *p = packet;
  312. int i;
  313. if ((eth_rcv_last+1) % PKTBUFSRX == eth_rcv_current)
  314. return;
  315. if (PKTSIZE < length)
  316. return;
  317. for (i = 0; i < length; i++)
  318. eth_rcv_bufs[eth_rcv_last].data[i] = p[i];
  319. eth_rcv_bufs[eth_rcv_last].length = length;
  320. eth_rcv_last = (eth_rcv_last + 1) % PKTBUFSRX;
  321. }
  322. int eth_receive(volatile void *packet, int length)
  323. {
  324. volatile char *p = packet;
  325. void *pp = push_packet;
  326. int i;
  327. if (eth_rcv_current == eth_rcv_last) {
  328. push_packet = eth_save_packet;
  329. eth_rx();
  330. push_packet = pp;
  331. if (eth_rcv_current == eth_rcv_last)
  332. return -1;
  333. }
  334. if (length < eth_rcv_bufs[eth_rcv_current].length)
  335. return -1;
  336. length = eth_rcv_bufs[eth_rcv_current].length;
  337. for (i = 0; i < length; i++)
  338. p[i] = eth_rcv_bufs[eth_rcv_current].data[i];
  339. eth_rcv_current = (eth_rcv_current + 1) % PKTBUFSRX;
  340. return length;
  341. }
  342. #endif /* CONFIG_API */
  343. void eth_try_another(int first_restart)
  344. {
  345. static struct eth_device *first_failed = NULL;
  346. char *ethrotate;
  347. /*
  348. * Do not rotate between network interfaces when
  349. * 'ethrotate' variable is set to 'no'.
  350. */
  351. if (((ethrotate = getenv ("ethrotate")) != NULL) &&
  352. (strcmp(ethrotate, "no") == 0))
  353. return;
  354. if (!eth_current)
  355. return;
  356. if (first_restart) {
  357. first_failed = eth_current;
  358. }
  359. eth_current = eth_current->next;
  360. #ifdef CONFIG_NET_MULTI
  361. /* update current ethernet name */
  362. {
  363. char *act = getenv("ethact");
  364. if (act == NULL || strcmp(act, eth_current->name) != 0)
  365. setenv("ethact", eth_current->name);
  366. }
  367. #endif
  368. if (first_failed == eth_current) {
  369. NetRestartWrap = 1;
  370. }
  371. }
  372. #ifdef CONFIG_NET_MULTI
  373. void eth_set_current(void)
  374. {
  375. static char *act = NULL;
  376. static int env_changed_id = 0;
  377. struct eth_device* old_current;
  378. int env_id;
  379. if (!eth_current) /* XXX no current */
  380. return;
  381. env_id = get_env_id();
  382. if ((act == NULL) || (env_changed_id != env_id)) {
  383. act = getenv("ethact");
  384. env_changed_id = env_id;
  385. }
  386. if (act != NULL) {
  387. old_current = eth_current;
  388. do {
  389. if (strcmp(eth_current->name, act) == 0)
  390. return;
  391. eth_current = eth_current->next;
  392. } while (old_current != eth_current);
  393. }
  394. setenv("ethact", eth_current->name);
  395. }
  396. #endif
  397. char *eth_get_name (void)
  398. {
  399. return (eth_current ? eth_current->name : "unknown");
  400. }
  401. #else /* !CONFIG_NET_MULTI */
  402. #warning Ethernet driver is deprecated. Please update to use CONFIG_NET_MULTI
  403. extern int at91rm9200_miiphy_initialize(bd_t *bis);
  404. extern int mcf52x2_miiphy_initialize(bd_t *bis);
  405. extern int ns7520_miiphy_initialize(bd_t *bis);
  406. int eth_initialize(bd_t *bis)
  407. {
  408. #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
  409. miiphy_init();
  410. #endif
  411. #if defined(CONFIG_AT91RM9200)
  412. at91rm9200_miiphy_initialize(bis);
  413. #endif
  414. #if defined(CONFIG_MCF52x2)
  415. mcf52x2_miiphy_initialize(bis);
  416. #endif
  417. #if defined(CONFIG_DRIVER_NS7520_ETHERNET)
  418. ns7520_miiphy_initialize(bis);
  419. #endif
  420. return 0;
  421. }
  422. #endif