Я благодарен Вам за помощь. Очень помогаете. Надеюсь и дальше сможете мне помочь, дабы добить до конца тему. И так, благодаря ВАм, пакеты icmp успешно принимаются. Вот код который получился на данный момент:
| Код |
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <conio.h>
#include <WinSock2.h>
#include <Ws2tcpip.h>
#include <process.h>
#include <time.h>
#include <windows.h>
#pragma comment(lib, "ws2_32.lib")
#define BUFSIZE 1500
#define ICMP_TIMXCEED 11
#define ICMP_TIMXCEED_INTRANS 0
#define ICMP_UNREACH 3
#define ICMP_UNREACH_PORT 3
#define ICMP_ECHO 8
typedef unsigned char u_int8_t;
typedef unsigned short u_int16_t;
typedef unsigned int u_int32_t;
/* стуктура даних UDP */
struct outdata {
int outdata_seq; /* порядковий номер */
int outdata_ttl; /* значення TTL */
DWORD timestamp; /* час відправлення пакета */
};
struct udphdr {
u_short uh_sport; /* source port */
u_short uh_dport; /* destination port */
u_short uh_ulen; /* udp length */
u_short uh_sum; /* udp checksum */
};
struct iphdr {
u_int32_t ihl:4;
u_int32_t version:4;
u_int8_t tos;
u_int16_t tot_len;
u_int16_t id;
u_int16_t frag_off;
u_int8_t ttl;
u_int8_t protocol;
u_int16_t check;
u_int32_t saddr;
u_int32_t daddr;
};
struct icmp
{
u_int8_t icmp_type; /* type of message, see below */
u_int8_t icmp_code; /* type sub code */
u_int16_t icmp_cksum; /* ones complement checksum of struct */
union
{
struct ih_idseq /* echo datagram */
{
u_int16_t icd_id;
u_int16_t icd_seq;
} ih_idseq;
} icmp_hun;
#define icmp_id icmp_hun.ih_idseq.icd_id
#define icmp_seq icmp_hun.ih_idseq.icd_seq
union
{
u_int8_t id_data[1];
} icmp_dun;
#define icmp_data icmp_dun.id_data
};
char recvbuf[BUFSIZE];
char sendbuf[BUFSIZE];
SOCKET sendfd = INVALID_SOCKET; /* дескриптор сокета для отправки UDP-дейтаграмм */
SOCKET recvfd = INVALID_SOCKET; /* дескриптор сырого сокета для приема ICMP-сообщений */
struct sockaddr_in sasend;
/* структура sockaddr() для отправки пакета */
struct sockaddr_in sabind;
/* структура sockaddr() для связывания порта отправителя */
struct sockaddr_in sarecv;
/* структура sockaddr() для получения пакета */
struct sockaddr_in salast;
/* последняя структура sockaddr() для получения */
int sport;
int dport;
int n = 0;
int ttl;
int probe;
int max_ttl = 25;
/* максимальное значение поля TTL */
int nprobes = 1;
/* количество пробных пакетов */
int dport = 32768 + 666;
/* начальный порт получателя */
int datalen = sizeof(struct outdata);
/* длина поля данных UDP */
WSADATA wsaData;
WSAEVENT rawscEvent = WSA_INVALID_EVENT;
unsigned short checksum( unsigned short *buffer, int size);
int main(int argc, char **argv) {
int iResult;
int seq = 0;
int code = 0;
int done = 0;
double rtt = 0.0;
struct hostent *hp = NULL;
struct outdata *outdata = NULL;
unsigned char data[128];
struct icmp *icmp_hdr = (struct icmp *) data;
// struct _SYSTEMTIME tvrecv;
struct sockaddr_in sockAddr;
unsigned long ul = 1;
int nRet;
//ініціюємо сокет
iResult = WSAStartup(MAKEWORD(2,2), &wsaData);
if (iResult != 0) {
printf("WSAStartup failed: %d\n", iResult);
return 1;
}
if (argc != 2) {
fprintf(stderr, "Usage: %s <hostname>\n", argv[0]);
exit(-1);
}
if ( (hp = gethostbyname(argv[1])) == NULL) {
printf("gethostbyname() failed");
exit(-1);
}
if ( (recvfd = socket(AF_INET, SOCK_RAW, IPPROTO_ICMP)) == SOCKET_ERROR) {
printf("socket() failed, %d\n", WSAGetLastError());
WSACleanup();
exit(-1);
}
if((rawscEvent = WSACreateEvent()) == WSA_INVALID_EVENT) {
printf("WSACreateEvent failed %d\n", WSAGetLastError());
return -1;
}
if(WSAEventSelect(recvfd, rawscEvent, FD_READ) == SOCKET_ERROR) {
printf("WSAEventSelect failed %d\n", WSAGetLastError());
return -1;
}
if ((sendfd = socket(AF_INET, SOCK_DGRAM, 0)) == SOCKET_ERROR) {
printf("socket() failed, %d\n", WSAGetLastError());
WSACleanup();
exit(-1);
}
sport = (_getpid() & 0xffff) | 0x8000;
/* номер порта UDP отправителя */
ZeroMemory(&sasend, sizeof(sasend));
sasend.sin_family = AF_INET;
sasend.sin_addr= *((struct in_addr *) hp->h_addr);
sabind.sin_family = AF_INET;
sabind.sin_port = htons(sport);
if (bind(sendfd, (struct sockaddr *)&sabind, sizeof(sabind)) != 0)
printf("bind() failed");
//отправляем пакет ехо, чтобы можно было принимать icmp(непонятный баг, но работает)
sockAddr.sin_family = AF_INET;
sockAddr.sin_addr.s_addr = inet_addr( "127.0.0.1" );
ZeroMemory(data, sizeof(data));
icmp_hdr->icmp_type = ICMP_ECHO;
icmp_hdr->icmp_code = 0;
icmp_hdr->icmp_id = 1;
icmp_hdr->icmp_seq = 1;
icmp_hdr->icmp_cksum = 0;
memset( &data[sizeof(struct icmp)],'X', sizeof(data)-sizeof(struct icmp));
icmp_hdr->icmp_cksum = checksum( (unsigned short *) data, sizeof(data));
if( sendto(recvfd, data, sizeof(icmp_hdr), 0, (struct sockaddr *) &sockAddr,
sizeof(sockAddr)) == SOCKET_ERROR )
printf( "Error of sendto, error code %u\n", WSAGetLastError());
for (ttl = 1; ttl <= max_ttl && done == 0; ttl++) {
iResult = setsockopt(sendfd, IPPROTO_IP, IP_TTL, (char *)&ttl, sizeof(int));
ZeroMemory(&salast, sizeof(salast));
printf("%2d ", ttl);
fflush(stdout);
for (probe = 0; probe < nprobes; probe++) {
outdata = (struct outdata *)sendbuf;
outdata->outdata_seq = ++seq;
outdata->outdata_ttl = ttl;
outdata->timestamp = GetTickCount();
sasend.sin_port = htons(dport + seq);
if (sendto(sendfd, sendbuf, datalen, 0, (struct sockaddr *)&sasend, sizeof(sasend)) < 0) {
printf("sendto() failed");
WSACleanup();
exit(-1);
}
}
packet_ok(seq);
}
}
int packet_ok(int seq) {
int len;
int hlen1;
int hlen2;
struct iphdr *ip;
struct iphdr *hip;
struct icmp *icmp;
struct udphdr *udp;
int count=0, iResult = 0;
DWORD rv = 2;
BOOL bResult = FALSE;
BOOL success = TRUE;
len = sizeof(sarecv);
do {
WSANETWORKEVENTS info;
rv = WSAWaitForMultipleEvents(1, &rawscEvent, FALSE, 4000, FALSE);
switch(rv) {
case WSA_WAIT_EVENT_0:
WSAResetEvent( rawscEvent );
printf( "WSA_WAIT_EVENT_0\n" );
if( WSAEnumNetworkEvents(recvfd, rawscEvent, &info) == SOCKET_ERROR )
printf( "Can't enum network events for ICMP socket, error code %u", WSAGetLastError());
else if( (info.lNetworkEvents & FD_READ) != 0 )
{
struct sockaddr_in sockAddr;
unsigned char data[512];
int bytes = recvfrom(recvfd, recvbuf, sizeof(recvbuf), 0, (struct sockaddr*)&sarecv, &len);
//пропустити перший пакет
//if(n++==0)
// break;
printf( "Has ICMP packet, %d bytes\n", bytes);
success=FALSE;
}
break;
case WSA_WAIT_TIMEOUT:
printf( "WSA_WAIT_TIMEOUT\n" );
success = FALSE;
break;
default:
printf( "WSAEnumNetworkEvents error %u\n", WSAGetLastError());
success = FALSE;
break;
}
} while(success);
ip = (struct iphdr *) recvbuf; /* начало IP-заголовка */
hlen1 = ip->ihl << 2; /* длина IP-заголовка */
icmp = (struct icmp *) (recvbuf + hlen1); /* начало ICMP-заголовка */
/* начало сохраненного IP-заголовка */
hip = (struct iphdr *) (recvbuf + hlen1 + 8);
/* длина сохраненного IP-заголовка */
hlen2 = hip->ihl << 2;
/* начало сохраненного UDP-заголовка */
udp = (struct udphdr *) (recvbuf + hlen1 + 8 + hlen2);
printf("ip protocol: %d\n", ip->protocol);
if (icmp->icmp_type == ICMP_TIMXCEED &&
icmp->icmp_code == ICMP_TIMXCEED_INTRANS) {
if (hip->protocol == IPPROTO_UDP &&
udp->uh_sport == htons(sport) &&
udp->uh_dport == htons(dport + seq))
return (-2);
}
if (icmp->icmp_type == ICMP_UNREACH) {
if (hip->protocol == IPPROTO_UDP &&
udp->uh_sport == htons(sport) &&
udp->uh_dport == htons(dport + seq)) {
if (icmp->icmp_code == ICMP_UNREACH_PORT)
return (-1);
}
}
}
unsigned short checksum( unsigned short *buffer, int size)
{
unsigned long cksum = 0;
while( size > 1 )
{
cksum += *buffer++;
size -= sizeof(unsigned short);
}
if( size != 0 ) cksum += *(unsigned char *) buffer;
cksum = (cksum >> 16) + (cksum & 0xffff);
cksum += (cksum >>16);
return (unsigned short) (~cksum);
}
|
Теперь касательно разбора пакета. Допустим я хочу вывести протокол с айпи заголовка hip
| Код |
ip = (struct iphdr *) recvbuf; /* начало IP-заголовка */
hlen1 = ip->ihl << 2; /* длина IP-заголовка */
icmp = (struct icmp *) (recvbuf + hlen1); /* начало ICMP-заголовка */
/* начало сохраненного IP-заголовка */
hip = (struct iphdr *) (recvbuf + hlen1 + 8);
/* длина сохраненного IP-заголовка */
hlen2 = hip->ihl << 2;
/* начало сохраненного UDP-заголовка */
udp = (struct udphdr *) (recvbuf + hlen1 + 8 + hlen2);
printf("ip protocol: %d\n", hip->protocol);
if (icmp->icmp_type == ICMP_TIMXCEED &&
icmp->icmp_code == ICMP_TIMXCEED_INTRANS) {
if (hip->protocol == IPPROTO_UDP &&
udp->uh_sport == htons(sport) &&
udp->uh_dport == htons(dport + seq))
return (-2);
|
Выводит 168, а должен 17(IPPROTO_UDP) . icmp->icmp_type, icmp->icmp_code выводятся с верными значениями.
Причем, снифер WireShark, показывает, что протокол UDP(17).
|
Пока по сокету что-нибудь не пошлёшь, он как будто запечатанный. Стоит что-то послать, и он начинает ловить ICMP...
. Итак вот что в конечном итоге получилось. Быть может кому-то понадобится. Правда комментарии на украинском языке, так как это требование задания было.
