[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / dccp / options.c

/*
 *  net/dccp/options.c
 *
 *  An implementation of the DCCP protocol
 *  Copyright (c) 2005 Aristeu Sergio Rozanski Filho <aris@cathedrallabs.org>
 *  Copyright (c) 2005 Arnaldo Carvalho de Melo <acme@ghostprotocols.net>
 *  Copyright (c) 2005 Ian McDonald <ian.mcdonald@jandi.co.nz>
 *
 *      This program is free software; you can redistribute it and/or
 *      modify it under the terms of the GNU General Public License
 *      as published by the Free Software Foundation; either version
 *      2 of the License, or (at your option) any later version.
 */
#include <linux/dccp.h>
#include <linux/module.h>
#include <linux/types.h>
#include <asm/unaligned.h>
#include <linux/kernel.h>
#include <linux/skbuff.h>

#include "ackvec.h"
#include "ccid.h"
#include "dccp.h"
#include "feat.h"

int sysctl_dccp_feat_sequence_window = DCCPF_INITIAL_SEQUENCE_WINDOW;
int sysctl_dccp_feat_rx_ccid	      = DCCPF_INITIAL_CCID;
int sysctl_dccp_feat_tx_ccid	      = DCCPF_INITIAL_CCID;
int sysctl_dccp_feat_send_ack_vector = DCCPF_INITIAL_SEND_ACK_VECTOR;
int sysctl_dccp_feat_send_ndp_count  = DCCPF_INITIAL_SEND_NDP_COUNT;

u64 dccp_decode_value_var(const u8 *bf, const u8 len)
{
	u64 value = 0;

	if (len >= DCCP_OPTVAL_MAXLEN)
		value += ((u64)*bf++) << 40;
	if (len > 4)
		value += ((u64)*bf++) << 32;
	if (len > 3)
		value += ((u64)*bf++) << 24;
	if (len > 2)
		value += ((u64)*bf++) << 16;
	if (len > 1)
		value += ((u64)*bf++) << 8;
	if (len > 0)
		value += *bf;

	return value;
}

/**
 * dccp_parse_options  -  Parse DCCP options present in @skb
 * @sk: client|server|listening dccp socket (when @dreq != NULL)
 * @dreq: request socket to use during connection setup, or NULL
 */
int dccp_parse_options(struct sock *sk, struct dccp_request_sock *dreq,
		       struct sk_buff *skb)
{
	struct dccp_sock *dp = dccp_sk(sk);
	const struct dccp_hdr *dh = dccp_hdr(skb);
	const u8 pkt_type = DCCP_SKB_CB(skb)->dccpd_type;
	u64 ackno = DCCP_SKB_CB(skb)->dccpd_ack_seq;
	unsigned char *options = (unsigned char *)dh + dccp_hdr_len(skb);
	unsigned char *opt_ptr = options;
	const unsigned char *opt_end = (unsigned char *)dh +
					(dh->dccph_doff * 4);
	struct dccp_options_received *opt_recv = &dp->dccps_options_received;
	unsigned char opt, len;
	unsigned char *value;
	u32 elapsed_time;
	__be32 opt_val;
	int rc;
	int mandatory = 0;

	memset(opt_recv, 0, sizeof(*opt_recv));

	opt = len = 0;
	while (opt_ptr != opt_end) {
		opt   = *opt_ptr++;
		len   = 0;
		value = NULL;

		/* Check if this isn't a single byte option */
		if (opt > DCCPO_MAX_RESERVED) {
			if (opt_ptr == opt_end)
				goto out_nonsensical_length;

			len = *opt_ptr++;
			if (len < 2)
				goto out_nonsensical_length;
			/*
			 * Remove the type and len fields, leaving
			 * just the value size
			 */
			len	-= 2;
			value	= opt_ptr;
			opt_ptr += len;

			if (opt_ptr > opt_end)
				goto out_nonsensical_length;
		}

		/*
		 * CCID-Specific Options (from RFC 4340, sec. 10.3):
		 *
		 * Option numbers 128 through 191 are for options sent from the
		 * HC-Sender to the HC-Receiver; option numbers 192 through 255
		 * are for options sent from the HC-Receiver to	the HC-Sender.
		 *
		 * CCID-specific options are ignored during connection setup, as
		 * negotiation may still be in progress (see RFC 4340, 10.3).
		 * The same applies to Ack Vectors, as these depend on the CCID.
		 *
		 */
		if (dreq != NULL && (opt >= 128 ||
		    opt == DCCPO_ACK_VECTOR_0 || opt == DCCPO_ACK_VECTOR_1))
			goto ignore_option;

		switch (opt) {
		case DCCPO_PADDING:
			break;
		case DCCPO_MANDATORY:
			if (mandatory)
				goto out_invalid_option;
			if (pkt_type != DCCP_PKT_DATA)
				mandatory = 1;
			break;
		case DCCPO_NDP_COUNT:
			if (len > 6)
				goto out_invalid_option;

			opt_recv->dccpor_ndp = dccp_decode_value_var(value, len);
			dccp_pr_debug("%s opt: NDP count=%llu\n", dccp_role(sk),
				      (unsigned long long)opt_recv->dccpor_ndp);
			break;
		case DCCPO_CHANGE_L:
			/* fall through */
		case DCCPO_CHANGE_R:
			if (pkt_type == DCCP_PKT_DATA)
				break;
			if (len < 2)
				goto out_invalid_option;
			rc = dccp_feat_change_recv(sk, opt, *value, value + 1,
						   len - 1);
			/*
			 * When there is a change error, change_recv is
			 * responsible for dealing with it.  i.e. reply with an
			 * empty confirm.
			 * If the change was mandatory, then we need to die.
			 */
			if (rc && mandatory)
				goto out_invalid_option;
			break;
		case DCCPO_CONFIRM_L:
			/* fall through */
		case DCCPO_CONFIRM_R:
			if (pkt_type == DCCP_PKT_DATA)
				break;
			if (len < 2)	/* FIXME this disallows empty confirm */
				goto out_invalid_option;
			if (dccp_feat_confirm_recv(sk, opt, *value,
						   value + 1, len - 1))
				goto out_invalid_option;
			break;
		case DCCPO_ACK_VECTOR_0:
		case DCCPO_ACK_VECTOR_1:
			if (dccp_packet_without_ack(skb))   /* RFC 4340, 11.4 */
				break;

			if (dccp_msk(sk)->dccpms_send_ack_vector &&
			    dccp_ackvec_parse(sk, skb, &ackno, opt, value, len))
				goto out_invalid_option;
			break;
		case DCCPO_TIMESTAMP:
			if (len != 4)
				goto out_invalid_option;
			/*
			 * RFC 4340 13.1: "The precise time corresponding to
			 * Timestamp Value zero is not specified". We use
			 * zero to indicate absence of a meaningful timestamp.
			 */
			opt_val = get_unaligned((__be32 *)value);
			if (unlikely(opt_val == 0)) {
				DCCP_WARN("Timestamp with zero value\n");
				break;
			}

			if (dreq != NULL) {
				dreq->dreq_timestamp_echo = ntohl(opt_val);
				dreq->dreq_timestamp_time = dccp_timestamp();
			} else {
				opt_recv->dccpor_timestamp =
					dp->dccps_timestamp_echo = ntohl(opt_val);
				dp->dccps_timestamp_time = dccp_timestamp();
			}
			dccp_pr_debug("%s rx opt: TIMESTAMP=%u, ackno=%llu\n",
				      dccp_role(sk), ntohl(opt_val),
				      (unsigned long long)
				      DCCP_SKB_CB(skb)->dccpd_ack_seq);
			break;
		case DCCPO_TIMESTAMP_ECHO:
			if (len != 4 && len != 6 && len != 8)
				goto out_invalid_option;

			opt_val = get_unaligned((__be32 *)value);
			opt_recv->dccpor_timestamp_echo = ntohl(opt_val);

			dccp_pr_debug("%s rx opt: TIMESTAMP_ECHO=%u, len=%d, "
				      "ackno=%llu", dccp_role(sk),
				      opt_recv->dccpor_timestamp_echo,
				      len + 2,
				      (unsigned long long)
				      DCCP_SKB_CB(skb)->dccpd_ack_seq);

			value += 4;

			if (len == 4) {		/* no elapsed time included */
				dccp_pr_debug_cat("\n");
				break;
			}

			if (len == 6) {		/* 2-byte elapsed time */
				__be16 opt_val2 = get_unaligned((__be16 *)value);
				elapsed_time = ntohs(opt_val2);
			} else {		/* 4-byte elapsed time */
				opt_val = get_unaligned((__be32 *)value);
				elapsed_time = ntohl(opt_val);
			}

			dccp_pr_debug_cat(", ELAPSED_TIME=%u\n", elapsed_time);

			/* Give precedence to the biggest ELAPSED_TIME */
			if (elapsed_time > opt_recv->dccpor_elapsed_time)
				opt_recv->dccpor_elapsed_time = elapsed_time;
			break;
		case DCCPO_ELAPSED_TIME:
			if (dccp_packet_without_ack(skb))   /* RFC 4340, 13.2 */
				break;

			if (len == 2) {
				__be16 opt_val2 = get_unaligned((__be16 *)value);
				elapsed_time = ntohs(opt_val2);
			} else if (len == 4) {
				opt_val = get_unaligned((__be32 *)value);
				elapsed_time = ntohl(opt_val);
			} else {
				goto out_invalid_option;
			}

			if (elapsed_time > opt_recv->dccpor_elapsed_time)
				opt_recv->dccpor_elapsed_time = elapsed_time;

			dccp_pr_debug("%s rx opt: ELAPSED_TIME=%d\n",
				      dccp_role(sk), elapsed_time);
			break;
		case 128 ... 191: {
			const u16 idx = value - options;

			if (ccid_hc_rx_parse_options(dp->dccps_hc_rx_ccid, sk,
						     opt, len, idx,
						     value) != 0)
				goto out_invalid_option;
		}
			break;
		case 192 ... 255: {
			const u16 idx = value - options;

			if (ccid_hc_tx_parse_options(dp->dccps_hc_tx_ccid, sk,
						     opt, len, idx,
						     value) != 0)
				goto out_invalid_option;
		}
			break;
		default:
			DCCP_CRIT("DCCP(%p): option %d(len=%d) not "
				  "implemented, ignoring", sk, opt, len);
			break;
		}
ignore_option:
		if (opt != DCCPO_MANDATORY)
			mandatory = 0;
	}

	/* mandatory was the last byte in option list -> reset connection */
	if (mandatory)
		goto out_invalid_option;

out_nonsensical_length:
	/* RFC 4340, 5.8: ignore option and all remaining option space */
	return 0;

out_invalid_option:
	DCCP_INC_STATS_BH(DCCP_MIB_INVALIDOPT);
	DCCP_SKB_CB(skb)->dccpd_reset_code = DCCP_RESET_CODE_OPTION_ERROR;
	DCCP_WARN("DCCP(%p): invalid option %d, len=%d", sk, opt, len);
	DCCP_SKB_CB(skb)->dccpd_reset_data[0] = opt;
	DCCP_SKB_CB(skb)->dccpd_reset_data[1] = len > 0 ? value[0] : 0;
	DCCP_SKB_CB(skb)->dccpd_reset_data[2] = len > 1 ? value[1] : 0;
	return -1;
}

EXPORT_SYMBOL_GPL(dccp_parse_options);

void dccp_encode_value_var(const u64 value, u8 *to, const u8 len)
{
	if (len >= DCCP_OPTVAL_MAXLEN)
		*to++ = (value & 0xFF0000000000ull) >> 40;
	if (len > 4)
		*to++ = (value & 0xFF00000000ull) >> 32;
	if (len > 3)
		*to++ = (value & 0xFF000000) >> 24;
	if (len > 2)
		*to++ = (value & 0xFF0000) >> 16;
	if (len > 1)
		*to++ = (value & 0xFF00) >> 8;
	if (len > 0)
		*to++ = (value & 0xFF);
}

static inline u8 dccp_ndp_len(const u64 ndp)
{
	if (likely(ndp <= 0xFF))
		return 1;
	return likely(ndp <= USHORT_MAX) ? 2 : (ndp <= UINT_MAX ? 4 : 6);
}

int dccp_insert_option(struct sock *sk, struct sk_buff *skb,
			const unsigned char option,
			const void *value, const unsigned char len)
{
	unsigned char *to;

	if (DCCP_SKB_CB(skb)->dccpd_opt_len + len + 2 > DCCP_MAX_OPT_LEN)
		return -1;

	DCCP_SKB_CB(skb)->dccpd_opt_len += len + 2;

	to    = skb_push(skb, len + 2);
	*to++ = option;
	*to++ = len + 2;

	memcpy(to, value, len);
	return 0;
}

EXPORT_SYMBOL_GPL(dccp_insert_option);

static int dccp_insert_option_ndp(struct sock *sk, struct sk_buff *skb)
{
	struct dccp_sock *dp = dccp_sk(sk);
	u64 ndp = dp->dccps_ndp_count;

	if (dccp_non_data_packet(skb))
		++dp->dccps_ndp_count;
	else
		dp->dccps_ndp_count = 0;

	if (ndp > 0) {
		unsigned char *ptr;
		const int ndp_len = dccp_ndp_len(ndp);
		const int len = ndp_len + 2;

		if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN)
			return -1;

		DCCP_SKB_CB(skb)->dccpd_opt_len += len;

		ptr = skb_push(skb, len);
		*ptr++ = DCCPO_NDP_COUNT;
		*ptr++ = len;
		dccp_encode_value_var(ndp, ptr, ndp_len);
	}

	return 0;
}

