options.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825
  1. /*
  2. * net/dccp/options.c
  3. *
  4. * An implementation of the DCCP protocol
  5. * Aristeu Sergio Rozanski Filho <aris@cathedrallabs.org>
  6. * Arnaldo Carvalho de Melo <acme@ghostprotocols.net>
  7. *
  8. * This program is free software; you can redistribute it and/or
  9. * modify it under the terms of the GNU General Public License
  10. * as published by the Free Software Foundation; either version
  11. * 2 of the License, or (at your option) any later version.
  12. */
  13. #include <linux/config.h>
  14. #include <linux/dccp.h>
  15. #include <linux/module.h>
  16. #include <linux/types.h>
  17. #include <linux/kernel.h>
  18. #include <linux/skbuff.h>
  19. #include "ccid.h"
  20. #include "dccp.h"
  21. static void dccp_ackpkts_check_rcv_ackvector(struct dccp_ackpkts *ap,
  22. struct sock *sk,
  23. const u64 ackno,
  24. const unsigned char len,
  25. const unsigned char *vector);
  26. /* stores the default values for new connection. may be changed with sysctl */
  27. static const struct dccp_options dccpo_default_values = {
  28. .dccpo_sequence_window = DCCPF_INITIAL_SEQUENCE_WINDOW,
  29. .dccpo_ccid = DCCPF_INITIAL_CCID,
  30. .dccpo_send_ack_vector = DCCPF_INITIAL_SEND_ACK_VECTOR,
  31. .dccpo_send_ndp_count = DCCPF_INITIAL_SEND_NDP_COUNT,
  32. };
  33. void dccp_options_init(struct dccp_options *dccpo)
  34. {
  35. memcpy(dccpo, &dccpo_default_values, sizeof(*dccpo));
  36. }
  37. static u32 dccp_decode_value_var(const unsigned char *bf, const u8 len)
  38. {
  39. u32 value = 0;
  40. if (len > 3)
  41. value += *bf++ << 24;
  42. if (len > 2)
  43. value += *bf++ << 16;
  44. if (len > 1)
  45. value += *bf++ << 8;
  46. if (len > 0)
  47. value += *bf;
  48. return value;
  49. }
  50. int dccp_parse_options(struct sock *sk, struct sk_buff *skb)
  51. {
  52. struct dccp_sock *dp = dccp_sk(sk);
  53. #ifdef CONFIG_IP_DCCP_DEBUG
  54. const char *debug_prefix = dp->dccps_role == DCCP_ROLE_CLIENT ?
  55. "CLIENT rx opt: " : "server rx opt: ";
  56. #endif
  57. const struct dccp_hdr *dh = dccp_hdr(skb);
  58. const u8 pkt_type = DCCP_SKB_CB(skb)->dccpd_type;
  59. unsigned char *options = (unsigned char *)dh + dccp_hdr_len(skb);
  60. unsigned char *opt_ptr = options;
  61. const unsigned char *opt_end = (unsigned char *)dh +
  62. (dh->dccph_doff * 4);
  63. struct dccp_options_received *opt_recv = &dp->dccps_options_received;
  64. unsigned char opt, len;
  65. unsigned char *value;
  66. memset(opt_recv, 0, sizeof(*opt_recv));
  67. while (opt_ptr != opt_end) {
  68. opt = *opt_ptr++;
  69. len = 0;
  70. value = NULL;
  71. /* Check if this isn't a single byte option */
  72. if (opt > DCCPO_MAX_RESERVED) {
  73. if (opt_ptr == opt_end)
  74. goto out_invalid_option;
  75. len = *opt_ptr++;
  76. if (len < 3)
  77. goto out_invalid_option;
  78. /*
  79. * Remove the type and len fields, leaving
  80. * just the value size
  81. */
  82. len -= 2;
  83. value = opt_ptr;
  84. opt_ptr += len;
  85. if (opt_ptr > opt_end)
  86. goto out_invalid_option;
  87. }
  88. switch (opt) {
  89. case DCCPO_PADDING:
  90. break;
  91. case DCCPO_NDP_COUNT:
  92. if (len > 3)
  93. goto out_invalid_option;
  94. opt_recv->dccpor_ndp = dccp_decode_value_var(value, len);
  95. dccp_pr_debug("%sNDP count=%d\n", debug_prefix,
  96. opt_recv->dccpor_ndp);
  97. break;
  98. case DCCPO_ACK_VECTOR_0:
  99. if (len > DCCP_MAX_ACK_VECTOR_LEN)
  100. goto out_invalid_option;
  101. if (pkt_type == DCCP_PKT_DATA)
  102. continue;
  103. opt_recv->dccpor_ack_vector_len = len;
  104. opt_recv->dccpor_ack_vector_idx = value - options;
  105. dccp_pr_debug("%sACK vector 0, len=%d, ack_ackno=%llu\n",
  106. debug_prefix, len,
  107. (unsigned long long)
  108. DCCP_SKB_CB(skb)->dccpd_ack_seq);
  109. dccp_ackvector_print(DCCP_SKB_CB(skb)->dccpd_ack_seq,
  110. value, len);
  111. dccp_ackpkts_check_rcv_ackvector(dp->dccps_hc_rx_ackpkts,
  112. sk,
  113. DCCP_SKB_CB(skb)->dccpd_ack_seq,
  114. len, value);
  115. break;
  116. case DCCPO_TIMESTAMP:
  117. if (len != 4)
  118. goto out_invalid_option;
  119. opt_recv->dccpor_timestamp = ntohl(*(u32 *)value);
  120. dp->dccps_timestamp_echo = opt_recv->dccpor_timestamp;
  121. dp->dccps_timestamp_time = jiffies;
  122. dccp_pr_debug("%sTIMESTAMP=%u, ackno=%llu\n",
  123. debug_prefix, opt_recv->dccpor_timestamp,
  124. (unsigned long long)
  125. DCCP_SKB_CB(skb)->dccpd_ack_seq);
  126. break;
  127. case DCCPO_TIMESTAMP_ECHO:
  128. if (len < 4 || len > 8)
  129. goto out_invalid_option;
  130. opt_recv->dccpor_timestamp_echo = ntohl(*(u32 *)value);
  131. dccp_pr_debug("%sTIMESTAMP_ECHO=%u, len=%d, ackno=%llu, "
  132. "diff=%u\n",
  133. debug_prefix,
  134. opt_recv->dccpor_timestamp_echo,
  135. len + 2,
  136. (unsigned long long)
  137. DCCP_SKB_CB(skb)->dccpd_ack_seq,
  138. (tcp_time_stamp -
  139. opt_recv->dccpor_timestamp_echo));
  140. opt_recv->dccpor_elapsed_time =
  141. dccp_decode_value_var(value + 4,
  142. len - 4);
  143. dccp_pr_debug("%sTIMESTAMP_ECHO ELAPSED_TIME=%d\n",
  144. debug_prefix,
  145. opt_recv->dccpor_elapsed_time);
  146. break;
  147. case DCCPO_ELAPSED_TIME:
  148. if (len > 4)
  149. goto out_invalid_option;
  150. if (pkt_type == DCCP_PKT_DATA)
  151. continue;
  152. opt_recv->dccpor_elapsed_time =
  153. dccp_decode_value_var(value, len);
  154. dccp_pr_debug("%sELAPSED_TIME=%d\n", debug_prefix,
  155. opt_recv->dccpor_elapsed_time);
  156. break;
  157. /*
  158. * From draft-ietf-dccp-spec-11.txt:
  159. *
  160. * Option numbers 128 through 191 are for
  161. * options sent from the HC-Sender to the
  162. * HC-Receiver; option numbers 192 through 255
  163. * are for options sent from the HC-Receiver to
  164. * the HC-Sender.
  165. */
  166. case 128 ... 191: {
  167. const u16 idx = value - options;
  168. if (ccid_hc_rx_parse_options(dp->dccps_hc_rx_ccid, sk,
  169. opt, len, idx,
  170. value) != 0)
  171. goto out_invalid_option;
  172. }
  173. break;
  174. case 192 ... 255: {
  175. const u16 idx = value - options;
  176. if (ccid_hc_tx_parse_options(dp->dccps_hc_tx_ccid, sk,
  177. opt, len, idx,
  178. value) != 0)
  179. goto out_invalid_option;
  180. }
  181. break;
  182. default:
  183. pr_info("DCCP(%p): option %d(len=%d) not "
  184. "implemented, ignoring\n",
  185. sk, opt, len);
  186. break;
  187. }
  188. }
  189. return 0;
  190. out_invalid_option:
  191. DCCP_INC_STATS_BH(DCCP_MIB_INVALIDOPT);
  192. DCCP_SKB_CB(skb)->dccpd_reset_code = DCCP_RESET_CODE_OPTION_ERROR;
  193. pr_info("DCCP(%p): invalid option %d, len=%d\n", sk, opt, len);
  194. return -1;
  195. }
  196. static void dccp_encode_value_var(const u32 value, unsigned char *to,
  197. const unsigned int len)
  198. {
  199. if (len > 3)
  200. *to++ = (value & 0xFF000000) >> 24;
  201. if (len > 2)
  202. *to++ = (value & 0xFF0000) >> 16;
  203. if (len > 1)
  204. *to++ = (value & 0xFF00) >> 8;
  205. if (len > 0)
  206. *to++ = (value & 0xFF);
  207. }
  208. static inline int dccp_ndp_len(const int ndp)
  209. {
  210. return likely(ndp <= 0xFF) ? 1 : ndp <= 0xFFFF ? 2 : 3;
  211. }
  212. void dccp_insert_option(struct sock *sk, struct sk_buff *skb,
  213. const unsigned char option,
  214. const void *value, const unsigned char len)
  215. {
  216. unsigned char *to;
  217. if (DCCP_SKB_CB(skb)->dccpd_opt_len + len + 2 > DCCP_MAX_OPT_LEN) {
  218. LIMIT_NETDEBUG(KERN_INFO "DCCP: packet too small to insert "
  219. "%d option!\n", option);
  220. return;
  221. }
  222. DCCP_SKB_CB(skb)->dccpd_opt_len += len + 2;
  223. to = skb_push(skb, len + 2);
  224. *to++ = option;
  225. *to++ = len + 2;
  226. memcpy(to, value, len);
  227. }
  228. EXPORT_SYMBOL_GPL(dccp_insert_option);
  229. static void dccp_insert_option_ndp(struct sock *sk, struct sk_buff *skb)
  230. {
  231. struct dccp_sock *dp = dccp_sk(sk);
  232. int ndp = dp->dccps_ndp_count;
  233. if (dccp_non_data_packet(skb))
  234. ++dp->dccps_ndp_count;
  235. else
  236. dp->dccps_ndp_count = 0;
  237. if (ndp > 0) {
  238. unsigned char *ptr;
  239. const int ndp_len = dccp_ndp_len(ndp);
  240. const int len = ndp_len + 2;
  241. if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN)
  242. return;
  243. DCCP_SKB_CB(skb)->dccpd_opt_len += len;
  244. ptr = skb_push(skb, len);
  245. *ptr++ = DCCPO_NDP_COUNT;
  246. *ptr++ = len;
  247. dccp_encode_value_var(ndp, ptr, ndp_len);
  248. }
  249. }
  250. static inline int dccp_elapsed_time_len(const u32 elapsed_time)
  251. {
  252. return elapsed_time == 0 ? 0 :
  253. elapsed_time <= 0xFF ? 1 :
  254. elapsed_time <= 0xFFFF ? 2 :
  255. elapsed_time <= 0xFFFFFF ? 3 : 4;
  256. }
  257. void dccp_insert_option_elapsed_time(struct sock *sk,
  258. struct sk_buff *skb,
  259. u32 elapsed_time)
  260. {
  261. #ifdef CONFIG_IP_DCCP_DEBUG
  262. struct dccp_sock *dp = dccp_sk(sk);
  263. const char *debug_prefix = dp->dccps_role == DCCP_ROLE_CLIENT ?
  264. "CLIENT TX opt: " : "server TX opt: ";
  265. #endif
  266. const int elapsed_time_len = dccp_elapsed_time_len(elapsed_time);
  267. const int len = 2 + elapsed_time_len;
  268. unsigned char *to;
  269. /* If elapsed_time == 0... */
  270. if (elapsed_time_len == 2)
  271. return;
  272. if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN) {
  273. LIMIT_NETDEBUG(KERN_INFO "DCCP: packet too small to "
  274. "insert elapsed time!\n");
  275. return;
  276. }
  277. DCCP_SKB_CB(skb)->dccpd_opt_len += len;
  278. to = skb_push(skb, len);
  279. *to++ = DCCPO_ELAPSED_TIME;
  280. *to++ = len;
  281. dccp_encode_value_var(elapsed_time, to, elapsed_time_len);
  282. dccp_pr_debug("%sELAPSED_TIME=%u, len=%d, seqno=%llu\n",
  283. debug_prefix, elapsed_time,
  284. len,
  285. (unsigned long long) DCCP_SKB_CB(skb)->dccpd_seq);
  286. }
  287. EXPORT_SYMBOL(dccp_insert_option_elapsed_time);
  288. static void dccp_insert_option_ack_vector(struct sock *sk, struct sk_buff *skb)
  289. {
  290. struct dccp_sock *dp = dccp_sk(sk);
  291. #ifdef CONFIG_IP_DCCP_DEBUG
  292. const char *debug_prefix = dp->dccps_role == DCCP_ROLE_CLIENT ?
  293. "CLIENT TX opt: " : "server TX opt: ";
  294. #endif
  295. struct dccp_ackpkts *ap = dp->dccps_hc_rx_ackpkts;
  296. int len = ap->dccpap_buf_vector_len + 2;
  297. const u32 elapsed_time = jiffies_to_usecs(jiffies - ap->dccpap_time) / 10;
  298. unsigned char *to, *from;
  299. if (elapsed_time != 0)
  300. dccp_insert_option_elapsed_time(sk, skb, elapsed_time);
  301. if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN) {
  302. LIMIT_NETDEBUG(KERN_INFO "DCCP: packet too small to "
  303. "insert ACK Vector!\n");
  304. return;
  305. }
  306. /*
  307. * XXX: now we have just one ack vector sent record, so
  308. * we have to wait for it to be cleared.
  309. *
  310. * Of course this is not acceptable, but this is just for
  311. * basic testing now.
  312. */
  313. if (ap->dccpap_ack_seqno != DCCP_MAX_SEQNO + 1)
  314. return;
  315. DCCP_SKB_CB(skb)->dccpd_opt_len += len;
  316. to = skb_push(skb, len);
  317. *to++ = DCCPO_ACK_VECTOR_0;
  318. *to++ = len;
  319. len = ap->dccpap_buf_vector_len;
  320. from = ap->dccpap_buf + ap->dccpap_buf_head;
  321. /* Check if buf_head wraps */
  322. if (ap->dccpap_buf_head + len > ap->dccpap_buf_len) {
  323. const unsigned int tailsize = (ap->dccpap_buf_len -
  324. ap->dccpap_buf_head);
  325. memcpy(to, from, tailsize);
  326. to += tailsize;
  327. len -= tailsize;
  328. from = ap->dccpap_buf;
  329. }
  330. memcpy(to, from, len);
  331. /*
  332. * From draft-ietf-dccp-spec-11.txt:
  333. *
  334. * For each acknowledgement it sends, the HC-Receiver will add an
  335. * acknowledgement record. ack_seqno will equal the HC-Receiver
  336. * sequence number it used for the ack packet; ack_ptr will equal
  337. * buf_head; ack_ackno will equal buf_ackno; and ack_nonce will
  338. * equal buf_nonce.
  339. *
  340. * This implemention uses just one ack record for now.
  341. */
  342. ap->dccpap_ack_seqno = DCCP_SKB_CB(skb)->dccpd_seq;
  343. ap->dccpap_ack_ptr = ap->dccpap_buf_head;
  344. ap->dccpap_ack_ackno = ap->dccpap_buf_ackno;
  345. ap->dccpap_ack_nonce = ap->dccpap_buf_nonce;
  346. ap->dccpap_ack_vector_len = ap->dccpap_buf_vector_len;
  347. dccp_pr_debug("%sACK Vector 0, len=%d, ack_seqno=%llu, "
  348. "ack_ackno=%llu\n",
  349. debug_prefix, ap->dccpap_ack_vector_len,
  350. (unsigned long long) ap->dccpap_ack_seqno,
  351. (unsigned long long) ap->dccpap_ack_ackno);
  352. }
  353. static inline void dccp_insert_option_timestamp(struct sock *sk,
  354. struct sk_buff *skb)
  355. {
  356. const u32 now = htonl(tcp_time_stamp);
  357. dccp_insert_option(sk, skb, DCCPO_TIMESTAMP, &now, sizeof(now));
  358. }
  359. static void dccp_insert_option_timestamp_echo(struct sock *sk,
  360. struct sk_buff *skb)
  361. {
  362. struct dccp_sock *dp = dccp_sk(sk);
  363. #ifdef CONFIG_IP_DCCP_DEBUG
  364. const char *debug_prefix = dp->dccps_role == DCCP_ROLE_CLIENT ?
  365. "CLIENT TX opt: " : "server TX opt: ";
  366. #endif
  367. u32 tstamp_echo;
  368. const u32 elapsed_time = jiffies_to_usecs(jiffies -
  369. dp->dccps_timestamp_time) / 10;
  370. const int elapsed_time_len = dccp_elapsed_time_len(elapsed_time);
  371. const int len = 6 + elapsed_time_len;
  372. unsigned char *to;
  373. if (DCCP_SKB_CB(skb)->dccpd_opt_len + len > DCCP_MAX_OPT_LEN) {
  374. LIMIT_NETDEBUG(KERN_INFO "DCCP: packet too small to insert "
  375. "timestamp echo!\n");
  376. return;
  377. }
  378. DCCP_SKB_CB(skb)->dccpd_opt_len += len;
  379. to = skb_push(skb, len);
  380. *to++ = DCCPO_TIMESTAMP_ECHO;
  381. *to++ = len;
  382. tstamp_echo = htonl(dp->dccps_timestamp_echo);
  383. memcpy(to, &tstamp_echo, 4);
  384. to += 4;
  385. dccp_encode_value_var(elapsed_time, to, elapsed_time_len);
  386. dccp_pr_debug("%sTIMESTAMP_ECHO=%u, len=%d, seqno=%llu\n",
  387. debug_prefix, dp->dccps_timestamp_echo,
  388. len,
  389. (unsigned long long) DCCP_SKB_CB(skb)->dccpd_seq);
  390. dp->dccps_timestamp_echo = 0;
  391. dp->dccps_timestamp_time = 0;
  392. }
  393. void dccp_insert_options(struct sock *sk, struct sk_buff *skb)
  394. {
  395. struct dccp_sock *dp = dccp_sk(sk);
  396. DCCP_SKB_CB(skb)->dccpd_opt_len = 0;
  397. if (dp->dccps_options.dccpo_send_ndp_count)
  398. dccp_insert_option_ndp(sk, skb);
  399. if (!dccp_packet_without_ack(skb)) {
  400. if (dp->dccps_options.dccpo_send_ack_vector &&
  401. (dp->dccps_hc_rx_ackpkts->dccpap_buf_ackno !=
  402. DCCP_MAX_SEQNO + 1))
  403. dccp_insert_option_ack_vector(sk, skb);
  404. dccp_insert_option_timestamp(sk, skb);
  405. if (dp->dccps_timestamp_echo != 0)
  406. dccp_insert_option_timestamp_echo(sk, skb);
  407. }
  408. ccid_hc_rx_insert_options(dp->dccps_hc_rx_ccid, sk, skb);
  409. ccid_hc_tx_insert_options(dp->dccps_hc_tx_ccid, sk, skb);
  410. /* XXX: insert other options when appropriate */
  411. if (DCCP_SKB_CB(skb)->dccpd_opt_len != 0) {
  412. /* The length of all options has to be a multiple of 4 */
  413. int padding = DCCP_SKB_CB(skb)->dccpd_opt_len % 4;
  414. if (padding != 0) {
  415. padding = 4 - padding;
  416. memset(skb_push(skb, padding), 0, padding);
  417. DCCP_SKB_CB(skb)->dccpd_opt_len += padding;
  418. }
  419. }
  420. }
  421. struct dccp_ackpkts *dccp_ackpkts_alloc(unsigned int len, int priority)
  422. {
  423. struct dccp_ackpkts *ap = kmalloc(sizeof(*ap) + len, priority);
  424. if (ap != NULL) {
  425. #ifdef CONFIG_IP_DCCP_DEBUG
  426. memset(ap->dccpap_buf, 0xFF, len);
  427. #endif
  428. ap->dccpap_buf_len = len;
  429. ap->dccpap_buf_head =
  430. ap->dccpap_buf_tail =
  431. ap->dccpap_buf_len - 1;
  432. ap->dccpap_buf_ackno =
  433. ap->dccpap_ack_ackno =
  434. ap->dccpap_ack_seqno = DCCP_MAX_SEQNO + 1;
  435. ap->dccpap_buf_nonce = ap->dccpap_buf_nonce = 0;
  436. ap->dccpap_ack_ptr = 0;
  437. ap->dccpap_time = 0;
  438. ap->dccpap_buf_vector_len = ap->dccpap_ack_vector_len = 0;
  439. }
  440. return ap;
  441. }
  442. void dccp_ackpkts_free(struct dccp_ackpkts *ap)
  443. {
  444. if (ap != NULL) {
  445. #ifdef CONFIG_IP_DCCP_DEBUG
  446. memset(ap, 0xFF, sizeof(*ap) + ap->dccpap_buf_len);
  447. #endif
  448. kfree(ap);
  449. }
  450. }
  451. static inline u8 dccp_ackpkts_state(const struct dccp_ackpkts *ap,
  452. const unsigned int index)
  453. {
  454. return ap->dccpap_buf[index] & DCCP_ACKPKTS_STATE_MASK;
  455. }
  456. static inline u8 dccp_ackpkts_len(const struct dccp_ackpkts *ap,
  457. const unsigned int index)
  458. {
  459. return ap->dccpap_buf[index] & DCCP_ACKPKTS_LEN_MASK;
  460. }
  461. /*
  462. * If several packets are missing, the HC-Receiver may prefer to enter multiple
  463. * bytes with run length 0, rather than a single byte with a larger run length;
  464. * this simplifies table updates if one of the missing packets arrives.
  465. */
  466. static inline int dccp_ackpkts_set_buf_head_state(struct dccp_ackpkts *ap,
  467. const unsigned int packets,
  468. const unsigned char state)
  469. {
  470. unsigned int gap;
  471. signed long new_head;
  472. if (ap->dccpap_buf_vector_len + packets > ap->dccpap_buf_len)
  473. return -ENOBUFS;
  474. gap = packets - 1;
  475. new_head = ap->dccpap_buf_head - packets;
  476. if (new_head < 0) {
  477. if (gap > 0) {
  478. memset(ap->dccpap_buf, DCCP_ACKPKTS_STATE_NOT_RECEIVED,
  479. gap + new_head + 1);
  480. gap = -new_head;
  481. }
  482. new_head += ap->dccpap_buf_len;
  483. }
  484. ap->dccpap_buf_head = new_head;
  485. if (gap > 0)
  486. memset(ap->dccpap_buf + ap->dccpap_buf_head + 1,
  487. DCCP_ACKPKTS_STATE_NOT_RECEIVED, gap);
  488. ap->dccpap_buf[ap->dccpap_buf_head] = state;
  489. ap->dccpap_buf_vector_len += packets;
  490. return 0;
  491. }
  492. /*
  493. * Implements the draft-ietf-dccp-spec-11.txt Appendix A
  494. */
  495. int dccp_ackpkts_add(struct dccp_ackpkts *ap, u64 ackno, u8 state)
  496. {
  497. /*
  498. * Check at the right places if the buffer is full, if it is, tell the
  499. * caller to start dropping packets till the HC-Sender acks our ACK
  500. * vectors, when we will free up space in dccpap_buf.
  501. *
  502. * We may well decide to do buffer compression, etc, but for now lets
  503. * just drop.
  504. *
  505. * From Appendix A:
  506. *
  507. * Of course, the circular buffer may overflow, either when the
  508. * HC-Sender is sending data at a very high rate, when the
  509. * HC-Receiver's acknowledgements are not reaching the HC-Sender,
  510. * or when the HC-Sender is forgetting to acknowledge those acks
  511. * (so the HC-Receiver is unable to clean up old state). In this
  512. * case, the HC-Receiver should either compress the buffer (by
  513. * increasing run lengths when possible), transfer its state to
  514. * a larger buffer, or, as a last resort, drop all received
  515. * packets, without processing them whatsoever, until its buffer
  516. * shrinks again.
  517. */
  518. /* See if this is the first ackno being inserted */
  519. if (ap->dccpap_buf_vector_len == 0) {
  520. ap->dccpap_buf[ap->dccpap_buf_head] = state;
  521. ap->dccpap_buf_vector_len = 1;
  522. } else if (after48(ackno, ap->dccpap_buf_ackno)) {
  523. const u64 delta = dccp_delta_seqno(ap->dccpap_buf_ackno,
  524. ackno);
  525. /*
  526. * Look if the state of this packet is the same as the
  527. * previous ackno and if so if we can bump the head len.
  528. */
  529. if (delta == 1 &&
  530. dccp_ackpkts_state(ap, ap->dccpap_buf_head) == state &&
  531. (dccp_ackpkts_len(ap, ap->dccpap_buf_head) <
  532. DCCP_ACKPKTS_LEN_MASK))
  533. ap->dccpap_buf[ap->dccpap_buf_head]++;
  534. else if (dccp_ackpkts_set_buf_head_state(ap, delta, state))
  535. return -ENOBUFS;
  536. } else {
  537. /*
  538. * A.1.2. Old Packets
  539. *
  540. * When a packet with Sequence Number S arrives, and
  541. * S <= buf_ackno, the HC-Receiver will scan the table
  542. * for the byte corresponding to S. (Indexing structures
  543. * could reduce the complexity of this scan.)
  544. */
  545. u64 delta = dccp_delta_seqno(ackno, ap->dccpap_buf_ackno);
  546. unsigned int index = ap->dccpap_buf_head;
  547. while (1) {
  548. const u8 len = dccp_ackpkts_len(ap, index);
  549. const u8 state = dccp_ackpkts_state(ap, index);
  550. /*
  551. * valid packets not yet in dccpap_buf have a reserved
  552. * entry, with a len equal to 0.
  553. */
  554. if (state == DCCP_ACKPKTS_STATE_NOT_RECEIVED &&
  555. len == 0 && delta == 0) { /* Found our
  556. reserved seat! */
  557. dccp_pr_debug("Found %llu reserved seat!\n",
  558. (unsigned long long) ackno);
  559. ap->dccpap_buf[index] = state;
  560. goto out;
  561. }
  562. /* len == 0 means one packet */
  563. if (delta < len + 1)
  564. goto out_duplicate;
  565. delta -= len + 1;
  566. if (++index == ap->dccpap_buf_len)
  567. index = 0;
  568. }
  569. }
  570. ap->dccpap_buf_ackno = ackno;
  571. ap->dccpap_time = jiffies;
  572. out:
  573. dccp_pr_debug("");
  574. dccp_ackpkts_print(ap);
  575. return 0;
  576. out_duplicate:
  577. /* Duplicate packet */
  578. dccp_pr_debug("Received a dup or already considered lost "
  579. "packet: %llu\n", (unsigned long long) ackno);
  580. return -EILSEQ;
  581. }
  582. #ifdef CONFIG_IP_DCCP_DEBUG
  583. void dccp_ackvector_print(const u64 ackno, const unsigned char *vector,
  584. int len)
  585. {
  586. if (!dccp_debug)
  587. return;
  588. printk("ACK vector len=%d, ackno=%llu |", len,
  589. (unsigned long long) ackno);
  590. while (len--) {
  591. const u8 state = (*vector & DCCP_ACKPKTS_STATE_MASK) >> 6;
  592. const u8 rl = (*vector & DCCP_ACKPKTS_LEN_MASK);
  593. printk("%d,%d|", state, rl);
  594. ++vector;
  595. }
  596. printk("\n");
  597. }
  598. void dccp_ackpkts_print(const struct dccp_ackpkts *ap)
  599. {
  600. dccp_ackvector_print(ap->dccpap_buf_ackno,
  601. ap->dccpap_buf + ap->dccpap_buf_head,
  602. ap->dccpap_buf_vector_len);
  603. }
  604. #endif
  605. static void dccp_ackpkts_trow_away_ack_record(struct dccp_ackpkts *ap)
  606. {
  607. /*
  608. * As we're keeping track of the ack vector size
  609. * (dccpap_buf_vector_len) and the sent ack vector size
  610. * (dccpap_ack_vector_len) we don't need dccpap_buf_tail at all, but
  611. * keep this code here as in the future we'll implement a vector of
  612. * ack records, as suggested in draft-ietf-dccp-spec-11.txt
  613. * Appendix A. -acme
  614. */
  615. #if 0
  616. ap->dccpap_buf_tail = ap->dccpap_ack_ptr + 1;
  617. if (ap->dccpap_buf_tail >= ap->dccpap_buf_len)
  618. ap->dccpap_buf_tail -= ap->dccpap_buf_len;
  619. #endif
  620. ap->dccpap_buf_vector_len -= ap->dccpap_ack_vector_len;
  621. }
  622. void dccp_ackpkts_check_rcv_ackno(struct dccp_ackpkts *ap, struct sock *sk,
  623. u64 ackno)
  624. {
  625. /* Check if we actually sent an ACK vector */
  626. if (ap->dccpap_ack_seqno == DCCP_MAX_SEQNO + 1)
  627. return;
  628. if (ackno == ap->dccpap_ack_seqno) {
  629. #ifdef CONFIG_IP_DCCP_DEBUG
  630. struct dccp_sock *dp = dccp_sk(sk);
  631. const char *debug_prefix = dp->dccps_role == DCCP_ROLE_CLIENT ?
  632. "CLIENT rx ack: " : "server rx ack: ";
  633. #endif
  634. dccp_pr_debug("%sACK packet 0, len=%d, ack_seqno=%llu, "
  635. "ack_ackno=%llu, ACKED!\n",
  636. debug_prefix, 1,
  637. (unsigned long long) ap->dccpap_ack_seqno,
  638. (unsigned long long) ap->dccpap_ack_ackno);
  639. dccp_ackpkts_trow_away_ack_record(ap);
  640. ap->dccpap_ack_seqno = DCCP_MAX_SEQNO + 1;
  641. }
  642. }
  643. static void dccp_ackpkts_check_rcv_ackvector(struct dccp_ackpkts *ap,
  644. struct sock *sk, u64 ackno,
  645. const unsigned char len,
  646. const unsigned char *vector)
  647. {
  648. unsigned char i;
  649. /* Check if we actually sent an ACK vector */
  650. if (ap->dccpap_ack_seqno == DCCP_MAX_SEQNO + 1)
  651. return;
  652. /*
  653. * We're in the receiver half connection, so if the received an ACK
  654. * vector ackno (e.g. 50) before dccpap_ack_seqno (e.g. 52), we're
  655. * not interested.
  656. *
  657. * Extra explanation with example:
  658. *
  659. * if we received an ACK vector with ackno 50, it can only be acking
  660. * 50, 49, 48, etc, not 52 (the seqno for the ACK vector we sent).
  661. */
  662. /* dccp_pr_debug("is %llu < %llu? ", ackno, ap->dccpap_ack_seqno); */
  663. if (before48(ackno, ap->dccpap_ack_seqno)) {
  664. /* dccp_pr_debug_cat("yes\n"); */
  665. return;
  666. }
  667. /* dccp_pr_debug_cat("no\n"); */
  668. i = len;
  669. while (i--) {
  670. const u8 rl = (*vector & DCCP_ACKPKTS_LEN_MASK);
  671. u64 ackno_end_rl;
  672. dccp_set_seqno(&ackno_end_rl, ackno - rl);
  673. /*
  674. * dccp_pr_debug("is %llu <= %llu <= %llu? ", ackno_end_rl,
  675. * ap->dccpap_ack_seqno, ackno);
  676. */
  677. if (between48(ap->dccpap_ack_seqno, ackno_end_rl, ackno)) {
  678. const u8 state = (*vector &
  679. DCCP_ACKPKTS_STATE_MASK) >> 6;
  680. /* dccp_pr_debug_cat("yes\n"); */
  681. if (state != DCCP_ACKPKTS_STATE_NOT_RECEIVED) {
  682. #ifdef CONFIG_IP_DCCP_DEBUG
  683. struct dccp_sock *dp = dccp_sk(sk);
  684. const char *debug_prefix =
  685. dp->dccps_role == DCCP_ROLE_CLIENT ?
  686. "CLIENT rx ack: " : "server rx ack: ";
  687. #endif
  688. dccp_pr_debug("%sACK vector 0, len=%d, "
  689. "ack_seqno=%llu, ack_ackno=%llu, "
  690. "ACKED!\n",
  691. debug_prefix, len,
  692. (unsigned long long)
  693. ap->dccpap_ack_seqno,
  694. (unsigned long long)
  695. ap->dccpap_ack_ackno);
  696. dccp_ackpkts_trow_away_ack_record(ap);
  697. }
  698. /*
  699. * If dccpap_ack_seqno was not received, no problem
  700. * we'll send another ACK vector.
  701. */
  702. ap->dccpap_ack_seqno = DCCP_MAX_SEQNO + 1;
  703. break;
  704. }
  705. /* dccp_pr_debug_cat("no\n"); */
  706. dccp_set_seqno(&ackno, ackno_end_rl - 1);
  707. ++vector;
  708. }
  709. }