go-dhcp/main.go

package main

import (
	"bytes"
	"encoding/binary"
	"net"
	"time"
	"unsafe"

	"go.uber.org/zap"
)

var leases []Lease = make([]Lease, 0)

func (dhcp DhcpMessage) Debug(s *zap.SugaredLogger) {
	s.Debugf("op=%x, htype=%x, hlen=%x, hops=%x", dhcp.Op, dhcp.Htype, dhcp.Hlen, dhcp.Hops)
	s.Debugf("xid=%x", dhcp.Xid)
	s.Debugf("secs=%d, flags=%x", dhcp.Secs, dhcp.Flags)

	s.Debugf("ciaddr=%x", dhcp.Ciaddr)
	s.Debugf("siaddr=%x", dhcp.Siaddr)
	s.Debugf("giaddr=%x", dhcp.Giaddr)
	s.Debugf("chaddr=%x", dhcp.Chaddr)

	s.Debugf("sname=%s", string(dhcp.Sname[:]))
	s.Debugf("file=%s", string(dhcp.File[:]))
	s.Debugf("magic=%x", dhcp.Magic)
}

func parseOptions(data []byte) Options {
	s := zap.S()
	i := 0

	options := make(Options)

out:
	for i < len(data) {
		code := OptionCode(data[i])
		switch code {
		case OptionEnd:
			s.Debug("Found END option at offset ", i)
			break out

		case OptionPad:
			s.Debug("Found padding option at offset ", i)
			i += 1
			continue
		}

		size := int(data[i+1])
		payload := data[i+2 : i+2+size]

		s.Debugf("code=%d, size=%d, payload=%x", code, size, payload)
		options[code] = Option{Code: code, Data: data[i+1 : i+2+size]}
		i += size + 2
	}

	s.Debugf("Parsed options: ", options)
	return options
}

func prepareOffer(request DhcpMessage) DhcpMessage {
	var sname [64]byte
	var file [128]byte
	copy(sname[:], "go-dhcp-server")

	dhcp := DhcpMessage{
		Op:     BOOTREPLY,
		Htype:  1, // Ethernet
		Hlen:   6, // Ethernet address length
		Hops:   0,
		Secs:   0,
		Flags:  request.Flags,
		Xid:    request.Xid,
		Siaddr: binary.BigEndian.Uint32(net.IPv4(10, 0, 0, 1).To4()),
		Ciaddr: 0,
		Yiaddr: binary.BigEndian.Uint32(net.IPv4(10, 0, 0, 2).To4()),
		Giaddr: request.Giaddr,
		Chaddr: request.Chaddr,
		Magic:  [4]byte{0x63, 0x82, 0x53, 0x63},
		Sname:  sname,
		File:   file,
	}
	return dhcp
}

func prepareAck(request DhcpMessage) DhcpMessage {
	var sname [64]byte
	var file [128]byte
	copy(sname[:], "go-dhcp-server")

	dhcp := DhcpMessage{
		Op:     BOOTREPLY,
		Htype:  1, // Ethernet
		Hlen:   6, // Ethernet address length
		Hops:   0,
		Secs:   0,
		Flags:  0,
		Xid:    request.Xid,
		Siaddr: binary.BigEndian.Uint32(net.IPv4(10, 0, 0, 1).To4()),
		Ciaddr: request.Ciaddr,
		Yiaddr: binary.BigEndian.Uint32(net.IPv4(10, 0, 0, 2).To4()),
		Giaddr: request.Giaddr,
		Chaddr: request.Chaddr,
		Magic:  [4]byte{0x63, 0x82, 0x53, 0x63},
		Sname:  sname,
		File:   file,
	}
	return dhcp
}

// sendMessage transmits a DHCP message with options via a UDP connection
// The end option (code 255) is automatically appended and does not need to
// be passed explicitly.
func sendMessage(conn *net.UDPConn, message DhcpMessage, options []Option) error {
	buf := make([]byte, 0)
	w := bytes.NewBuffer(buf)
	err := binary.Write(w, binary.BigEndian, message)
	if err != nil {
		return err
	}

	for _, v := range options {
		err = w.WriteByte(byte(v.Code))
		if err != nil {
			return err
		}
		_, err = w.Write(v.Data)
		if err != nil {
			return err
		}
	}

	// Automatically add END option, so the caller doesn't
	// need to specificy it for every invocation.
	err = w.WriteByte(byte(OptionEnd))
	if err != nil {
		return err
	}

	msg := w.Bytes()
	zap.S().Debug("Msg", msg)
	_, err = conn.Write(msg)
	if err != nil {
		return err
	}

	return nil
}