static inline int dccp_elapsed_time_len(const u32 elapsed_time)
{
	return elapsed_time == 0 ? 0 : elapsed_time <= 0xFFFF ? 2 : 4;
}

int dccp_insert_option_elapsed_time(struct sock *sk, struct sk_buff *skb,
				    u32 elapsed_time)
{
	const int elapsed_time_len = dccp_elapsed_time_len(elapsed_time);
	const int len = 2 + elapsed_time_len;
	unsigned char *to;

	if (elapsed_time_len == 0)
		return 0;

	if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN)
		return -1;

	DCCP_SKB_CB(skb)->dccpd_opt_len += len;

	to    = skb_push(skb, len);
	*to++ = DCCPO_ELAPSED_TIME;
	*to++ = len;

	if (elapsed_time_len == 2) {
		const __be16 var16 = htons((u16)elapsed_time);
		memcpy(to, &var16, 2);
	} else {
		const __be32 var32 = htonl(elapsed_time);
		memcpy(to, &var32, 4);
	}

	return 0;
}

EXPORT_SYMBOL_GPL(dccp_insert_option_elapsed_time);

int dccp_insert_option_timestamp(struct sock *sk, struct sk_buff *skb)
{
	__be32 now = htonl(dccp_timestamp());
	/* yes this will overflow but that is the point as we want a
	 * 10 usec 32 bit timer which mean it wraps every 11.9 hours */

	return dccp_insert_option(sk, skb, DCCPO_TIMESTAMP, &now, sizeof(now));
}

