Signed-off-by: Toni Uhlig <matzeton@googlemail.com>
This commit is contained in:
@@ -811,7 +811,7 @@ struct ndpi_flow_udp_struct {
|
||||
u_int32_t halflife2_stage:2; // 0 - 2
|
||||
|
||||
/* NDPI_PROTOCOL_TFTP */
|
||||
u_int32_t tftp_stage:1;
|
||||
u_int32_t tftp_stage:2;
|
||||
|
||||
/* NDPI_PROTOCOL_AIMINI */
|
||||
u_int32_t aimini_stage:5;
|
||||
|
||||
+92
-20
@@ -28,6 +28,8 @@
|
||||
|
||||
#include "ndpi_api.h"
|
||||
|
||||
/* see: https://datatracker.ietf.org/doc/html/rfc1350 */
|
||||
|
||||
static void ndpi_int_tftp_add_connection(struct ndpi_detection_module_struct
|
||||
*ndpi_struct, struct ndpi_flow_struct *flow)
|
||||
{
|
||||
@@ -41,32 +43,102 @@ void ndpi_search_tftp(struct ndpi_detection_module_struct
|
||||
|
||||
NDPI_LOG_DBG(ndpi_struct, "search TFTP\n");
|
||||
|
||||
if ((packet->payload_packet_len > 3)
|
||||
&& (flow->l4.udp.tftp_stage == 0)
|
||||
&& (ntohl(get_u_int32_t(packet->payload, 0)) == 0x00030001)) {
|
||||
NDPI_LOG_DBG2(ndpi_struct, "maybe tftp. need next packet\n");
|
||||
flow->l4.udp.tftp_stage = 1;
|
||||
if (packet->payload_packet_len < 4 /* min. header size */ ||
|
||||
get_u_int8_t(packet->payload, 0) != 0x00)
|
||||
{
|
||||
NDPI_EXCLUDE_PROTO(ndpi_struct, flow);
|
||||
return;
|
||||
}
|
||||
|
||||
if(flow->l4.udp.tftp_stage == 1) {
|
||||
if (packet->payload_packet_len > 3 && (flow->l4.udp.tftp_stage == 1)
|
||||
&& ntohl(get_u_int32_t(packet->payload, 0)) == 0x00040001) {
|
||||
/* parse TFTP opcode */
|
||||
switch (get_u_int8_t(packet->payload, 1))
|
||||
{
|
||||
case 0x01:
|
||||
/* Read request (RRQ) */
|
||||
case 0x02:
|
||||
/* Write request (WWQ) */
|
||||
|
||||
NDPI_LOG_INFO(ndpi_struct, "found tftp\n");
|
||||
ndpi_int_tftp_add_connection(ndpi_struct, flow);
|
||||
return;
|
||||
}
|
||||
if (packet->payload[packet->payload_packet_len - 1] != 0x00 /* last pdu element is a nul terminated string */)
|
||||
{
|
||||
NDPI_EXCLUDE_PROTO(ndpi_struct, flow);
|
||||
return;
|
||||
}
|
||||
|
||||
if (packet->payload_packet_len > 1
|
||||
&& ((packet->payload[0] == 0 && packet->payload[packet->payload_packet_len - 1] == 0)
|
||||
|| (packet->payload_packet_len == 4 && ntohl(get_u_int32_t(packet->payload, 0)) == 0x00040000))) {
|
||||
NDPI_LOG_DBG2(ndpi_struct, "skip initial packet\n");
|
||||
return;
|
||||
}
|
||||
{
|
||||
char const * const possible_modes[] = { "netascii", "octet", "mail" };
|
||||
uint8_t mode_found = 0;
|
||||
for (uint8_t mode_idx = 0; mode_idx < sizeof(possible_modes) / sizeof(possible_modes[0]); ++mode_idx)
|
||||
{
|
||||
size_t const mode_len = strlen(possible_modes[mode_idx]);
|
||||
|
||||
if (packet->payload_packet_len < mode_len + 1 /* mode is a nul terminated string */)
|
||||
{
|
||||
continue;
|
||||
}
|
||||
if (strncasecmp((char const *)&packet->payload[packet->payload_packet_len - 1 - mode_len],
|
||||
possible_modes[mode_idx], mode_len) == 0)
|
||||
{
|
||||
mode_found = 1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (mode_found == 0)
|
||||
{
|
||||
NDPI_EXCLUDE_PROTO(ndpi_struct, flow);
|
||||
return;
|
||||
}
|
||||
|
||||
/* We have seen enough and do not need any more TFTP packets. */
|
||||
NDPI_LOG_INFO(ndpi_struct, "found tftp (RRQ/WWQ)\n");
|
||||
ndpi_int_tftp_add_connection(ndpi_struct, flow);
|
||||
}
|
||||
return;
|
||||
|
||||
case 0x03:
|
||||
/* Data (DATA) */
|
||||
if (packet->payload_packet_len > 4 /* DATA header size */ + 512 /* max. block size */)
|
||||
{
|
||||
NDPI_EXCLUDE_PROTO(ndpi_struct, flow);
|
||||
return;
|
||||
}
|
||||
break;
|
||||
|
||||
case 0x04:
|
||||
/* Acknowledgment (ACK) */
|
||||
if (packet->payload_packet_len != 4 /* ACK has a fixed packet size */)
|
||||
{
|
||||
NDPI_EXCLUDE_PROTO(ndpi_struct, flow);
|
||||
return;
|
||||
}
|
||||
break;
|
||||
|
||||
case 0x05:
|
||||
/* Error (ERROR) */
|
||||
|
||||
if (packet->payload_packet_len < 5 ||
|
||||
packet->payload[packet->payload_packet_len - 1] != 0x00 ||
|
||||
packet->payload[2] != 0x00 || packet->payload[3] > 0x07)
|
||||
{
|
||||
NDPI_EXCLUDE_PROTO(ndpi_struct, flow);
|
||||
return;
|
||||
}
|
||||
break;
|
||||
|
||||
default:
|
||||
NDPI_EXCLUDE_PROTO(ndpi_struct, flow);
|
||||
return;
|
||||
}
|
||||
|
||||
NDPI_EXCLUDE_PROTO(ndpi_struct, flow);
|
||||
|
||||
if (flow->l4.udp.tftp_stage < 3)
|
||||
{
|
||||
NDPI_LOG_DBG2(ndpi_struct, "maybe tftp. need next packet\n");
|
||||
flow->l4.udp.tftp_stage++;
|
||||
return;
|
||||
}
|
||||
|
||||
NDPI_LOG_INFO(ndpi_struct, "found tftp\n");
|
||||
ndpi_int_tftp_add_connection(ndpi_struct, flow);
|
||||
}
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user