166 static u32 isotp_bc_flags(struct isotp_sock *so)  in isotp_bc_flags()  argument
168 	return so->opt.flags & ISOTP_ALL_BC_FLAGS;  in isotp_bc_flags()
171 static bool isotp_register_rxid(struct isotp_sock *so)  in isotp_register_rxid()  argument
174 	return (isotp_bc_flags(so) == 0);  in isotp_register_rxid()
177 static bool isotp_register_txecho(struct isotp_sock *so)  in isotp_register_txecho()  argument
180 	return (isotp_bc_flags(so) != CAN_ISOTP_SF_BROADCAST);  in isotp_register_txecho()
185 	struct isotp_sock *so = container_of(hrtimer, struct isotp_sock,  in isotp_rx_timer_handler()  local
187 	struct sock *sk = &so->sk;  in isotp_rx_timer_handler()
189 	if (so->rx.state == ISOTP_WAIT_DATA) {  in isotp_rx_timer_handler()
198 		so->rx.state = ISOTP_IDLE;  in isotp_rx_timer_handler()
209 	struct isotp_sock *so = isotp_sk(sk);  in isotp_send_fc()  local
212 	nskb = alloc_skb(so->ll.mtu + sizeof(struct can_skb_priv), gfp_any());  in isotp_send_fc()
216 	dev = dev_get_by_index(sock_net(sk), so->ifindex);  in isotp_send_fc()
229 	skb_put_zero(nskb, so->ll.mtu);  in isotp_send_fc()
232 	ncf->can_id = so->txid;  in isotp_send_fc()
234 	if (so->opt.flags & CAN_ISOTP_TX_PADDING) {  in isotp_send_fc()
235 		memset(ncf->data, so->opt.txpad_content, CAN_MAX_DLEN);  in isotp_send_fc()
242 	ncf->data[ae + 1] = so->rxfc.bs;  in isotp_send_fc()
243 	ncf->data[ae + 2] = so->rxfc.stmin;  in isotp_send_fc()
246 		ncf->data[0] = so->opt.ext_address;  in isotp_send_fc()
248 	ncf->flags = so->ll.tx_flags;  in isotp_send_fc()
258 	so->rx.bs = 0;  in isotp_send_fc()
261 	so->lastrxcf_tstamp = ktime_set(0, 0);  in isotp_send_fc()
264 	hrtimer_start(&so->rxtimer, ktime_set(ISOTP_FC_TIMEOUT, 0),  in isotp_send_fc()
323 static int check_pad(struct isotp_sock *so, struct canfd_frame *cf,  in check_pad()  argument
329 	if (!(so->opt.flags & CAN_ISOTP_RX_PADDING)) {  in check_pad()
330 		if (so->opt.flags & CAN_ISOTP_CHK_PAD_LEN)  in check_pad()
338 	if ((so->opt.flags & CAN_ISOTP_CHK_PAD_LEN) &&  in check_pad()
343 	if (so->opt.flags & CAN_ISOTP_CHK_PAD_DATA) {  in check_pad()
351 static void isotp_send_cframe(struct isotp_sock *so);
353 static int isotp_rcv_fc(struct isotp_sock *so, struct canfd_frame *cf, int ae)  in isotp_rcv_fc()  argument
355 	struct sock *sk = &so->sk;  in isotp_rcv_fc()
357 	if (so->tx.state != ISOTP_WAIT_FC &&  in isotp_rcv_fc()
358 	    so->tx.state != ISOTP_WAIT_FIRST_FC)  in isotp_rcv_fc()
361 	hrtimer_cancel(&so->txtimer);  in isotp_rcv_fc()
364 	    ((so->opt.flags & ISOTP_CHECK_PADDING) &&  in isotp_rcv_fc()
365 	     check_pad(so, cf, ae + FC_CONTENT_SZ, so->opt.rxpad_content))) {  in isotp_rcv_fc()
371 		so->tx.state = ISOTP_IDLE;  in isotp_rcv_fc()
372 		wake_up_interruptible(&so->wait);  in isotp_rcv_fc()
377 	if (so->tx.state == ISOTP_WAIT_FIRST_FC) {  in isotp_rcv_fc()
378 		so->txfc.bs = cf->data[ae + 1];  in isotp_rcv_fc()
379 		so->txfc.stmin = cf->data[ae + 2];  in isotp_rcv_fc()
382 		if (so->txfc.stmin > 0x7F &&  in isotp_rcv_fc()
383 		    (so->txfc.stmin < 0xF1 || so->txfc.stmin > 0xF9))  in isotp_rcv_fc()
384 			so->txfc.stmin = 0x7F;  in isotp_rcv_fc()
386 		so->tx_gap = ktime_set(0, 0);  in isotp_rcv_fc()
388 		so->tx_gap = ktime_add_ns(so->tx_gap, so->frame_txtime);  in isotp_rcv_fc()
390 		if (so->opt.flags & CAN_ISOTP_FORCE_TXSTMIN)  in isotp_rcv_fc()
391 			so->tx_gap = ktime_add_ns(so->tx_gap,  in isotp_rcv_fc()
392 						  so->force_tx_stmin);  in isotp_rcv_fc()
393 		else if (so->txfc.stmin < 0x80)  in isotp_rcv_fc()
394 			so->tx_gap = ktime_add_ns(so->tx_gap,  in isotp_rcv_fc()
395 						  so->txfc.stmin * 1000000);  in isotp_rcv_fc()
397 			so->tx_gap = ktime_add_ns(so->tx_gap,  in isotp_rcv_fc()
398 						  (so->txfc.stmin - 0xF0)  in isotp_rcv_fc()
400 		so->tx.state = ISOTP_WAIT_FC;  in isotp_rcv_fc()
405 		so->tx.bs = 0;  in isotp_rcv_fc()
406 		so->tx.state = ISOTP_SENDING;  in isotp_rcv_fc()
408 		hrtimer_start(&so->txtimer, ktime_set(ISOTP_ECHO_TIMEOUT, 0),  in isotp_rcv_fc()
410 		isotp_send_cframe(so);  in isotp_rcv_fc()
415 		hrtimer_start(&so->txtimer, ktime_set(ISOTP_FC_TIMEOUT, 0),  in isotp_rcv_fc()
428 		so->tx.state = ISOTP_IDLE;  in isotp_rcv_fc()
429 		wake_up_interruptible(&so->wait);  in isotp_rcv_fc()
437 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv_sf()  local
440 	hrtimer_cancel(&so->rxtimer);  in isotp_rcv_sf()
441 	so->rx.state = ISOTP_IDLE;  in isotp_rcv_sf()
446 	if ((so->opt.flags & ISOTP_CHECK_PADDING) &&  in isotp_rcv_sf()
447 	    check_pad(so, cf, pcilen + len, so->opt.rxpad_content)) {  in isotp_rcv_sf()
469 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv_ff()  local
474 	hrtimer_cancel(&so->rxtimer);  in isotp_rcv_ff()
475 	so->rx.state = ISOTP_IDLE;  in isotp_rcv_ff()
478 	so->rx.ll_dl = padlen(cf->len);  in isotp_rcv_ff()
481 	if (cf->len != so->rx.ll_dl)  in isotp_rcv_ff()
485 	so->rx.len = (cf->data[ae] & 0x0F) << 8;  in isotp_rcv_ff()
486 	so->rx.len += cf->data[ae + 1];  in isotp_rcv_ff()
489 	if (so->rx.len) {  in isotp_rcv_ff()
493 		so->rx.len = cf->data[ae + 2] << 24;  in isotp_rcv_ff()
494 		so->rx.len += cf->data[ae + 3] << 16;  in isotp_rcv_ff()
495 		so->rx.len += cf->data[ae + 4] << 8;  in isotp_rcv_ff()
496 		so->rx.len += cf->data[ae + 5];  in isotp_rcv_ff()
501 	off = (so->rx.ll_dl > CAN_MAX_DLEN) ? 1 : 0;  in isotp_rcv_ff()
503 	if (so->rx.len + ae + off + ff_pci_sz < so->rx.ll_dl)  in isotp_rcv_ff()
506 	if (so->rx.len > MAX_MSG_LENGTH) {  in isotp_rcv_ff()
513 	so->rx.idx = 0;  in isotp_rcv_ff()
514 	for (i = ae + ff_pci_sz; i < so->rx.ll_dl; i++)  in isotp_rcv_ff()
515 		so->rx.buf[so->rx.idx++] = cf->data[i];  in isotp_rcv_ff()
518 	so->rx.sn = 1;  in isotp_rcv_ff()
519 	so->rx.state = ISOTP_WAIT_DATA;  in isotp_rcv_ff()
522 	if (so->opt.flags & CAN_ISOTP_LISTEN_MODE)  in isotp_rcv_ff()
533 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv_cf()  local
537 	if (so->rx.state != ISOTP_WAIT_DATA)  in isotp_rcv_cf()
541 	if (so->opt.flags & CAN_ISOTP_FORCE_RXSTMIN) {  in isotp_rcv_cf()
542 		if (ktime_to_ns(ktime_sub(skb->tstamp, so->lastrxcf_tstamp)) <  in isotp_rcv_cf()
543 		    so->force_rx_stmin)  in isotp_rcv_cf()
546 		so->lastrxcf_tstamp = skb->tstamp;  in isotp_rcv_cf()
549 	hrtimer_cancel(&so->rxtimer);  in isotp_rcv_cf()
552 	if (cf->len > so->rx.ll_dl)  in isotp_rcv_cf()
556 	if (cf->len < so->rx.ll_dl) {  in isotp_rcv_cf()
558 		if (so->rx.len - so->rx.idx > so->rx.ll_dl - ae - N_PCI_SZ)  in isotp_rcv_cf()
562 	if ((cf->data[ae] & 0x0F) != so->rx.sn) {  in isotp_rcv_cf()
569 		so->rx.state = ISOTP_IDLE;  in isotp_rcv_cf()
572 	so->rx.sn++;  in isotp_rcv_cf()
573 	so->rx.sn %= 16;  in isotp_rcv_cf()
576 		so->rx.buf[so->rx.idx++] = cf->data[i];  in isotp_rcv_cf()
577 		if (so->rx.idx >= so->rx.len)  in isotp_rcv_cf()
581 	if (so->rx.idx >= so->rx.len) {  in isotp_rcv_cf()
583 		so->rx.state = ISOTP_IDLE;  in isotp_rcv_cf()
585 		if ((so->opt.flags & ISOTP_CHECK_PADDING) &&  in isotp_rcv_cf()
586 		    check_pad(so, cf, i + 1, so->opt.rxpad_content)) {  in isotp_rcv_cf()
594 		nskb = alloc_skb(so->rx.len, gfp_any());  in isotp_rcv_cf()
598 		memcpy(skb_put(nskb, so->rx.len), so->rx.buf,  in isotp_rcv_cf()
599 		       so->rx.len);  in isotp_rcv_cf()
608 	if (!so->rxfc.bs || ++so->rx.bs < so->rxfc.bs) {  in isotp_rcv_cf()
610 		hrtimer_start(&so->rxtimer, ktime_set(ISOTP_FC_TIMEOUT, 0),  in isotp_rcv_cf()
616 	if (so->opt.flags & CAN_ISOTP_LISTEN_MODE)  in isotp_rcv_cf()
619 	/* we reached the specified blocksize so->rxfc.bs */  in isotp_rcv_cf()
627 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv()  local
629 	int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0;  in isotp_rcv()
635 	if (skb->len != so->ll.mtu)  in isotp_rcv()
641 	if (ae && cf->data[0] != so->opt.rx_ext_address)  in isotp_rcv()
650 	spin_lock(&so->rx_lock);  in isotp_rcv()
652 	if (so->opt.flags & CAN_ISOTP_HALF_DUPLEX) {  in isotp_rcv()
654 		if ((so->tx.state != ISOTP_IDLE && n_pci_type != N_PCI_FC) ||  in isotp_rcv()
655 		    (so->rx.state != ISOTP_IDLE && n_pci_type == N_PCI_FC))  in isotp_rcv()
662 		isotp_rcv_fc(so, cf, ae);  in isotp_rcv()
683 				 * If so take care of the increased SF PCI size  in isotp_rcv()
707 	spin_unlock(&so->rx_lock);  in isotp_rcv()
710 static void isotp_fill_dataframe(struct canfd_frame *cf, struct isotp_sock *so,  in isotp_fill_dataframe()  argument
714 	int space = so->tx.ll_dl - pcilen;  in isotp_fill_dataframe()
715 	int num = min_t(int, so->tx.len - so->tx.idx, space);  in isotp_fill_dataframe()
718 	cf->can_id = so->txid;  in isotp_fill_dataframe()
722 		if (so->opt.flags & CAN_ISOTP_TX_PADDING) {  in isotp_fill_dataframe()
725 			memset(cf->data, so->opt.txpad_content, cf->len);  in isotp_fill_dataframe()
735 		cf->data[pcilen + i] = so->tx.buf[so->tx.idx++];  in isotp_fill_dataframe()
738 		cf->data[0] = so->opt.ext_address;  in isotp_fill_dataframe()
741 static void isotp_send_cframe(struct isotp_sock *so)  in isotp_send_cframe()  argument
743 	struct sock *sk = &so->sk;  in isotp_send_cframe()
748 	int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0;  in isotp_send_cframe()
750 	dev = dev_get_by_index(sock_net(sk), so->ifindex);  in isotp_send_cframe()
754 	skb = alloc_skb(so->ll.mtu + sizeof(struct can_skb_priv), GFP_ATOMIC);  in isotp_send_cframe()
765 	skb_put_zero(skb, so->ll.mtu);  in isotp_send_cframe()
768 	isotp_fill_dataframe(cf, so, ae, 0);  in isotp_send_cframe()
771 	cf->data[ae] = N_PCI_CF | so->tx.sn++;  in isotp_send_cframe()
772 	so->tx.sn %= 16;  in isotp_send_cframe()
773 	so->tx.bs++;  in isotp_send_cframe()
775 	cf->flags = so->ll.tx_flags;  in isotp_send_cframe()
781 	if (so->cfecho)  in isotp_send_cframe()
782 		pr_notice_once("can-isotp: cfecho is %08X != 0\n", so->cfecho);  in isotp_send_cframe()
785 	so->cfecho = *(u32 *)cf->data;  in isotp_send_cframe()
798 static void isotp_create_fframe(struct canfd_frame *cf, struct isotp_sock *so,  in isotp_create_fframe()  argument
804 	cf->can_id = so->txid;  in isotp_create_fframe()
805 	cf->len = so->tx.ll_dl;  in isotp_create_fframe()
807 		cf->data[0] = so->opt.ext_address;  in isotp_create_fframe()
810 	if (so->tx.len > 4095) {  in isotp_create_fframe()
814 		cf->data[ae + 2] = (u8)(so->tx.len >> 24) & 0xFFU;  in isotp_create_fframe()
815 		cf->data[ae + 3] = (u8)(so->tx.len >> 16) & 0xFFU;  in isotp_create_fframe()
816 		cf->data[ae + 4] = (u8)(so->tx.len >> 8) & 0xFFU;  in isotp_create_fframe()
817 		cf->data[ae + 5] = (u8)so->tx.len & 0xFFU;  in isotp_create_fframe()
821 		cf->data[ae] = (u8)(so->tx.len >> 8) | N_PCI_FF;  in isotp_create_fframe()
822 		cf->data[ae + 1] = (u8)so->tx.len & 0xFFU;  in isotp_create_fframe()
827 	for (i = ae + ff_pci_sz; i < so->tx.ll_dl; i++)  in isotp_create_fframe()
828 		cf->data[i] = so->tx.buf[so->tx.idx++];  in isotp_create_fframe()
830 	so->tx.sn = 1;  in isotp_create_fframe()
836 	struct isotp_sock *so = isotp_sk(sk);  in isotp_rcv_echo()  local
840 	if (skb->sk != sk || so->cfecho != *(u32 *)cf->data)  in isotp_rcv_echo()
844 	hrtimer_cancel(&so->txtimer);  in isotp_rcv_echo()
847 	so->cfecho = 0;  in isotp_rcv_echo()
849 	if (so->tx.idx >= so->tx.len) {  in isotp_rcv_echo()
851 		so->tx.state = ISOTP_IDLE;  in isotp_rcv_echo()
852 		wake_up_interruptible(&so->wait);  in isotp_rcv_echo()
856 	if (so->txfc.bs && so->tx.bs >= so->txfc.bs) {  in isotp_rcv_echo()
858 		so->tx.state = ISOTP_WAIT_FC;  in isotp_rcv_echo()
859 		hrtimer_start(&so->txtimer, ktime_set(ISOTP_FC_TIMEOUT, 0),  in isotp_rcv_echo()
865 	if (!so->tx_gap) {  in isotp_rcv_echo()
867 		hrtimer_start(&so->txtimer, ktime_set(ISOTP_ECHO_TIMEOUT, 0),  in isotp_rcv_echo()
869 		isotp_send_cframe(so);  in isotp_rcv_echo()
874 	hrtimer_start(&so->txtimer, so->tx_gap, HRTIMER_MODE_REL_SOFT);  in isotp_rcv_echo()
879 	struct isotp_sock *so = container_of(hrtimer, struct isotp_sock,  in isotp_tx_timer_handler()  local
881 	struct sock *sk = &so->sk;  in isotp_tx_timer_handler()
884 	switch (so->tx.state) {  in isotp_tx_timer_handler()
888 		if (!so->cfecho) {  in isotp_tx_timer_handler()
890 			hrtimer_set_expires(&so->txtimer,  in isotp_tx_timer_handler()
896 			isotp_send_cframe(so);  in isotp_tx_timer_handler()
901 		pr_notice_once("can-isotp: cfecho %08X timeout\n", so->cfecho);  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()
921 			  so->tx.state, so->cfecho);  in isotp_tx_timer_handler()
930 	struct isotp_sock *so = isotp_sk(sk);  in isotp_sendmsg()  local
931 	u32 old_state = so->tx.state;  in isotp_sendmsg()
935 	int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0;  in isotp_sendmsg()
936 	int wait_tx_done = (so->opt.flags & CAN_ISOTP_WAIT_TX_DONE) ? 1 : 0;  in isotp_sendmsg()
941 	if (!so->bound)  in isotp_sendmsg()
945 	if (cmpxchg(&so->tx.state, ISOTP_IDLE, ISOTP_SENDING) != ISOTP_IDLE ||  in isotp_sendmsg()
946 	    wq_has_sleeper(&so->wait)) {  in isotp_sendmsg()
953 		err = wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE);  in isotp_sendmsg()
957 		so->tx.state = ISOTP_SENDING;  in isotp_sendmsg()
966 	off = (so->tx.ll_dl > CAN_MAX_DLEN) ? 1 : 0;  in isotp_sendmsg()
969 	if ((isotp_bc_flags(so) == CAN_ISOTP_SF_BROADCAST) &&  in isotp_sendmsg()
970 	    (size > so->tx.ll_dl - SF_PCI_SZ4 - ae - off)) {  in isotp_sendmsg()
975 	err = memcpy_from_msg(so->tx.buf, msg, size);  in isotp_sendmsg()
979 	dev = dev_get_by_index(sock_net(sk), so->ifindex);  in isotp_sendmsg()
985 	skb = sock_alloc_send_skb(sk, so->ll.mtu + sizeof(struct can_skb_priv),  in isotp_sendmsg()
996 	so->tx.len = size;  in isotp_sendmsg()
997 	so->tx.idx = 0;  in isotp_sendmsg()
1000 	skb_put_zero(skb, so->ll.mtu);  in isotp_sendmsg()
1003 	if (so->cfecho)  in isotp_sendmsg()
1004 		pr_notice_once("can-isotp: uninit cfecho %08X\n", so->cfecho);  in isotp_sendmsg()
1007 	if (size <= so->tx.ll_dl - SF_PCI_SZ4 - ae - off) {  in isotp_sendmsg()
1020 		isotp_fill_dataframe(cf, so, ae, off);  in isotp_sendmsg()
1032 		so->cfecho = *(u32 *)cf->data;  in isotp_sendmsg()
1036 		isotp_create_fframe(cf, so, ae);  in isotp_sendmsg()
1038 		if (isotp_bc_flags(so) == CAN_ISOTP_CF_BROADCAST) {  in isotp_sendmsg()
1040 			if (so->opt.flags & CAN_ISOTP_FORCE_TXSTMIN)  in isotp_sendmsg()
1041 				so->tx_gap = ktime_set(0, so->force_tx_stmin);  in isotp_sendmsg()
1043 				so->tx_gap = ktime_set(0, so->frame_txtime);  in isotp_sendmsg()
1046 			so->txfc.bs = 0;  in isotp_sendmsg()
1049 			so->cfecho = *(u32 *)cf->data;  in isotp_sendmsg()
1052 			so->tx.state = ISOTP_WAIT_FIRST_FC;  in isotp_sendmsg()
1058 			so->cfecho = 0;  in isotp_sendmsg()
1062 	hrtimer_start(&so->txtimer, ktime_set(hrtimer_sec, 0),  in isotp_sendmsg()
1066 	cf->flags = so->ll.tx_flags;  in isotp_sendmsg()
1077 		hrtimer_cancel(&so->txtimer);  in isotp_sendmsg()
1080 		so->cfecho = 0;  in isotp_sendmsg()
1087 		wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE);  in isotp_sendmsg()
1099 	so->tx.state = old_state;  in isotp_sendmsg()
1100 	if (so->tx.state == ISOTP_IDLE)  in isotp_sendmsg()
1101 		wake_up_interruptible(&so->wait);  in isotp_sendmsg()
1111 	struct isotp_sock *so = isotp_sk(sk);  in isotp_recvmsg()  local
1117 	if (!so->bound)  in isotp_recvmsg()
1153 	struct isotp_sock *so;  in isotp_release()  local
1159 	so = isotp_sk(sk);  in isotp_release()
1163 	wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE);  in isotp_release()
1166 	while (isotp_busy_notifier == so) {  in isotp_release()
1171 	list_del(&so->notifier);  in isotp_release()
1177 	if (so->bound && isotp_register_txecho(so)) {  in isotp_release()
1178 		if (so->ifindex) {  in isotp_release()
1181 			dev = dev_get_by_index(net, so->ifindex);  in isotp_release()
1183 				if (isotp_register_rxid(so))  in isotp_release()
1184 					can_rx_unregister(net, dev, so->rxid,  in isotp_release()
1185 							  SINGLE_MASK(so->rxid),  in isotp_release()
1188 				can_rx_unregister(net, dev, so->txid,  in isotp_release()
1189 						  SINGLE_MASK(so->txid),  in isotp_release()
1197 	hrtimer_cancel(&so->txtimer);  in isotp_release()
1198 	hrtimer_cancel(&so->rxtimer);  in isotp_release()
1200 	so->ifindex = 0;  in isotp_release()
1201 	so->bound = 0;  in isotp_release()
1216 	struct isotp_sock *so = isotp_sk(sk);  in isotp_bind()  local
1239 	if (isotp_register_rxid(so)) {  in isotp_bind()
1255 	if (so->bound) {  in isotp_bind()
1261 	if (isotp_register_rxid(so) && rx_id == tx_id) {  in isotp_bind()
1276 	if (dev->mtu < so->ll.mtu) {  in isotp_bind()
1286 	if (isotp_register_rxid(so))  in isotp_bind()
1290 	if (isotp_register_txecho(so)) {  in isotp_bind()
1292 		so->cfecho = 0;  in isotp_bind()
1302 	so->ifindex = ifindex;  in isotp_bind()
1303 	so->rxid = rx_id;  in isotp_bind()
1304 	so->txid = tx_id;  in isotp_bind()
1305 	so->bound = 1;  in isotp_bind()
1323 	struct isotp_sock *so = isotp_sk(sk);  in isotp_getname()  local
1330 	addr->can_ifindex = so->ifindex;  in isotp_getname()
1331 	addr->can_addr.tp.rx_id = so->rxid;  in isotp_getname()
1332 	addr->can_addr.tp.tx_id = so->txid;  in isotp_getname()
1341 	struct isotp_sock *so = isotp_sk(sk);  in isotp_setsockopt_locked()  local
1344 	if (so->bound)  in isotp_setsockopt_locked()
1352 		if (copy_from_sockptr(&so->opt, optval, optlen))  in isotp_setsockopt_locked()
1356 		if (!(so->opt.flags & CAN_ISOTP_RX_EXT_ADDR))  in isotp_setsockopt_locked()
1357 			so->opt.rx_ext_address = so->opt.ext_address;  in isotp_setsockopt_locked()
1360 		if (isotp_bc_flags(so) == ISOTP_ALL_BC_FLAGS) {  in isotp_setsockopt_locked()
1362 			so->opt.flags &= ~CAN_ISOTP_CF_BROADCAST;  in isotp_setsockopt_locked()
1369 		if (so->opt.frame_txtime) {  in isotp_setsockopt_locked()
1370 			if (so->opt.frame_txtime == CAN_ISOTP_FRAME_TXTIME_ZERO)  in isotp_setsockopt_locked()
1371 				so->frame_txtime = 0;  in isotp_setsockopt_locked()
1373 				so->frame_txtime = so->opt.frame_txtime;  in isotp_setsockopt_locked()
1381 		if (copy_from_sockptr(&so->rxfc, optval, optlen))  in isotp_setsockopt_locked()
1389 		if (copy_from_sockptr(&so->force_tx_stmin, optval, optlen))  in isotp_setsockopt_locked()
1397 		if (copy_from_sockptr(&so->force_rx_stmin, optval, optlen))  in isotp_setsockopt_locked()
1419 			memcpy(&so->ll, &ll, sizeof(ll));  in isotp_setsockopt_locked()
1422 			so->tx.ll_dl = ll.tx_dl;  in isotp_setsockopt_locked()
1455 	struct isotp_sock *so = isotp_sk(sk);  in isotp_getsockopt()  local
1469 		val = &so->opt;  in isotp_getsockopt()
1474 		val = &so->rxfc;  in isotp_getsockopt()
1479 		val = &so->force_tx_stmin;  in isotp_getsockopt()
1484 		val = &so->force_rx_stmin;  in isotp_getsockopt()
1489 		val = &so->ll;  in isotp_getsockopt()
1503 static void isotp_notify(struct isotp_sock *so, unsigned long msg,  in isotp_notify()  argument
1506 	struct sock *sk = &so->sk;  in isotp_notify()
1511 	if (so->ifindex != dev->ifindex)  in isotp_notify()
1518 		if (so->bound && isotp_register_txecho(so)) {  in isotp_notify()
1519 			if (isotp_register_rxid(so))  in isotp_notify()
1520 				can_rx_unregister(dev_net(dev), dev, so->rxid,  in isotp_notify()
1521 						  SINGLE_MASK(so->rxid),  in isotp_notify()
1524 			can_rx_unregister(dev_net(dev), dev, so->txid,  in isotp_notify()
1525 					  SINGLE_MASK(so->txid),  in isotp_notify()
1529 		so->ifindex = 0;  in isotp_notify()
1530 		so->bound  = 0;  in isotp_notify()
1571 	struct isotp_sock *so = isotp_sk(sk);  in isotp_init()  local
1573 	so->ifindex = 0;  in isotp_init()
1574 	so->bound = 0;  in isotp_init()
1576 	so->opt.flags = CAN_ISOTP_DEFAULT_FLAGS;  in isotp_init()
1577 	so->opt.ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS;  in isotp_init()
1578 	so->opt.rx_ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS;  in isotp_init()
1579 	so->opt.rxpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT;  in isotp_init()
1580 	so->opt.txpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT;  in isotp_init()
1581 	so->opt.frame_txtime = CAN_ISOTP_DEFAULT_FRAME_TXTIME;  in isotp_init()
1582 	so->frame_txtime = CAN_ISOTP_DEFAULT_FRAME_TXTIME;  in isotp_init()
1583 	so->rxfc.bs = CAN_ISOTP_DEFAULT_RECV_BS;  in isotp_init()
1584 	so->rxfc.stmin = CAN_ISOTP_DEFAULT_RECV_STMIN;  in isotp_init()
1585 	so->rxfc.wftmax = CAN_ISOTP_DEFAULT_RECV_WFTMAX;  in isotp_init()
1586 	so->ll.mtu = CAN_ISOTP_DEFAULT_LL_MTU;  in isotp_init()
1587 	so->ll.tx_dl = CAN_ISOTP_DEFAULT_LL_TX_DL;  in isotp_init()
1588 	so->ll.tx_flags = CAN_ISOTP_DEFAULT_LL_TX_FLAGS;  in isotp_init()
1591 	so->tx.ll_dl = so->ll.tx_dl;  in isotp_init()
1593 	so->rx.state = ISOTP_IDLE;  in isotp_init()
1594 	so->tx.state = ISOTP_IDLE;  in isotp_init()
1596 	hrtimer_init(&so->rxtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT);  in isotp_init()
1597 	so->rxtimer.function = isotp_rx_timer_handler;  in isotp_init()
1598 	hrtimer_init(&so->txtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT);  in isotp_init()
1599 	so->txtimer.function = isotp_tx_timer_handler;  in isotp_init()
1601 	init_waitqueue_head(&so->wait);  in isotp_init()
1602 	spin_lock_init(&so->rx_lock);  in isotp_init()
1605 	list_add_tail(&so->notifier, &isotp_notifier_list);  in isotp_init()