EXPORT_SYMBOL_GPL(dccp_insert_option_timestamp);

static int dccp_insert_option_timestamp_echo(struct dccp_sock *dp,
					     struct dccp_request_sock *dreq,
					     struct sk_buff *skb)
{
	__be32 tstamp_echo;
	unsigned char *to;
	u32 elapsed_time, elapsed_time_len, len;

	if (dreq != NULL) {
		elapsed_time = dccp_timestamp() - dreq->dreq_timestamp_time;
		tstamp_echo  = htonl(dreq->dreq_timestamp_echo);
		dreq->dreq_timestamp_echo = 0;
	} else {
		elapsed_time = dccp_timestamp() - dp->dccps_timestamp_time;
		tstamp_echo  = htonl(dp->dccps_timestamp_echo);
		dp->dccps_timestamp_echo = 0;
	}

	elapsed_time_len = dccp_elapsed_time_len(elapsed_time);
	len = 6 + elapsed_time_len;

	if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN)
		return -1;

	DCCP_SKB_CB(skb)->dccpd_opt_len += len;

	to    = skb_push(skb, len);
	*to++ = DCCPO_TIMESTAMP_ECHO;
	*to++ = len;

	memcpy(to, &tstamp_echo, 4);
	to += 4;

	if (elapsed_time_len == 2) {
		const __be16 var16 = htons((u16)elapsed_time);
		memcpy(to, &var16, 2);
	} else if (elapsed_time_len == 4) {
		const __be32 var32 = htonl(elapsed_time);
		memcpy(to, &var32, 4);
	}

	return 0;
}

static int dccp_insert_feat_opt(struct sk_buff *skb, u8 type, u8 feat,
				u8 *val, u8 len)
{
	u8 *to;

	if (DCCP_SKB_CB(skb)->dccpd_opt_len + len + 3 > DCCP_MAX_OPT_LEN) {
		DCCP_WARN("packet too small for feature %d option!\n", feat);
		return -1;
	}

	DCCP_SKB_CB(skb)->dccpd_opt_len += len + 3;

	to    = skb_push(skb, len + 3);
	*to++ = type;
	*to++ = len + 3;
	*to++ = feat;

	if (len)
		memcpy(to, val, len);

	dccp_pr_debug("%s(%s (%d), ...), length %d\n",
		      dccp_feat_typename(type),
		      dccp_feat_name(feat), feat, len);
	return 0;
}

static int dccp_insert_options_feat(struct sock *sk, struct sk_buff *skb)
{
	struct dccp_minisock *dmsk = dccp_msk(sk);
	struct dccp_opt_pend *opt, *next;
	int change = 0;

	/* confirm any options [NN opts] */
	list_for_each_entry_safe(opt, next, &dmsk->dccpms_conf, dccpop_node) {
		dccp_insert_feat_opt(skb, opt->dccpop_type,
				     opt->dccpop_feat, opt->dccpop_val,
				     opt->dccpop_len);
		/* fear empty confirms */
		if (opt->dccpop_val)
			kfree(opt->dccpop_val);
		kfree(opt);
	}
	INIT_LIST_HEAD(&dmsk->dccpms_conf);

	/* see which features we need to send */
	list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
		/* see if we need to send any confirm */
		if (opt->dccpop_sc) {
			dccp_insert_feat_opt(skb, opt->dccpop_type + 1,
					     opt->dccpop_feat,
					     opt->dccpop_sc->dccpoc_val,
					     opt->dccpop_sc->dccpoc_len);

			BUG_ON(!opt->dccpop_sc->dccpoc_val);
			kfree(opt->dccpop_sc->dccpoc_val);
			kfree(opt->dccpop_sc);
			opt->dccpop_sc = NULL;
		}

		/* any option not confirmed, re-send it */
		if (!opt->dccpop_conf) {
			dccp_insert_feat_opt(skb, opt->dccpop_type,
					     opt->dccpop_feat, opt->dccpop_val,
					     opt->dccpop_len);
			change++;
		}
	}

	return 0;
}

/* The length of all options needs to be a multiple of 4 (5.8) */
static void dccp_insert_option_padding(struct sk_buff *skb)
{
	int padding = DCCP_SKB_CB(skb)->dccpd_opt_len % 4;

	if (padding != 0) {
		padding = 4 - padding;
		memset(skb_push(skb, padding), 0, padding);
		DCCP_SKB_CB(skb)->dccpd_opt_len += padding;
	}
}

