netboot/dhcp/dhcp.go

// Package dhcp implements parsing and serialization of DHCP packets.
package dhcp

import (
	"bytes"
	"encoding/binary"
	"errors"
	"fmt"
	"io"
	"net"
	"sort"
)

var magic = []byte{99, 130, 83, 99}

// MessageType is the type of a DHCP message.
type MessageType int

// Message types as described in RFC 2131.
const (
	MsgDiscover MessageType = iota + 1
	MsgOffer
	MsgRequest
	MsgDecline
	MsgAck
	MsgNack
	MsgRelease
	MsgInform
)

func (mt MessageType) String() string {
	switch mt {
	case MsgDiscover:
		return "DHCPDISCOVER"
	case MsgOffer:
		return "DHCPOFFER"
	case MsgRequest:
		return "DHCPREQUEST"
	case MsgDecline:
		return "DHCPDECLINE"
	case MsgAck:
		return "DHCPACK"
	case MsgNack:
		return "DHCPNAK"
	case MsgRelease:
		return "DHCPRELEASE"
	case MsgInform:
		return "DHCPINFORM"
	default:
		return fmt.Sprintf("<unknown DHCP message type %d>", mt)
	}
}

// Packet represents a DHCP packet.
type Packet struct {
	Type          MessageType
	TransactionID string
	Broadcast     bool
	HardwareAddr  net.HardwareAddr // Only ethernet supported at the moment

	ClientAddr net.IP // Client's current IP address (it will respond to ARP for this IP)
	YourAddr   net.IP // Client IP address offered/assigned by server
	ServerAddr net.IP // Responding server's IP address
	RelayAddr  net.IP // IP address of DHCP relay agent, if an agent forwarded the request

	BootServerName string
	BootFilename   string

	Options Options
}

func (p *Packet) testString() string {
	var b bytes.Buffer
	bcast := "Unicast"
	if p.Broadcast {
		bcast = "Broadcast"
	}
	fmt.Fprintf(&b, `=====
%s
  %#v
  %s
  MAC: %s
  ClientIP: %s
  YourIP: %s
  ServerIP: %s
  RelayIP: %s

  BootServerName: %s
  BootFilename: %s

  Options:
`, p.Type, p.TransactionID, bcast, p.HardwareAddr, p.ClientAddr, p.YourAddr, p.ServerAddr, p.RelayAddr, p.BootServerName, p.BootFilename)

	var opts []int
	for n := range p.Options {
		opts = append(opts, n)
	}
	sort.Ints(opts)
	for _, n := range opts {
		fmt.Fprintf(&b, "    %d: %#v\n", n, p.Options[n])
	}
	b.WriteString("=====\n")
	return b.String()
}

// Marshal returns the wire encoding of p.
func (p *Packet) Marshal() ([]byte, error) {
	if len(p.TransactionID) != 4 {
		return nil, errors.New("transaction ID must be 4 bytes")
	}
	if len(p.HardwareAddr) != 6 {
		return nil, errors.New("non-ethernet hardware address not supported")
	}
	if len(p.BootServerName) > 64 {
		return nil, errors.New("sname must be <= 64 bytes")
	}
	optsInFile, optsInSname := false, false
	v, ok := p.Options.Byte(52)
	if ok {
		optsInFile, optsInFile = v&1 != 0, v&2 != 0
	}
	if optsInFile && p.BootFilename != "" {
		return nil, errors.New("DHCP option 52 says to use the 'file' field for options, but BootFilename is not empty")
	}
	if optsInSname && p.BootServerName != "" {
		return nil, errors.New("DHCP option 52 says to use the 'sname' field for options, but BootServerName is not empty")
	}

	ret := new(bytes.Buffer)
	ret.Grow(244)

	switch p.Type {
	case MsgDiscover, MsgRequest, MsgDecline, MsgRelease, MsgInform:
		ret.WriteByte(1)
	case MsgOffer, MsgAck, MsgNack:
		ret.WriteByte(2)
	default:
		return nil, fmt.Errorf("unknown DHCP message type %d", p.Type)
	}
	// Hardware address type = Ethernet
	ret.WriteByte(1)
	// Hardware address length = 6
	ret.WriteByte(6)
	// Hops = 0
	ret.WriteByte(0)
	// Transaction ID
	ret.WriteString(p.TransactionID)
	// Seconds elapsed
	ret.Write([]byte{0, 0})
	// Broadcast flag
	if p.Broadcast {
		ret.Write([]byte{0x80, 0})
	} else {
		ret.Write([]byte{0, 0})
	}

	writeIP(ret, p.ClientAddr)
	writeIP(ret, p.YourAddr)
	writeIP(ret, p.ServerAddr)
	writeIP(ret, p.RelayAddr)

	// MAC address + 10 bytes of padding
	ret.Write([]byte(p.HardwareAddr))
	ret.Write([]byte{0, 0, 0, 0, 0, 0, 0, 0, 0, 0})

	opts := p.Options
	var err error
	if optsInSname {
		opts, err = opts.marshalLimited(ret, 64, true)
		if err != nil {
			return nil, err
		}
	} else {
		ret.WriteString(p.BootServerName)
		for i := len(p.BootServerName); i < 64; i++ {
			ret.WriteByte(0)
		}
	}

	if optsInFile {
		opts, err = opts.marshalLimited(ret, 128, true)
		if err != nil {
			return nil, err
		}
	} else {
		ret.WriteString(p.BootServerName)
		for i := len(p.BootServerName); i < 64; i++ {
			ret.WriteByte(0)
		}
	}

	ret.Write(magic)
	if err := opts.MarshalTo(ret); err != nil {
		return nil, err
	}

	return ret.Bytes(), nil
}

