source: trunk/packages/invirt-dhcp/invirt-dhcpserver @ 2583

#!/usr/bin/python
import sys
import pydhcplib
import pydhcplib.dhcp_network
from pydhcplib.dhcp_packet import *
from pydhcplib.type_hw_addr import hwmac
from pydhcplib.type_ipv4 import ipv4
from pydhcplib.type_strlist import strlist
import socket
import IN

import syslog as s

import time
from invirt import database
from invirt.config import structs as config

dhcp_options = {'subnet_mask': config.dhcp.netmask,
                'router': config.dhcp.gateway,
                'domain_name_server': ','.join(config.dhcp.dns),
                'ip_address_lease_time': 60*60*24}

class DhcpBackend:
    def __init__(self):
        database.connect()
    def findNIC(self, mac):
        database.clear_cache()
        return database.NIC.query().filter_by(mac_addr=mac).first()
    def find_interface(self, packet):
        chaddr = hwmac(packet.GetHardwareAddress())
        nic = self.findNIC(str(chaddr))
        if nic is None or nic.ip is None:
            return None
        ipstr = ''.join(reversed(['%02X' % i for i in ipv4(nic.ip).list()]))
        for line in open('/proc/net/route'):
            parts = line.split()
            if parts[1] == ipstr:
                s.syslog(s.LOG_DEBUG, "find_interface found "+str(nic.ip)+" on "+parts[0])
                return parts[0]
        return None
                            
    def getParameters(self, **extra):
        all_options=dict(dhcp_options)
        all_options.update(extra)
        options = {}
        for parameter, value in all_options.iteritems():
            if value is None:
                continue
            option_type = DhcpOptionsTypes[DhcpOptions[parameter]]

            if option_type == "ipv4" :
                # this is a single ip address
                options[parameter] = map(int,value.split("."))
            elif option_type == "ipv4+" :
                # this is multiple ip address
                iplist = value.split(",")
                opt = []
                for single in iplist :
                    opt.extend(ipv4(single).list())
                options[parameter] = opt
            elif option_type == "32-bits" :
                # This is probably a number...
                digit = int(value)
                options[parameter] = [digit>>24&0xFF,(digit>>16)&0xFF,(digit>>8)&0xFF,digit&0xFF]
            elif option_type == "16-bits" :
                digit = int(value)
                options[parameter] = [(digit>>8)&0xFF,digit&0xFF]

            elif option_type == "char" :
                digit = int(value)
                options[parameter] = [digit&0xFF]

            elif option_type == "bool" :
                if value=="False" or value=="false" or value==0 :
                    options[parameter] = [0]
                else : options[parameter] = [1]
                    
            elif option_type == "string" :
                options[parameter] = strlist(value).list()
            
            elif option_type == "RFC3397" :
                parsed_value = ""
                for item in value:
                    components = item.split('.')
                    item_fmt = "".join(chr(len(elt)) + elt for elt in components) + "\x00"
                    parsed_value += item_fmt
                
                options[parameter] = strlist(parsed_value).list()
            
            else :
                options[parameter] = strlist(value).list()
        return options

    def Discover(self, packet):
        s.syslog(s.LOG_DEBUG, "dhcp_backend : Discover ")
        chaddr = hwmac(packet.GetHardwareAddress())
        nic = self.findNIC(str(chaddr))
        if nic is None or nic.machine is None:
            return False
        ip = nic.ip
        if ip is None:  #Deactivated?
            return False

        options = {}
        if nic.hostname and '.' in nic.hostname:
            options['host_name'], options['domain_name'] = nic.hostname.split('.', 1)
        elif nic.machine.name:
            options['host_name'] = nic.machine.name
            options['domain_name'] = config.dns.domains[0]
        else:
            hostname = None
        if DhcpOptions['domain_search'] in packet.GetOption('parameter_request_list'):
            options['host_name'] += '.' + options['domain_name']
            del options['domain_name']
            options['domain_search'] = [config.dhcp.search_domain]
        if ip is not None:
            ip = ipv4(ip)
            s.syslog(s.LOG_DEBUG,"dhcp_backend : Discover result = "+str(ip))
            packet_parameters = self.getParameters(**options)

            # FIXME: Other offer parameters go here
            packet_parameters["yiaddr"] = ip.list()
            
            packet.SetMultipleOptions(packet_parameters)
            return True
        return False
        
    def Request(self, packet):
        s.syslog(s.LOG_DEBUG, "dhcp_backend : Request")
        
        discover = self.Discover(packet)
        
        chaddr = hwmac(packet.GetHardwareAddress())
        request = packet.GetOption("request_ip_address")
        if not request:
            request = packet.GetOption("ciaddr")
        yiaddr = packet.GetOption("yiaddr")

        if not discover:
            s.syslog(s.LOG_INFO,"Unknown MAC address: "+str(chaddr))
            return False
        
        if yiaddr!="0.0.0.0" and yiaddr == request :
            s.syslog(s.LOG_INFO,"Ack ip "+str(yiaddr)+" for "+str(chaddr))
            return True
        else:
            s.syslog(s.LOG_INFO,"Requested ip "+str(request)+" not available for "+str(chaddr))
        return False

    def Decline(self, packet):
        pass
    def Release(self, packet):
        pass
    

