123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257 |
-
-
- #include <string.h>
- #include <stdlib.h>
- #include <stdio.h>
- #include <errno.h>
- #include <assert.h>
- #include <byteswap.h>
- #include <gpxe/if_ether.h>
- #include <gpxe/netdevice.h>
- #include <gpxe/device.h>
- #include <gpxe/xfer.h>
- #include <gpxe/open.h>
- #include <gpxe/job.h>
- #include <gpxe/retry.h>
- #include <gpxe/tcpip.h>
- #include <gpxe/ip.h>
- #include <gpxe/uuid.h>
- #include <gpxe/dhcp.h>
- #include <gpxe/timer.h>
- #include <gpxe/settings.h>
- #include <gpxe/dhcp.h>
- #include <gpxe/dhcpopts.h>
- #include <gpxe/dhcppkt.h>
- #include <gpxe/features.h>
-
-
-
-
- static const uint8_t dhcp_op[] = {
- [DHCPDISCOVER] = BOOTP_REQUEST,
- [DHCPOFFER] = BOOTP_REPLY,
- [DHCPREQUEST] = BOOTP_REQUEST,
- [DHCPDECLINE] = BOOTP_REQUEST,
- [DHCPACK] = BOOTP_REPLY,
- [DHCPNAK] = BOOTP_REPLY,
- [DHCPRELEASE] = BOOTP_REQUEST,
- [DHCPINFORM] = BOOTP_REQUEST,
- };
-
-
- static uint8_t dhcp_request_options_data[] = {
- DHCP_MAX_MESSAGE_SIZE,
- DHCP_WORD ( ETH_MAX_MTU - 20 - 8 ),
- DHCP_CLIENT_ARCHITECTURE, DHCP_WORD ( 0 ),
- DHCP_CLIENT_NDI, DHCP_OPTION ( 1 , 2, 1 ),
- DHCP_VENDOR_CLASS_ID,
- DHCP_STRING ( 'P', 'X', 'E', 'C', 'l', 'i', 'e', 'n', 't', ':',
- 'A', 'r', 'c', 'h', ':', '0', '0', '0', '0', '0', ':',
- 'U', 'N', 'D', 'I', ':', '0', '0', '2', '0', '0', '1' ),
- DHCP_PARAMETER_REQUEST_LIST,
- DHCP_OPTION ( DHCP_SUBNET_MASK, DHCP_ROUTERS, DHCP_DNS_SERVERS,
- DHCP_LOG_SERVERS, DHCP_HOST_NAME, DHCP_DOMAIN_NAME,
- DHCP_ROOT_PATH, DHCP_VENDOR_ENCAP, DHCP_VENDOR_CLASS_ID,
- DHCP_TFTP_SERVER_NAME, DHCP_BOOTFILE_NAME,
- DHCP_EB_ENCAP, DHCP_ISCSI_INITIATOR_IQN ),
- DHCP_END
- };
-
-
- static struct dhcp_options dhcp_request_options = {
- .data = dhcp_request_options_data,
- .max_len = sizeof ( dhcp_request_options_data ),
- .len = sizeof ( dhcp_request_options_data ),
- };
-
-
- static uint8_t dhcp_features[0] __table_start ( uint8_t, dhcp_features );
- static uint8_t dhcp_features_end[0] __table_end ( uint8_t, dhcp_features );
-
-
- FEATURE_VERSION ( VERSION_MAJOR, VERSION_MINOR, VERSION_PATCH );
-
-
- struct dhcp_netdev_desc {
-
- uint8_t type;
-
- uint16_t vendor;
-
- uint16_t device;
- } __attribute__ (( packed ));
-
-
- struct dhcp_client_id {
-
- uint8_t ll_proto;
-
- uint8_t ll_addr[MAX_LL_ADDR_LEN];
- } __attribute__ (( packed ));
-
-
- struct dhcp_client_uuid {
-
- uint8_t type;
-
- union uuid uuid;
- } __attribute__ (( packed ));
-
- #define DHCP_CLIENT_UUID_TYPE 0
-
-
- struct dhcp_pxe_boot_menu_item {
-
-
- uint16_t type;
-
-
- uint16_t layer;
- } __attribute__ (( packed ));
-
-
- static inline const char * dhcp_msgtype_name ( unsigned int msgtype ) {
- switch ( msgtype ) {
- case DHCPNONE: return "BOOTP";
- case DHCPDISCOVER: return "DHCPDISCOVER";
- case DHCPOFFER: return "DHCPOFFER";
- case DHCPREQUEST: return "DHCPREQUEST";
- case DHCPDECLINE: return "DHCPDECLINE";
- case DHCPACK: return "DHCPACK";
- case DHCPNAK: return "DHCPNAK";
- case DHCPRELEASE: return "DHCPRELEASE";
- case DHCPINFORM: return "DHCPINFORM";
- default: return "DHCP<invalid>";
- }
- }
-
-
- static uint32_t dhcp_xid ( struct net_device *netdev ) {
- uint32_t xid;
-
- memcpy ( &xid, ( netdev->ll_addr + netdev->ll_protocol->ll_addr_len
- - sizeof ( xid ) ), sizeof ( xid ) );
- return xid;
- }
-
-
-
-
- struct dhcp_settings {
-
- struct refcnt refcnt;
-
- struct dhcp_packet dhcppkt;
-
- struct settings settings;
- };
-
-
- static inline __attribute__ (( always_inline )) struct dhcp_settings *
- dhcpset_get ( struct dhcp_settings *dhcpset ) {
- ref_get ( &dhcpset->refcnt );
- return dhcpset;
- }
-
-
- static inline __attribute__ (( always_inline )) void
- dhcpset_put ( struct dhcp_settings *dhcpset ) {
- ref_put ( &dhcpset->refcnt );
- }
-
-
- static int dhcpset_store ( struct settings *settings, struct setting *setting,
- const void *data, size_t len ) {
- struct dhcp_settings *dhcpset =
- container_of ( settings, struct dhcp_settings, settings );
-
- return dhcppkt_store ( &dhcpset->dhcppkt, setting->tag, data, len );
- }
-
-
- static int dhcpset_fetch ( struct settings *settings, struct setting *setting,
- void *data, size_t len ) {
- struct dhcp_settings *dhcpset =
- container_of ( settings, struct dhcp_settings, settings );
-
- return dhcppkt_fetch ( &dhcpset->dhcppkt, setting->tag, data, len );
- }
-
-
- static struct settings_operations dhcpset_settings_operations = {
- .store = dhcpset_store,
- .fetch = dhcpset_fetch,
- };
-
-
- static struct dhcp_settings * dhcpset_create ( const struct dhcphdr *dhcphdr,
- size_t len ) {
- struct dhcp_settings *dhcpset;
- void *data;
-
- dhcpset = zalloc ( sizeof ( *dhcpset ) + len );
- if ( dhcpset ) {
- data = ( ( ( void * ) dhcpset ) + sizeof ( *dhcpset ) );
- memcpy ( data, dhcphdr, len );
- dhcppkt_init ( &dhcpset->dhcppkt, data, len );
- settings_init ( &dhcpset->settings,
- &dhcpset_settings_operations, &dhcpset->refcnt,
- DHCP_SETTINGS_NAME, 0 );
- }
- return dhcpset;
- }
-
-
- struct setting dhcp_server_setting __setting = {
- .name = "dhcp-server",
- .description = "DHCP server address",
- .tag = DHCP_SERVER_IDENTIFIER,
- .type = &setting_type_ipv4,
- };
-
-
-
-
- enum dhcp_session_state {
-
- DHCP_STATE_DISCOVER = 0,
-
- DHCP_STATE_REQUEST,
-
- DHCP_STATE_PROXYREQUEST,
-
- DHCP_STATE_BSREQUEST,
- };
-
-
- static inline const char * dhcp_state_name ( enum dhcp_session_state state ) {
- switch ( state ) {
- case DHCP_STATE_DISCOVER: return "DHCPDISCOVER";
- case DHCP_STATE_REQUEST: return "DHCPREQUEST";
- case DHCP_STATE_PROXYREQUEST: return "ProxyDHCPREQUEST";
- case DHCP_STATE_BSREQUEST: return "BootServerREQUEST";
- default: return "<invalid>";
- }
- }
-
-
- struct dhcp_session {
-
- struct refcnt refcnt;
-
- struct job_interface job;
-
- struct xfer_interface xfer;
-
-
- struct net_device *netdev;
-
-
-
- enum dhcp_session_state state;
-
- struct dhcp_settings *dhcpoffer;
-
- struct dhcp_settings *proxydhcpoffer;
-
- struct dhcp_settings *dhcpack;
-
- struct dhcp_settings *proxydhcpack;
-
- struct dhcp_settings *bsdhcpack;
-
- struct retry_timer timer;
-
- unsigned long start;
- };
-
-
- static void dhcp_free ( struct refcnt *refcnt ) {
- struct dhcp_session *dhcp =
- container_of ( refcnt, struct dhcp_session, refcnt );
-
- netdev_put ( dhcp->netdev );
- dhcpset_put ( dhcp->dhcpoffer );
- dhcpset_put ( dhcp->proxydhcpoffer );
- dhcpset_put ( dhcp->dhcpack );
- dhcpset_put ( dhcp->proxydhcpack );
- dhcpset_put ( dhcp->bsdhcpack );
- free ( dhcp );
- }
-
-
- static void dhcp_finished ( struct dhcp_session *dhcp, int rc ) {
-
-
- job_nullify ( &dhcp->job );
- xfer_nullify ( &dhcp->xfer );
-
-
- stop_timer ( &dhcp->timer );
-
-
- xfer_close ( &dhcp->xfer, rc );
- job_done ( &dhcp->job, rc );
- }
-
-
-
-
- int dhcp_create_packet ( struct dhcp_packet *dhcppkt,
- struct net_device *netdev, uint8_t msgtype,
- struct dhcp_options *options,
- void *data, size_t max_len ) {
- struct dhcphdr *dhcphdr = data;
- size_t options_len;
- unsigned int hlen;
- int rc;
-
-
- options_len = ( options ? options->len : 0 );
- if ( max_len < ( sizeof ( *dhcphdr ) + options_len ) )
- return -ENOSPC;
-
-
- memset ( dhcphdr, 0, max_len );
- dhcphdr->xid = dhcp_xid ( netdev );
- dhcphdr->magic = htonl ( DHCP_MAGIC_COOKIE );
- dhcphdr->htype = ntohs ( netdev->ll_protocol->ll_proto );
- dhcphdr->op = dhcp_op[msgtype];
-
-
- hlen = netdev->ll_protocol->ll_addr_len;
- if ( hlen > sizeof ( dhcphdr->chaddr ) ) {
- hlen = 0;
- dhcphdr->flags = htons ( BOOTP_FL_BROADCAST );
- }
- dhcphdr->hlen = hlen;
- memcpy ( dhcphdr->chaddr, netdev->ll_addr, hlen );
- memcpy ( dhcphdr->options, options->data, options_len );
-
-
- memset ( dhcppkt, 0, sizeof ( *dhcppkt ) );
- dhcppkt_init ( dhcppkt, data, max_len );
-
-
- if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_MESSAGE_TYPE,
- &msgtype, sizeof ( msgtype ) ) ) != 0 )
- return rc;
-
- return 0;
- }
-
-
- int dhcp_create_request ( struct dhcp_packet *dhcppkt,
- struct net_device *netdev, unsigned int msgtype,
- struct in_addr ciaddr, struct in_addr server,
- struct in_addr requested_ip,
- struct dhcp_pxe_boot_menu_item *menu_item,
- void *data, size_t max_len ) {
- struct device_description *desc = &netdev->dev->desc;
- struct dhcp_netdev_desc dhcp_desc;
- struct dhcp_client_id client_id;
- struct dhcp_client_uuid client_uuid;
- size_t dhcp_features_len;
- size_t ll_addr_len;
- int rc;
-
-
- if ( ( rc = dhcp_create_packet ( dhcppkt, netdev, msgtype,
- &dhcp_request_options, data,
- max_len ) ) != 0 ) {
- DBG ( "DHCP could not create DHCP packet: %s\n",
- strerror ( rc ) );
- return rc;
- }
-
-
- dhcppkt->dhcphdr->ciaddr = ciaddr;
-
-
- if ( server.s_addr &&
- ( ( rc = dhcppkt_store ( dhcppkt, DHCP_SERVER_IDENTIFIER,
- &server, sizeof ( server ) ) ) != 0 ) ) {
- DBG ( "DHCP could not set server ID: %s\n",
- strerror ( rc ) );
- return rc;
- }
-
-
- if ( requested_ip.s_addr &&
- ( ( rc = dhcppkt_store ( dhcppkt, DHCP_REQUESTED_ADDRESS,
- &requested_ip,
- sizeof ( requested_ip ) ) ) != 0 ) ) {
- DBG ( "DHCP could not set requested address: %s\n",
- strerror ( rc ) );
- return rc;
- }
-
-
- dhcp_features_len = ( dhcp_features_end - dhcp_features );
- if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_EB_ENCAP, dhcp_features,
- dhcp_features_len ) ) != 0 ) {
- DBG ( "DHCP could not set features list option: %s\n",
- strerror ( rc ) );
- return rc;
- }
-
-
- dhcp_desc.type = desc->bus_type;
- dhcp_desc.vendor = htons ( desc->vendor );
- dhcp_desc.device = htons ( desc->device );
- if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_EB_BUS_ID, &dhcp_desc,
- sizeof ( dhcp_desc ) ) ) != 0 ) {
- DBG ( "DHCP could not set bus ID option: %s\n",
- strerror ( rc ) );
- return rc;
- }
-
-
-
- client_id.ll_proto = ntohs ( netdev->ll_protocol->ll_proto );
- ll_addr_len = netdev->ll_protocol->ll_addr_len;
- assert ( ll_addr_len <= sizeof ( client_id.ll_addr ) );
- memcpy ( client_id.ll_addr, netdev->ll_addr, ll_addr_len );
- if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_CLIENT_ID, &client_id,
- ( ll_addr_len + 1 ) ) ) != 0 ) {
- DBG ( "DHCP could not set client ID: %s\n",
- strerror ( rc ) );
- return rc;
- }
-
-
- client_uuid.type = DHCP_CLIENT_UUID_TYPE;
- if ( ( rc = fetch_uuid_setting ( NULL, &uuid_setting,
- &client_uuid.uuid ) ) >= 0 ) {
- if ( ( rc = dhcppkt_store ( dhcppkt, DHCP_CLIENT_UUID,
- &client_uuid,
- sizeof ( client_uuid ) ) ) != 0 ) {
- DBG ( "DHCP could not set client UUID: %s\n",
- strerror ( rc ) );
- return rc;
- }
- }
-
-
- if ( menu_item && menu_item->type &&
- ( ( rc = dhcppkt_store ( dhcppkt, DHCP_PXE_BOOT_MENU_ITEM,
- menu_item,
- sizeof ( *menu_item ) ) ) != 0 ) ) {
- DBG ( "DHCP could not set PXE menu item: %s\n",
- strerror ( rc ) );
- return rc;
- }
-
- return 0;
- }
-
-
- static int dhcp_tx ( struct dhcp_session *dhcp ) {
- static struct sockaddr_in dest = {
- .sin_family = AF_INET,
- .sin_port = htons ( PROXYDHCP_PORT ),
- };
- static struct sockaddr_in src = {
- .sin_family = AF_INET,
- .sin_port = htons ( BOOTPC_PORT ),
- };
- struct xfer_metadata meta = {
- .netdev = dhcp->netdev,
- };
- struct io_buffer *iobuf;
- struct dhcp_packet dhcppkt;
- struct in_addr ciaddr = { 0 };
- struct in_addr server = { 0 };
- struct in_addr requested_ip = { 0 };
- struct dhcp_pxe_boot_menu_item menu_item = { 0, 0 };
- unsigned int msgtype;
- int rc;
-
-
-
- start_timer ( &dhcp->timer );
-
-
- switch ( dhcp->state ) {
- case DHCP_STATE_DISCOVER:
- msgtype = DHCPDISCOVER;
- break;
- case DHCP_STATE_REQUEST:
- assert ( dhcp->dhcpoffer );
- msgtype = DHCPREQUEST;
- dhcppkt_fetch ( &dhcp->dhcpoffer->dhcppkt,
- DHCP_SERVER_IDENTIFIER, &server,
- sizeof ( server ) );
- requested_ip = dhcp->dhcpoffer->dhcppkt.dhcphdr->yiaddr;
- break;
- case DHCP_STATE_PROXYREQUEST:
- assert ( dhcp->dhcpoffer );
- assert ( dhcp->proxydhcpoffer );
- assert ( dhcp->dhcpack );
- msgtype = DHCPREQUEST;
- ciaddr = dhcp->dhcpoffer->dhcppkt.dhcphdr->yiaddr;
- dhcppkt_fetch ( &dhcp->proxydhcpoffer->dhcppkt,
- DHCP_SERVER_IDENTIFIER, &dest.sin_addr,
- sizeof ( dest.sin_addr ) );
- meta.dest = ( struct sockaddr * ) &dest;
- server = dest.sin_addr;
- assert ( dest.sin_addr.s_addr );
- assert ( ciaddr.s_addr );
- break;
- case DHCP_STATE_BSREQUEST:
- assert ( dhcp->dhcpoffer );
- assert ( dhcp->proxydhcpoffer );
- assert ( dhcp->dhcpack );
- assert ( dhcp->proxydhcpack );
- msgtype = DHCPREQUEST;
- ciaddr = dhcp->dhcpoffer->dhcppkt.dhcphdr->yiaddr;
- dhcppkt_fetch ( &dhcp->proxydhcpack->dhcppkt,
- DHCP_PXE_BOOT_SERVER_MCAST,
- &dest.sin_addr, sizeof ( dest.sin_addr ) );
- meta.dest = ( struct sockaddr * ) &dest;
- dhcppkt_fetch ( &dhcp->proxydhcpack->dhcppkt,
- DHCP_PXE_BOOT_MENU, &menu_item.type,
- sizeof ( menu_item.type ) );
- assert ( dest.sin_addr.s_addr );
- assert ( menu_item.type );
- assert ( ciaddr.s_addr );
- break;
- default:
- assert ( 0 );
- return -EINVAL;
- }
-
- DBGC ( dhcp, "DHCP %p %s", dhcp, dhcp_msgtype_name ( msgtype ) );
- if ( server.s_addr )
- DBGC ( dhcp, " to %s", inet_ntoa ( server ) );
- if ( meta.dest ) {
- if ( dest.sin_addr.s_addr == server.s_addr ) {
- DBGC ( dhcp, ":%d (unicast)",
- ntohs ( dest.sin_port ) );
- } else {
- DBGC ( dhcp, " via %s:%d", inet_ntoa ( dest.sin_addr ),
- ntohs ( dest.sin_port ) );
- }
- } else {
- DBGC ( dhcp, " (broadcast)" );
- }
- if ( requested_ip.s_addr )
- DBGC ( dhcp, " for %s", inet_ntoa ( requested_ip ) );
- if ( menu_item.type )
- DBGC ( dhcp, " for item %04x", ntohs ( menu_item.type ) );
- DBGC ( dhcp, "\n" );
-
-
- iobuf = xfer_alloc_iob ( &dhcp->xfer, DHCP_MIN_LEN );
- if ( ! iobuf )
- return -ENOMEM;
-
-
- if ( ( rc = dhcp_create_request ( &dhcppkt, dhcp->netdev, msgtype,
- ciaddr, server, requested_ip,
- &menu_item, iobuf->data,
- iob_tailroom ( iobuf ) ) ) != 0 ) {
- DBGC ( dhcp, "DHCP %p could not construct DHCP request: %s\n",
- dhcp, strerror ( rc ) );
- goto done;
- }
-
-
- if ( ciaddr.s_addr ) {
- src.sin_addr = ciaddr;
- meta.src = ( struct sockaddr * ) &src;
- }
-
-
- iob_put ( iobuf, dhcppkt.len );
- rc = xfer_deliver_iob_meta ( &dhcp->xfer, iobuf, &meta );
- iobuf = NULL;
- if ( rc != 0 ) {
- DBGC ( dhcp, "DHCP %p could not transmit UDP packet: %s\n",
- dhcp, strerror ( rc ) );
- goto done;
- }
-
- done:
- free_iob ( iobuf );
- return rc;
- }
-
-
- static void dhcp_set_state ( struct dhcp_session *dhcp,
- enum dhcp_session_state state ) {
- DBGC ( dhcp, "DHCP %p entering %s state\n",
- dhcp, dhcp_state_name ( state ) );
- dhcp->state = state;
- dhcp->start = currticks();
- dhcp->timer.min_timeout = 0;
- start_timer_nodelay ( &dhcp->timer );
- }
-
-
- static void dhcp_next_state ( struct dhcp_session *dhcp ) {
- struct in_addr bs_mcast = { 0 };
-
- switch ( dhcp->state ) {
- case DHCP_STATE_DISCOVER:
- dhcp_set_state ( dhcp, DHCP_STATE_REQUEST );
- break;
- case DHCP_STATE_REQUEST:
- if ( dhcp->proxydhcpoffer ) {
-
-
- dhcp->proxydhcpack = dhcpset_get ( dhcp->dhcpack );
- dhcp_set_state ( dhcp, DHCP_STATE_PROXYREQUEST );
- break;
- }
-
- case DHCP_STATE_PROXYREQUEST:
- if ( dhcp->proxydhcpack ) {
- dhcppkt_fetch ( &dhcp->proxydhcpack->dhcppkt,
- DHCP_PXE_BOOT_SERVER_MCAST,
- &bs_mcast, sizeof ( bs_mcast ) );
- if ( bs_mcast.s_addr ) {
- dhcp_set_state ( dhcp, DHCP_STATE_BSREQUEST );
- break;
- }
- }
-
- case DHCP_STATE_BSREQUEST:
- dhcp_finished ( dhcp, 0 );
- break;
- default:
- assert ( 0 );
- return;
- }
-
- }
-
-
- static void dhcp_store_dhcpoffer ( struct dhcp_session *dhcp,
- struct dhcp_settings *dhcpoffer,
- struct dhcp_settings **stored_dhcpoffer ) {
- uint8_t stored_priority = 0;
- uint8_t priority = 0;
-
-
- if ( *stored_dhcpoffer ) {
- dhcppkt_fetch ( &(*stored_dhcpoffer)->dhcppkt,
- DHCP_EB_PRIORITY, &stored_priority,
- sizeof ( stored_priority ) );
- }
- dhcppkt_fetch ( &dhcpoffer->dhcppkt, DHCP_EB_PRIORITY, &priority,
- sizeof ( priority ) );
-
-
- if ( priority >= stored_priority ) {
- if ( *stored_dhcpoffer ) {
- DBGC ( dhcp, "DHCP %p stored DHCPOFFER %p discarded\n",
- dhcp, *stored_dhcpoffer );
- }
- DBGC ( dhcp, "DHCP %p DHCPOFFER %p stored\n",
- dhcp, dhcpoffer );
- dhcpset_put ( *stored_dhcpoffer );
- *stored_dhcpoffer = dhcpset_get ( dhcpoffer );
- }
- }
-
-
- static void dhcp_rx_dhcpoffer ( struct dhcp_session *dhcp,
- struct dhcp_settings *dhcpoffer ) {
- struct in_addr server_id = { 0 };
- char vci[9];
- int len;
- uint8_t ignore_proxy = 0;
- unsigned long elapsed;
-
-
- if ( dhcppkt_fetch ( &dhcpoffer->dhcppkt, DHCP_SERVER_IDENTIFIER,
- &server_id, sizeof ( server_id ) )
- != sizeof ( server_id ) ) {
- DBGC ( dhcp, "DHCP %p DHCPOFFER %p missing server ID\n",
- dhcp, dhcpoffer );
-
- }
-
-
- if ( dhcpoffer->dhcppkt.dhcphdr->yiaddr.s_addr != 0 ) {
- DBGC ( dhcp, "DHCP %p DHCPOFFER %p from %s",
- dhcp, dhcpoffer, inet_ntoa ( server_id ) );
- DBGC ( dhcp, " has IP %s\n",
- inet_ntoa ( dhcpoffer->dhcppkt.dhcphdr->yiaddr ) );
- dhcp_store_dhcpoffer ( dhcp, dhcpoffer, &dhcp->dhcpoffer );
- }
-
-
-
- len = dhcppkt_fetch ( &dhcpoffer->dhcppkt, DHCP_VENDOR_CLASS_ID,
- vci, sizeof ( vci ) );
- if ( ( server_id.s_addr != 0 ) &&
- ( len >= ( int ) sizeof ( vci ) ) &&
- ( strncmp ( "PXEClient", vci, sizeof ( vci ) ) == 0 ) ) {
- DBGC ( dhcp, "DHCP %p DHCPOFFER %p from %s is a "
- "ProxyDHCPOFFER\n",
- dhcp, dhcpoffer, inet_ntoa ( server_id ) );
- dhcp_store_dhcpoffer ( dhcp, dhcpoffer,
- &dhcp->proxydhcpoffer );
- }
-
-
-
-
-
- if ( ! dhcp->dhcpoffer )
- return;
-
-
-
- dhcppkt_fetch ( &dhcp->dhcpoffer->dhcppkt, DHCP_EB_NO_PROXYDHCP,
- &ignore_proxy, sizeof ( ignore_proxy ) );
- if ( ignore_proxy && dhcp->proxydhcpoffer ) {
- DBGC ( dhcp, "DHCP %p discarding ProxyDHCPOFFER\n", dhcp );
- dhcpset_put ( dhcp->proxydhcpoffer );
- dhcp->proxydhcpoffer = NULL;
- }
-
-
- elapsed = ( currticks() - dhcp->start );
- if ( ! ( ignore_proxy || dhcp->proxydhcpoffer ||
- ( elapsed > PROXYDHCP_WAIT_TIME ) ) )
- return;
-
-
- dhcp_next_state ( dhcp );
- }
-
-
- static int dhcp_store_dhcpack ( struct dhcp_session *dhcp,
- struct dhcp_settings *dhcpack,
- struct settings *parent ) {
- struct settings *settings = &dhcpack->settings;
- struct settings *old_settings;
- int rc;
-
-
- if ( ( old_settings = find_child_settings ( parent, settings->name ) ))
- unregister_settings ( old_settings );
-
-
- if ( ( rc = register_settings ( settings, parent ) ) != 0 ) {
- DBGC ( dhcp, "DHCP %p could not register settings: %s\n",
- dhcp, strerror ( rc ) );
- dhcp_finished ( dhcp, rc );
- return rc;
- }
-
- return 0;
- }
-
-
- static void dhcp_rx_dhcpack ( struct dhcp_session *dhcp,
- struct dhcp_settings *dhcpack ) {
- struct settings *parent;
- struct in_addr offer_server_id = { 0 };
- struct in_addr ack_server_id = { 0 };
- int rc;
-
-
- assert ( dhcp->dhcpoffer != NULL );
- dhcppkt_fetch ( &dhcp->dhcpoffer->dhcppkt, DHCP_SERVER_IDENTIFIER,
- &offer_server_id, sizeof ( offer_server_id ) );
- dhcppkt_fetch ( &dhcpack->dhcppkt, DHCP_SERVER_IDENTIFIER,
- &ack_server_id, sizeof ( ack_server_id ) );
- if ( offer_server_id.s_addr != ack_server_id.s_addr ) {
- DBGC ( dhcp, "DHCP %p ignoring DHCPACK with wrong server ID "
- "%s\n", dhcp, inet_ntoa ( ack_server_id ) );
- return;
- }
-
-
- assert ( dhcp->dhcpack == NULL );
- dhcp->dhcpack = dhcpset_get ( dhcpack );
-
-
- parent = netdev_settings ( dhcp->netdev );
- if ( ( rc = dhcp_store_dhcpack ( dhcp, dhcpack, parent ) ) != 0 )
- return;
-
-
- dhcp_next_state ( dhcp );
- }
-
-
- static void dhcp_rx_proxydhcpack ( struct dhcp_session *dhcp,
- struct dhcp_settings *proxydhcpack ) {
- struct in_addr offer_server_id = { 0 };
- struct in_addr ack_server_id = { 0 };
- int rc;
-
-
- assert ( dhcp->proxydhcpoffer != NULL );
- if ( ( rc = dhcppkt_fetch ( &proxydhcpack->dhcppkt,
- DHCP_SERVER_IDENTIFIER, &ack_server_id,
- sizeof ( ack_server_id ) ) ) > 0 ) {
- dhcppkt_fetch ( &dhcp->proxydhcpoffer->dhcppkt,
- DHCP_SERVER_IDENTIFIER, &offer_server_id,
- sizeof ( offer_server_id ) );
- if ( offer_server_id.s_addr != ack_server_id.s_addr ) {
- DBGC ( dhcp, "DHCP %p ignoring ProxyDHCPACK with "
- "wrong server ID %s\n",
- dhcp, inet_ntoa ( ack_server_id ) );
- return;
- }
- }
-
-
- proxydhcpack->settings.name = PROXYDHCP_SETTINGS_NAME;
-
-
- dhcpset_put ( dhcp->proxydhcpack );
- dhcp->proxydhcpack = dhcpset_get ( proxydhcpack );
-
-
- if ( ( rc = dhcp_store_dhcpack ( dhcp, proxydhcpack, NULL ) ) != 0 )
- return;
-
-
- dhcp_next_state ( dhcp );
- }
-
-
- static void dhcp_rx_bsdhcpack ( struct dhcp_session *dhcp,
- struct dhcp_settings *bsdhcpack ) {
- int rc;
-
-
- bsdhcpack->settings.name = BSDHCP_SETTINGS_NAME;
-
-
- assert ( dhcp->bsdhcpack == NULL );
- dhcp->bsdhcpack = dhcpset_get ( bsdhcpack );
-
-
- if ( ( rc = dhcp_store_dhcpack ( dhcp, bsdhcpack, NULL ) ) != 0 )
- return;
-
-
- dhcp_next_state ( dhcp );
- }
-
-
- static int dhcp_deliver_iob ( struct xfer_interface *xfer,
- struct io_buffer *iobuf,
- struct xfer_metadata *meta ) {
- struct dhcp_session *dhcp =
- container_of ( xfer, struct dhcp_session, xfer );
- struct sockaddr_in *sin_src;
- unsigned int src_port;
- struct dhcp_settings *dhcpset;
- struct dhcphdr *dhcphdr;
- uint8_t msgtype = 0;
- int rc = 0;
-
-
- if ( ! meta ) {
- DBGC ( dhcp, "DHCP %p received packet without metadata\n",
- dhcp );
- rc = -EINVAL;
- goto err_no_meta;
- }
- if ( ! meta->src ) {
- DBGC ( dhcp, "DHCP %p received packet without source port\n",
- dhcp );
- rc = -EINVAL;
- goto err_no_src;
- }
- sin_src = ( struct sockaddr_in * ) meta->src;
- src_port = sin_src->sin_port;
-
-
- dhcpset = dhcpset_create ( iobuf->data, iob_len ( iobuf ) );
- if ( ! dhcpset ) {
- DBGC ( dhcp, "DHCP %p could not store DHCP packet\n", dhcp );
- rc = -ENOMEM;
- goto err_dhcpset_create;
- }
- dhcphdr = dhcpset->dhcppkt.dhcphdr;
-
-
- dhcppkt_fetch ( &dhcpset->dhcppkt, DHCP_MESSAGE_TYPE, &msgtype,
- sizeof ( msgtype ) );
- DBGC ( dhcp, "DHCP %p %s %p from %s:%d\n", dhcp,
- dhcp_msgtype_name ( msgtype ), dhcpset,
- inet_ntoa ( sin_src->sin_addr ), ntohs ( src_port ) );
-
-
- if ( dhcphdr->xid != dhcp_xid ( dhcp->netdev ) ) {
- DBGC ( dhcp, "DHCP %p %s %p has bad transaction ID\n",
- dhcp, dhcp_msgtype_name ( msgtype ), dhcpset );
- rc = -EINVAL;
- goto err_xid;
- };
-
-
- switch ( dhcp->state ) {
- case DHCP_STATE_DISCOVER:
- if ( ( ( msgtype == DHCPOFFER ) || ( msgtype == DHCPNONE ) ) &&
- ( src_port == htons ( BOOTPS_PORT ) ) )
- dhcp_rx_dhcpoffer ( dhcp, dhcpset );
- break;
- case DHCP_STATE_REQUEST:
- if ( ( ( msgtype == DHCPACK ) || ( msgtype == DHCPNONE ) ) &&
- ( src_port == htons ( BOOTPS_PORT ) ) )
- dhcp_rx_dhcpack ( dhcp, dhcpset );
- break;
- case DHCP_STATE_PROXYREQUEST:
- if ( ( msgtype == DHCPACK ) &&
- ( src_port == htons ( PROXYDHCP_PORT ) ) )
- dhcp_rx_proxydhcpack ( dhcp, dhcpset );
- break;
- case DHCP_STATE_BSREQUEST:
- if ( ( msgtype == DHCPACK ) &&
- ( src_port == htons ( PROXYDHCP_PORT ) ) )
- dhcp_rx_bsdhcpack ( dhcp, dhcpset );
- break;
- default:
- assert ( 0 );
- break;
- }
-
- err_xid:
- dhcpset_put ( dhcpset );
- err_dhcpset_create:
- err_no_src:
- err_no_meta:
- free_iob ( iobuf );
- return rc;
- }
-
-
- static struct xfer_interface_operations dhcp_xfer_operations = {
- .close = ignore_xfer_close,
- .vredirect = xfer_vopen,
- .window = unlimited_xfer_window,
- .alloc_iob = default_xfer_alloc_iob,
- .deliver_iob = dhcp_deliver_iob,
- .deliver_raw = xfer_deliver_as_iob,
- };
-
-
- static void dhcp_timer_expired ( struct retry_timer *timer, int fail ) {
- struct dhcp_session *dhcp =
- container_of ( timer, struct dhcp_session, timer );
- unsigned long elapsed = ( currticks() - dhcp->start );
-
-
- if ( fail ) {
- dhcp_finished ( dhcp, -ETIMEDOUT );
- return;
- }
-
-
- if ( dhcp->dhcpoffer && ( elapsed > PROXYDHCP_WAIT_TIME ) ) {
- dhcp_next_state ( dhcp );
- return;
- }
-
-
- dhcp_tx ( dhcp );
- }
-
-
-
-
- static void dhcp_job_kill ( struct job_interface *job ) {
- struct dhcp_session *dhcp =
- container_of ( job, struct dhcp_session, job );
-
-
- dhcp_finished ( dhcp, -ECANCELED );
- }
-
-
- static struct job_interface_operations dhcp_job_operations = {
- .done = ignore_job_done,
- .kill = dhcp_job_kill,
- .progress = ignore_job_progress,
- };
-
-
-
-
- int start_dhcp ( struct job_interface *job, struct net_device *netdev ) {
- static struct sockaddr_in server = {
- .sin_family = AF_INET,
- .sin_addr.s_addr = INADDR_BROADCAST,
- .sin_port = htons ( BOOTPS_PORT ),
- };
- static struct sockaddr_in client = {
- .sin_family = AF_INET,
- .sin_port = htons ( BOOTPC_PORT ),
- };
- struct dhcp_session *dhcp;
- int rc;
-
-
- dhcp = zalloc ( sizeof ( *dhcp ) );
- if ( ! dhcp )
- return -ENOMEM;
- dhcp->refcnt.free = dhcp_free;
- job_init ( &dhcp->job, &dhcp_job_operations, &dhcp->refcnt );
- xfer_init ( &dhcp->xfer, &dhcp_xfer_operations, &dhcp->refcnt );
- dhcp->netdev = netdev_get ( netdev );
- dhcp->timer.expired = dhcp_timer_expired;
- dhcp->timer.min_timeout = DHCP_MIN_TIMEOUT;
- dhcp->timer.max_timeout = DHCP_MAX_TIMEOUT;
- dhcp->start = currticks();
-
-
- if ( ( rc = xfer_open_socket ( &dhcp->xfer, SOCK_DGRAM,
- ( struct sockaddr * ) &server,
- ( struct sockaddr * ) &client ) ) != 0 )
- goto err;
-
-
- start_timer_nodelay ( &dhcp->timer );
-
-
- job_plug_plug ( &dhcp->job, job );
- ref_put ( &dhcp->refcnt );
- return 0;
-
- err:
- dhcp_finished ( dhcp, rc );
- ref_put ( &dhcp->refcnt );
- return rc;
- }
|