// L2TPNS: icmp
-char const *cvs_id_icmp = "$Id: icmp.c,v 1.7 2005/01/25 04:19:05 bodea Exp $";
+char const *cvs_id_icmp = "$Id: icmp.c,v 1.8 2005/06/04 15:42:06 bodea Exp $";
#include <arpa/inet.h>
#include <netdb.h>
char buf[128] = {0};
struct iphdr *iph;
struct icmphdr *icmp;
- char *data;
int len = 0, on = 1, icmp_socket;
struct sockaddr_in whereto = {0};
len = sizeof(struct iphdr);
icmp = (struct icmphdr *)(buf + len);
len += sizeof(struct icmphdr);
- data = (char *)(buf + len);
- len += (packet_len < 64) ? packet_len : 64;
- memcpy(data, packet, (packet_len < 64) ? packet_len : 64);
+
+ /* ip header + first 8 bytes of payload */
+ if (packet_len > (sizeof(struct iphdr) + 8))
+ packet_len = sizeof(struct iphdr) + 8;
+
+ memcpy(buf + len, packet, packet_len);
+ len += packet_len;
iph->tos = 0;
iph->id = id;
icmp->type = ICMP_DEST_UNREACH;
icmp->code = ICMP_HOST_UNREACH;
- icmp->checksum = _checksum((char *) icmp, sizeof(struct icmphdr) + ((packet_len < 64) ? packet_len : 64));
+ icmp->checksum = _checksum((char *) icmp, sizeof(struct icmphdr) + packet_len);
iph->check = _checksum((char *) iph, sizeof(struct iphdr));