int dccp_insert_options(struct sock *sk, struct sk_buff *skb)
{
	struct dccp_sock *dp = dccp_sk(sk);
	struct dccp_minisock *dmsk = dccp_msk(sk);

	DCCP_SKB_CB(skb)->dccpd_opt_len = 0;

	if (dmsk->dccpms_send_ndp_count &&
	    dccp_insert_option_ndp(sk, skb))
		return -1;

	if (!dccp_packet_without_ack(skb)) {
		if (dmsk->dccpms_send_ack_vector &&
		    dccp_ackvec_pending(dp->dccps_hc_rx_ackvec) &&
		    dccp_insert_option_ackvec(sk, skb))
			return -1;
	}

	if (dp->dccps_hc_rx_insert_options) {
		if (ccid_hc_rx_insert_options(dp->dccps_hc_rx_ccid, sk, skb))
			return -1;
		dp->dccps_hc_rx_insert_options = 0;
	}

	/* Feature negotiation */
	/* Data packets can't do feat negotiation */
	if (DCCP_SKB_CB(skb)->dccpd_type != DCCP_PKT_DATA &&
	    DCCP_SKB_CB(skb)->dccpd_type != DCCP_PKT_DATAACK &&
	    dccp_insert_options_feat(sk, skb))
		return -1;

	/*
	 * Obtain RTT sample from Request/Response exchange.
	 * This is currently used in CCID 3 initialisation.
	 */
	if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_REQUEST &&
	    dccp_insert_option_timestamp(sk, skb))
		return -1;

	if (dp->dccps_timestamp_echo != 0 &&
	    dccp_insert_option_timestamp_echo(dp, NULL, skb))
		return -1;

	dccp_insert_option_padding(skb);
	return 0;
}

int dccp_insert_options_rsk(struct dccp_request_sock *dreq, struct sk_buff *skb)
{
	DCCP_SKB_CB(skb)->dccpd_opt_len = 0;

	if (dreq->dreq_timestamp_echo != 0 &&
	    dccp_insert_option_timestamp_echo(NULL, dreq, skb))
		return -1;

	dccp_insert_option_padding(skb);
	return 0;
}
Commit	Line	Data
7c657876 ACM	1	/*
	2	* net/dccp/options.c
	3	*
	4	* An implementation of the DCCP protocol
1bc09869 IM	5	* Copyright (c) 2005 Aristeu Sergio Rozanski Filho <aris@cathedrallabs.org>
1bc09869 IM	6	* Copyright (c) 2005 Arnaldo Carvalho de Melo <acme@ghostprotocols.net>
e6bccd35	7	* Copyright (c) 2005 Ian McDonald <ian.mcdonald@jandi.co.nz>
7c657876 ACM	8	*
	9	* This program is free software; you can redistribute it and/or
	10	* modify it under the terms of the GNU General Public License
	11	* as published by the Free Software Foundation; either version
	12	* 2 of the License, or (at your option) any later version.
	13	*/
7c657876 ACM	14	#include <linux/dccp.h>
	15	#include <linux/module.h>
	16	#include <linux/types.h>
76fd1e87	17	#include <asm/unaligned.h>
7c657876 ACM	18	#include <linux/kernel.h>
	19	#include <linux/skbuff.h>
	20
ae31c339	21	#include "ackvec.h"
7c657876 ACM	22	#include "ccid.h"
7c657876 ACM	23	#include "dccp.h"
afe00251	24	#include "feat.h"
7c657876	25
afb0a34d GR	26	int sysctl_dccp_feat_sequence_window = DCCPF_INITIAL_SEQUENCE_WINDOW;
	27	int sysctl_dccp_feat_rx_ccid = DCCPF_INITIAL_CCID;
	28	int sysctl_dccp_feat_tx_ccid = DCCPF_INITIAL_CCID;
afb0a34d GR	29	int sysctl_dccp_feat_send_ack_vector = DCCPF_INITIAL_SEND_ACK_VECTOR;
afb0a34d GR	30	int sysctl_dccp_feat_send_ndp_count = DCCPF_INITIAL_SEND_NDP_COUNT;
7c657876	31
b9aaac1c	32	u64 dccp_decode_value_var(const u8 *bf, const u8 len)
7c657876	33	{
b9aaac1c	34	u64 value = 0;
7c657876	35
b9aaac1c GR	36	if (len >= DCCP_OPTVAL_MAXLEN)
	37	value += ((u64)*bf++) << 40;
	38	if (len > 4)
	39	value += ((u64)*bf++) << 32;
7c657876	40	if (len > 3)
b9aaac1c	41	value += ((u64)*bf++) << 24;
7c657876	42	if (len > 2)
b9aaac1c	43	value += ((u64)*bf++) << 16;
7c657876	44	if (len > 1)
b9aaac1c	45	value += ((u64)*bf++) << 8;
7c657876 ACM	46	if (len > 0)
	47	value += *bf;
	48
	49	return value;
	50	}
	51
8b819412 GR	52	/**
	53	* dccp_parse_options - Parse DCCP options present in @skb
	54	* @sk: client\|server\|listening dccp socket (when @dreq != NULL)
	55	* @dreq: request socket to use during connection setup, or NULL
	56	*/
	57	int dccp_parse_options(struct sock sk, struct dccp_request_sock dreq,
	58	struct sk_buff *skb)
