netcmd.c 2.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113
  1. /* Network test commands: netinfo, netrecv, netsend. */
  2. #include "io.h"
  3. #include "timer.h"
  4. #include "ne2000.h"
  5. static void put_hex2(unsigned char v)
  6. {
  7. static const char hex[] = "0123456789ABCDEF";
  8. io_putchar(hex[(v >> 4) & 0xF]);
  9. io_putchar(hex[v & 0xF]);
  10. }
  11. static void put_dec(unsigned int v)
  12. {
  13. char b[12];
  14. int i = 0;
  15. if (v == 0) {
  16. io_putchar('0');
  17. return;
  18. }
  19. while (v) {
  20. b[i++] = (char)('0' + (v % 10));
  21. v /= 10;
  22. }
  23. while (i)
  24. io_putchar(b[--i]);
  25. }
  26. void program_netinfo_main(void)
  27. {
  28. ne2000_init();
  29. ne2000_print_info();
  30. }
  31. void program_netrecv_main(void)
  32. {
  33. unsigned char buf[2048];
  34. unsigned int deadline, count = 0;
  35. ne2000_init();
  36. if (!ne2000_present()) {
  37. io_putstr("netrecv: no NIC found\n");
  38. return;
  39. }
  40. io_putstr("netrecv: listening (8s)...\n");
  41. deadline = get_ticks_ms() + 8000;
  42. while (get_ticks_ms() < deadline) {
  43. int len = ne2000_rx(buf, sizeof(buf));
  44. unsigned int i;
  45. if (len < 0)
  46. continue;
  47. io_putstr("rx ");
  48. put_dec((unsigned int)len);
  49. io_putstr(" bytes:\n");
  50. for (i = 0; i < (unsigned int)len; i++) {
  51. put_hex2(buf[i]);
  52. io_putchar(' ');
  53. if ((i & 15) == 15)
  54. io_putchar('\n');
  55. }
  56. if (((unsigned int)len & 15) != 0)
  57. io_putchar('\n');
  58. if (++count >= 32)
  59. break;
  60. }
  61. io_putstr("netrecv: ");
  62. put_dec(count);
  63. io_putstr(" frame(s)\n");
  64. }
  65. void program_netsend_main(void)
  66. {
  67. unsigned char frame[64];
  68. unsigned char mac[6];
  69. unsigned int i;
  70. ne2000_init();
  71. if (!ne2000_present()) {
  72. io_putstr("netsend: no NIC found\n");
  73. return;
  74. }
  75. ne2000_get_mac(mac);
  76. /* Broadcast test frame: dst=ff:ff:ff:ff:ff:ff, src=our MAC,
  77. ethertype 0x88B5 (local experimental), payload "NEBS". */
  78. for (i = 0; i < 6; i++)
  79. frame[i] = 0xFF;
  80. for (i = 0; i < 6; i++)
  81. frame[6 + i] = mac[i];
  82. frame[12] = 0x88;
  83. frame[13] = 0xB5;
  84. frame[14] = 'N';
  85. frame[15] = 'E';
  86. frame[16] = 'B';
  87. frame[17] = 'S';
  88. for (i = 18; i < 64; i++)
  89. frame[i] = 0x00;
  90. if (ne2000_tx(frame, sizeof(frame)) != 0) {
  91. io_putstr("netsend: transmit failed\n");
  92. return;
  93. }
  94. io_putstr("netsend: sent 64-byte broadcast frame\n");
  95. }