Sweden-Number/dlls/nsiproxy.sys/udp.c

429 lines
14 KiB
C

/*
* nsiproxy.sys udp module
*
* Copyright 2003, 2006, 2011 Juan Lang
* Copyright 2021 Huw Davies
*
* This library 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 2.1 of the License, or (at your option) any later version.
*
* This library 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 this library; if not, write to the Free Software
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
*/
#include "config.h"
#include <stdarg.h>
#include <stddef.h>
#ifdef HAVE_SYS_TYPES_H
#include <sys/types.h>
#endif
#ifdef HAVE_SYS_SYSCTL_H
#include <sys/sysctl.h>
#endif
#ifdef HAVE_SYS_SOCKET_H
#include <sys/socket.h>
#endif
#ifdef HAVE_SYS_SOCKETVAR_H
#include <sys/socketvar.h>
#endif
#ifdef HAVE_NETINET_IN_H
#include <netinet/in.h>
#endif
#ifdef HAVE_NETINET_IP_H
#include <netinet/ip.h>
#endif
#ifdef HAVE_NETINET_IP_VAR_H
#include <netinet/ip_var.h>
#endif
#ifdef HAVE_NETINET_IN_PCB_H
#include <netinet/in_pcb.h>
#endif
#ifdef HAVE_NETINET_UDP_H
#include <netinet/udp.h>
#endif
#ifdef HAVE_NETINET_UDP_VAR_H
#include <netinet/udp_var.h>
#endif
#include "ntstatus.h"
#define WIN32_NO_STATUS
#include "windef.h"
#include "winbase.h"
#include "winternl.h"
#define USE_WS_PREFIX
#include "winsock2.h"
#include "ifdef.h"
#include "netiodef.h"
#include "ws2ipdef.h"
#include "udpmib.h"
#include "wine/heap.h"
#include "wine/nsi.h"
#include "wine/debug.h"
#include "wine/server.h"
#include "nsiproxy_private.h"
WINE_DEFAULT_DEBUG_CHANNEL(nsi);
static DWORD udp_num_addrs( USHORT family )
{
DWORD endpoint_count = 0;
nsi_enumerate_all( 1, 0, &NPI_MS_UDP_MODULEID, NSI_UDP_ENDPOINT_TABLE,
NULL, 0, NULL, 0, NULL, 0, NULL, 0, &endpoint_count );
/* FIXME: actually retrieve the keys and only count endpoints which match family */
return endpoint_count;
}
static NTSTATUS udp_stats_get_all_parameters( const void *key, DWORD key_size, void *rw_data, DWORD rw_size,
void *dynamic_data, DWORD dynamic_size, void *static_data, DWORD static_size )
{
struct nsi_udp_stats_dynamic dyn;
const USHORT *family = key;
TRACE( "%p %d %p %d %p %d %p %d\n", key, key_size, rw_data, rw_size, dynamic_data, dynamic_size,
static_data, static_size );
if (*family != WS_AF_INET && *family != WS_AF_INET6) return STATUS_NOT_SUPPORTED;
memset( &dyn, 0, sizeof(dyn) );
dyn.num_addrs = udp_num_addrs( *family );
#ifdef __linux__
if (*family == WS_AF_INET)
{
NTSTATUS status = STATUS_NOT_SUPPORTED;
static const char hdr[] = "Udp:";
char buf[512], *ptr;
FILE *fp;
if (!(fp = fopen( "/proc/net/snmp", "r" ))) return STATUS_NOT_SUPPORTED;
while ((ptr = fgets( buf, sizeof(buf), fp )))
{
if (_strnicmp( buf, hdr, sizeof(hdr) - 1) ) continue;
/* last line was a header, get another */
if (!(ptr = fgets( buf, sizeof(buf), fp ))) break;
if (!_strnicmp(buf, hdr, sizeof(hdr) - 1))
{
unsigned int in_dgrams, out_dgrams;
ptr += sizeof(hdr);
sscanf( ptr, "%u %u %u %u %u",
&in_dgrams, &dyn.no_ports, &dyn.in_errs, &out_dgrams, &dyn.num_addrs );
dyn.in_dgrams = in_dgrams;
dyn.out_dgrams = out_dgrams;
if (dynamic_data) *(struct nsi_udp_stats_dynamic *)dynamic_data = dyn;
status = STATUS_SUCCESS;
break;
}
}
fclose( fp );
return status;
}
else
{
unsigned int in_dgrams = 0, out_dgrams = 0;
struct
{
const char *name;
DWORD *elem;
} udp_stat_list[] =
{
{ "Udp6InDatagrams", &in_dgrams },
{ "Udp6NoPorts", &dyn.no_ports },
{ "Udp6InErrors", &dyn.in_errs },
{ "Udp6OutDatagrams", &out_dgrams },
};
char buf[512], *ptr, *value;
DWORD res, i;
FILE *fp;
if (!(fp = fopen( "/proc/net/snmp6", "r" ))) return STATUS_NOT_SUPPORTED;
while ((ptr = fgets( buf, sizeof(buf), fp )))
{
if (!(value = strchr( buf, ' ' ))) continue;
/* terminate the valuename */
ptr = value - 1;
*(ptr + 1) = '\0';
/* and strip leading spaces from value */
value += 1;
while (*value==' ') value++;
if ((ptr = strchr( value, '\n' ))) *ptr='\0';
for (i = 0; i < ARRAY_SIZE(udp_stat_list); i++)
if (!_strnicmp( buf, udp_stat_list[i].name, -1 ) && sscanf( value, "%d", &res ))
*udp_stat_list[i].elem = res;
}
dyn.in_dgrams = in_dgrams;
dyn.out_dgrams = out_dgrams;
if (dynamic_data) *(struct nsi_udp_stats_dynamic *)dynamic_data = dyn;
fclose( fp );
return STATUS_SUCCESS;
}
#elif defined(HAVE_SYS_SYSCTL_H) && defined(UDPCTL_STATS) && defined(HAVE_STRUCT_UDPSTAT_UDPS_IPACKETS)
{
int mib[] = { CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_STATS };
struct udpstat udp_stat;
size_t needed = sizeof(udp_stat);
if (sysctl( mib, ARRAY_SIZE(mib), &udp_stat, &needed, NULL, 0 ) == -1) return STATUS_NOT_SUPPORTED;
dyn.in_dgrams = udp_stat.udps_ipackets;
dyn.out_dgrams = udp_stat.udps_opackets;
dyn.no_ports = udp_stat.udps_noport;
dyn.in_errs = udp_stat.udps_hdrops + udp_stat.udps_badsum + udp_stat.udps_fullsock + udp_stat.udps_badlen;
if (dynamic_data) *(struct nsi_udp_stats_dynamic *)dynamic_data = dyn;
return STATUS_SUCCESS;
}
#endif
FIXME( "Not implemented\n" );
return STATUS_NOT_SUPPORTED;
}
static NTSTATUS udp_endpoint_enumerate_all( void *key_data, DWORD key_size, void *rw_data, DWORD rw_size,
void *dynamic_data, DWORD dynamic_size,
void *static_data, DWORD static_size, DWORD_PTR *count )
{
DWORD num = 0;
NTSTATUS status = STATUS_SUCCESS;
BOOL want_data = key_size || rw_size || dynamic_size || static_size;
struct nsi_udp_endpoint_key key, *key_out = key_data;
struct nsi_udp_endpoint_static stat, *stat_out = static_data;
struct ipv6_addr_scope *addr_scopes = NULL;
unsigned int addr_scopes_size = 0, pid_map_size = 0;
struct pid_map *pid_map = NULL;
TRACE( "%p %d %p %d %p %d %p %d %p\n", key_data, key_size, rw_data, rw_size,
dynamic_data, dynamic_size, static_data, static_size, count );
#ifdef __linux__
{
FILE *fp;
char buf[512], *ptr;
int inode;
if (!(fp = fopen( "/proc/net/udp", "r" ))) return ERROR_NOT_SUPPORTED;
memset( &key, 0, sizeof(key) );
memset( &stat, 0, sizeof(stat) );
pid_map = get_pid_map( &pid_map_size );
/* skip header line */
ptr = fgets( buf, sizeof(buf), fp );
while ((ptr = fgets( buf, sizeof(buf), fp )))
{
if (sscanf( ptr, "%*u: %x:%hx %*s %*s %*s %*s %*s %*s %*s %d",
&key.local.Ipv4.sin_addr.WS_s_addr, &key.local.Ipv4.sin_port, &inode ) != 3)
continue;
key.local.Ipv4.sin_family = WS_AF_INET;
key.local.Ipv4.sin_port = htons( key.local.Ipv4.sin_port );
stat.pid = find_owning_pid( pid_map, pid_map_size, inode );
stat.create_time = 0; /* FIXME */
stat.flags = 0; /* FIXME */
stat.mod_info = 0; /* FIXME */
if (num < *count)
{
if (key_out) *key_out++ = key;
if (stat_out) *stat_out++ = stat;
}
num++;
}
fclose( fp );
if ((fp = fopen( "/proc/net/udp6", "r" )))
{
memset( &key, 0, sizeof(key) );
memset( &stat, 0, sizeof(stat) );
addr_scopes = get_ipv6_addr_scope_table( &addr_scopes_size );
/* skip header line */
ptr = fgets( buf, sizeof(buf), fp );
while ((ptr = fgets( buf, sizeof(buf), fp )))
{
DWORD *local_addr = (DWORD *)&key.local.Ipv6.sin6_addr;
if (sscanf( ptr, "%*u: %8x%8x%8x%8x:%hx %*s %*s %*s %*s %*s %*s %*s %d",
local_addr, local_addr + 1, local_addr + 2, local_addr + 3,
&key.local.Ipv6.sin6_port, &inode ) != 6)
continue;
key.local.Ipv6.sin6_family = WS_AF_INET6;
key.local.Ipv6.sin6_port = htons( key.local.Ipv6.sin6_port );
key.local.Ipv6.sin6_scope_id = find_ipv6_addr_scope( &key.local.Ipv6.sin6_addr, addr_scopes,
addr_scopes_size );
stat.pid = find_owning_pid( pid_map, pid_map_size, inode );
stat.create_time = 0; /* FIXME */
stat.flags = 0; /* FIXME */
stat.mod_info = 0; /* FIXME */
if (num < *count)
{
if (key_out) *key_out++ = key;
if (stat_out) *stat_out++ = stat;
}
num++;
}
fclose( fp );
}
}
#elif defined(HAVE_SYS_SYSCTL_H) && defined(UDPCTL_PCBLIST) && defined(HAVE_STRUCT_XINPGEN)
{
int mib[] = { CTL_NET, PF_INET, IPPROTO_UDP, UDPCTL_PCBLIST };
size_t len = 0;
char *buf = NULL;
struct xinpgen *xig, *orig_xig;
if (sysctl( mib, ARRAY_SIZE(mib), NULL, &len, NULL, 0 ) < 0)
{
ERR( "Failure to read net.inet.udp.pcblist via sysctlbyname!\n" );
status = STATUS_NOT_SUPPORTED;
goto err;
}
buf = heap_alloc( len );
if (!buf)
{
status = STATUS_NO_MEMORY;
goto err;
}
if (sysctl( mib, ARRAY_SIZE(mib), buf, &len, NULL, 0 ) < 0)
{
ERR( "Failure to read net.inet.udp.pcblist via sysctlbyname!\n" );
status = STATUS_NOT_SUPPORTED;
goto err;
}
/* Might be nothing here; first entry is just a header it seems */
if (len <= sizeof(struct xinpgen)) goto err;
addr_scopes = get_ipv6_addr_scope_table( &addr_scopes_size );
pid_map = get_pid_map( &pid_map_size );
orig_xig = (struct xinpgen *)buf;
xig = orig_xig;
for (xig = (struct xinpgen *)((char *)xig + xig->xig_len);
xig->xig_len > sizeof (struct xinpgen);
xig = (struct xinpgen *)((char *)xig + xig->xig_len))
{
#if __FreeBSD_version >= 1200026
struct xinpcb *in = (struct xinpcb *)xig;
struct xsocket *sock = &in->xi_socket;
#else
struct inpcb *in = &((struct xinpcb *)xig)->xi_inp;
struct xsocket *sock = &((struct xinpcb *)xig)->xi_socket;
#endif
static const struct in6_addr zero;
/* Ignore sockets for other protocols */
if (sock->xso_protocol != IPPROTO_UDP) continue;
/* Ignore PCBs that were freed while generating the data */
if (in->inp_gencnt > orig_xig->xig_gen) continue;
/* we're only interested in IPv4 and IPv6 addresses */
if (!(in->inp_vflag & (INP_IPV4 | INP_IPV6))) continue;
/* If all 0's, skip it */
if (in->inp_vflag & INP_IPV4 && !in->inp_laddr.s_addr) continue;
if (in->inp_vflag & INP_IPV6 && !memcmp( &in->in6p_laddr, &zero, sizeof(zero) ) && !in->inp_lport) continue;
if (in->inp_vflag & INP_IPV4)
{
key.local.Ipv4.sin_family = WS_AF_INET;
key.local.Ipv4.sin_addr.WS_s_addr = in->inp_laddr.s_addr;
key.local.Ipv4.sin_port = in->inp_lport;
}
else
{
key.local.Ipv6.sin6_family = WS_AF_INET6;
memcpy( &key.local.Ipv6.sin6_addr, &in->in6p_laddr, sizeof(in->in6p_laddr) );
key.local.Ipv6.sin6_port = in->inp_lport;
key.local.Ipv6.sin6_scope_id = find_ipv6_addr_scope( &key.local.Ipv6.sin6_addr, addr_scopes,
addr_scopes_size );
}
stat.pid = find_owning_pid( pid_map, pid_map_size, (UINT_PTR)sock->so_pcb );
stat.create_time = 0; /* FIXME */
stat.flags = !(in->inp_flags & INP_ANONPORT);
stat.mod_info = 0; /* FIXME */
if (num < *count)
{
if (key_out) *key_out++ = key;
if (stat_out) *stat_out++ = stat;
}
num++;
}
err:
heap_free( buf );
}
#else
FIXME( "not implemented\n" );
return STATUS_NOT_IMPLEMENTED;
#endif
if (!want_data || num <= *count) *count = num;
else status = STATUS_MORE_ENTRIES;
heap_free( pid_map );
heap_free( addr_scopes );
return status;
}
static struct module_table udp_tables[] =
{
{
NSI_UDP_STATS_TABLE,
{
sizeof(USHORT), 0,
sizeof(struct nsi_udp_stats_dynamic), 0
},
NULL,
udp_stats_get_all_parameters,
},
{
NSI_UDP_ENDPOINT_TABLE,
{
sizeof(struct nsi_udp_endpoint_key), 0,
0, sizeof(struct nsi_udp_endpoint_static)
},
udp_endpoint_enumerate_all,
},
{
~0u
}
};
const struct module udp_module =
{
&NPI_MS_UDP_MODULEID,
udp_tables
};