main.c 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127
  1. #include <assert.h>
  2. #include <stdio.h>
  3. #include <stdlib.h>
  4. #include <string.h>
  5. #include <uv.h>
  6. uv_loop_t *loop;
  7. uv_udp_t send_socket;
  8. uv_udp_t recv_socket;
  9. void alloc_buffer(uv_handle_t *handle, size_t suggested_size, uv_buf_t *buf) {
  10. buf->base = malloc(suggested_size);
  11. buf->len = suggested_size;
  12. }
  13. void on_read(uv_udp_t *req, ssize_t nread, const uv_buf_t *buf, const struct sockaddr *addr, unsigned flags) {
  14. if (nread < 0) {
  15. fprintf(stderr, "Read error %s\n", uv_err_name(nread));
  16. uv_close((uv_handle_t*) req, NULL);
  17. free(buf->base);
  18. return;
  19. }
  20. char sender[17] = { 0 };
  21. uv_ip4_name((const struct sockaddr_in*) addr, sender, 16);
  22. fprintf(stderr, "Recv from %s\n", sender);
  23. // ... DHCP specific code
  24. unsigned int *as_integer = (unsigned int*)buf->base;
  25. unsigned int ipbin = ntohl(as_integer[4]);
  26. unsigned char ip[4] = {0};
  27. int i;
  28. for (i = 0; i < 4; i++)
  29. ip[i] = (ipbin >> i*8) & 0xff;
  30. fprintf(stderr, "Offered IP %d.%d.%d.%d\n", ip[3], ip[2], ip[1], ip[0]);
  31. free(buf->base);
  32. uv_udp_recv_stop(req);
  33. }
  34. uv_buf_t make_discover_msg() {
  35. uv_buf_t buffer;
  36. alloc_buffer(NULL, 256, &buffer);
  37. memset(buffer.base, 0, buffer.len);
  38. // BOOTREQUEST
  39. buffer.base[0] = 0x1;
  40. // HTYPE ethernet
  41. buffer.base[1] = 0x1;
  42. // HLEN
  43. buffer.base[2] = 0x6;
  44. // HOPS
  45. buffer.base[3] = 0x0;
  46. // XID 4 bytes
  47. buffer.base[4] = (unsigned int) random();
  48. // SECS
  49. buffer.base[8] = 0x0;
  50. // FLAGS
  51. buffer.base[10] = 0x80;
  52. // CIADDR 12-15 is all zeros
  53. // YIADDR 16-19 is all zeros
  54. // SIADDR 20-23 is all zeros
  55. // GIADDR 24-27 is all zeros
  56. // CHADDR 28-43 is the MAC address, use your own
  57. buffer.base[28] = 0xe4;
  58. buffer.base[29] = 0xce;
  59. buffer.base[30] = 0x8f;
  60. buffer.base[31] = 0x13;
  61. buffer.base[32] = 0xf6;
  62. buffer.base[33] = 0xd4;
  63. // SNAME 64 bytes zero
  64. // FILE 128 bytes zero
  65. // OPTIONS
  66. // - magic cookie
  67. buffer.base[236] = 99;
  68. buffer.base[237] = 130;
  69. buffer.base[238] = 83;
  70. buffer.base[239] = 99;
  71. // DHCP Message type
  72. buffer.base[240] = 53;
  73. buffer.base[241] = 1;
  74. buffer.base[242] = 1; // DHCPDISCOVER
  75. // DHCP Parameter request list
  76. buffer.base[243] = 55;
  77. buffer.base[244] = 4;
  78. buffer.base[245] = 1;
  79. buffer.base[246] = 3;
  80. buffer.base[247] = 15;
  81. buffer.base[248] = 6;
  82. return buffer;
  83. }
  84. void on_send(uv_udp_send_t *req, int status) {
  85. if (status) {
  86. fprintf(stderr, "Send error %s\n", uv_strerror(status));
  87. return;
  88. }
  89. }
  90. int main() {
  91. loop = uv_default_loop();
  92. uv_udp_init(loop, &recv_socket);
  93. struct sockaddr_in recv_addr;
  94. uv_ip4_addr("0.0.0.0", 68, &recv_addr);
  95. uv_udp_bind(&recv_socket, (const struct sockaddr *)&recv_addr, UV_UDP_REUSEADDR);
  96. uv_udp_recv_start(&recv_socket, alloc_buffer, on_read);
  97. uv_udp_init(loop, &send_socket);
  98. struct sockaddr_in broadcast_addr;
  99. uv_ip4_addr("0.0.0.0", 0, &broadcast_addr);
  100. uv_udp_bind(&send_socket, (const struct sockaddr *)&broadcast_addr, 0);
  101. uv_udp_set_broadcast(&send_socket, 1);
  102. uv_udp_send_t send_req;
  103. uv_buf_t discover_msg = make_discover_msg();
  104. struct sockaddr_in send_addr;
  105. uv_ip4_addr("255.255.255.255", 67, &send_addr);
  106. uv_udp_send(&send_req, &send_socket, &discover_msg, 1, (const struct sockaddr *)&send_addr, on_send);
  107. return uv_run(loop, UV_RUN_DEFAULT);
  108. }