7c657876 ACM	59	{
7c657876 ACM	60	struct dccp_sock *dp = dccp_sk(sk);
7c657876 ACM	61	const struct dccp_hdr *dh = dccp_hdr(skb);
7c657876 ACM	62	const u8 pkt_type = DCCP_SKB_CB(skb)->dccpd_type;
bdf13d20	63	u64 ackno = DCCP_SKB_CB(skb)->dccpd_ack_seq;
7c657876 ACM	64	unsigned char options = (unsigned char )dh + dccp_hdr_len(skb);
7c657876 ACM	65	unsigned char *opt_ptr = options;
7690af3f ACM	66	const unsigned char opt_end = (unsigned char )dh +
7690af3f ACM	67	(dh->dccph_doff * 4);
7c657876 ACM	68	struct dccp_options_received *opt_recv = &dp->dccps_options_received;
	69	unsigned char opt, len;
	70	unsigned char *value;
1c14ac0a	71	u32 elapsed_time;
76fd1e87	72	__be32 opt_val;
afe00251 AB	73	int rc;
afe00251 AB	74	int mandatory = 0;
7c657876 ACM	75
	76	memset(opt_recv, 0, sizeof(*opt_recv));
	77
fb950496	78	opt = len = 0;
7c657876 ACM	79	while (opt_ptr != opt_end) {
	80	opt = *opt_ptr++;
	81	len = 0;
	82	value = NULL;
	83
	84	/* Check if this isn't a single byte option */
	85	if (opt > DCCPO_MAX_RESERVED) {
	86	if (opt_ptr == opt_end)
faf61c33	87	goto out_nonsensical_length;
7c657876 ACM	88
7c657876 ACM	89	len = *opt_ptr++;
faf61c33 GR	90	if (len < 2)
faf61c33 GR	91	goto out_nonsensical_length;
7c657876 ACM	92	/*
	93	* Remove the type and len fields, leaving
	94	* just the value size
	95	*/
	96	len -= 2;
	97	value = opt_ptr;
	98	opt_ptr += len;
	99
	100	if (opt_ptr > opt_end)
faf61c33	101	goto out_nonsensical_length;
7c657876 ACM	102	}
7c657876 ACM	103
8b819412 GR	104	/*
	105	* CCID-Specific Options (from RFC 4340, sec. 10.3):
	106	*
	107	* Option numbers 128 through 191 are for options sent from the
	108	* HC-Sender to the HC-Receiver; option numbers 192 through 255
	109	* are for options sent from the HC-Receiver to the HC-Sender.
	110	*
	111	* CCID-specific options are ignored during connection setup, as
	112	* negotiation may still be in progress (see RFC 4340, 10.3).
65907a43	113	* The same applies to Ack Vectors, as these depend on the CCID.
8b819412 GR	114	*
8b819412 GR	115	*/
65907a43 GR	116	if (dreq != NULL && (opt >= 128 \|\|
65907a43 GR	117	opt == DCCPO_ACK_VECTOR_0 \|\| opt == DCCPO_ACK_VECTOR_1))
8b819412 GR	118	goto ignore_option;
8b819412 GR	119
7c657876 ACM	120	switch (opt) {
	121	case DCCPO_PADDING:
	122	break;
afe00251 AB	123	case DCCPO_MANDATORY:
	124	if (mandatory)
	125	goto out_invalid_option;
6df9424a ACM	126	if (pkt_type != DCCP_PKT_DATA)
6df9424a ACM	127	mandatory = 1;
afe00251	128	break;
7c657876	129	case DCCPO_NDP_COUNT:
5b5d0e70	130	if (len > 6)
7c657876 ACM	131	goto out_invalid_option;
	132
	133	opt_recv->dccpor_ndp = dccp_decode_value_var(value, len);
5b5d0e70 GR	134	dccp_pr_debug("%s opt: NDP count=%llu\n", dccp_role(sk),
5b5d0e70 GR	135	(unsigned long long)opt_recv->dccpor_ndp);
7c657876	136	break;
afe00251 AB	137	case DCCPO_CHANGE_L:
	138	/* fall through */
	139	case DCCPO_CHANGE_R:
cf86314c GR	140	if (pkt_type == DCCP_PKT_DATA)
cf86314c GR	141	break;
afe00251 AB	142	if (len < 2)
	143	goto out_invalid_option;
	144	rc = dccp_feat_change_recv(sk, opt, *value, value + 1,
	145	len - 1);
	146	/*
	147	* When there is a change error, change_recv is
	148	* responsible for dealing with it. i.e. reply with an
	149	* empty confirm.
	150	* If the change was mandatory, then we need to die.
	151	*/
	152	if (rc && mandatory)
	153	goto out_invalid_option;
	154	break;
	155	case DCCPO_CONFIRM_L:
	156	/* fall through */
	157	case DCCPO_CONFIRM_R:
cf86314c GR	158	if (pkt_type == DCCP_PKT_DATA)
	159	break;
	160	if (len < 2) /* FIXME this disallows empty confirm */
afe00251 AB	161	goto out_invalid_option;
	162	if (dccp_feat_confirm_recv(sk, opt, *value,
	163	value + 1, len - 1))
	164	goto out_invalid_option;
	165	break;
7c657876	166	case DCCPO_ACK_VECTOR_0:
ae31c339	167	case DCCPO_ACK_VECTOR_1:
c86ab2b6	168	if (dccp_packet_without_ack(skb)) /* RFC 4340, 11.4 */
e5a6de91	169	break;
7c657876	170
a4bf3902	171	if (dccp_msk(sk)->dccpms_send_ack_vector &&
bdf13d20	172	dccp_ackvec_parse(sk, skb, &ackno, opt, value, len))
ae31c339	173	goto out_invalid_option;
7c657876 ACM	174	break;
	175	case DCCPO_TIMESTAMP:
	176	if (len != 4)
	177	goto out_invalid_option;
b4d4f7c7 GR	178	/*
	179	* RFC 4340 13.1: "The precise time corresponding to
	180	* Timestamp Value zero is not specified". We use
	181	* zero to indicate absence of a meaningful timestamp.
	182	*/
76fd1e87	183	opt_val = get_unaligned((__be32 *)value);
b4d4f7c7 GR	184	if (unlikely(opt_val == 0)) {
	185	DCCP_WARN("Timestamp with zero value\n");
	186	break;
	187	}
7c657876	188
b4d4f7c7 GR	189	if (dreq != NULL) {
	190	dreq->dreq_timestamp_echo = ntohl(opt_val);
	191	dreq->dreq_timestamp_time = dccp_timestamp();
	192	} else {
	193	opt_recv->dccpor_timestamp =
	194	dp->dccps_timestamp_echo = ntohl(opt_val);
	195	dp->dccps_timestamp_time = dccp_timestamp();
	196	}
09dbc389	197	dccp_pr_debug("%s rx opt: TIMESTAMP=%u, ackno=%llu\n",
b4d4f7c7	198	dccp_role(sk), ntohl(opt_val),
f6ccf554	199	(unsigned long long)
7c657876 ACM	200	DCCP_SKB_CB(skb)->dccpd_ack_seq);
	201	break;
	202	case DCCPO_TIMESTAMP_ECHO:
1bc09869	203	if (len != 4 && len != 6 && len != 8)
7c657876 ACM	204	goto out_invalid_option;
7c657876 ACM	205
76fd1e87 GR	206	opt_val = get_unaligned((__be32 *)value);
76fd1e87 GR	207	opt_recv->dccpor_timestamp_echo = ntohl(opt_val);
7c657876	208
09dbc389	209	dccp_pr_debug("%s rx opt: TIMESTAMP_ECHO=%u, len=%d, "
f73f7097	210	"ackno=%llu", dccp_role(sk),
7690af3f	211	opt_recv->dccpor_timestamp_echo,
f6ccf554 DM	212	len + 2,
f6ccf554 DM	213	(unsigned long long)
1bc09869 IM	214	DCCP_SKB_CB(skb)->dccpd_ack_seq);
1bc09869 IM	215
76fd1e87	216	value += 4;
1bc09869	217
76fd1e87	218	if (len == 4) { /* no elapsed time included */
f73f7097	219	dccp_pr_debug_cat("\n");
1c14ac0a	220	break;
f73f7097	221	}
1c14ac0a	222
76fd1e87 GR	223	if (len == 6) { /* 2-byte elapsed time */
	224	__be16 opt_val2 = get_unaligned((__be16 *)value);
	225	elapsed_time = ntohs(opt_val2);
	226	} else { /* 4-byte elapsed time */
	227	opt_val = get_unaligned((__be32 *)value);
	228	elapsed_time = ntohl(opt_val);
	229	}
1c14ac0a	230
dcad856f	231	dccp_pr_debug_cat(", ELAPSED_TIME=%u\n", elapsed_time);
f73f7097	232
1c14ac0a ACM	233	/* Give precedence to the biggest ELAPSED_TIME */
	234	if (elapsed_time > opt_recv->dccpor_elapsed_time)
	235	opt_recv->dccpor_elapsed_time = elapsed_time;
7c657876 ACM	236	break;
7c657876 ACM	237	case DCCPO_ELAPSED_TIME:
c86ab2b6 GR	238	if (dccp_packet_without_ack(skb)) /* RFC 4340, 13.2 */
c86ab2b6 GR	239	break;
1bc09869	240
76fd1e87 GR	241	if (len == 2) {
	242	__be16 opt_val2 = get_unaligned((__be16 *)value);
	243	elapsed_time = ntohs(opt_val2);
c86ab2b6	244	} else if (len == 4) {
76fd1e87 GR	245	opt_val = get_unaligned((__be32 *)value);
76fd1e87 GR	246	elapsed_time = ntohl(opt_val);
c86ab2b6 GR	247	} else {
c86ab2b6 GR	248	goto out_invalid_option;
76fd1e87	249	}
1c14ac0a ACM	250
	251	if (elapsed_time > opt_recv->dccpor_elapsed_time)
	252	opt_recv->dccpor_elapsed_time = elapsed_time;
1bc09869	253
09dbc389 GR	254	dccp_pr_debug("%s rx opt: ELAPSED_TIME=%d\n",
09dbc389 GR	255	dccp_role(sk), elapsed_time);
7c657876	256	break;
7c657876 ACM	257	case 128 ... 191: {
	258	const u16 idx = value - options;
	259
7690af3f ACM	260	if (ccid_hc_rx_parse_options(dp->dccps_hc_rx_ccid, sk,
	261	opt, len, idx,
	262	value) != 0)
7c657876 ACM	263	goto out_invalid_option;
	264	}
	265	break;
	266	case 192 ... 255: {
	267	const u16 idx = value - options;
	268
7690af3f ACM	269	if (ccid_hc_tx_parse_options(dp->dccps_hc_tx_ccid, sk,
	270	opt, len, idx,
	271	value) != 0)
7c657876 ACM	272	goto out_invalid_option;
	273	}
	274	break;
	275	default:
59348b19 GR	276	DCCP_CRIT("DCCP(%p): option %d(len=%d) not "
59348b19 GR	277	"implemented, ignoring", sk, opt, len);
7c657876	278	break;
c9eaf173	279	}
8b819412	280	ignore_option:
afe00251 AB	281	if (opt != DCCPO_MANDATORY)
afe00251 AB	282	mandatory = 0;
7c657876 ACM	283	}
7c657876 ACM	284
6df9424a ACM	285	/* mandatory was the last byte in option list -> reset connection */
	286	if (mandatory)
	287	goto out_invalid_option;
	288
faf61c33 GR	289	out_nonsensical_length:
faf61c33 GR	290	/* RFC 4340, 5.8: ignore option and all remaining option space */
7c657876 ACM	291	return 0;
	292
	293	out_invalid_option:
	294	DCCP_INC_STATS_BH(DCCP_MIB_INVALIDOPT);
	295	DCCP_SKB_CB(skb)->dccpd_reset_code = DCCP_RESET_CODE_OPTION_ERROR;
59348b19	296	DCCP_WARN("DCCP(%p): invalid option %d, len=%d", sk, opt, len);
eac7726b GR	297	DCCP_SKB_CB(skb)->dccpd_reset_data[0] = opt;
	298	DCCP_SKB_CB(skb)->dccpd_reset_data[1] = len > 0 ? value[0] : 0;
	299	DCCP_SKB_CB(skb)->dccpd_reset_data[2] = len > 1 ? value[1] : 0;
7c657876 ACM	300	return -1;
	301	}
	302