class DhcpServer(pydhcplib.dhcp_network.DhcpServer):
    def __init__(self, backend, options = {'client_listenport':68,'server_listenport':67}):
        pydhcplib.dhcp_network.DhcpServer.__init__(self,"0.0.0.0",options["client_listen_port"],options["server_listen_port"],)
        self.backend = backend
        s.syslog(s.LOG_DEBUG, "__init__ DhcpServer")

    def SendDhcpPacketTo(self, To, packet):
        intf = self.backend.find_interface(packet)
        if intf:
            self.dhcp_socket.setsockopt(socket.SOL_SOCKET, IN.SO_BINDTODEVICE, intf)
            ret = self.dhcp_socket.sendto(packet.EncodePacket(), (To,self.emit_port))
            self.dhcp_socket.setsockopt(socket.SOL_SOCKET, IN.SO_BINDTODEVICE, '')
            return ret
        else:
            return self.dhcp_socket.sendto(packet.EncodePacket(),(To,self.emit_port))

    def SendPacket(self, packet):
        """Encode and send the packet."""
        
        giaddr = packet.GetOption('giaddr')

        # in all case, if giaddr is set, send packet to relay_agent
        # network address defines by giaddr
        if giaddr!=[0,0,0,0] :
            agent_ip = ".".join(map(str,giaddr))
            self.SendDhcpPacketTo(agent_ip,packet)
            s.syslog(s.LOG_DEBUG, "SendPacket to agent : "+agent_ip)

        # FIXME: This shouldn't broadcast if it has an IP address to send
        # it to instead. See RFC2131 part 4.1 for full details
        else :
            s.syslog(s.LOG_DEBUG, "No agent, broadcast packet.")
            self.SendDhcpPacketTo("255.255.255.255",packet)
            

    def HandleDhcpDiscover(self, packet):
        """Build and send DHCPOFFER packet in response to DHCPDISCOVER
        packet."""

        logmsg = "Get DHCPDISCOVER packet from " + hwmac(packet.GetHardwareAddress()).str()

        s.syslog(s.LOG_INFO, logmsg)
        offer = DhcpPacket()
        offer.CreateDhcpOfferPacketFrom(packet)
        
        if self.backend.Discover(offer):
            self.SendPacket(offer)
        # FIXME : what if false ?


    def HandleDhcpRequest(self, packet):
        """Build and send DHCPACK or DHCPNACK packet in response to
        DHCPREQUEST packet. 4 types of DHCPREQUEST exists."""

        ip = packet.GetOption("request_ip_address")
        sid = packet.GetOption("server_identifier")
        ciaddr = packet.GetOption("ciaddr")
        #packet.PrintHeaders()
        #packet.PrintOptions()

        if sid != [0,0,0,0] and ciaddr == [0,0,0,0] :
            s.syslog(s.LOG_INFO, "Get DHCPREQUEST_SELECTING_STATE packet")

        elif sid == [0,0,0,0] and ciaddr == [0,0,0,0] and ip :
            s.syslog(s.LOG_INFO, "Get DHCPREQUEST_INITREBOOT_STATE packet")

        elif sid == [0,0,0,0] and ciaddr != [0,0,0,0] and not ip :
            s.syslog(s.LOG_INFO,"Get DHCPREQUEST_INITREBOOT_STATE packet")

        else : s.syslog(s.LOG_INFO,"Get DHCPREQUEST_UNKNOWN_STATE packet : not implemented")

        if self.backend.Request(packet) : packet.TransformToDhcpAckPacket()
        else : packet.TransformToDhcpNackPacket()

        self.SendPacket(packet)



    # FIXME: These are not yet implemented.
    def HandleDhcpDecline(self, packet):
        s.syslog(s.LOG_INFO, "Get DHCPDECLINE packet")
        self.backend.Decline(packet)
        
    def HandleDhcpRelease(self, packet):
        s.syslog(s.LOG_INFO,"Get DHCPRELEASE packet")
        self.backend.Release(packet)
        
    def HandleDhcpInform(self, packet):
        s.syslog(s.LOG_INFO, "Get DHCPINFORM packet")

        if self.backend.Request(packet) :
            packet.TransformToDhcpAckPacket()
            # FIXME : Remove lease_time from options
            self.SendPacket(packet)

        # FIXME : what if false ?

if '__main__' == __name__:
    options = { "server_listen_port":67,
                "client_listen_port":68,
                "listen_address":"0.0.0.0"}

    myip = socket.gethostbyname(socket.gethostname())
    if not myip:
        print "invirt-dhcpserver: cannot determine local IP address by looking up %s" % socket.gethostname()
        sys.exit(1)
    
    dhcp_options['server_identifier'] = myip

    backend = DhcpBackend()
    server = DhcpServer(backend, options)

    while True : server.GetNextDhcpPacket()