infiniband/core/ib_ud_header.c

45 #define STRUCT_FIELD(header, field) \
46 	.struct_offset_bytes = offsetof(struct ib_unpacked_ ## header, field),      \
47 	.struct_size_bytes   = sizeof ((struct ib_unpacked_ ## header *) 0)->field, \
48 	.field_name          = #header ":" #field
286 __sum16 ib_ud_ip4_csum(struct ib_ud_header *header)
293 	iph.ip_tos	= header->ip4.tos;
294 	iph.ip_len	= header->ip4.tot_len;
295 	iph.ip_id	= header->ip4.id;
296 	iph.ip_off	= header->ip4.frag_off;
297 	iph.ip_ttl	= header->ip4.ttl;
298 	iph.ip_p	= header->ip4.protocol;
300 	iph.ip_src.s_addr = header->ip4.saddr;
301 	iph.ip_dst.s_addr = header->ip4.daddr;
311  * ib_ud_header_init - Initialize UD header structure
314  * @eth_present: specify if Eth header is present
317  * @ip_version: if non-zero, IP header, V4 or V6, will be included
318  * @udp_present :if non-zero, UDP header will be included
320  * @header:Structure to initialize
330 		      struct ib_ud_header *header)
335 	memset(header, 0, sizeof *header);
338 	 * UDP header without IP header doesn't make sense
346 		header->lrh.link_version     = 0;
347 		header->lrh.link_next_header =
356 		header->lrh.packet_length = cpu_to_be16(packet_length);
360 		header->eth.type = cpu_to_be16(ETH_P_8021Q);
363 		header->grh.ip_version      = 6;
364 		header->grh.payload_length  =
371 		header->grh.next_header     = udp_present ? IPPROTO_UDP : 0x1b;
375 		header->ip4.ver = 4; /* version 4 */
376 		header->ip4.hdr_len = 5; /* 5 words */
377 		header->ip4.tot_len =
384 		header->ip4.protocol = IPPROTO_UDP;
387 		header->udp.length =
395 		header->bth.opcode           = IB_OPCODE_UD_SEND_ONLY_WITH_IMMEDIATE;
397 		header->bth.opcode           = IB_OPCODE_UD_SEND_ONLY;
398 	header->bth.pad_count                = (4 - payload_bytes) & 3;
399 	header->bth.transport_header_version = 0;
401 	header->lrh_present = lrh_present;
402 	header->eth_present = eth_present;
403 	header->vlan_present = vlan_present;
404 	header->grh_present = grh_present || (ip_version == 6);
405 	header->ipv4_present = ip_version == 4;
406 	header->udp_present = udp_present;
407 	header->immediate_present = immediate_present;
413  * ib_ud_header_pack - Pack UD header struct into wire format
414  * @header:UD header struct
417  * ib_ud_header_pack() packs the UD header structure @header into wire
420 int ib_ud_header_pack(struct ib_ud_header *header,
425 	if (header->lrh_present) {
427 			&header->lrh, (char *)buf + len);
430 	if (header->eth_present) {
432 			&header->eth, (char *)buf + len);
435 	if (header->vlan_present) {
437 			&header->vlan, (char *)buf + len);
440 	if (header->grh_present) {
442 			&header->grh, (char *)buf + len);
445 	if (header->ipv4_present) {
447 			&header->ip4, (char *)buf + len);
450 	if (header->udp_present) {
452 			&header->udp, (char *)buf + len);
457 		&header->bth, (char *)buf + len);
461 		&header->deth, (char *)buf + len);
464 	if (header->immediate_present) {
465 		memcpy((char *)buf + len, &header->immediate_data, sizeof header->immediate_data);
466 		len += sizeof header->immediate_data;
474  * ib_ud_header_unpack - Unpack UD header struct from wire format
475  * @header:UD header struct
478  * ib_ud_header_pack() unpacks the UD header structure @header from wire
482 			struct ib_ud_header *header)
485 		  buf, &header->lrh);
488 	if (header->lrh.link_version != 0) {
490 			header->lrh.link_version);
494 	switch (header->lrh.link_next_header) {
496 		header->grh_present = 0;
500 		header->grh_present = 1;
502 			  buf, &header->grh);
505 		if (header->grh.ip_version != 6) {
507 				header->grh.ip_version);
510 		if (header->grh.next_header != 0x1b) {
512 				header->grh.next_header);
519 			header->lrh.link_next_header);
524 		  buf, &header->bth);
527 	switch (header->bth.opcode) {
529 		header->immediate_present = 0;
532 		header->immediate_present = 1;
535 		pr_warn("Invalid BTH.opcode 0x%02x\n", header->bth.opcode);
539 	if (header->bth.transport_header_version != 0) {
541 			header->bth.transport_header_version);
546 		  buf, &header->deth);
549 	if (header->immediate_present)
550 		memcpy(&header->immediate_data, buf, sizeof header->immediate_data);