b61fafc4 ACM	303	EXPORT_SYMBOL_GPL(dccp_parse_options);
b61fafc4 ACM	304
b9aaac1c	305	void dccp_encode_value_var(const u64 value, u8 *to, const u8 len)
7c657876	306	{
b9aaac1c GR	307	if (len >= DCCP_OPTVAL_MAXLEN)
	308	*to++ = (value & 0xFF0000000000ull) >> 40;
	309	if (len > 4)
	310	*to++ = (value & 0xFF00000000ull) >> 32;
7c657876 ACM	311	if (len > 3)
	312	*to++ = (value & 0xFF000000) >> 24;
	313	if (len > 2)
	314	*to++ = (value & 0xFF0000) >> 16;
	315	if (len > 1)
	316	*to++ = (value & 0xFF00) >> 8;
	317	if (len > 0)
	318	*to++ = (value & 0xFF);
	319	}
	320
5b5d0e70	321	static inline u8 dccp_ndp_len(const u64 ndp)
7c657876	322	{
5b5d0e70 GR	323	if (likely(ndp <= 0xFF))
	324	return 1;
	325	return likely(ndp <= USHORT_MAX) ? 2 : (ndp <= UINT_MAX ? 4 : 6);
7c657876 ACM	326	}
7c657876 ACM	327
2d0817d1	328	int dccp_insert_option(struct sock sk, struct sk_buff skb,
7c657876 ACM	329	const unsigned char option,
	330	const void *value, const unsigned char len)
	331	{
	332	unsigned char *to;
	333
2d0817d1 ACM	334	if (DCCP_SKB_CB(skb)->dccpd_opt_len + len + 2 > DCCP_MAX_OPT_LEN)
2d0817d1 ACM	335	return -1;
7c657876 ACM	336
	337	DCCP_SKB_CB(skb)->dccpd_opt_len += len + 2;
	338
	339	to = skb_push(skb, len + 2);
	340	*to++ = option;
	341	*to++ = len + 2;
	342
	343	memcpy(to, value, len);
2d0817d1	344	return 0;
7c657876 ACM	345	}
	346
	347	EXPORT_SYMBOL_GPL(dccp_insert_option);
	348
