/*
* Copyright (c) 2016 Fabien Siron <fabien.siron@epita.fr>
* Copyright (c) 2017 JingPiao Chen <chenjingpiao@gmail.com>
* Copyright (c) 2016-2018 The strace developers.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
#include "defs.h"
#include <endian.h>
#include "netlink.h"
#include "nlattr.h"
#include <netinet/in.h>
#include <arpa/inet.h>
#include <linux/sock_diag.h>
#include "static_assert.h"
#include "xlat/netlink_sk_meminfo_indices.h"
static bool
fetch_nlattr(struct tcb *const tcp, struct nlattr *const nlattr,
const kernel_ulong_t addr, const unsigned int len,
const bool in_array)
{
if (len < sizeof(struct nlattr)) {
printstr_ex(tcp, addr, len, QUOTE_FORCE_HEX);
return false;
}
if (tfetch_obj(tcp, addr, nlattr))
return true;
if (in_array) {
tprints("...");
printaddr_comment(addr);
} else {
printaddr(addr);
}
return false;
}
static void
print_nlattr(const struct nlattr *const nla,
const struct xlat *const table,
const char *const dflt)
{
static_assert(NLA_TYPE_MASK == ~(NLA_F_NESTED | NLA_F_NET_BYTEORDER),
"wrong NLA_TYPE_MASK");
tprintf("{nla_len=%u, nla_type=", nla->nla_len);
if (nla->nla_type & NLA_F_NESTED) {
print_xlat(NLA_F_NESTED);
tprints("|");
}
if (nla->nla_type & NLA_F_NET_BYTEORDER) {
print_xlat(NLA_F_NET_BYTEORDER);
tprints("|");
}
printxval(table, nla->nla_type & NLA_TYPE_MASK, dflt);
tprints("}");
}
static void
decode_nlattr_with_data(struct tcb *const tcp,
const struct nlattr *const nla,
const kernel_ulong_t addr,
const unsigned int len,
const struct xlat *const table,
const char *const dflt,
const nla_decoder_t *const decoders,
const unsigned int size,
const void *const opaque_data)
{
const unsigned int nla_len = MIN(nla->nla_len, len);
if (nla_len > NLA_HDRLEN)
tprints("{");
print_nlattr(nla, table, dflt);
if (nla_len > NLA_HDRLEN) {
const unsigned int idx =
size ? nla->nla_type & NLA_TYPE_MASK : 0;
tprints(", ");
if (!decoders
|| (size && idx >= size)
|| !decoders[idx]
|| !decoders[idx](
tcp, addr + NLA_HDRLEN,
nla_len - NLA_HDRLEN,
size ? opaque_data
: (const void *) (uintptr_t) nla->nla_type)
)
printstr_ex(tcp, addr + NLA_HDRLEN,
nla_len - NLA_HDRLEN, QUOTE_FORCE_HEX);
tprints("}");
}
}
void
decode_nlattr(struct tcb *const tcp,
kernel_ulong_t addr,
unsigned int len,
const struct xlat *const table,
const char *const dflt,
const nla_decoder_t *const decoders,
const unsigned int size,
const void *const opaque_data)
{
struct nlattr nla;
bool is_array = false;
unsigned int elt;
if (decoders && !size && opaque_data)
error_func_msg("[xlat %p, dflt \"%s\", decoders %p] "
"size is zero (going to pass nla_type as "
"decoder argument), but opaque data (%p) is not "
"- will be ignored",
table, dflt, decoders, opaque_data);
for (elt = 0; fetch_nlattr(tcp, &nla, addr, len, is_array); elt++) {
if (abbrev(tcp) && elt == max_strlen) {
tprints("...");
break;
}
const unsigned int nla_len = NLA_ALIGN(nla.nla_len);
kernel_ulong_t next_addr = 0;
unsigned int next_len = 0;
if (nla.nla_len >= NLA_HDRLEN) {
next_len = (len >= nla_len) ? len - nla_len : 0;
if (next_len && addr + nla_len > addr)
next_addr = addr + nla_len;
}
if (!is_array && next_addr) {
tprints("[");
is_array = true;
}
decode_nlattr_with_data(tcp, &nla, addr, len, table, dflt,
decoders, size, opaque_data);
if (!next_addr)
break;
tprints(", ");
addr = next_addr;
len = next_len;
}
if (is_array) {
tprints("]");
}
}
bool
decode_nla_str(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
printstr_ex(tcp, addr, len, QUOTE_0_TERMINATED);
return true;
}
bool
decode_nla_strn(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
printstrn(tcp, addr, len);
return true;
}
bool
decode_nla_meminfo(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
uint32_t mem;
const size_t nmemb = len / sizeof(mem);
if (!nmemb)
return false;
unsigned int count = 0;
print_array_ex(tcp, addr, nmemb, &mem, sizeof(mem),
tfetch_mem, print_uint32_array_member, &count,
PAF_PRINT_INDICES | PAF_INDEX_XLAT_VALUE_INDEXED
| XLAT_STYLE_FMT_U,
ARRSZ_PAIR(netlink_sk_meminfo_indices),
"SK_MEMINFO_???");
return true;
}
bool
decode_nla_fd(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
int fd;
if (len < sizeof(fd))
return false;
else if (!umove_or_printaddr(tcp, addr, &fd))
printfd(tcp, fd);
return true;
}
bool
decode_nla_uid(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
uint32_t uid;
if (len < sizeof(uid))
return false;
else if (!umove_or_printaddr(tcp, addr, &uid))
printuid("", uid);
return true;
}
bool
decode_nla_gid(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
return decode_nla_uid(tcp, addr, len, opaque_data);
}
bool
decode_nla_ifindex(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
uint32_t ifindex;
if (len < sizeof(ifindex))
return false;
else if (!umove_or_printaddr(tcp, addr, &ifindex))
print_ifindex(ifindex);
return true;
}
bool
decode_nla_xval(struct tcb *const tcp,
const kernel_ulong_t addr,
unsigned int len,
const void *const opaque_data)
{
const struct decode_nla_xlat_opts * const opts = opaque_data;
union {
uint64_t val;
uint8_t bytes[sizeof(uint64_t)];
} data = { .val = 0 };
if (len > sizeof(data) || len < opts->size)
return false;
if (opts->size)
len = MIN(len, opts->size);
const size_t bytes_offs = is_bigendian ? sizeof(data) - len : 0;
if (!umoven_or_printaddr(tcp, addr, len, data.bytes + bytes_offs)) {
if (opts->process_fn)
data.val = opts->process_fn(data.val);
if (opts->prefix)
tprints(opts->prefix);
printxval_dispatch_ex(opts->xlat, opts->xlat_size, data.val,
opts->dflt, opts->xt, opts->style);
if (opts->suffix)
tprints(opts->suffix);
}
return true;
}
static uint64_t
process_host_order(uint64_t val)
{
return ntohs(val);
}
bool
decode_nla_ether_proto(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
const struct decode_nla_xlat_opts opts = {
.xlat = ethernet_protocols,
.xlat_size = ethernet_protocols_size,
.dflt = "ETHER_P_???",
.xt = XT_SORTED,
.prefix = "htons(",
.suffix = ")",
.size = 2,
.process_fn = process_host_order,
};
return decode_nla_xval(tcp, addr, len, &opts);
}
bool
decode_nla_ip_proto(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
const struct decode_nla_xlat_opts opts = {
.xlat = inet_protocols,
.xlat_size = inet_protocols_size,
.xt = XT_SORTED,
.dflt = "IPPROTO_???",
.size = 1,
};
return decode_nla_xval(tcp, addr, len, &opts);
}
bool
decode_nla_in_addr(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
struct in_addr in;
if (len < sizeof(in))
return false;
else if (!umove_or_printaddr(tcp, addr, &in))
print_inet_addr(AF_INET, &in, sizeof(in), NULL);
return true;
}
bool
decode_nla_in6_addr(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
struct in6_addr in6;
if (len < sizeof(in6))
return false;
else if (!umove_or_printaddr(tcp, addr, &in6))
print_inet_addr(AF_INET6, &in6, sizeof(in6), NULL);
return true;
}
bool
decode_nla_flags(struct tcb *const tcp,
const kernel_ulong_t addr,
unsigned int len,
const void *const opaque_data)
{
const struct decode_nla_xlat_opts * const opts = opaque_data;
union {
uint64_t flags;
uint8_t bytes[sizeof(uint64_t)];
} data = { .flags = 0 };
if (len > sizeof(data) || len < opts->size)
return false;
if (opts->size)
len = MIN(len, opts->size);
const size_t bytes_offs = is_bigendian ? sizeof(data) - len : 0;
if (opts->xt == XT_INDEXED)
error_func_msg("indexed xlats are currently incompatible with "
"printflags");
if (!umoven_or_printaddr(tcp, addr, len, data.bytes + bytes_offs)) {
if (opts->process_fn)
data.flags = opts->process_fn(data.flags);
if (opts->prefix)
tprints(opts->prefix);
printflags_ex(data.flags, opts->dflt, opts->style, opts->xlat,
NULL);
if (opts->suffix)
tprints(opts->suffix);
}
return true;
}
bool
decode_nla_be16(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
uint16_t num;
if (len < sizeof(num))
return false;
else if (!umove_or_printaddr(tcp, addr, &num))
tprintf("htons(%u)", ntohs(num));
return true;
}
bool
decode_nla_be64(struct tcb *const tcp,
const kernel_ulong_t addr,
const unsigned int len,
const void *const opaque_data)
{
#if defined HAVE_BE64TOH || defined be64toh
uint64_t num;
if (len < sizeof(num))
return false;
else if (!umove_or_printaddr(tcp, addr, &num))
tprintf("htobe64(%" PRIu64 ")", be64toh(num));
return true;
#else
return false;
#endif
}
#define DECODE_NLA_INTEGER(name, type, fmt) \
bool \
decode_nla_ ## name(struct tcb *const tcp, \
const kernel_ulong_t addr, \
const unsigned int len, \
const void *const opaque_data) \
{ \
type num; \
\
if (len < sizeof(num)) \
return false; \
if (!umove_or_printaddr(tcp, addr, &num)) \
tprintf(fmt, num); \
return true; \
}
DECODE_NLA_INTEGER(x8, uint8_t, "%#" PRIx8)
DECODE_NLA_INTEGER(x16, uint16_t, "%#" PRIx16)
DECODE_NLA_INTEGER(x32, uint32_t, "%#" PRIx32)
DECODE_NLA_INTEGER(x64, uint64_t, "%#" PRIx64)
DECODE_NLA_INTEGER(u8, uint8_t, "%" PRIu8)
DECODE_NLA_INTEGER(u16, uint16_t, "%" PRIu16)
DECODE_NLA_INTEGER(u32, uint32_t, "%" PRIu32)
DECODE_NLA_INTEGER(u64, uint64_t, "%" PRIu64)
DECODE_NLA_INTEGER(s8, int8_t, "%" PRId8)
DECODE_NLA_INTEGER(s16, int16_t, "%" PRId16)
DECODE_NLA_INTEGER(s32, int32_t, "%" PRId32)
DECODE_NLA_INTEGER(s64, int64_t, "%" PRId64)