mirror of
https://github.com/Waujito/youtubeUnblock.git
synced 2024-12-22 06:15:31 +00:00
462 lines
10 KiB
C
462 lines
10 KiB
C
#include "utils.h"
|
|
#include "logging.h"
|
|
#include "types.h"
|
|
|
|
#ifndef KERNEL_SPACE
|
|
#include <stdlib.h>
|
|
#include <libnetfilter_queue/libnetfilter_queue_ipv4.h>
|
|
#include <libnetfilter_queue/libnetfilter_queue_ipv6.h>
|
|
#include <libnetfilter_queue/libnetfilter_queue_tcp.h>
|
|
#endif
|
|
|
|
|
|
void tcp4_set_checksum(struct tcphdr *tcph, struct iphdr *iph)
|
|
{
|
|
#ifdef KERNEL_SPACE
|
|
uint32_t tcp_packet_len = ntohs(iph->tot_len) - (iph->ihl << 2);
|
|
tcph->check = 0;
|
|
tcph->check = csum_tcpudp_magic(
|
|
iph->saddr, iph->daddr, tcp_packet_len,
|
|
IPPROTO_TCP,
|
|
csum_partial(tcph, tcp_packet_len, 0));
|
|
#else
|
|
nfq_tcp_compute_checksum_ipv4(tcph, iph);
|
|
#endif
|
|
}
|
|
|
|
void ip4_set_checksum(struct iphdr *iph)
|
|
{
|
|
#ifdef KERNEL_SPACE
|
|
iph->check = 0;
|
|
iph->check = ip_fast_csum(iph, iph->ihl);
|
|
#else
|
|
nfq_ip_set_checksum(iph);
|
|
#endif
|
|
}
|
|
|
|
void tcp6_set_checksum(struct tcphdr *tcph, struct ip6_hdr *iph) {
|
|
uint16_t old_check = ntohs(tcph->check);
|
|
|
|
// nfq_tcp_compute_checksum_ipv6(tcph, iph);
|
|
}
|
|
|
|
int set_ip_checksum(void *iph, uint32_t iphb_len) {
|
|
int ipvx = netproto_version(iph, iphb_len);
|
|
|
|
if (ipvx == IP4VERSION) {
|
|
ip4_set_checksum(iph);
|
|
} else if (ipvx == IP6VERSION) { // IP6 has no checksums
|
|
} else
|
|
return -1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int set_tcp_checksum(struct tcphdr *tcph, void *iph, uint32_t iphb_len) {
|
|
int ipvx = netproto_version(iph, iphb_len);
|
|
|
|
if (ipvx == IP4VERSION) {
|
|
tcp4_set_checksum(tcph, iph);
|
|
} else if (ipvx == IP6VERSION) {
|
|
tcp6_set_checksum(tcph, iph);
|
|
} else
|
|
return -1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int ip4_payload_split(uint8_t *pkt, uint32_t buflen,
|
|
struct iphdr **iph, uint32_t *iph_len,
|
|
uint8_t **payload, uint32_t *plen) {
|
|
if (pkt == NULL || buflen < sizeof(struct iphdr)) {
|
|
lgerror("ip4_payload_split: pkt|buflen", -EINVAL);
|
|
return -EINVAL;
|
|
}
|
|
|
|
struct iphdr *hdr = (struct iphdr *)pkt;
|
|
if (netproto_version(pkt, buflen) != IP4VERSION) {
|
|
lgerror("ip4_payload_split: ipversion", -EINVAL);
|
|
return -EINVAL;
|
|
}
|
|
|
|
uint32_t hdr_len = hdr->ihl * 4;
|
|
uint32_t pktlen = ntohs(hdr->tot_len);
|
|
if (buflen < pktlen || hdr_len > pktlen) {
|
|
lgerror("ip4_payload_split: buflen cmp pktlen", -EINVAL);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (iph)
|
|
*iph = hdr;
|
|
if (iph_len)
|
|
*iph_len = hdr_len;
|
|
if (payload)
|
|
*payload = pkt + hdr_len;
|
|
if (plen)
|
|
*plen = pktlen - hdr_len;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int tcp4_payload_split(uint8_t *pkt, uint32_t buflen,
|
|
struct iphdr **iph, uint32_t *iph_len,
|
|
struct tcphdr **tcph, uint32_t *tcph_len,
|
|
uint8_t **payload, uint32_t *plen) {
|
|
struct iphdr *hdr;
|
|
uint32_t hdr_len;
|
|
struct tcphdr *thdr;
|
|
uint32_t thdr_len;
|
|
|
|
uint8_t *tcph_pl;
|
|
uint32_t tcph_plen;
|
|
|
|
if (ip4_payload_split(pkt, buflen, &hdr, &hdr_len,
|
|
&tcph_pl, &tcph_plen)){
|
|
return -EINVAL;
|
|
}
|
|
|
|
|
|
if (
|
|
hdr->protocol != IPPROTO_TCP ||
|
|
tcph_plen < sizeof(struct tcphdr)) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
|
|
thdr = (struct tcphdr *)(tcph_pl);
|
|
thdr_len = thdr->doff * 4;
|
|
|
|
if (thdr_len > tcph_plen) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (iph) *iph = hdr;
|
|
if (iph_len) *iph_len = hdr_len;
|
|
if (tcph) *tcph = thdr;
|
|
if (tcph_len) *tcph_len = thdr_len;
|
|
if (payload) *payload = tcph_pl + thdr_len;
|
|
if (plen) *plen = tcph_plen - thdr_len;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int ip6_payload_split(uint8_t *pkt, uint32_t buflen,
|
|
struct ip6_hdr **iph, uint32_t *iph_len,
|
|
uint8_t **payload, uint32_t *plen) {
|
|
if (pkt == NULL || buflen < sizeof(struct ip6_hdr)) {
|
|
lgerror("ip6_payload_split: pkt|buflen", -EINVAL);
|
|
return -EINVAL;
|
|
}
|
|
|
|
struct ip6_hdr *hdr = (struct ip6_hdr *)pkt;
|
|
if (netproto_version(pkt, buflen) != 6) {
|
|
lgerror("ip6_payload_split: ip6version", -EINVAL);
|
|
return -EINVAL;
|
|
}
|
|
|
|
uint32_t hdr_len = sizeof(struct ip6_hdr);
|
|
uint32_t pktlen = ntohs(hdr->ip6_plen);
|
|
if (buflen < pktlen) {
|
|
lgerror("ip6_payload_split: buflen cmp pktlen: %d %d", -EINVAL, buflen, pktlen);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (iph)
|
|
*iph = hdr;
|
|
if (iph_len)
|
|
*iph_len = hdr_len;
|
|
if (payload)
|
|
*payload = pkt + hdr_len;
|
|
if (plen)
|
|
*plen = pktlen;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int tcp6_payload_split(uint8_t *pkt, uint32_t buflen,
|
|
struct ip6_hdr **iph, uint32_t *iph_len,
|
|
struct tcphdr **tcph, uint32_t *tcph_len,
|
|
uint8_t **payload, uint32_t *plen) {
|
|
struct ip6_hdr *hdr;
|
|
uint32_t hdr_len;
|
|
struct tcphdr *thdr;
|
|
uint32_t thdr_len;
|
|
|
|
uint8_t *tcph_pl;
|
|
uint32_t tcph_plen;
|
|
|
|
if (ip6_payload_split(pkt, buflen, &hdr, &hdr_len,
|
|
&tcph_pl, &tcph_plen)){
|
|
return -EINVAL;
|
|
}
|
|
|
|
|
|
if (
|
|
hdr->ip6_nxt != IPPROTO_TCP ||
|
|
tcph_plen < sizeof(struct tcphdr)) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
|
|
thdr = (struct tcphdr *)(tcph_pl);
|
|
thdr_len = thdr->doff * 4;
|
|
|
|
if (thdr_len > tcph_plen) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (iph) *iph = hdr;
|
|
if (iph_len) *iph_len = hdr_len;
|
|
if (tcph) *tcph = thdr;
|
|
if (tcph_len) *tcph_len = thdr_len;
|
|
if (payload) *payload = tcph_pl + thdr_len;
|
|
if (plen) *plen = tcph_plen - thdr_len;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int tcp_payload_split(uint8_t *pkt, uint32_t buflen,
|
|
void **iph, uint32_t *iph_len,
|
|
struct tcphdr **tcph, uint32_t *tcph_len,
|
|
uint8_t **payload, uint32_t *plen) {
|
|
int netvers = netproto_version(pkt, buflen);
|
|
if (netvers == IP4VERSION) {
|
|
return tcp4_payload_split(pkt, buflen, (struct iphdr **)iph, iph_len, tcph, tcph_len, payload, plen);
|
|
} else if (netvers == IP6VERSION) {
|
|
return tcp6_payload_split(pkt, buflen, (struct ip6_hdr **)iph, iph_len, tcph, tcph_len, payload, plen);
|
|
} else {
|
|
lgerror("Internet Protocol version is unsupported", -EINVAL);
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
int udp4_payload_split(uint8_t *pkt, uint32_t buflen,
|
|
struct iphdr **iph, uint32_t *iph_len,
|
|
struct udphdr **udph,
|
|
uint8_t **payload, uint32_t *plen) {
|
|
struct iphdr *hdr;
|
|
uint32_t hdr_len;
|
|
struct udphdr *uhdr;
|
|
uint32_t uhdr_len;
|
|
|
|
uint8_t *ip_ph;
|
|
uint32_t ip_phlen;
|
|
|
|
if (ip4_payload_split(pkt, buflen, &hdr, &hdr_len,
|
|
&ip_ph, &ip_phlen)){
|
|
return -EINVAL;
|
|
}
|
|
|
|
|
|
if (
|
|
hdr->protocol != IPPROTO_UDP ||
|
|
ip_phlen < sizeof(struct udphdr)) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
|
|
uhdr = (struct udphdr *)(ip_ph);
|
|
if (uhdr->len != 0 && ntohs(uhdr->len) != ip_phlen) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (iph) *iph = hdr;
|
|
if (iph_len) *iph_len = hdr_len;
|
|
if (udph) *udph = uhdr;
|
|
if (payload) *payload = ip_ph + sizeof(struct udphdr);
|
|
if (plen) *plen = ip_phlen - sizeof(struct udphdr);
|
|
|
|
return 0;
|
|
}
|
|
|
|
// split packet to two ipv4 fragments.
|
|
int ip4_frag(const uint8_t *pkt, uint32_t buflen, uint32_t payload_offset,
|
|
uint8_t *frag1, uint32_t *f1len,
|
|
uint8_t *frag2, uint32_t *f2len) {
|
|
|
|
struct iphdr *hdr;
|
|
const uint8_t *payload;
|
|
uint32_t plen;
|
|
uint32_t hdr_len;
|
|
int ret;
|
|
|
|
if (!frag1 || !f1len || !frag2 || !f2len)
|
|
return -EINVAL;
|
|
|
|
if ((ret = ip4_payload_split(
|
|
(uint8_t *)pkt, buflen,
|
|
&hdr, &hdr_len, (uint8_t **)&payload, &plen)) < 0) {
|
|
lgerror("ipv4_frag: TCP Header extract error", ret);
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (plen <= payload_offset) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (payload_offset & ((1 << 3) - 1)) {
|
|
lgerror("ipv4_frag: Payload offset MUST be a multiply of 8!", -EINVAL);
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
uint32_t f1_plen = payload_offset;
|
|
uint32_t f1_dlen = f1_plen + hdr_len;
|
|
|
|
uint32_t f2_plen = plen - payload_offset;
|
|
uint32_t f2_dlen = f2_plen + hdr_len;
|
|
|
|
if (*f1len < f1_dlen || *f2len < f2_dlen) {
|
|
return -ENOMEM;
|
|
}
|
|
*f1len = f1_dlen;
|
|
*f2len = f2_dlen;
|
|
|
|
memcpy(frag1, hdr, hdr_len);
|
|
memcpy(frag2, hdr, hdr_len);
|
|
|
|
memcpy(frag1 + hdr_len, payload, f1_plen);
|
|
memcpy(frag2 + hdr_len, payload + payload_offset, f2_plen);
|
|
|
|
struct iphdr *f1_hdr = (void *)frag1;
|
|
struct iphdr *f2_hdr = (void *)frag2;
|
|
|
|
uint16_t f1_frag_off = ntohs(f1_hdr->frag_off);
|
|
uint16_t f2_frag_off = ntohs(f2_hdr->frag_off);
|
|
|
|
f1_frag_off &= IP_OFFMASK;
|
|
f1_frag_off |= IP_MF;
|
|
|
|
if ((f2_frag_off & ~IP_OFFMASK) == IP_MF) {
|
|
f2_frag_off &= IP_OFFMASK;
|
|
f2_frag_off |= IP_MF;
|
|
} else {
|
|
f2_frag_off &= IP_OFFMASK;
|
|
}
|
|
|
|
f2_frag_off += (uint16_t)payload_offset / 8;
|
|
|
|
f1_hdr->frag_off = htons(f1_frag_off);
|
|
f1_hdr->tot_len = htons(f1_dlen);
|
|
|
|
f2_hdr->frag_off = htons(f2_frag_off);
|
|
f2_hdr->tot_len = htons(f2_dlen);
|
|
|
|
ip4_set_checksum(f1_hdr);
|
|
ip4_set_checksum(f2_hdr);
|
|
|
|
return 0;
|
|
}
|
|
|
|
// split packet to two tcp-on-ipv4 segments.
|
|
int tcp_frag(const uint8_t *pkt, uint32_t buflen, uint32_t payload_offset,
|
|
uint8_t *seg1, uint32_t *s1len,
|
|
uint8_t *seg2, uint32_t *s2len) {
|
|
|
|
// struct ip6_hdr *hdr6;
|
|
void *hdr;
|
|
uint32_t hdr_len;
|
|
struct tcphdr *tcph;
|
|
uint32_t tcph_len;
|
|
uint32_t plen;
|
|
const uint8_t *payload;
|
|
int ret;
|
|
|
|
if (!seg1 || !s1len || !seg2 || !s2len)
|
|
return -EINVAL;
|
|
|
|
if ((ret = tcp_payload_split((uint8_t *)pkt, buflen,
|
|
&hdr, &hdr_len,
|
|
&tcph, &tcph_len,
|
|
(uint8_t **)&payload, &plen)) < 0) {
|
|
lgerror("tcp_frag: tcp_payload_split", ret);
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
int ipvx = netproto_version(pkt, buflen);
|
|
|
|
|
|
if (ipvx == IP4VERSION) {
|
|
struct iphdr *iphdr = hdr;
|
|
if (
|
|
ntohs(iphdr->frag_off) & IP_MF ||
|
|
ntohs(iphdr->frag_off) & IP_OFFMASK) {
|
|
lgdebugmsg("tcp_frag: ip4: frag value: %d",
|
|
ntohs(iphdr->frag_off));
|
|
lgerror("tcp_frag: ip4: ip fragmentation is set", -EINVAL);
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
|
|
if (plen <= payload_offset) {
|
|
return -EINVAL;
|
|
}
|
|
|
|
uint32_t s1_plen = payload_offset;
|
|
uint32_t s1_dlen = s1_plen + hdr_len + tcph_len;
|
|
|
|
uint32_t s2_plen = plen - payload_offset;
|
|
uint32_t s2_dlen = s2_plen + hdr_len + tcph_len;
|
|
|
|
if (*s1len < s1_dlen || *s2len < s2_dlen)
|
|
return -ENOMEM;
|
|
|
|
*s1len = s1_dlen;
|
|
*s2len = s2_dlen;
|
|
|
|
memcpy(seg1, hdr, hdr_len);
|
|
memcpy(seg2, hdr, hdr_len);
|
|
|
|
memcpy(seg1 + hdr_len, tcph, tcph_len);
|
|
memcpy(seg2 + hdr_len, tcph, tcph_len);
|
|
|
|
memcpy(seg1 + hdr_len + tcph_len, payload, s1_plen);
|
|
memcpy(seg2 + hdr_len + tcph_len, payload + payload_offset, s2_plen);
|
|
|
|
if (ipvx == IP4VERSION) {
|
|
struct iphdr *s1_hdr = (void *)seg1;
|
|
struct iphdr *s2_hdr = (void *)seg2;
|
|
s1_hdr->tot_len = htons(s1_dlen);
|
|
s2_hdr->tot_len = htons(s2_dlen);
|
|
} else {
|
|
struct ip6_hdr *s1_hdr = (void *)seg1;
|
|
struct ip6_hdr *s2_hdr = (void *)seg2;
|
|
s1_hdr->ip6_plen = htons(s1_dlen - hdr_len);
|
|
s2_hdr->ip6_plen = htons(s2_dlen - hdr_len);
|
|
}
|
|
|
|
struct tcphdr *s1_tcph = (void *)(seg1 + hdr_len);
|
|
struct tcphdr *s2_tcph = (void *)(seg2 + hdr_len);
|
|
|
|
s2_tcph->seq = htonl(ntohl(s2_tcph->seq) + payload_offset);
|
|
|
|
set_tcp_checksum(s1_tcph, seg1, hdr_len);
|
|
set_tcp_checksum(s2_tcph, seg2, hdr_len);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void z_function(const char *str, int *zbuf, size_t len) {
|
|
zbuf[0] = len;
|
|
|
|
ssize_t lh = 0, rh = 1;
|
|
for (ssize_t i = 1; i < len; i++) {
|
|
zbuf[i] = 0;
|
|
if (i < rh) {
|
|
zbuf[i] = min(zbuf[i - lh], rh - i);
|
|
}
|
|
|
|
while (i + zbuf[i] < len && str[zbuf[i]] == str[i + zbuf[i]])
|
|
zbuf[i]++;
|
|
|
|
if (i + zbuf[i] > rh) {
|
|
lh = i;
|
|
rh = i + zbuf[i];
|
|
}
|
|
}
|
|
}
|
|
|