2d0817d1	349	static int dccp_insert_option_ndp(struct sock sk, struct sk_buff skb)
7c657876 ACM	350	{
7c657876 ACM	351	struct dccp_sock *dp = dccp_sk(sk);
5b5d0e70	352	u64 ndp = dp->dccps_ndp_count;
7c657876 ACM	353
	354	if (dccp_non_data_packet(skb))
	355	++dp->dccps_ndp_count;
	356	else
	357	dp->dccps_ndp_count = 0;
	358
	359	if (ndp > 0) {
	360	unsigned char *ptr;
	361	const int ndp_len = dccp_ndp_len(ndp);
	362	const int len = ndp_len + 2;
	363
	364	if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN)
2d0817d1	365	return -1;
7c657876 ACM	366
	367	DCCP_SKB_CB(skb)->dccpd_opt_len += len;
	368
	369	ptr = skb_push(skb, len);
	370	*ptr++ = DCCPO_NDP_COUNT;
	371	*ptr++ = len;
	372	dccp_encode_value_var(ndp, ptr, ndp_len);
	373	}
2d0817d1 ACM	374
2d0817d1 ACM	375	return 0;
7c657876 ACM	376	}
	377
	378	static inline int dccp_elapsed_time_len(const u32 elapsed_time)
	379	{
b1c9fe7b	380	return elapsed_time == 0 ? 0 : elapsed_time <= 0xFFFF ? 2 : 4;
7c657876 ACM	381	}
7c657876 ACM	382
2d0817d1 ACM	383	int dccp_insert_option_elapsed_time(struct sock sk, struct sk_buff skb,
2d0817d1 ACM	384	u32 elapsed_time)
7c657876	385	{
7c657876 ACM	386	const int elapsed_time_len = dccp_elapsed_time_len(elapsed_time);
	387	const int len = 2 + elapsed_time_len;
	388	unsigned char *to;
	389
1bc09869	390	if (elapsed_time_len == 0)
2d0817d1	391	return 0;
7c657876	392
2d0817d1 ACM	393	if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN)
2d0817d1 ACM	394	return -1;
7c657876 ACM	395
	396	DCCP_SKB_CB(skb)->dccpd_opt_len += len;
	397
	398	to = skb_push(skb, len);
	399	*to++ = DCCPO_ELAPSED_TIME;
	400	*to++ = len;
	401
1bc09869	402	if (elapsed_time_len == 2) {
60fe62e7	403	const __be16 var16 = htons((u16)elapsed_time);
1bc09869 IM	404	memcpy(to, &var16, 2);
1bc09869 IM	405	} else {
60fe62e7	406	const __be32 var32 = htonl(elapsed_time);
1bc09869 IM	407	memcpy(to, &var32, 4);
1bc09869 IM	408	}
7c657876	409
2d0817d1	410	return 0;
7c657876 ACM	411	}
7c657876 ACM	412
d4b81ff7	413	EXPORT_SYMBOL_GPL(dccp_insert_option_elapsed_time);
7c657876	414
2d0817d1	415	int dccp_insert_option_timestamp(struct sock sk, struct sk_buff skb)
7c657876	416	{
4c70f383	417	__be32 now = htonl(dccp_timestamp());
1bc09869 IM	418	/* yes this will overflow but that is the point as we want a
	419	* 10 usec 32 bit timer which mean it wraps every 11.9 hours */
	420
2d0817d1	421	return dccp_insert_option(sk, skb, DCCPO_TIMESTAMP, &now, sizeof(now));
7c657876 ACM	422	}
7c657876 ACM	423
d4b81ff7 ACM	424	EXPORT_SYMBOL_GPL(dccp_insert_option_timestamp);
d4b81ff7 ACM	425
b4d4f7c7 GR	426	static int dccp_insert_option_timestamp_echo(struct dccp_sock *dp,
b4d4f7c7 GR	427	struct dccp_request_sock *dreq,
2d0817d1	428	struct sk_buff *skb)
7c657876	429	{
60fe62e7	430	__be32 tstamp_echo;
7c657876	431	unsigned char *to;
b4d4f7c7 GR	432	u32 elapsed_time, elapsed_time_len, len;
	433
	434	if (dreq != NULL) {
	435	elapsed_time = dccp_timestamp() - dreq->dreq_timestamp_time;
	436	tstamp_echo = htonl(dreq->dreq_timestamp_echo);
	437	dreq->dreq_timestamp_echo = 0;
	438	} else {
	439	elapsed_time = dccp_timestamp() - dp->dccps_timestamp_time;
	440	tstamp_echo = htonl(dp->dccps_timestamp_echo);
	441	dp->dccps_timestamp_echo = 0;
	442	}
	443
b0e56780 ACM	444	elapsed_time_len = dccp_elapsed_time_len(elapsed_time);
	445	len = 6 + elapsed_time_len;
	446
2d0817d1 ACM	447	if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN)
2d0817d1 ACM	448	return -1;
7c657876 ACM	449
	450	DCCP_SKB_CB(skb)->dccpd_opt_len += len;
	451
	452	to = skb_push(skb, len);
	453	*to++ = DCCPO_TIMESTAMP_ECHO;
	454	*to++ = len;
	455
7c657876 ACM	456	memcpy(to, &tstamp_echo, 4);
7c657876 ACM	457	to += 4;
afe00251	458
1bc09869	459	if (elapsed_time_len == 2) {
60fe62e7	460	const __be16 var16 = htons((u16)elapsed_time);
1bc09869 IM	461	memcpy(to, &var16, 2);
1bc09869 IM	462	} else if (elapsed_time_len == 4) {
60fe62e7	463	const __be32 var32 = htonl(elapsed_time);
1bc09869 IM	464	memcpy(to, &var32, 4);
1bc09869 IM	465	}
7c657876	466
2d0817d1	467	return 0;
7c657876 ACM	468	}
7c657876 ACM	469
afe00251	470	static int dccp_insert_feat_opt(struct sk_buff *skb, u8 type, u8 feat,
c9eaf173	471	u8 *val, u8 len)
afe00251 AB	472	{
	473	u8 *to;
	474
	475	if (DCCP_SKB_CB(skb)->dccpd_opt_len + len + 3 > DCCP_MAX_OPT_LEN) {
59348b19	476	DCCP_WARN("packet too small for feature %d option!\n", feat);
afe00251 AB	477	return -1;
	478	}
	479
	480	DCCP_SKB_CB(skb)->dccpd_opt_len += len + 3;
	481
	482	to = skb_push(skb, len + 3);
	483	*to++ = type;
	484	*to++ = len + 3;
	485	*to++ = feat;
	486
	487	if (len)
	488	memcpy(to, val, len);
afe00251	489
c02fdc0e GR	490	dccp_pr_debug("%s(%s (%d), ...), length %d\n",
	491	dccp_feat_typename(type),
	492	dccp_feat_name(feat), feat, len);
afe00251 AB	493	return 0;
	494	}
	495
