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