diff options
Diffstat (limited to 'src')
| -rw-r--r-- | src/include/ndpi_protocol_ids.h | 1 | ||||
| -rw-r--r-- | src/include/ndpi_protocols.h | 1 | ||||
| -rw-r--r-- | src/lib/ndpi_main.c | 7 | ||||
| -rw-r--r-- | src/lib/protocols/tplink_shp.c | 95 |
4 files changed, 104 insertions, 0 deletions
diff --git a/src/include/ndpi_protocol_ids.h b/src/include/ndpi_protocol_ids.h index 6e271ea99..894b8c1f9 100644 --- a/src/include/ndpi_protocol_ids.h +++ b/src/include/ndpi_protocol_ids.h @@ -360,6 +360,7 @@ typedef enum { NDPI_PROTOCOL_MUNIN = 329, NDPI_PROTOCOL_ELASTICSEARCH = 330, NDPI_PROTOCOL_TUYA_LP = 331, /* TUYA LAN Protocol; IoT OS: https://github.com/tuya/tuya-iotos-embeded-sdk-wifi-ble-bk7231n */ + NDPI_PROTOCOL_TPLINK_SHP = 332, /* TP-LINK Smart Home Protocol */ #ifdef CUSTOM_NDPI_PROTOCOLS diff --git a/src/include/ndpi_protocols.h b/src/include/ndpi_protocols.h index e0b778b34..be07c517c 100644 --- a/src/include/ndpi_protocols.h +++ b/src/include/ndpi_protocols.h @@ -247,6 +247,7 @@ void init_line_dissector(struct ndpi_detection_module_struct *ndpi_struct, u_int void init_munin_dissector(struct ndpi_detection_module_struct *ndpi_struct, u_int32_t *id); void init_elasticsearch_dissector(struct ndpi_detection_module_struct *ndpi_struct, u_int32_t *id); void init_tuya_lp_dissector(struct ndpi_detection_module_struct *ndpi_struct, u_int32_t *id); +void init_tplink_shp_dissector(struct ndpi_detection_module_struct *ndpi_struct, u_int32_t *id); /* ndpi_main.c */ extern u_int32_t ndpi_ip_port_hash_funct(u_int32_t ip, u_int16_t port); diff --git a/src/lib/ndpi_main.c b/src/lib/ndpi_main.c index 5f4b28e95..fa12772eb 100644 --- a/src/lib/ndpi_main.c +++ b/src/lib/ndpi_main.c @@ -2057,6 +2057,10 @@ static void ndpi_init_protocol_defaults(struct ndpi_detection_module_struct *ndp "TuyaLP", NDPI_PROTOCOL_CATEGORY_IOT_SCADA, ndpi_build_default_ports(ports_a, 0, 0, 0, 0, 0) /* TCP */, ndpi_build_default_ports(ports_b, 6667, 0, 0, 0, 0) /* UDP */); + ndpi_set_proto_defaults(ndpi_str, 1 /* encrypted */, 0 /* nw proto */, NDPI_PROTOCOL_ACCEPTABLE, NDPI_PROTOCOL_TPLINK_SHP, + "TPLINK_SHP", NDPI_PROTOCOL_CATEGORY_IOT_SCADA, + ndpi_build_default_ports(ports_a, 9999, 0, 0, 0, 0) /* TCP */, + ndpi_build_default_ports(ports_b, 9999, 0, 0, 0, 0) /* UDP */); #ifdef CUSTOM_NDPI_PROTOCOLS @@ -4757,6 +4761,9 @@ static int ndpi_callback_init(struct ndpi_detection_module_struct *ndpi_str) { /* TUYA LP */ init_tuya_lp_dissector(ndpi_str, &a); + /* TPLINK_SHP */ + init_tplink_shp_dissector(ndpi_str, &a); + #ifdef CUSTOM_NDPI_PROTOCOLS #include "../../../nDPI-custom/custom_ndpi_main_init.c" #endif diff --git a/src/lib/protocols/tplink_shp.c b/src/lib/protocols/tplink_shp.c new file mode 100644 index 000000000..6301fd7ea --- /dev/null +++ b/src/lib/protocols/tplink_shp.c @@ -0,0 +1,95 @@ +/* + * tplink_shp.c + * + * TP-LINK Smart Home Protocol + * + * Copyright (C) 2022 - ntop.org + * + * nDPI is free software: you can redistribute it and/or modify + * it under the terms of the GNU Lesser General Public License as published by + * the Free Software Foundation, either version 3 of the License, or + * (at your option) any later version. + * + * nDPI is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU Lesser General Public License for more details. + * + * You should have received a copy of the GNU Lesser General Public License + * along with nDPI. If not, see <http://www.gnu.org/licenses/>. + * + */ + + +#include "ndpi_protocol_ids.h" + +#define NDPI_CURRENT_PROTO NDPI_PROTOCOL_TPLINK_SHP + +#include "ndpi_api.h" + +#define _TPLSHP_MIN_LEN 2 +#define _TPLSHP_TCP_LEN_HDR 4 + +static void ndpi_int_tplink_shp_add_connection(struct ndpi_detection_module_struct * const ndpi_struct, + struct ndpi_flow_struct * const flow) +{ + NDPI_LOG_INFO(ndpi_struct, "found TPLINK SHP\n"); + + ndpi_set_detected_protocol(ndpi_struct, flow, + NDPI_PROTOCOL_TPLINK_SHP, + NDPI_PROTOCOL_UNKNOWN, + NDPI_CONFIDENCE_DPI); +} + +/* ***************************************************** */ + +void ndpi_search_tplink_shp(struct ndpi_detection_module_struct *ndpi_struct, + struct ndpi_flow_struct *flow) +{ + struct ndpi_packet_struct const * const packet = &ndpi_struct->packet; + + NDPI_LOG_DBG(ndpi_struct, "search TPLINK SHP\n"); + + u_int16_t offset = 0; + /* Skip length header (TCP payloads only) */ + if(packet->tcp != NULL) offset = _TPLSHP_TCP_LEN_HDR; + + if (packet->payload_packet_len - offset < _TPLSHP_MIN_LEN) + { + NDPI_EXCLUDE_PROTO(ndpi_struct, flow); + return; + } + + u_int16_t i; + u_int8_t k = 171, b[_TPLSHP_MIN_LEN]; + + for (i = 0 ; i < _TPLSHP_MIN_LEN; i++) + { + b[i] = packet->payload[i + offset] ^ k; + k = packet->payload[i + offset]; + } + + if (b[0] != '{' || (b[1] != '}' && b[1] != '"')) + { + NDPI_EXCLUDE_PROTO(ndpi_struct, flow); + return; + } + + ndpi_int_tplink_shp_add_connection(ndpi_struct, flow); +} + +/* ***************************************************** */ + +void init_tplink_shp_dissector(struct ndpi_detection_module_struct *ndpi_struct, + u_int32_t *id) +{ + ndpi_set_bitmask_protocol_detection("TPLINK SHP", ndpi_struct, *id, + NDPI_PROTOCOL_TPLINK_SHP, + ndpi_search_tplink_shp, + NDPI_SELECTION_BITMASK_PROTOCOL_V4_V6_TCP_OR_UDP_WITH_PAYLOAD_WITHOUT_RETRANSMISSION, + SAVE_DETECTION_BITMASK_AS_UNKNOWN, + ADD_TO_DETECTION_BITMASK + ); + + *id += 1; +} |