181 static u32 isotp_bc_flags(struct isotp_sock *so)  in isotp_bc_flags()  argument
183 	return so->opt.flags & ISOTP_ALL_BC_FLAGS;  in isotp_bc_flags()
186 static bool isotp_register_rxid(struct isotp_sock *so)  in isotp_register_rxid()  argument
189 	return (isotp_bc_flags(so) == 0);  in isotp_register_rxid()
194 	struct isotp_sock *so = container_of(hrtimer, struct isotp_sock,  in isotp_rx_timer_handler()  local
196 	struct sock *sk = &so->sk;  in isotp_rx_timer_handler()
198 	if (so->rx.state == ISOTP_WAIT_DATA) {  in isotp_rx_timer_handler()
207 		so->rx.state = ISOTP_IDLE;  in isotp_rx_timer_handler()
218 	struct isotp_sock *so = isotp_sk(sk);  in isotp_send_fc()  local
221 	nskb = alloc_skb(so->ll.mtu + sizeof(struct can_skb_priv), gfp_any());  in isotp_send_fc()
225 	dev = dev_get_by_index(sock_net(sk), so->ifindex);  in isotp_send_fc()
238 	skb_put_zero(nskb, so->ll.mtu);  in isotp_send_fc()
241 	ncf->can_id = so->txid;  in isotp_send_fc()
243 	if (so->opt.flags & CAN_ISOTP_TX_PADDING) {  in isotp_send_fc()
244 		memset(ncf->data, so->opt.txpad_content, CAN_MAX_DLEN);  in isotp_send_fc()
251 	ncf->data[ae + 1] = so->rxfc.bs;  in isotp_send_fc()
252 	ncf->data[ae + 2] = so->rxfc.stmin;  in isotp_send_fc()
255 		ncf->data[0] = so->opt.ext_address;  in isotp_send_fc()
257 	ncf->flags = so->ll.tx_flags;  in isotp_send_fc()
267 	so->rx.bs = 0;  in isotp_send_fc()
270 	so->lastrxcf_tstamp = ktime_set(0, 0);  in isotp_send_fc()
273 	hrtimer_start(&so->rxtimer, ktime_set(ISOTP_FC_TIMEOUT, 0),  in isotp_send_fc()
332 static int check_pad(struct isotp_sock *so, struct canfd_frame *cf,  in check_pad()  argument
338 	if (!(so->opt.flags & CAN_ISOTP_RX_PADDING)) {  in check_pad()
339 		if (so->opt.flags & CAN_ISOTP_CHK_PAD_LEN)  in check_pad()
347 	if ((so->opt.flags & CAN_ISOTP_CHK_PAD_LEN) &&  in check_pad()
352 	if (so->opt.flags & CAN_ISOTP_CHK_PAD_DATA) {  in check_pad()
360 static void isotp_send_cframe(struct isotp_sock *so);
362 static int isotp_rcv_fc(struct isotp_sock *so, struct canfd_frame *cf, int ae)  in isotp_rcv_fc()  argument
364 	struct sock *sk = &so->sk;  in isotp_rcv_fc()
366 	if (so->tx.state != ISOTP_WAIT_FC &&  in isotp_rcv_fc()
367 	    so->tx.state != ISOTP_WAIT_FIRST_FC)  in isotp_rcv_fc()
370 	hrtimer_cancel(&so->txtimer);  in isotp_rcv_fc()
373 	    ((so->opt.flags & ISOTP_CHECK_PADDING) &&  in isotp_rcv_fc()
374 	     check_pad(so, cf, ae + FC_CONTENT_SZ, so->opt.rxpad_content))) {  in isotp_rcv_fc()
380 		so->tx.state = ISOTP_IDLE;  in isotp_rcv_fc()
381 		wake_up_interruptible(&so->wait);  in isotp_rcv_fc()
386 	if (so->tx.state == ISOTP_WAIT_FIRST_FC ||  in isotp_rcv_fc()
387 	    so->opt.flags & CAN_ISOTP_DYN_FC_PARMS) {  in isotp_rcv_fc()
388 		so->txfc.bs = cf->data[ae + 1];  in isotp_rcv_fc()
389 		so->txfc.stmin = cf->data[ae + 2];  in isotp_rcv_fc()
392 		if (so->txfc.stmin > 0x7F &&  in isotp_rcv_fc()
393 		    (so->txfc.stmin < 0xF1 || so->txfc.stmin > 0xF9))  in isotp_rcv_fc()
394 			so->txfc.stmin = 0x7F;  in isotp_rcv_fc()
396 		so->tx_gap = ktime_set(0, 0);  in isotp_rcv_fc()
398 		so->tx_gap = ktime_add_ns(so->tx_gap, so->frame_txtime);  in isotp_rcv_fc()
400 		if (so->opt.flags & CAN_ISOTP_FORCE_TXSTMIN)  in isotp_rcv_fc()
401 			so->tx_gap = ktime_add_ns(so->tx_gap,  in isotp_rcv_fc()
402 						  so->force_tx_stmin);  in isotp_rcv_fc()
403 		else if (so->txfc.stmin < 0x80)  in isotp_rcv_fc()
404 			so->tx_gap = ktime_add_ns(so->tx_gap,  in isotp_rcv_fc()
405 						  so->txfc.stmin * 1000000);  in isotp_rcv_fc()
407 			so->tx_gap = ktime_add_ns(so->tx_gap,  in isotp_rcv_fc()
408 						  (so->txfc.stmin - 0xF0)  in isotp_rcv_fc()
410 		so->tx.state = ISOTP_WAIT_FC;  in isotp_rcv_fc()
415 		so->tx.bs = 0;  in isotp_rcv_fc()
416 		so->tx.state = ISOTP_SENDING;  in isotp_rcv_fc()
418 		hrtimer_start(&so->txtimer, ktime_set(ISOTP_ECHO_TIMEOUT, 0),  in isotp_rcv_fc()
420 		isotp_send_cframe(so);  in isotp_rcv_fc()
425 		hrtimer_start(&so->txtimer, ktime_set(ISOTP_FC_TIMEOUT, 0),  in isotp_rcv_fc()
438 		so->tx.state = ISOTP_IDLE;  in isotp_rcv_fc()
439 		wake_up_interruptible(&so->wait);  in isotp_rcv_fc()
447 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv_sf()  local
450 	hrtimer_cancel(&so->rxtimer);  in isotp_rcv_sf()
451 	so->rx.state = ISOTP_IDLE;  in isotp_rcv_sf()
456 	if ((so->opt.flags & ISOTP_CHECK_PADDING) &&  in isotp_rcv_sf()
457 	    check_pad(so, cf, pcilen + len, so->opt.rxpad_content)) {  in isotp_rcv_sf()
479 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv_ff()  local
484 	hrtimer_cancel(&so->rxtimer);  in isotp_rcv_ff()
485 	so->rx.state = ISOTP_IDLE;  in isotp_rcv_ff()
488 	so->rx.ll_dl = padlen(cf->len);  in isotp_rcv_ff()
491 	if (cf->len != so->rx.ll_dl)  in isotp_rcv_ff()
495 	so->rx.len = (cf->data[ae] & 0x0F) << 8;  in isotp_rcv_ff()
496 	so->rx.len += cf->data[ae + 1];  in isotp_rcv_ff()
499 	if (so->rx.len) {  in isotp_rcv_ff()
503 		so->rx.len = cf->data[ae + 2] << 24;  in isotp_rcv_ff()
504 		so->rx.len += cf->data[ae + 3] << 16;  in isotp_rcv_ff()
505 		so->rx.len += cf->data[ae + 4] << 8;  in isotp_rcv_ff()
506 		so->rx.len += cf->data[ae + 5];  in isotp_rcv_ff()
511 	off = (so->rx.ll_dl > CAN_MAX_DLEN) ? 1 : 0;  in isotp_rcv_ff()
513 	if (so->rx.len + ae + off + ff_pci_sz < so->rx.ll_dl)  in isotp_rcv_ff()
517 	if (so->rx.len > so->rx.buflen && so->rx.buflen < max_pdu_size) {  in isotp_rcv_ff()
521 			so->rx.buf = newbuf;  in isotp_rcv_ff()
522 			so->rx.buflen = max_pdu_size;  in isotp_rcv_ff()
526 	if (so->rx.len > so->rx.buflen) {  in isotp_rcv_ff()
533 	so->rx.idx = 0;  in isotp_rcv_ff()
534 	for (i = ae + ff_pci_sz; i < so->rx.ll_dl; i++)  in isotp_rcv_ff()
535 		so->rx.buf[so->rx.idx++] = cf->data[i];  in isotp_rcv_ff()
538 	so->rx.sn = 1;  in isotp_rcv_ff()
539 	so->rx.state = ISOTP_WAIT_DATA;  in isotp_rcv_ff()
542 	if (so->opt.flags & CAN_ISOTP_LISTEN_MODE)  in isotp_rcv_ff()
553 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv_cf()  local
557 	if (so->rx.state != ISOTP_WAIT_DATA)  in isotp_rcv_cf()
561 	if (so->opt.flags & CAN_ISOTP_FORCE_RXSTMIN) {  in isotp_rcv_cf()
562 		if (ktime_to_ns(ktime_sub(skb->tstamp, so->lastrxcf_tstamp)) <  in isotp_rcv_cf()
563 		    so->force_rx_stmin)  in isotp_rcv_cf()
566 		so->lastrxcf_tstamp = skb->tstamp;  in isotp_rcv_cf()
569 	hrtimer_cancel(&so->rxtimer);  in isotp_rcv_cf()
572 	if (cf->len > so->rx.ll_dl)  in isotp_rcv_cf()
576 	if (cf->len < so->rx.ll_dl) {  in isotp_rcv_cf()
578 		if (so->rx.len - so->rx.idx > so->rx.ll_dl - ae - N_PCI_SZ)  in isotp_rcv_cf()
582 	if ((cf->data[ae] & 0x0F) != so->rx.sn) {  in isotp_rcv_cf()
589 		so->rx.state = ISOTP_IDLE;  in isotp_rcv_cf()
592 	so->rx.sn++;  in isotp_rcv_cf()
593 	so->rx.sn %= 16;  in isotp_rcv_cf()
596 		so->rx.buf[so->rx.idx++] = cf->data[i];  in isotp_rcv_cf()
597 		if (so->rx.idx >= so->rx.len)  in isotp_rcv_cf()
601 	if (so->rx.idx >= so->rx.len) {  in isotp_rcv_cf()
603 		so->rx.state = ISOTP_IDLE;  in isotp_rcv_cf()
605 		if ((so->opt.flags & ISOTP_CHECK_PADDING) &&  in isotp_rcv_cf()
606 		    check_pad(so, cf, i + 1, so->opt.rxpad_content)) {  in isotp_rcv_cf()
614 		nskb = alloc_skb(so->rx.len, gfp_any());  in isotp_rcv_cf()
618 		memcpy(skb_put(nskb, so->rx.len), so->rx.buf,  in isotp_rcv_cf()
619 		       so->rx.len);  in isotp_rcv_cf()
628 	if (!so->rxfc.bs || ++so->rx.bs < so->rxfc.bs) {  in isotp_rcv_cf()
630 		hrtimer_start(&so->rxtimer, ktime_set(ISOTP_FC_TIMEOUT, 0),  in isotp_rcv_cf()
636 	if (so->opt.flags & CAN_ISOTP_LISTEN_MODE)  in isotp_rcv_cf()
639 	/* we reached the specified blocksize so->rxfc.bs */  in isotp_rcv_cf()
647 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv()  local
649 	int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0;  in isotp_rcv()
655 	if (skb->len != so->ll.mtu)  in isotp_rcv()
661 	if (ae && cf->data[0] != so->opt.rx_ext_address)  in isotp_rcv()
670 	spin_lock(&so->rx_lock);  in isotp_rcv()
672 	if (so->opt.flags & CAN_ISOTP_HALF_DUPLEX) {  in isotp_rcv()
674 		if ((so->tx.state != ISOTP_IDLE && n_pci_type != N_PCI_FC) ||  in isotp_rcv()
675 		    (so->rx.state != ISOTP_IDLE && n_pci_type == N_PCI_FC))  in isotp_rcv()
682 		isotp_rcv_fc(so, cf, ae);  in isotp_rcv()
703 				 * If so take care of the increased SF PCI size  in isotp_rcv()
727 	spin_unlock(&so->rx_lock);  in isotp_rcv()
730 static void isotp_fill_dataframe(struct canfd_frame *cf, struct isotp_sock *so,  in isotp_fill_dataframe()  argument
734 	int space = so->tx.ll_dl - pcilen;  in isotp_fill_dataframe()
735 	int num = min_t(int, so->tx.len - so->tx.idx, space);  in isotp_fill_dataframe()
738 	cf->can_id = so->txid;  in isotp_fill_dataframe()
742 		if (so->opt.flags & CAN_ISOTP_TX_PADDING) {  in isotp_fill_dataframe()
745 			memset(cf->data, so->opt.txpad_content, cf->len);  in isotp_fill_dataframe()
755 		cf->data[pcilen + i] = so->tx.buf[so->tx.idx++];  in isotp_fill_dataframe()
758 		cf->data[0] = so->opt.ext_address;  in isotp_fill_dataframe()
761 static void isotp_send_cframe(struct isotp_sock *so)  in isotp_send_cframe()  argument
763 	struct sock *sk = &so->sk;  in isotp_send_cframe()
768 	int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0;  in isotp_send_cframe()
770 	dev = dev_get_by_index(sock_net(sk), so->ifindex);  in isotp_send_cframe()
774 	skb = alloc_skb(so->ll.mtu + sizeof(struct can_skb_priv), GFP_ATOMIC);  in isotp_send_cframe()
785 	skb_put_zero(skb, so->ll.mtu);  in isotp_send_cframe()
788 	isotp_fill_dataframe(cf, so, ae, 0);  in isotp_send_cframe()
791 	cf->data[ae] = N_PCI_CF | so->tx.sn++;  in isotp_send_cframe()
792 	so->tx.sn %= 16;  in isotp_send_cframe()
793 	so->tx.bs++;  in isotp_send_cframe()
795 	cf->flags = so->ll.tx_flags;  in isotp_send_cframe()
801 	if (so->cfecho)  in isotp_send_cframe()
802 		pr_notice_once("can-isotp: cfecho is %08X != 0\n", so->cfecho);  in isotp_send_cframe()
805 	so->cfecho = *(u32 *)cf->data;  in isotp_send_cframe()
818 static void isotp_create_fframe(struct canfd_frame *cf, struct isotp_sock *so,  in isotp_create_fframe()  argument
824 	cf->can_id = so->txid;  in isotp_create_fframe()
825 	cf->len = so->tx.ll_dl;  in isotp_create_fframe()
827 		cf->data[0] = so->opt.ext_address;  in isotp_create_fframe()
830 	if (so->tx.len > MAX_12BIT_PDU_SIZE) {  in isotp_create_fframe()
834 		cf->data[ae + 2] = (u8)(so->tx.len >> 24) & 0xFFU;  in isotp_create_fframe()
835 		cf->data[ae + 3] = (u8)(so->tx.len >> 16) & 0xFFU;  in isotp_create_fframe()
836 		cf->data[ae + 4] = (u8)(so->tx.len >> 8) & 0xFFU;  in isotp_create_fframe()
837 		cf->data[ae + 5] = (u8)so->tx.len & 0xFFU;  in isotp_create_fframe()
841 		cf->data[ae] = (u8)(so->tx.len >> 8) | N_PCI_FF;  in isotp_create_fframe()
842 		cf->data[ae + 1] = (u8)so->tx.len & 0xFFU;  in isotp_create_fframe()
847 	for (i = ae + ff_pci_sz; i < so->tx.ll_dl; i++)  in isotp_create_fframe()
848 		cf->data[i] = so->tx.buf[so->tx.idx++];  in isotp_create_fframe()
850 	so->tx.sn = 1;  in isotp_create_fframe()
856 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv_echo()  local
860 	if (skb->sk != sk || so->cfecho != *(u32 *)cf->data)  in isotp_rcv_echo()
864 	hrtimer_cancel(&so->txtimer);  in isotp_rcv_echo()
867 	so->cfecho = 0;  in isotp_rcv_echo()
869 	if (so->tx.idx >= so->tx.len) {  in isotp_rcv_echo()
871 		so->tx.state = ISOTP_IDLE;  in isotp_rcv_echo()
872 		wake_up_interruptible(&so->wait);  in isotp_rcv_echo()
876 	if (so->txfc.bs && so->tx.bs >= so->txfc.bs) {  in isotp_rcv_echo()
878 		so->tx.state = ISOTP_WAIT_FC;  in isotp_rcv_echo()
879 		hrtimer_start(&so->txtimer, ktime_set(ISOTP_FC_TIMEOUT, 0),  in isotp_rcv_echo()
885 	if (!so->tx_gap) {  in isotp_rcv_echo()
887 		hrtimer_start(&so->txtimer, ktime_set(ISOTP_ECHO_TIMEOUT, 0),  in isotp_rcv_echo()
889 		isotp_send_cframe(so);  in isotp_rcv_echo()
894 	hrtimer_start(&so->txfrtimer, so->tx_gap, HRTIMER_MODE_REL_SOFT);  in isotp_rcv_echo()
899 	struct isotp_sock *so = container_of(hrtimer, struct isotp_sock,  in isotp_tx_timer_handler()  local
901 	struct sock *sk = &so->sk;  in isotp_tx_timer_handler()
904 	if (so->tx.state == ISOTP_IDLE || so->tx.state == ISOTP_SHUTDOWN)  in isotp_tx_timer_handler()
915 	so->tx.state = ISOTP_IDLE;  in isotp_tx_timer_handler()
916 	wake_up_interruptible(&so->wait);  in isotp_tx_timer_handler()
923 	struct isotp_sock *so = container_of(hrtimer, struct isotp_sock,  in isotp_txfr_timer_handler()  local
927 	hrtimer_start(&so->txtimer, ktime_set(ISOTP_ECHO_TIMEOUT, 0),  in isotp_txfr_timer_handler()
931 	if (so->tx.state == ISOTP_SENDING && !so->cfecho)  in isotp_txfr_timer_handler()
932 		isotp_send_cframe(so);  in isotp_txfr_timer_handler()
940 	struct isotp_sock *so = isotp_sk(sk);  in isotp_sendmsg()  local
944 	int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0;  in isotp_sendmsg()
945 	int wait_tx_done = (so->opt.flags & CAN_ISOTP_WAIT_TX_DONE) ? 1 : 0;  in isotp_sendmsg()
950 	if (!so->bound || so->tx.state == ISOTP_SHUTDOWN)  in isotp_sendmsg()
953 	while (cmpxchg(&so->tx.state, ISOTP_IDLE, ISOTP_SENDING) != ISOTP_IDLE) {  in isotp_sendmsg()
958 		if (so->tx.state == ISOTP_SHUTDOWN)  in isotp_sendmsg()
962 		err = wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE);  in isotp_sendmsg()
968 	if (size > so->tx.buflen && so->tx.buflen < max_pdu_size) {  in isotp_sendmsg()
972 			so->tx.buf = newbuf;  in isotp_sendmsg()
973 			so->tx.buflen = max_pdu_size;  in isotp_sendmsg()
977 	if (!size || size > so->tx.buflen) {  in isotp_sendmsg()
983 	off = (so->tx.ll_dl > CAN_MAX_DLEN) ? 1 : 0;  in isotp_sendmsg()
986 	if ((isotp_bc_flags(so) == CAN_ISOTP_SF_BROADCAST) &&  in isotp_sendmsg()
987 	    (size > so->tx.ll_dl - SF_PCI_SZ4 - ae - off)) {  in isotp_sendmsg()
992 	err = memcpy_from_msg(so->tx.buf, msg, size);  in isotp_sendmsg()
996 	dev = dev_get_by_index(sock_net(sk), so->ifindex);  in isotp_sendmsg()
1002 	skb = sock_alloc_send_skb(sk, so->ll.mtu + sizeof(struct can_skb_priv),  in isotp_sendmsg()
1013 	so->tx.len = size;  in isotp_sendmsg()
1014 	so->tx.idx = 0;  in isotp_sendmsg()
1017 	skb_put_zero(skb, so->ll.mtu);  in isotp_sendmsg()
1020 	if (so->cfecho)  in isotp_sendmsg()
1021 		pr_notice_once("can-isotp: uninit cfecho %08X\n", so->cfecho);  in isotp_sendmsg()
1024 	if (size <= so->tx.ll_dl - SF_PCI_SZ4 - ae - off) {  in isotp_sendmsg()
1037 		isotp_fill_dataframe(cf, so, ae, off);  in isotp_sendmsg()
1049 		so->cfecho = *(u32 *)cf->data;  in isotp_sendmsg()
1053 		isotp_create_fframe(cf, so, ae);  in isotp_sendmsg()
1055 		if (isotp_bc_flags(so) == CAN_ISOTP_CF_BROADCAST) {  in isotp_sendmsg()
1057 			if (so->opt.flags & CAN_ISOTP_FORCE_TXSTMIN)  in isotp_sendmsg()
1058 				so->tx_gap = ktime_set(0, so->force_tx_stmin);  in isotp_sendmsg()
1060 				so->tx_gap = ktime_set(0, so->frame_txtime);  in isotp_sendmsg()
1063 			so->txfc.bs = 0;  in isotp_sendmsg()
1066 			so->cfecho = *(u32 *)cf->data;  in isotp_sendmsg()
1069 			so->tx.state = ISOTP_WAIT_FIRST_FC;  in isotp_sendmsg()
1075 			so->cfecho = 0;  in isotp_sendmsg()
1079 	hrtimer_start(&so->txtimer, ktime_set(hrtimer_sec, 0),  in isotp_sendmsg()
1083 	cf->flags = so->ll.tx_flags;  in isotp_sendmsg()
1094 		hrtimer_cancel(&so->txtimer);  in isotp_sendmsg()
1097 		so->cfecho = 0;  in isotp_sendmsg()
1104 		err = wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE);  in isotp_sendmsg()
1117 	so->tx.state = ISOTP_IDLE;  in isotp_sendmsg()
1118 	hrtimer_cancel(&so->txfrtimer);  in isotp_sendmsg()
1119 	hrtimer_cancel(&so->txtimer);  in isotp_sendmsg()
1122 	so->tx.state = ISOTP_IDLE;  in isotp_sendmsg()
1123 	wake_up_interruptible(&so->wait);  in isotp_sendmsg()
1133 	struct isotp_sock *so = isotp_sk(sk);  in isotp_recvmsg()  local
1139 	if (!so->bound)  in isotp_recvmsg()
1175 	struct isotp_sock *so;  in isotp_release()  local
1181 	so = isotp_sk(sk);  in isotp_release()
1185 	while (wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE) == 0 &&  in isotp_release()
1186 	       cmpxchg(&so->tx.state, ISOTP_IDLE, ISOTP_SHUTDOWN) != ISOTP_IDLE)  in isotp_release()
1190 	so->tx.state = ISOTP_SHUTDOWN;  in isotp_release()
1191 	so->rx.state = ISOTP_IDLE;  in isotp_release()
1194 	while (isotp_busy_notifier == so) {  in isotp_release()
1199 	list_del(&so->notifier);  in isotp_release()
1205 	if (so->bound) {  in isotp_release()
1206 		if (so->ifindex) {  in isotp_release()
1209 			dev = dev_get_by_index(net, so->ifindex);  in isotp_release()
1211 				if (isotp_register_rxid(so))  in isotp_release()
1212 					can_rx_unregister(net, dev, so->rxid,  in isotp_release()
1213 							  SINGLE_MASK(so->rxid),  in isotp_release()
1216 				can_rx_unregister(net, dev, so->txid,  in isotp_release()
1217 						  SINGLE_MASK(so->txid),  in isotp_release()
1225 	hrtimer_cancel(&so->txfrtimer);  in isotp_release()
1226 	hrtimer_cancel(&so->txtimer);  in isotp_release()
1227 	hrtimer_cancel(&so->rxtimer);  in isotp_release()
1229 	so->ifindex = 0;  in isotp_release()
1230 	so->bound = 0;  in isotp_release()
1232 	if (so->rx.buf != so->rx.sbuf)  in isotp_release()
1233 		kfree(so->rx.buf);  in isotp_release()
1235 	if (so->tx.buf != so->tx.sbuf)  in isotp_release()
1236 		kfree(so->tx.buf);  in isotp_release()
1251 	struct isotp_sock *so = isotp_sk(sk);  in isotp_bind()  local
1277 	if (isotp_register_rxid(so)) {  in isotp_bind()
1293 	if (so->bound) {  in isotp_bind()
1299 	if (isotp_register_rxid(so) && rx_id == tx_id) {  in isotp_bind()
1314 	if (dev->mtu < so->ll.mtu) {  in isotp_bind()
1324 	if (isotp_register_rxid(so))  in isotp_bind()
1329 	so->cfecho = 0;  in isotp_bind()
1338 	so->ifindex = ifindex;  in isotp_bind()
1339 	so->rxid = rx_id;  in isotp_bind()
1340 	so->txid = tx_id;  in isotp_bind()
1341 	so->bound = 1;  in isotp_bind()
1359 	struct isotp_sock *so = isotp_sk(sk);  in isotp_getname()  local
1366 	addr->can_ifindex = so->ifindex;  in isotp_getname()
1367 	addr->can_addr.tp.rx_id = so->rxid;  in isotp_getname()
1368 	addr->can_addr.tp.tx_id = so->txid;  in isotp_getname()
1377 	struct isotp_sock *so = isotp_sk(sk);  in isotp_setsockopt_locked()  local
1380 	if (so->bound)  in isotp_setsockopt_locked()
1388 		if (copy_from_sockptr(&so->opt, optval, optlen))  in isotp_setsockopt_locked()
1392 		if (!(so->opt.flags & CAN_ISOTP_RX_EXT_ADDR))  in isotp_setsockopt_locked()
1393 			so->opt.rx_ext_address = so->opt.ext_address;  in isotp_setsockopt_locked()
1396 		if (isotp_bc_flags(so) == ISOTP_ALL_BC_FLAGS) {  in isotp_setsockopt_locked()
1398 			so->opt.flags &= ~CAN_ISOTP_CF_BROADCAST;  in isotp_setsockopt_locked()
1405 		if (so->opt.frame_txtime) {  in isotp_setsockopt_locked()
1406 			if (so->opt.frame_txtime == CAN_ISOTP_FRAME_TXTIME_ZERO)  in isotp_setsockopt_locked()
1407 				so->frame_txtime = 0;  in isotp_setsockopt_locked()
1409 				so->frame_txtime = so->opt.frame_txtime;  in isotp_setsockopt_locked()
1417 		if (copy_from_sockptr(&so->rxfc, optval, optlen))  in isotp_setsockopt_locked()
1425 		if (copy_from_sockptr(&so->force_tx_stmin, optval, optlen))  in isotp_setsockopt_locked()
1433 		if (copy_from_sockptr(&so->force_rx_stmin, optval, optlen))  in isotp_setsockopt_locked()
1455 			memcpy(&so->ll, &ll, sizeof(ll));  in isotp_setsockopt_locked()
1458 			so->tx.ll_dl = ll.tx_dl;  in isotp_setsockopt_locked()
1491 	struct isotp_sock *so = isotp_sk(sk);  in isotp_getsockopt()  local
1505 		val = &so->opt;  in isotp_getsockopt()
1510 		val = &so->rxfc;  in isotp_getsockopt()
1515 		val = &so->force_tx_stmin;  in isotp_getsockopt()
1520 		val = &so->force_rx_stmin;  in isotp_getsockopt()
1525 		val = &so->ll;  in isotp_getsockopt()
1539 static void isotp_notify(struct isotp_sock *so, unsigned long msg,  in isotp_notify()  argument
1542 	struct sock *sk = &so->sk;  in isotp_notify()
1547 	if (so->ifindex != dev->ifindex)  in isotp_notify()
1554 		if (so->bound) {  in isotp_notify()
1555 			if (isotp_register_rxid(so))  in isotp_notify()
1556 				can_rx_unregister(dev_net(dev), dev, so->rxid,  in isotp_notify()
1557 						  SINGLE_MASK(so->rxid),  in isotp_notify()
1560 			can_rx_unregister(dev_net(dev), dev, so->txid,  in isotp_notify()
1561 					  SINGLE_MASK(so->txid),  in isotp_notify()
1565 		so->ifindex = 0;  in isotp_notify()
1566 		so->bound  = 0;  in isotp_notify()
1607 	struct isotp_sock *so = isotp_sk(sk);  in isotp_init()  local
1609 	so->ifindex = 0;  in isotp_init()
1610 	so->bound = 0;  in isotp_init()
1612 	so->opt.flags = CAN_ISOTP_DEFAULT_FLAGS;  in isotp_init()
1613 	so->opt.ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS;  in isotp_init()
1614 	so->opt.rx_ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS;  in isotp_init()
1615 	so->opt.rxpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT;  in isotp_init()
1616 	so->opt.txpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT;  in isotp_init()
1617 	so->opt.frame_txtime = CAN_ISOTP_DEFAULT_FRAME_TXTIME;  in isotp_init()
1618 	so->frame_txtime = CAN_ISOTP_DEFAULT_FRAME_TXTIME;  in isotp_init()
1619 	so->rxfc.bs = CAN_ISOTP_DEFAULT_RECV_BS;  in isotp_init()
1620 	so->rxfc.stmin = CAN_ISOTP_DEFAULT_RECV_STMIN;  in isotp_init()
1621 	so->rxfc.wftmax = CAN_ISOTP_DEFAULT_RECV_WFTMAX;  in isotp_init()
1622 	so->ll.mtu = CAN_ISOTP_DEFAULT_LL_MTU;  in isotp_init()
1623 	so->ll.tx_dl = CAN_ISOTP_DEFAULT_LL_TX_DL;  in isotp_init()
1624 	so->ll.tx_flags = CAN_ISOTP_DEFAULT_LL_TX_FLAGS;  in isotp_init()
1627 	so->tx.ll_dl = so->ll.tx_dl;  in isotp_init()
1629 	so->rx.state = ISOTP_IDLE;  in isotp_init()
1630 	so->tx.state = ISOTP_IDLE;  in isotp_init()
1632 	so->rx.buf = so->rx.sbuf;  in isotp_init()
1633 	so->tx.buf = so->tx.sbuf;  in isotp_init()
1634 	so->rx.buflen = ARRAY_SIZE(so->rx.sbuf);  in isotp_init()
1635 	so->tx.buflen = ARRAY_SIZE(so->tx.sbuf);  in isotp_init()
1637 	hrtimer_init(&so->rxtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT);  in isotp_init()
1638 	so->rxtimer.function = isotp_rx_timer_handler;  in isotp_init()
1639 	hrtimer_init(&so->txtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT);  in isotp_init()
1640 	so->txtimer.function = isotp_tx_timer_handler;  in isotp_init()
1641 	hrtimer_init(&so->txfrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT);  in isotp_init()
1642 	so->txfrtimer.function = isotp_txfr_timer_handler;  in isotp_init()
1644 	init_waitqueue_head(&so->wait);  in isotp_init()
1645 	spin_lock_init(&so->rx_lock);  in isotp_init()
1648 	list_add_tail(&so->notifier, &isotp_notifier_list);  in isotp_init()
1657 	struct isotp_sock *so = isotp_sk(sk);  in isotp_poll()  local
1660 	poll_wait(file, &so->wait, wait);  in isotp_poll()
1663 	if ((mask & EPOLLWRNORM) && (so->tx.state != ISOTP_IDLE))  in isotp_poll()