- fixed Eth_pkt_send()
- dhcp: don't send padding bytes for whole options git-svn-id: http://moon:8086/svn/mips@211 a8ebac50-d88d-4704-bea3-6648445a41b3
This commit is contained in:
+47
-49
@@ -11,20 +11,20 @@
|
||||
#include "udp.h"
|
||||
#include "dhcp.h"
|
||||
|
||||
#define WITH_CLIENT_ID 1
|
||||
const char hostname[] = "ML-402";
|
||||
|
||||
// -------------------------------------------------------------------------
|
||||
// Testing
|
||||
void DHCP_request_send(packet_t *pPacket, uint32_t dhcp_msg_type, uint8_t *mac_addr_src, uint8_t *inet_addr_src, uint8_t *inet_addr_dst, DHCP *pLast)
|
||||
{
|
||||
uint16_t sum;
|
||||
DHCP *pDHCP;
|
||||
uint8_t *pData;
|
||||
DHCP dhcp;
|
||||
dhcp_opt_hdr_t *pOpt_hdr;
|
||||
uint32_t size, pos, magic = 0x63825363;
|
||||
|
||||
|
||||
pDHCP = (DHCP*)UDP_create(pPacket, inet_addr_src, 68, inet_addr_dst, 67, NULL, sizeof(DHCP));
|
||||
uint32_t size;
|
||||
uint32_t magic = 0x63825363;
|
||||
uint32_t option_size;
|
||||
|
||||
DHCP *pDHCP = &dhcp;
|
||||
|
||||
memset(pDHCP, 0, sizeof(DHCP));
|
||||
|
||||
@@ -43,49 +43,50 @@ void DHCP_request_send(packet_t *pPacket, uint32_t dhcp_msg_type, uint8_t *mac_a
|
||||
pDHCP->xid = (uint32_t)rand();
|
||||
|
||||
// Options
|
||||
pos = 0;
|
||||
option_size = 0;
|
||||
|
||||
size = sizeof(magic);
|
||||
memset(&pDHCP->options[pos], 0xAA, sizeof(pDHCP->options));
|
||||
memcpy(&pDHCP->options[pos], &magic, size);
|
||||
pos += size;
|
||||
memcpy(&pDHCP->options[option_size], &magic, size);
|
||||
option_size += size;
|
||||
|
||||
// Set msg type
|
||||
size = sizeof(dhcp_opt_hdr_t);
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[pos];
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[option_size];
|
||||
pOpt_hdr->code = DHCP_OPT_MSGTYPE;
|
||||
pOpt_hdr->len = 1;
|
||||
pos += size;
|
||||
option_size += size;
|
||||
|
||||
size = pOpt_hdr->len;
|
||||
pDHCP->options[pos] = dhcp_msg_type;
|
||||
pos += size;
|
||||
pDHCP->options[option_size] = dhcp_msg_type;
|
||||
option_size += size;
|
||||
|
||||
#ifdef WITH_CLIENT_ID
|
||||
// Set client ID
|
||||
size = sizeof(dhcp_opt_hdr_t);
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[pos];
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[option_size];
|
||||
pOpt_hdr->code = DHCP_OPT_CLIENTID;
|
||||
pOpt_hdr->len = 6;
|
||||
pos += size;
|
||||
option_size += size;
|
||||
|
||||
size = pOpt_hdr->len;
|
||||
memcpy(&pDHCP->options[pos], mac_addr_src, size);
|
||||
pos += size;
|
||||
memcpy(&pDHCP->options[option_size], mac_addr_src, size);
|
||||
option_size += size;
|
||||
#endif
|
||||
|
||||
// Set client name
|
||||
size = sizeof(dhcp_opt_hdr_t);
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[pos];
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[option_size];
|
||||
pOpt_hdr->code = DHCP_OPT_HOSTNAME;
|
||||
pOpt_hdr->len = strlen(hostname);
|
||||
pos += size;
|
||||
option_size += size;
|
||||
|
||||
size = pOpt_hdr->len;
|
||||
memcpy(&pDHCP->options[pos], hostname, size);
|
||||
pos += size;
|
||||
memcpy(&pDHCP->options[option_size], hostname, size);
|
||||
option_size += size;
|
||||
|
||||
pDHCP->options[pos] = DHCP_OPT_END;
|
||||
pDHCP->options[option_size] = DHCP_OPT_END;
|
||||
option_size++;
|
||||
|
||||
break;
|
||||
|
||||
case DHCP_MSG_DHCPREQUEST:
|
||||
@@ -93,67 +94,64 @@ void DHCP_request_send(packet_t *pPacket, uint32_t dhcp_msg_type, uint8_t *mac_a
|
||||
pDHCP->xid = pLast->xid;
|
||||
|
||||
// Options
|
||||
pos = 0;
|
||||
option_size = 0;
|
||||
|
||||
size = sizeof(magic);
|
||||
memcpy(&pDHCP->options[pos], &magic, size);
|
||||
pos += size;
|
||||
memcpy(&pDHCP->options[option_size], &magic, size);
|
||||
option_size += size;
|
||||
|
||||
// Set msg type
|
||||
size = sizeof(dhcp_opt_hdr_t);
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[pos];
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[option_size];
|
||||
pOpt_hdr->code = DHCP_OPT_MSGTYPE;
|
||||
pOpt_hdr->len = 1;
|
||||
pos += size;
|
||||
option_size += size;
|
||||
|
||||
size = pOpt_hdr->len;
|
||||
pDHCP->options[pos] = dhcp_msg_type;
|
||||
pos += size;
|
||||
pDHCP->options[option_size] = dhcp_msg_type;
|
||||
option_size += size;
|
||||
|
||||
#ifdef WITH_CLIENT_ID
|
||||
// Set client ID
|
||||
size = sizeof(dhcp_opt_hdr_t);
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[pos];
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[option_size];
|
||||
pOpt_hdr->code = DHCP_OPT_CLIENTID;
|
||||
pOpt_hdr->len = 6;
|
||||
pos += size;
|
||||
option_size += size;
|
||||
|
||||
size = pOpt_hdr->len;
|
||||
memcpy(&pDHCP->options[pos], mac_addr_src, size);
|
||||
pos += size;
|
||||
memcpy(&pDHCP->options[option_size], mac_addr_src, size);
|
||||
option_size += size;
|
||||
#endif
|
||||
// Set client name
|
||||
size = sizeof(dhcp_opt_hdr_t);
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[pos];
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[option_size];
|
||||
pOpt_hdr->code = DHCP_OPT_HOSTNAME;
|
||||
pOpt_hdr->len = strlen(hostname);
|
||||
pos += size;
|
||||
option_size += size;
|
||||
|
||||
size = pOpt_hdr->len;
|
||||
memcpy(&pDHCP->options[pos], hostname, size);
|
||||
pos += size;
|
||||
memcpy(&pDHCP->options[option_size], hostname, size);
|
||||
option_size += size;
|
||||
|
||||
// Set requested IP address
|
||||
size = sizeof(dhcp_opt_hdr_t);
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[pos];
|
||||
pOpt_hdr = (dhcp_opt_hdr_t*)&pDHCP->options[option_size];
|
||||
pOpt_hdr->code = DHCP_OPT_REQIP;
|
||||
pOpt_hdr->len = 4;
|
||||
pos += size;
|
||||
option_size += size;
|
||||
|
||||
size = pOpt_hdr->len;
|
||||
memcpy(&pDHCP->options[pos], pLast->yiaddr, size);
|
||||
pos += size;
|
||||
memcpy(&pDHCP->options[option_size], pLast->yiaddr, size);
|
||||
option_size += size;
|
||||
|
||||
pDHCP->options[pos] = DHCP_OPT_END;
|
||||
pDHCP->options[option_size] = DHCP_OPT_END;
|
||||
option_size++;
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
|
||||
|
||||
pData = (uint8_t*)Eth_pkt_append(pPacket, sizeof(DHCP));
|
||||
|
||||
UDP_create(pPacket, inet_addr_src, 68, inet_addr_dst, 67, (uint8_t*)&dhcp, sizeof(DHCP) - sizeof(dhcp_option_t) + option_size);
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user