|  | /* | 
|  | * 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) |