2d0817d1	496	static int dccp_insert_options_feat(struct sock sk, struct sk_buff skb)
afe00251	497	{
a4bf3902	498	struct dccp_minisock *dmsk = dccp_msk(sk);
afe00251 AB	499	struct dccp_opt_pend opt, next;
	500	int change = 0;
	501
	502	/* confirm any options [NN opts] */
a4bf3902	503	list_for_each_entry_safe(opt, next, &dmsk->dccpms_conf, dccpop_node) {
afe00251 AB	504	dccp_insert_feat_opt(skb, opt->dccpop_type,
	505	opt->dccpop_feat, opt->dccpop_val,
	506	opt->dccpop_len);
	507	/* fear empty confirms */
	508	if (opt->dccpop_val)
	509	kfree(opt->dccpop_val);
	510	kfree(opt);
	511	}
a4bf3902	512	INIT_LIST_HEAD(&dmsk->dccpms_conf);
afe00251 AB	513
afe00251 AB	514	/* see which features we need to send */
a4bf3902	515	list_for_each_entry(opt, &dmsk->dccpms_pending, dccpop_node) {
afe00251 AB	516	/* see if we need to send any confirm */
	517	if (opt->dccpop_sc) {
	518	dccp_insert_feat_opt(skb, opt->dccpop_type + 1,
	519	opt->dccpop_feat,
	520	opt->dccpop_sc->dccpoc_val,
	521	opt->dccpop_sc->dccpoc_len);
	522
	523	BUG_ON(!opt->dccpop_sc->dccpoc_val);
	524	kfree(opt->dccpop_sc->dccpoc_val);
	525	kfree(opt->dccpop_sc);
	526	opt->dccpop_sc = NULL;
	527	}
	528
	529	/* any option not confirmed, re-send it */
	530	if (!opt->dccpop_conf) {
	531	dccp_insert_feat_opt(skb, opt->dccpop_type,
	532	opt->dccpop_feat, opt->dccpop_val,
	533	opt->dccpop_len);
	534	change++;
	535	}
	536	}
	537
2d0817d1	538	return 0;
afe00251 AB	539	}
afe00251 AB	540
af3b867e GR	541	/* The length of all options needs to be a multiple of 4 (5.8) */
	542	static void dccp_insert_option_padding(struct sk_buff *skb)
	543	{
	544	int padding = DCCP_SKB_CB(skb)->dccpd_opt_len % 4;
	545
	546	if (padding != 0) {
	547	padding = 4 - padding;
	548	memset(skb_push(skb, padding), 0, padding);
	549	DCCP_SKB_CB(skb)->dccpd_opt_len += padding;
	550	}
	551	}
	552
2d0817d1	553	int dccp_insert_options(struct sock sk, struct sk_buff skb)
7c657876 ACM	554	{
7c657876 ACM	555	struct dccp_sock *dp = dccp_sk(sk);
a4bf3902	556	struct dccp_minisock *dmsk = dccp_msk(sk);
7c657876 ACM	557
	558	DCCP_SKB_CB(skb)->dccpd_opt_len = 0;
	559
a4bf3902	560	if (dmsk->dccpms_send_ndp_count &&
2d0817d1 ACM	561	dccp_insert_option_ndp(sk, skb))
2d0817d1 ACM	562	return -1;
7c657876 ACM	563
7c657876 ACM	564	if (!dccp_packet_without_ack(skb)) {
a4bf3902	565	if (dmsk->dccpms_send_ack_vector &&
2d0817d1 ACM	566	dccp_ackvec_pending(dp->dccps_hc_rx_ackvec) &&
	567	dccp_insert_option_ackvec(sk, skb))
	568	return -1;
7c657876 ACM	569	}
7c657876 ACM	570
507d37cf	571	if (dp->dccps_hc_rx_insert_options) {
2d0817d1 ACM	572	if (ccid_hc_rx_insert_options(dp->dccps_hc_rx_ccid, sk, skb))
2d0817d1 ACM	573	return -1;
507d37cf ACM	574	dp->dccps_hc_rx_insert_options = 0;
507d37cf ACM	575	}
7c657876	576
afe00251	577	/* Feature negotiation */
2d0817d1 ACM	578	/* Data packets can't do feat negotiation */
	579	if (DCCP_SKB_CB(skb)->dccpd_type != DCCP_PKT_DATA &&
	580	DCCP_SKB_CB(skb)->dccpd_type != DCCP_PKT_DATAACK &&
	581	dccp_insert_options_feat(sk, skb))
	582	return -1;
afe00251	583
89560b53 GR	584	/*
	585	* Obtain RTT sample from Request/Response exchange.
	586	* This is currently used in CCID 3 initialisation.
	587	*/
	588	if (DCCP_SKB_CB(skb)->dccpd_type == DCCP_PKT_REQUEST &&
	589	dccp_insert_option_timestamp(sk, skb))
	590	return -1;
	591
b4d4f7c7 GR	592	if (dp->dccps_timestamp_echo != 0 &&
	593	dccp_insert_option_timestamp_echo(dp, NULL, skb))
	594	return -1;
	595
af3b867e GR	596	dccp_insert_option_padding(skb);
	597	return 0;
	598	}
7c657876	599
af3b867e GR	600	int dccp_insert_options_rsk(struct dccp_request_sock dreq, struct sk_buff skb)
	601	{
	602	DCCP_SKB_CB(skb)->dccpd_opt_len = 0;
7c657876	603
af3b867e GR	604	if (dreq->dreq_timestamp_echo != 0 &&
	605	dccp_insert_option_timestamp_echo(NULL, dreq, skb))
	606	return -1;
2d0817d1	607
af3b867e	608	dccp_insert_option_padding(skb);
2d0817d1	609	return 0;
7c657876	610	}