437 static inline pgn_t j1939_xtp_ctl_to_pgn(const u8 *dat)  in j1939_xtp_ctl_to_pgn()  argument
441 	pgn = (dat[7] << 16) | (dat[6] << 8) | (dat[5] << 0);  in j1939_xtp_ctl_to_pgn()
447 static inline unsigned int j1939_tp_ctl_to_size(const u8 *dat)  in j1939_tp_ctl_to_size()  argument
449 	return (dat[2] << 8) + (dat[1] << 0);  in j1939_tp_ctl_to_size()
452 static inline unsigned int j1939_etp_ctl_to_packet(const u8 *dat)  in j1939_etp_ctl_to_packet()  argument
454 	return (dat[4] << 16) | (dat[3] << 8) | (dat[2] << 0);  in j1939_etp_ctl_to_packet()
457 static inline unsigned int j1939_etp_ctl_to_size(const u8 *dat)  in j1939_etp_ctl_to_size()  argument
459 	return (dat[4] << 24) | (dat[3] << 16) |  in j1939_etp_ctl_to_size()
460 		(dat[2] << 8) | (dat[1] << 0);  in j1939_etp_ctl_to_size()
625 			   const u8 *dat, int len)  in j1939_tp_tx_dat()  argument
635 	skb_put_data(skb, dat, len);  in j1939_tp_tx_dat()
644 			       bool swap_src_dst, pgn_t pgn, const u8 *dat)  in j1939_xtp_do_tx_ctl()  argument
657 	memcpy(skdat, dat, 5);  in j1939_xtp_do_tx_ctl()
666 				  bool swap_src_dst, const u8 *dat)  in j1939_tp_tx_ctl()  argument
672 				   session->skcb.addr.pgn, dat);  in j1939_tp_tx_ctl()
681 	u8 dat[5];  in j1939_xtp_tx_abort()  local
686 	memset(dat, 0xff, sizeof(dat));  in j1939_xtp_tx_abort()
687 	dat[0] = J1939_TP_CMD_ABORT;  in j1939_xtp_tx_abort()
688 	dat[1] = err;  in j1939_xtp_tx_abort()
689 	return j1939_xtp_do_tx_ctl(priv, re_skcb, swap_src_dst, pgn, dat);  in j1939_xtp_tx_abort()
710 	u8 dat[8];  in j1939_session_tx_rts()  local
713 	memset(dat, 0xff, sizeof(dat));  in j1939_session_tx_rts()
715 	dat[1] = (session->total_message_size >> 0);  in j1939_session_tx_rts()
716 	dat[2] = (session->total_message_size >> 8);  in j1939_session_tx_rts()
717 	dat[3] = session->pkt.total;  in j1939_session_tx_rts()
720 		dat[0] = J1939_ETP_CMD_RTS;  in j1939_session_tx_rts()
721 		dat[1] = (session->total_message_size >> 0);  in j1939_session_tx_rts()
722 		dat[2] = (session->total_message_size >> 8);  in j1939_session_tx_rts()
723 		dat[3] = (session->total_message_size >> 16);  in j1939_session_tx_rts()
724 		dat[4] = (session->total_message_size >> 24);  in j1939_session_tx_rts()
726 		dat[0] = J1939_TP_CMD_BAM;  in j1939_session_tx_rts()
730 		dat[0] = J1939_TP_CMD_RTS;  in j1939_session_tx_rts()
731 		dat[4] = dat[3];  in j1939_session_tx_rts()
734 	if (dat[0] == session->last_txcmd)  in j1939_session_tx_rts()
738 	ret = j1939_tp_tx_ctl(session, false, dat);  in j1939_session_tx_rts()
742 	session->last_txcmd = dat[0];  in j1939_session_tx_rts()
743 	if (dat[0] == J1939_TP_CMD_BAM) {  in j1939_session_tx_rts()
758 	u8 dat[8];  in j1939_session_tx_dpo()  local
761 	memset(dat, 0xff, sizeof(dat));  in j1939_session_tx_dpo()
763 	dat[0] = J1939_ETP_CMD_DPO;  in j1939_session_tx_dpo()
766 	dat[1] = session->pkt.last - session->pkt.tx_acked;  in j1939_session_tx_dpo()
767 	dat[2] = (pkt >> 0);  in j1939_session_tx_dpo()
768 	dat[3] = (pkt >> 8);  in j1939_session_tx_dpo()
769 	dat[4] = (pkt >> 16);  in j1939_session_tx_dpo()
771 	ret = j1939_tp_tx_ctl(session, false, dat);  in j1939_session_tx_dpo()
775 	session->last_txcmd = dat[0];  in j1939_session_tx_dpo()
793 	u8 dat[8];  in j1939_session_tx_dat()  local
810 		dat[0] = session->pkt.tx - session->pkt.dpo + 1;  in j1939_session_tx_dat()
829 		memcpy(&dat[1], &tpdat[offset], len);  in j1939_session_tx_dat()
830 		ret = j1939_tp_tx_dat(session, dat, len + 1);  in j1939_session_tx_dat()
908 	u8 dat[8];  in j1939_session_tx_cts()  local
915 	memset(dat, 0xff, sizeof(dat));  in j1939_session_tx_cts()
919 		dat[0] = J1939_ETP_CMD_CTS;  in j1939_session_tx_cts()
920 		dat[1] = len;  in j1939_session_tx_cts()
921 		dat[2] = (pkt >> 0);  in j1939_session_tx_cts()
922 		dat[3] = (pkt >> 8);  in j1939_session_tx_cts()
923 		dat[4] = (pkt >> 16);  in j1939_session_tx_cts()
925 		dat[0] = J1939_TP_CMD_CTS;  in j1939_session_tx_cts()
926 		dat[1] = len;  in j1939_session_tx_cts()
927 		dat[2] = session->pkt.rx + 1;  in j1939_session_tx_cts()
930 	if (dat[0] == session->last_txcmd)  in j1939_session_tx_cts()
934 	ret = j1939_tp_tx_ctl(session, true, dat);  in j1939_session_tx_cts()
940 		session->last_txcmd = dat[0];  in j1939_session_tx_cts()
951 	u8 dat[8];  in j1939_session_tx_eoma()  local
957 	memset(dat, 0xff, sizeof(dat));  in j1939_session_tx_eoma()
960 		dat[0] = J1939_ETP_CMD_EOMA;  in j1939_session_tx_eoma()
961 		dat[1] = session->total_message_size >> 0;  in j1939_session_tx_eoma()
962 		dat[2] = session->total_message_size >> 8;  in j1939_session_tx_eoma()
963 		dat[3] = session->total_message_size >> 16;  in j1939_session_tx_eoma()
964 		dat[4] = session->total_message_size >> 24;  in j1939_session_tx_eoma()
966 		dat[0] = J1939_TP_CMD_EOMA;  in j1939_session_tx_eoma()
967 		dat[1] = session->total_message_size;  in j1939_session_tx_eoma()
968 		dat[2] = session->total_message_size >> 8;  in j1939_session_tx_eoma()
969 		dat[3] = session->pkt.total;  in j1939_session_tx_eoma()
972 	if (dat[0] == session->last_txcmd)  in j1939_session_tx_eoma()
976 	ret = j1939_tp_tx_ctl(session, true, dat);  in j1939_session_tx_eoma()
980 	session->last_txcmd = dat[0];  in j1939_session_tx_eoma()
1355 	const u8 *dat;  in j1939_xtp_rx_eoma_one()  local
1361 	dat = skb->data;  in j1939_xtp_rx_eoma_one()
1364 		len = j1939_etp_ctl_to_size(dat);  in j1939_xtp_rx_eoma_one()
1366 		len = j1939_tp_ctl_to_size(dat);  in j1939_xtp_rx_eoma_one()
1404 	const u8 *dat;  in j1939_xtp_rx_cts_one()  local
1406 	dat = skb->data;  in j1939_xtp_rx_cts_one()
1413 	if (session->last_cmd == dat[0]) {  in j1939_xtp_rx_cts_one()
1419 		pkt = j1939_etp_ctl_to_packet(dat);  in j1939_xtp_rx_cts_one()
1421 		pkt = dat[2];  in j1939_xtp_rx_cts_one()
1425 	else if (dat[1] > session->pkt.block /* 0xff for etp */)  in j1939_xtp_rx_cts_one()
1431 	session->pkt.last = session->pkt.tx_acked + dat[1];  in j1939_xtp_rx_cts_one()
1438 	session->last_cmd = dat[0];  in j1939_xtp_rx_cts_one()
1439 	if (dat[1]) {  in j1939_xtp_rx_cts_one()
1580 	const u8 *dat;  in j1939_xtp_rx_rts_session_new()  local
1586 	dat = skb->data;  in j1939_xtp_rx_rts_session_new()
1587 	pgn = j1939_xtp_ctl_to_pgn(dat);  in j1939_xtp_rx_rts_session_new()
1594 		len = j1939_etp_ctl_to_size(dat);  in j1939_xtp_rx_rts_session_new()
1602 		len = j1939_tp_ctl_to_size(dat);  in j1939_xtp_rx_rts_session_new()
1627 		if (dat[3] != session->pkt.total)  in j1939_xtp_rx_rts_session_new()
1630 				     dat[3]);  in j1939_xtp_rx_rts_session_new()
1631 		session->pkt.total = dat[3];  in j1939_xtp_rx_rts_session_new()
1632 		session->pkt.block = min(dat[3], dat[4]);  in j1939_xtp_rx_rts_session_new()
1749 	const u8 *dat = skb->data;  in j1939_xtp_rx_dpo_one()  local
1758 	session->last_cmd = dat[0];  in j1939_xtp_rx_dpo_one()
1787 	const u8 *dat;  in j1939_xtp_rx_dat_one()  local
1797 	dat = skb->data;  in j1939_xtp_rx_dat_one()
1822 	packet = (dat[0] - 1 + session->pkt.dpo);  in j1939_xtp_rx_dat_one()
1850 		memcpy(&tpdat[offset], &dat[1], nbytes);  in j1939_xtp_rx_dat_one()
1854 		err = memcmp(&tpdat[offset], &dat[1], nbytes);  in j1939_xtp_rx_dat_one()
1859 					nbytes, &dat[1],  in j1939_xtp_rx_dat_one()