func writeIP(w io.Writer, ip net.IP) {
	ip = ip.To4()
	if ip == nil {
		w.Write([]byte{0, 0, 0, 0})
	} else {
		w.Write([]byte(ip))
	}
}

// Unmarshal parses a DHCP message and returns a Packet.
func Unmarshal(bs []byte) (*Packet, error) {
	// 244 bytes is the minimum size of a valid DHCP message:
	//  - BOOTP header (236b)
	//  - DHCP magic (4b)
	//  - DHCP message type mandatory option (3b)
	//  - End of options marker (1b)
	if len(bs) < 244 {
		return nil, errors.New("packet too short")
	}

	if !bytes.Equal(bs[236:240], magic) {
		return nil, errors.New("packet does not have DHCP magic number")
	}

	ret := &Packet{
		Options: make(Options),
	}

	if bs[1] != 1 || bs[2] != 6 {
		return nil, fmt.Errorf("packet has unsupported hardware address type/length %d/%d", bs[1], bs[2])
	}
	ret.HardwareAddr = net.HardwareAddr(bs[28:34])
	ret.TransactionID = string(bs[4:8])
	if binary.BigEndian.Uint16(bs[10:12])&0x8000 != 0 {
		ret.Broadcast = true
	}

	ret.ClientAddr = net.IP(bs[12:16])
	ret.YourAddr = net.IP(bs[16:20])
	ret.ServerAddr = net.IP(bs[20:24])
	ret.RelayAddr = net.IP(bs[24:28])

	if err := ret.Options.Unmarshal(bs[240:]); err != nil {
		return nil, fmt.Errorf("packet has malformed options section: %s", err)
	}

	// The 'file' and 'sname' BOOTP fields can either have the obvious
	// meaning from BOOTP, or can store extra DHCP options if the main
	// options section specifies the "Option overload" option.
	file, sname := false, false
	v, ok := ret.Options.Byte(52)
	if ok {
		file, sname = v&1 != 0, v&2 != 0
	}
	if sname {
		if err := ret.Options.Unmarshal(bs[44:108]); err != nil {
			return nil, fmt.Errorf("packet has malformed options in 'sname' field: %s", err)
		}
	} else {
		s, ok := nullStr(bs[44:108])
		if !ok {
			return nil, fmt.Errorf("unterminated 'sname' string")
		}
		ret.BootServerName = s
	}
	if file {
		if err := ret.Options.Unmarshal(bs[108:236]); err != nil {
			return nil, fmt.Errorf("packet has malformed options in 'file' field: %s", err)
		}
	} else {
		s, ok := nullStr(bs[108:236])
		if !ok {
			return nil, fmt.Errorf("unterminated 'file' string")
		}
		ret.BootServerName = s
	}

	// DHCP packets must all have at least the "DHCP Message Type"
	// option.
	typ, ok := ret.Options.Byte(53)
	if !ok {
		return nil, errors.New("packet has no DHCP Message Type")
	}
	ret.Type = MessageType(typ)
	switch ret.Type {
	case MsgDiscover, MsgRequest, MsgDecline, MsgRelease, MsgInform:
		if bs[0] != 1 {
			return nil, fmt.Errorf("BOOTP message type (%d) doesn't match DHCP message type (%s)", bs[0], ret.Type)
		}
	case MsgOffer, MsgAck, MsgNack:
		if bs[0] != 2 {
			return nil, fmt.Errorf("BOOTP message type (%d) doesn't match DHCP message type (%s", bs[0], ret.Type)
		}
	default:
	}

	return ret, nil
}

func nullStr(bs []byte) (string, bool) {
	i := bytes.IndexByte(bs, 0)
	if i == -1 {
		return "", false
	}
	return string(bs[:i]), true
}