func handleOffer(dhcp DhcpMessage, remote *net.UDPAddr) error {
	s := zap.S()

	offer := prepareOffer(dhcp)
	localAddr, _ := net.ResolveUDPAddr("udp", "172.17.0.1:68")
	clientAddr, _ := net.ResolveUDPAddr("udp", "255.255.255.255:68")
	conn, err := net.DialUDP("udp", localAddr, clientAddr)
	if err != nil {
		panic(err)
	}
	defer conn.Close()

	s.Info("Sending DHCPOFFER...")
	options := []Option{
		{
			Code: OptionDHCPMessageType,
			Data: []byte{1, byte(MessageTypeOffer)},
		},
	}
	sendMessage(conn, offer, options)
	return nil
}

func handleAck(dhcp DhcpMessage, remote *net.UDPAddr) error {
	s := zap.S()

	ack := prepareAck(dhcp)

	options := []Option{
		{
			Code: OptionDHCPMessageType,
			Data: []byte{1, byte(MessageTypeAck)},
		},
		{
			Code: OptionIPAddressLeaseTime,
			Data: append([]byte{4}, u32tob(3600)...),
		},
	}
	s.Debug("Options: ", options)

	localAddr, _ := net.ResolveUDPAddr("udp", "172.17.0.1:68")
	clientAddr, _ := net.ResolveUDPAddr("udp", "255.255.255.255:68")
	conn, err := net.DialUDP("udp", localAddr, clientAddr)
	if err != nil {
		panic(err)
	}
	defer conn.Close()

	s.Info("Sending DHCPACK")
	sendMessage(conn, ack, options)

	lease := Lease{
		TransactionId: ack.Xid,
		TTL:           time.Now().Add(1 * time.Hour),
		State:         Requested,
		ClientAddr:    ack.Chaddr,
		Address:       int2ip(ack.Yiaddr),
	}
	leases = append(leases, lease)

	return nil
}

func handleMsg(data []byte, remote *net.UDPAddr) {
	s := zap.S()

	s.Debugf("Connection from client %v", remote.IP)

	var dhcp DhcpMessage
	reader := bytes.NewReader(data)
	binary.Read(reader, binary.BigEndian, &dhcp)
	dhcp.Debug(s)

	if dhcp.Magic != [4]byte{0x63, 0x82, 0x53, 0x63} {
		panic("Invalid DHCP magic field")
	}

	optDataOffset := int(unsafe.Sizeof(dhcp))
	optData := data[optDataOffset:]
	s.Debug("Raw options data:", optData)

	options := parseOptions(optData)
	dhcpMsgType := options[OptionDHCPMessageType]
	s.Info("DHCP message type ", dhcpMsgType)

	switch MessageType(dhcpMsgType.Data[1]) {
	case MessageTypeDiscover:
		go handleOffer(dhcp, remote)

	case MessageTypeRequest:
		go handleAck(dhcp, remote)
	}
}

func main() {
	// Set up logging
	logger, _ := zap.NewDevelopment()
	defer logger.Sync() // flushes buffer, if any
	zap.ReplaceGlobals(logger)

	addr, _ := net.ResolveUDPAddr("udp4", ":67")
	conn, err := net.ListenUDP("udp4", addr)
	if err != nil {
		panic(err)
	}
	defer conn.Close()

	zap.L().Info("Listening for incoming connections")

	for {
		buf := make([]byte, 1024)
		rlen, remote, err := conn.ReadFrom(buf[:])
		if err != nil {
			panic(err)
		}

		// Do stuff with the read bytes
		remoteAddr, ok := remote.(*net.UDPAddr)
		if !ok {
			zap.S().Warn("Not a valid remote IP address: ", remote)
			continue
		}
		go handleMsg(buf[0:rlen], remoteAddr)
	}
}