10e552da7Schristos #include <assert.h>
20e552da7Schristos #include <stdio.h>
30e552da7Schristos #include <stdlib.h>
40e552da7Schristos #include <string.h>
50e552da7Schristos
60e552da7Schristos #include <uv.h>
70e552da7Schristos
80e552da7Schristos uv_loop_t *loop;
90e552da7Schristos uv_udp_t send_socket;
100e552da7Schristos uv_udp_t recv_socket;
110e552da7Schristos
alloc_buffer(uv_handle_t * handle,size_t suggested_size,uv_buf_t * buf)120e552da7Schristos void alloc_buffer(uv_handle_t *handle, size_t suggested_size, uv_buf_t *buf) {
130e552da7Schristos buf->base = malloc(suggested_size);
140e552da7Schristos buf->len = suggested_size;
150e552da7Schristos }
160e552da7Schristos
on_read(uv_udp_t * req,ssize_t nread,const uv_buf_t * buf,const struct sockaddr * addr,unsigned flags)170e552da7Schristos void on_read(uv_udp_t *req, ssize_t nread, const uv_buf_t *buf, const struct sockaddr *addr, unsigned flags) {
180e552da7Schristos if (nread < 0) {
190e552da7Schristos fprintf(stderr, "Read error %s\n", uv_err_name(nread));
200e552da7Schristos uv_close((uv_handle_t*) req, NULL);
210e552da7Schristos free(buf->base);
220e552da7Schristos return;
230e552da7Schristos }
240e552da7Schristos
250e552da7Schristos char sender[17] = { 0 };
260e552da7Schristos uv_ip4_name((const struct sockaddr_in*) addr, sender, 16);
270e552da7Schristos fprintf(stderr, "Recv from %s\n", sender);
280e552da7Schristos
290e552da7Schristos // ... DHCP specific code
300e552da7Schristos unsigned int *as_integer = (unsigned int*)buf->base;
310e552da7Schristos unsigned int ipbin = ntohl(as_integer[4]);
320e552da7Schristos unsigned char ip[4] = {0};
330e552da7Schristos int i;
340e552da7Schristos for (i = 0; i < 4; i++)
350e552da7Schristos ip[i] = (ipbin >> i*8) & 0xff;
360e552da7Schristos fprintf(stderr, "Offered IP %d.%d.%d.%d\n", ip[3], ip[2], ip[1], ip[0]);
370e552da7Schristos
380e552da7Schristos free(buf->base);
390e552da7Schristos uv_udp_recv_stop(req);
400e552da7Schristos }
410e552da7Schristos
make_discover_msg()420e552da7Schristos uv_buf_t make_discover_msg() {
430e552da7Schristos uv_buf_t buffer;
440e552da7Schristos alloc_buffer(NULL, 256, &buffer);
450e552da7Schristos memset(buffer.base, 0, buffer.len);
460e552da7Schristos
470e552da7Schristos // BOOTREQUEST
480e552da7Schristos buffer.base[0] = 0x1;
490e552da7Schristos // HTYPE ethernet
500e552da7Schristos buffer.base[1] = 0x1;
510e552da7Schristos // HLEN
520e552da7Schristos buffer.base[2] = 0x6;
530e552da7Schristos // HOPS
540e552da7Schristos buffer.base[3] = 0x0;
550e552da7Schristos // XID 4 bytes
56*5f2f4271Schristos if (uv_random(NULL, NULL, &buffer.base[4], 4, 0, NULL))
57*5f2f4271Schristos abort();
580e552da7Schristos // SECS
590e552da7Schristos buffer.base[8] = 0x0;
600e552da7Schristos // FLAGS
610e552da7Schristos buffer.base[10] = 0x80;
620e552da7Schristos // CIADDR 12-15 is all zeros
630e552da7Schristos // YIADDR 16-19 is all zeros
640e552da7Schristos // SIADDR 20-23 is all zeros
650e552da7Schristos // GIADDR 24-27 is all zeros
660e552da7Schristos // CHADDR 28-43 is the MAC address, use your own
670e552da7Schristos buffer.base[28] = 0xe4;
680e552da7Schristos buffer.base[29] = 0xce;
690e552da7Schristos buffer.base[30] = 0x8f;
700e552da7Schristos buffer.base[31] = 0x13;
710e552da7Schristos buffer.base[32] = 0xf6;
720e552da7Schristos buffer.base[33] = 0xd4;
730e552da7Schristos // SNAME 64 bytes zero
740e552da7Schristos // FILE 128 bytes zero
750e552da7Schristos // OPTIONS
760e552da7Schristos // - magic cookie
770e552da7Schristos buffer.base[236] = 99;
780e552da7Schristos buffer.base[237] = 130;
790e552da7Schristos buffer.base[238] = 83;
800e552da7Schristos buffer.base[239] = 99;
810e552da7Schristos
820e552da7Schristos // DHCP Message type
830e552da7Schristos buffer.base[240] = 53;
840e552da7Schristos buffer.base[241] = 1;
850e552da7Schristos buffer.base[242] = 1; // DHCPDISCOVER
860e552da7Schristos
870e552da7Schristos // DHCP Parameter request list
880e552da7Schristos buffer.base[243] = 55;
890e552da7Schristos buffer.base[244] = 4;
900e552da7Schristos buffer.base[245] = 1;
910e552da7Schristos buffer.base[246] = 3;
920e552da7Schristos buffer.base[247] = 15;
930e552da7Schristos buffer.base[248] = 6;
940e552da7Schristos
950e552da7Schristos return buffer;
960e552da7Schristos }
970e552da7Schristos
on_send(uv_udp_send_t * req,int status)980e552da7Schristos void on_send(uv_udp_send_t *req, int status) {
990e552da7Schristos if (status) {
1000e552da7Schristos fprintf(stderr, "Send error %s\n", uv_strerror(status));
1010e552da7Schristos return;
1020e552da7Schristos }
1030e552da7Schristos }
1040e552da7Schristos
main()1050e552da7Schristos int main() {
1060e552da7Schristos loop = uv_default_loop();
1070e552da7Schristos
1080e552da7Schristos uv_udp_init(loop, &recv_socket);
1090e552da7Schristos struct sockaddr_in recv_addr;
1100e552da7Schristos uv_ip4_addr("0.0.0.0", 68, &recv_addr);
1110e552da7Schristos uv_udp_bind(&recv_socket, (const struct sockaddr *)&recv_addr, UV_UDP_REUSEADDR);
1120e552da7Schristos uv_udp_recv_start(&recv_socket, alloc_buffer, on_read);
1130e552da7Schristos
1140e552da7Schristos uv_udp_init(loop, &send_socket);
1150e552da7Schristos struct sockaddr_in broadcast_addr;
1160e552da7Schristos uv_ip4_addr("0.0.0.0", 0, &broadcast_addr);
1170e552da7Schristos uv_udp_bind(&send_socket, (const struct sockaddr *)&broadcast_addr, 0);
1180e552da7Schristos uv_udp_set_broadcast(&send_socket, 1);
1190e552da7Schristos
1200e552da7Schristos uv_udp_send_t send_req;
1210e552da7Schristos uv_buf_t discover_msg = make_discover_msg();
1220e552da7Schristos
1230e552da7Schristos struct sockaddr_in send_addr;
1240e552da7Schristos uv_ip4_addr("255.255.255.255", 67, &send_addr);
1250e552da7Schristos uv_udp_send(&send_req, &send_socket, &discover_msg, 1, (const struct sockaddr *)&send_addr, on_send);
1260e552da7Schristos
1270e552da7Schristos return uv_run(loop, UV_RUN_DEFAULT);
1280e552da7Schristos }
129