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