433 static inline pgn_t j1939_xtp_ctl_to_pgn(const u8 *dat)  in j1939_xtp_ctl_to_pgn()  argument
437 	pgn = (dat[7] << 16) | (dat[6] << 8) | (dat[5] << 0);  in j1939_xtp_ctl_to_pgn()
443 static inline unsigned int j1939_tp_ctl_to_size(const u8 *dat)  in j1939_tp_ctl_to_size()  argument
445 	return (dat[2] << 8) + (dat[1] << 0);  in j1939_tp_ctl_to_size()
448 static inline unsigned int j1939_etp_ctl_to_packet(const u8 *dat)  in j1939_etp_ctl_to_packet()  argument
450 	return (dat[4] << 16) | (dat[3] << 8) | (dat[2] << 0);  in j1939_etp_ctl_to_packet()
453 static inline unsigned int j1939_etp_ctl_to_size(const u8 *dat)  in j1939_etp_ctl_to_size()  argument
455 	return (dat[4] << 24) | (dat[3] << 16) |  in j1939_etp_ctl_to_size()
456 		(dat[2] << 8) | (dat[1] << 0);  in j1939_etp_ctl_to_size()
621 			   const u8 *dat, int len)  in j1939_tp_tx_dat()  argument
631 	skb_put_data(skb, dat, len);  in j1939_tp_tx_dat()
640 			       bool swap_src_dst, pgn_t pgn, const u8 *dat)  in j1939_xtp_do_tx_ctl()  argument
653 	memcpy(skdat, dat, 5);  in j1939_xtp_do_tx_ctl()
662 				  bool swap_src_dst, const u8 *dat)  in j1939_tp_tx_ctl()  argument
668 				   session->skcb.addr.pgn, dat);  in j1939_tp_tx_ctl()
677 	u8 dat[5];  in j1939_xtp_tx_abort()  local
682 	memset(dat, 0xff, sizeof(dat));  in j1939_xtp_tx_abort()
683 	dat[0] = J1939_TP_CMD_ABORT;  in j1939_xtp_tx_abort()
684 	dat[1] = err;  in j1939_xtp_tx_abort()
685 	return j1939_xtp_do_tx_ctl(priv, re_skcb, swap_src_dst, pgn, dat);  in j1939_xtp_tx_abort()
706 	u8 dat[8];  in j1939_session_tx_rts()  local
709 	memset(dat, 0xff, sizeof(dat));  in j1939_session_tx_rts()
711 	dat[1] = (session->total_message_size >> 0);  in j1939_session_tx_rts()
712 	dat[2] = (session->total_message_size >> 8);  in j1939_session_tx_rts()
713 	dat[3] = session->pkt.total;  in j1939_session_tx_rts()
716 		dat[0] = J1939_ETP_CMD_RTS;  in j1939_session_tx_rts()
717 		dat[1] = (session->total_message_size >> 0);  in j1939_session_tx_rts()
718 		dat[2] = (session->total_message_size >> 8);  in j1939_session_tx_rts()
719 		dat[3] = (session->total_message_size >> 16);  in j1939_session_tx_rts()
720 		dat[4] = (session->total_message_size >> 24);  in j1939_session_tx_rts()
722 		dat[0] = J1939_TP_CMD_BAM;  in j1939_session_tx_rts()
726 		dat[0] = J1939_TP_CMD_RTS;  in j1939_session_tx_rts()
727 		dat[4] = dat[3];  in j1939_session_tx_rts()
730 	if (dat[0] == session->last_txcmd)  in j1939_session_tx_rts()
734 	ret = j1939_tp_tx_ctl(session, false, dat);  in j1939_session_tx_rts()
738 	session->last_txcmd = dat[0];  in j1939_session_tx_rts()
739 	if (dat[0] == J1939_TP_CMD_BAM) {  in j1939_session_tx_rts()
754 	u8 dat[8];  in j1939_session_tx_dpo()  local
757 	memset(dat, 0xff, sizeof(dat));  in j1939_session_tx_dpo()
759 	dat[0] = J1939_ETP_CMD_DPO;  in j1939_session_tx_dpo()
762 	dat[1] = session->pkt.last - session->pkt.tx_acked;  in j1939_session_tx_dpo()
763 	dat[2] = (pkt >> 0);  in j1939_session_tx_dpo()
764 	dat[3] = (pkt >> 8);  in j1939_session_tx_dpo()
765 	dat[4] = (pkt >> 16);  in j1939_session_tx_dpo()
767 	ret = j1939_tp_tx_ctl(session, false, dat);  in j1939_session_tx_dpo()
771 	session->last_txcmd = dat[0];  in j1939_session_tx_dpo()
789 	u8 dat[8];  in j1939_session_tx_dat()  local
806 		dat[0] = session->pkt.tx - session->pkt.dpo + 1;  in j1939_session_tx_dat()
826 		memcpy(&dat[1], &tpdat[offset], len);  in j1939_session_tx_dat()
827 		ret = j1939_tp_tx_dat(session, dat, len + 1);  in j1939_session_tx_dat()
905 	u8 dat[8];  in j1939_session_tx_cts()  local
912 	memset(dat, 0xff, sizeof(dat));  in j1939_session_tx_cts()
916 		dat[0] = J1939_ETP_CMD_CTS;  in j1939_session_tx_cts()
917 		dat[1] = len;  in j1939_session_tx_cts()
918 		dat[2] = (pkt >> 0);  in j1939_session_tx_cts()
919 		dat[3] = (pkt >> 8);  in j1939_session_tx_cts()
920 		dat[4] = (pkt >> 16);  in j1939_session_tx_cts()
922 		dat[0] = J1939_TP_CMD_CTS;  in j1939_session_tx_cts()
923 		dat[1] = len;  in j1939_session_tx_cts()
924 		dat[2] = session->pkt.rx + 1;  in j1939_session_tx_cts()
927 	if (dat[0] == session->last_txcmd)  in j1939_session_tx_cts()
931 	ret = j1939_tp_tx_ctl(session, true, dat);  in j1939_session_tx_cts()
937 		session->last_txcmd = dat[0];  in j1939_session_tx_cts()
948 	u8 dat[8];  in j1939_session_tx_eoma()  local
954 	memset(dat, 0xff, sizeof(dat));  in j1939_session_tx_eoma()
957 		dat[0] = J1939_ETP_CMD_EOMA;  in j1939_session_tx_eoma()
958 		dat[1] = session->total_message_size >> 0;  in j1939_session_tx_eoma()
959 		dat[2] = session->total_message_size >> 8;  in j1939_session_tx_eoma()
960 		dat[3] = session->total_message_size >> 16;  in j1939_session_tx_eoma()
961 		dat[4] = session->total_message_size >> 24;  in j1939_session_tx_eoma()
963 		dat[0] = J1939_TP_CMD_EOMA;  in j1939_session_tx_eoma()
964 		dat[1] = session->total_message_size;  in j1939_session_tx_eoma()
965 		dat[2] = session->total_message_size >> 8;  in j1939_session_tx_eoma()
966 		dat[3] = session->pkt.total;  in j1939_session_tx_eoma()
969 	if (dat[0] == session->last_txcmd)  in j1939_session_tx_eoma()
973 	ret = j1939_tp_tx_ctl(session, true, dat);  in j1939_session_tx_eoma()
977 	session->last_txcmd = dat[0];  in j1939_session_tx_eoma()
1359 	const u8 *dat;  in j1939_xtp_rx_eoma_one()  local
1365 	dat = skb->data;  in j1939_xtp_rx_eoma_one()
1368 		len = j1939_etp_ctl_to_size(dat);  in j1939_xtp_rx_eoma_one()
1370 		len = j1939_tp_ctl_to_size(dat);  in j1939_xtp_rx_eoma_one()
1408 	const u8 *dat;  in j1939_xtp_rx_cts_one()  local
1410 	dat = skb->data;  in j1939_xtp_rx_cts_one()
1417 	if (session->last_cmd == dat[0]) {  in j1939_xtp_rx_cts_one()
1423 		pkt = j1939_etp_ctl_to_packet(dat);  in j1939_xtp_rx_cts_one()
1425 		pkt = dat[2];  in j1939_xtp_rx_cts_one()
1429 	else if (dat[1] > session->pkt.block /* 0xff for etp */)  in j1939_xtp_rx_cts_one()
1435 	session->pkt.last = session->pkt.tx_acked + dat[1];  in j1939_xtp_rx_cts_one()
1442 	session->last_cmd = dat[0];  in j1939_xtp_rx_cts_one()
1443 	if (dat[1]) {  in j1939_xtp_rx_cts_one()
1584 	const u8 *dat;  in j1939_xtp_rx_rts_session_new()  local
1590 	dat = skb->data;  in j1939_xtp_rx_rts_session_new()
1591 	pgn = j1939_xtp_ctl_to_pgn(dat);  in j1939_xtp_rx_rts_session_new()
1598 		len = j1939_etp_ctl_to_size(dat);  in j1939_xtp_rx_rts_session_new()
1606 		len = j1939_tp_ctl_to_size(dat);  in j1939_xtp_rx_rts_session_new()
1631 		if (dat[3] != session->pkt.total)  in j1939_xtp_rx_rts_session_new()
1634 				     dat[3]);  in j1939_xtp_rx_rts_session_new()
1635 		session->pkt.total = dat[3];  in j1939_xtp_rx_rts_session_new()
1636 		session->pkt.block = min(dat[3], dat[4]);  in j1939_xtp_rx_rts_session_new()
1756 	const u8 *dat = skb->data;  in j1939_xtp_rx_dpo_one()  local
1765 	session->last_cmd = dat[0];  in j1939_xtp_rx_dpo_one()
1797 	const u8 *dat;  in j1939_xtp_rx_dat_one()  local
1807 	dat = skb->data;  in j1939_xtp_rx_dat_one()
1833 	packet = (dat[0] - 1 + session->pkt.dpo);  in j1939_xtp_rx_dat_one()
1861 		memcpy(&tpdat[offset], &dat[1], nbytes);  in j1939_xtp_rx_dat_one()
1865 		err = memcmp(&tpdat[offset], &dat[1], nbytes);  in j1939_xtp_rx_dat_one()
1870 					nbytes, &dat[1],  in j1939_xtp_rx_dat_one()