infiniband/core/ud_header.c

42 #define STRUCT_FIELD(header, field) \
43 	.struct_offset_bytes = offsetof(struct ib_unpacked_ ## header, field),      \
44 	.struct_size_bytes   = sizeof_field(struct ib_unpacked_ ## header, field), \
45 	.field_name          = #header ":" #field
283 __sum16 ib_ud_ip4_csum(struct ib_ud_header *header)
289 	iph.tos		= header->ip4.tos;
290 	iph.tot_len	= header->ip4.tot_len;
291 	iph.id		= header->ip4.id;
292 	iph.frag_off	= header->ip4.frag_off;
293 	iph.ttl		= header->ip4.ttl;
294 	iph.protocol	= header->ip4.protocol;
296 	iph.saddr	= header->ip4.saddr;
297 	iph.daddr	= header->ip4.daddr;
304  * ib_ud_header_init - Initialize UD header structure
307  * @eth_present: specify if Eth header is present
310  * @ip_version: if non-zero, IP header, V4 or V6, will be included
311  * @udp_present :if non-zero, UDP header will be included
313  * @header:Structure to initialize
323 		      struct ib_ud_header *header)
328 	memset(header, 0, sizeof *header);
331 	 * UDP header without IP header doesn't make sense
339 		header->lrh.link_version     = 0;
340 		header->lrh.link_next_header =
349 		header->lrh.packet_length = cpu_to_be16(packet_length);
353 		header->eth.type = cpu_to_be16(ETH_P_8021Q);
356 		header->grh.ip_version      = 6;
357 		header->grh.payload_length  =
364 		header->grh.next_header     = udp_present ? IPPROTO_UDP : 0x1b;
368 		header->ip4.ver = 4; /* version 4 */
369 		header->ip4.hdr_len = 5; /* 5 words */
370 		header->ip4.tot_len =
377 		header->ip4.protocol = IPPROTO_UDP;
380 		header->udp.length =
388 		header->bth.opcode           = IB_OPCODE_UD_SEND_ONLY_WITH_IMMEDIATE;
390 		header->bth.opcode           = IB_OPCODE_UD_SEND_ONLY;
391 	header->bth.pad_count                = (4 - payload_bytes) & 3;
392 	header->bth.transport_header_version = 0;
394 	header->lrh_present = lrh_present;
395 	header->eth_present = eth_present;
396 	header->vlan_present = vlan_present;
397 	header->grh_present = grh_present || (ip_version == 6);
398 	header->ipv4_present = ip_version == 4;
399 	header->udp_present = udp_present;
400 	header->immediate_present = immediate_present;
406  * ib_ud_header_pack - Pack UD header struct into wire format
407  * @header:UD header struct
410  * ib_ud_header_pack() packs the UD header structure @header into wire
413 int ib_ud_header_pack(struct ib_ud_header *header,
418 	if (header->lrh_present) {
420 			&header->lrh, buf + len);
423 	if (header->eth_present) {
425 			&header->eth, buf + len);
428 	if (header->vlan_present) {
430 			&header->vlan, buf + len);
433 	if (header->grh_present) {
435 			&header->grh, buf + len);
438 	if (header->ipv4_present) {
440 			&header->ip4, buf + len);
443 	if (header->udp_present) {
445 			&header->udp, buf + len);
450 		&header->bth, buf + len);
454 		&header->deth, buf + len);
457 	if (header->immediate_present) {
458 		memcpy(buf + len, &header->immediate_data, sizeof header->immediate_data);
459 		len += sizeof header->immediate_data;
467  * ib_ud_header_unpack - Unpack UD header struct from wire format
468  * @header:UD header struct
471  * ib_ud_header_pack() unpacks the UD header structure @header from wire
475 			struct ib_ud_header *header)
478 		  buf, &header->lrh);
481 	if (header->lrh.link_version != 0) {
483 			header->lrh.link_version);
487 	switch (header->lrh.link_next_header) {
489 		header->grh_present = 0;
493 		header->grh_present = 1;
495 			  buf, &header->grh);
498 		if (header->grh.ip_version != 6) {
500 				header->grh.ip_version);
503 		if (header->grh.next_header != 0x1b) {
505 				header->grh.next_header);
512 			header->lrh.link_next_header);
517 		  buf, &header->bth);
520 	switch (header->bth.opcode) {
522 		header->immediate_present = 0;
525 		header->immediate_present = 1;
528 		pr_warn("Invalid BTH.opcode 0x%02x\n", header->bth.opcode);
532 	if (header->bth.transport_header_version != 0) {
534 			header->bth.transport_header_version);
539 		  buf, &header->deth);
542 	if (header->immediate_present)
543 		memcpy(&header->immediate_data, buf, sizeof header->immediate_data);