Lines Matching +full:wait +full:- +full:state
1 // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
2 /* isotp.c - ISO 15765-2 CAN transport protocol for protocol family CAN
4 * This implementation does not provide ISO-TP specific return values to the
7 * - RX path timeout of data reception leads to -ETIMEDOUT
8 * - RX path SN mismatch leads to -EILSEQ
9 * - RX path data reception with wrong padding leads to -EBADMSG
10 * - TX path flowcontrol reception timeout leads to -ECOMM
11 * - TX path flowcontrol reception overflow leads to -EMSGSIZE
12 * - TX path flowcontrol reception with wrong layout/padding leads to -EBADMSG
13 * - when a transfer (tx) is on the run the next write() blocks until it's done
14 * - use CAN_ISOTP_WAIT_TX_DONE flag to block the caller until the PDU is sent
15 * - as we have static buffers the check whether the PDU fits into the buffer
16 * is done at FF reception time (no support for sending 'wait frames')
60 #include <linux/wait.h>
75 MODULE_DESCRIPTION("PF_CAN ISO 15765-2 transport protocol");
78 MODULE_ALIAS("can-proto-6");
86 /* Since ISO 15765-2:2016 the CAN isotp protocol supports more than 4095
94 /* maximum PDU size before ISO 15765-2:2016 extension was 4095 */
105 /* N_PCI type values in bits 7-4 of N_PCI bytes */
123 #define ISOTP_FC_WT 1 /* wait */
143 u32 state; member
168 wait_queue_head_t wait; member
169 spinlock_t rx_lock; /* protect single thread state machine */
183 return so->opt.flags & ISOTP_ALL_BC_FLAGS; in isotp_bc_flags()
196 struct sock *sk = &so->sk; in isotp_rx_timer_handler()
198 if (so->rx.state == ISOTP_WAIT_DATA) { in isotp_rx_timer_handler()
202 sk->sk_err = ETIMEDOUT; in isotp_rx_timer_handler()
206 /* reset rx state */ in isotp_rx_timer_handler()
207 so->rx.state = ISOTP_IDLE; in isotp_rx_timer_handler()
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()
232 can_skb_prv(nskb)->ifindex = dev->ifindex; in isotp_send_fc()
233 can_skb_prv(nskb)->skbcnt = 0; in isotp_send_fc()
235 nskb->dev = dev; in isotp_send_fc()
237 ncf = (struct canfd_frame *)nskb->data; 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()
245 ncf->len = CAN_MAX_DLEN; in isotp_send_fc()
247 ncf->len = ae + FC_CONTENT_SZ; in isotp_send_fc()
250 ncf->data[ae] = N_PCI_FC | flowstatus; 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()
261 pr_notice_once("can-isotp: %s: can_send_ret %pe\n", 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()
280 struct sockaddr_can *addr = (struct sockaddr_can *)skb->cb; in isotp_rcv_skb()
282 BUILD_BUG_ON(sizeof(skb->cb) < sizeof(struct sockaddr_can)); in isotp_rcv_skb()
285 addr->can_family = AF_CAN; in isotp_rcv_skb()
286 addr->can_ifindex = skb->dev->ifindex; in isotp_rcv_skb()
295 8, 8, 8, 8, 8, 8, 8, 8, 8, /* 0 - 8 */ in padlen()
296 12, 12, 12, 12, /* 9 - 12 */ in padlen()
297 16, 16, 16, 16, /* 13 - 16 */ in padlen()
298 20, 20, 20, 20, /* 17 - 20 */ in padlen()
299 24, 24, 24, 24, /* 21 - 24 */ in padlen()
300 32, 32, 32, 32, 32, 32, 32, 32, /* 25 - 32 */ in padlen()
301 48, 48, 48, 48, 48, 48, 48, 48, /* 33 - 40 */ in padlen()
302 48, 48, 48, 48, 48, 48, 48, 48 /* 41 - 48 */ in padlen()
316 * start at cf.data[7] cf->len has to be 7 to be optimal. in check_optimized()
319 if (cf->len <= CAN_MAX_DLEN) in check_optimized()
320 return (cf->len != start_index); in check_optimized()
322 /* This relation is also valid in the non-linear DLC range, where in check_optimized()
324 * The correct check would be (padlen(cf->len) != padlen(start_index)). in check_optimized()
325 * But as cf->len can only take discrete values from 12, .., 64 at this in check_optimized()
326 * point the padlen(cf->len) is always equal to cf->len. in check_optimized()
328 return (cf->len != padlen(start_index)); in check_optimized()
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()
348 cf->len != padlen(cf->len)) in check_pad()
352 if (so->opt.flags & CAN_ISOTP_CHK_PAD_DATA) { in check_pad()
353 for (i = start_index; i < cf->len; i++) in check_pad()
354 if (cf->data[i] != content) in check_pad()
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()
372 if ((cf->len < ae + FC_CONTENT_SZ) || 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()
375 /* malformed PDU - report 'not a data message' */ in isotp_rcv_fc()
376 sk->sk_err = EBADMSG; 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()
413 switch (cf->data[ae] & 0x0F) { 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()
424 /* start timer to wait for next FC frame */ in isotp_rcv_fc()
425 hrtimer_start(&so->txtimer, ktime_set(ISOTP_FC_TIMEOUT, 0), in isotp_rcv_fc()
430 /* overflow on receiver side - report 'message too long' */ in isotp_rcv_fc()
431 sk->sk_err = EMSGSIZE; in isotp_rcv_fc()
438 so->tx.state = ISOTP_IDLE; in isotp_rcv_fc()
439 wake_up_interruptible(&so->wait); in isotp_rcv_fc()
450 hrtimer_cancel(&so->rxtimer); in isotp_rcv_sf()
451 so->rx.state = ISOTP_IDLE; in isotp_rcv_sf()
453 if (!len || len > cf->len - pcilen) 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()
458 /* malformed PDU - report 'not a data message' */ in isotp_rcv_sf()
459 sk->sk_err = EBADMSG; in isotp_rcv_sf()
469 memcpy(skb_put(nskb, len), &cf->data[pcilen], len); in isotp_rcv_sf()
471 nskb->tstamp = skb->tstamp; in isotp_rcv_sf()
472 nskb->dev = skb->dev; in isotp_rcv_sf()
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()
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()
583 /* wrong sn detected - report 'illegal byte sequence' */ in isotp_rcv_cf()
584 sk->sk_err = EILSEQ; in isotp_rcv_cf()
588 /* reset rx state */ 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()
595 for (i = ae + N_PCI_SZ; i < cf->len; i++) { 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()
607 /* malformed PDU - report 'not a data message' */ in isotp_rcv_cf()
608 sk->sk_err = EBADMSG; 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()
621 nskb->tstamp = skb->tstamp; in isotp_rcv_cf()
622 nskb->dev = skb->dev; 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()
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()
658 cf = (struct canfd_frame *)skb->data; in isotp_rcv()
661 if (ae && cf->data[0] != so->opt.rx_ext_address) in isotp_rcv()
664 n_pci_type = cf->data[ae] & 0xF0; in isotp_rcv()
666 /* Make sure the state changes and data structures stay consistent at 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()
690 * requirements - no matter if it's CAN 2.0 or CAN FD in isotp_rcv()
694 sf_dl = cf->data[ae] & 0x0F; in isotp_rcv()
696 if (cf->len <= CAN_MAX_DLEN) { in isotp_rcv()
710 cf->data[SF_PCI_SZ4 + ae]); in isotp_rcv()
727 spin_unlock(&so->rx_lock); in isotp_rcv()
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()
739 cf->len = num + pcilen; in isotp_fill_dataframe()
742 if (so->opt.flags & CAN_ISOTP_TX_PADDING) { in isotp_fill_dataframe()
744 cf->len = padlen(cf->len); in isotp_fill_dataframe()
745 memset(cf->data, so->opt.txpad_content, cf->len); in isotp_fill_dataframe()
746 } else if (cf->len > CAN_MAX_DLEN) { in isotp_fill_dataframe()
748 cf->len = padlen(cf->len); in isotp_fill_dataframe()
749 memset(cf->data, CAN_ISOTP_DEFAULT_PAD_CONTENT, in isotp_fill_dataframe()
750 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()
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()
781 can_skb_prv(skb)->ifindex = dev->ifindex; in isotp_send_cframe()
782 can_skb_prv(skb)->skbcnt = 0; in isotp_send_cframe()
784 cf = (struct canfd_frame *)skb->data; in isotp_send_cframe()
785 skb_put_zero(skb, so->ll.mtu); 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()
797 skb->dev = dev; 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()
810 pr_notice_once("can-isotp: %s: can_send_ret %pe\n", in isotp_send_cframe()
812 if (can_send_ret == -ENOBUFS) in isotp_send_cframe()
813 pr_notice_once("can-isotp: tx queue is full\n"); in isotp_send_cframe()
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()
832 cf->data[ae] = N_PCI_FF; in isotp_create_fframe()
833 cf->data[ae + 1] = 0; 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()
857 struct canfd_frame *cf = (struct canfd_frame *)skb->data; in isotp_rcv_echo()
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()
877 /* stop and wait for FC with timeout */ 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()
894 hrtimer_start(&so->txfrtimer, so->tx_gap, HRTIMER_MODE_REL_SOFT); in isotp_rcv_echo()
901 struct sock *sk = &so->sk; in isotp_tx_timer_handler()
903 /* don't handle timeouts in IDLE or SHUTDOWN state */ in isotp_tx_timer_handler()
904 if (so->tx.state == ISOTP_IDLE || so->tx.state == ISOTP_SHUTDOWN) in isotp_tx_timer_handler()
910 sk->sk_err = ECOMM; in isotp_tx_timer_handler()
914 /* reset tx state */ 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()
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()
939 struct sock *sk = sock->sk; in isotp_sendmsg()
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()
951 return -EADDRNOTAVAIL; in isotp_sendmsg()
953 while (cmpxchg(&so->tx.state, ISOTP_IDLE, ISOTP_SENDING) != ISOTP_IDLE) { in isotp_sendmsg()
954 /* we do not support multiple buffers - for now */ in isotp_sendmsg()
955 if (msg->msg_flags & MSG_DONTWAIT) in isotp_sendmsg()
956 return -EAGAIN; in isotp_sendmsg()
958 if (so->tx.state == ISOTP_SHUTDOWN) in isotp_sendmsg()
959 return -EADDRNOTAVAIL; in isotp_sendmsg()
961 /* wait for complete transmission of current pdu */ 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()
978 err = -EINVAL; in isotp_sendmsg()
983 off = (so->tx.ll_dl > CAN_MAX_DLEN) ? 1 : 0; in isotp_sendmsg()
987 (size > so->tx.ll_dl - SF_PCI_SZ4 - ae - off)) { in isotp_sendmsg()
988 err = -EINVAL; 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()
998 err = -ENXIO; in isotp_sendmsg()
1002 skb = sock_alloc_send_skb(sk, so->ll.mtu + sizeof(struct can_skb_priv), in isotp_sendmsg()
1003 msg->msg_flags & MSG_DONTWAIT, &err); in isotp_sendmsg()
1010 can_skb_prv(skb)->ifindex = dev->ifindex; in isotp_sendmsg()
1011 can_skb_prv(skb)->skbcnt = 0; in isotp_sendmsg()
1013 so->tx.len = size; in isotp_sendmsg()
1014 so->tx.idx = 0; in isotp_sendmsg()
1016 cf = (struct canfd_frame *)skb->data; 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()
1025 /* The message size generally fits into a SingleFrame - good. in isotp_sendmsg()
1034 if (size <= CAN_MAX_DLEN - SF_PCI_SZ4 - ae) in isotp_sendmsg()
1040 cf->data[ae] = N_PCI_SF; in isotp_sendmsg()
1044 cf->data[SF_PCI_SZ4 + ae] = size; in isotp_sendmsg()
1046 cf->data[ae] |= size; in isotp_sendmsg()
1048 /* set CF echo tag for isotp_rcv_echo() (SF-mode) */ in isotp_sendmsg()
1049 so->cfecho = *(u32 *)cf->data; in isotp_sendmsg()
1056 /* set timer for FC-less operation (STmin = 0) */ 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()
1062 /* disable wait for FCs due to activated block size */ in isotp_sendmsg()
1063 so->txfc.bs = 0; in isotp_sendmsg()
1065 /* set CF echo tag for isotp_rcv_echo() (CF-mode) */ in isotp_sendmsg()
1066 so->cfecho = *(u32 *)cf->data; in isotp_sendmsg()
1069 so->tx.state = ISOTP_WAIT_FIRST_FC; in isotp_sendmsg()
1074 /* no CF echo tag for isotp_rcv_echo() (FF-mode) */ 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()
1085 skb->dev = dev; in isotp_sendmsg()
1086 skb->sk = sk; in isotp_sendmsg()
1090 pr_notice_once("can-isotp: %s: can_send_ret %pe\n", in isotp_sendmsg()
1093 /* no transmission -> no timeout monitoring */ in isotp_sendmsg()
1094 hrtimer_cancel(&so->txtimer); in isotp_sendmsg()
1097 so->cfecho = 0; in isotp_sendmsg()
1103 /* wait for complete transmission of current pdu */ in isotp_sendmsg()
1104 err = wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE); in isotp_sendmsg()
1116 /* got signal: force tx state machine to be 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()
1121 /* drop this PDU and unlock a potential wait queue */ in isotp_sendmsg()
1122 so->tx.state = ISOTP_IDLE; in isotp_sendmsg()
1123 wake_up_interruptible(&so->wait); in isotp_sendmsg()
1131 struct sock *sk = sock->sk; in isotp_recvmsg()
1137 return -EINVAL; in isotp_recvmsg()
1139 if (!so->bound) in isotp_recvmsg()
1140 return -EADDRNOTAVAIL; in isotp_recvmsg()
1146 if (size < skb->len) in isotp_recvmsg()
1147 msg->msg_flags |= MSG_TRUNC; in isotp_recvmsg()
1149 size = skb->len; in isotp_recvmsg()
1151 ret = memcpy_to_msg(msg, skb->data, size); in isotp_recvmsg()
1157 if (msg->msg_name) { in isotp_recvmsg()
1159 msg->msg_namelen = ISOTP_MIN_NAMELEN; in isotp_recvmsg()
1160 memcpy(msg->msg_name, skb->cb, msg->msg_namelen); in isotp_recvmsg()
1164 ret = (flags & MSG_TRUNC) ? skb->len : size; in isotp_recvmsg()
1174 struct sock *sk = sock->sk; in isotp_release()
1184 /* wait for complete transmission of current pdu */ 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()
1189 /* force state machines to be idle also when a signal occurred */ in isotp_release()
1190 so->tx.state = ISOTP_SHUTDOWN; in isotp_release()
1191 so->rx.state = ISOTP_IDLE; 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()
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()
1239 sock->sk = NULL; in isotp_release()
1242 sock_prot_inuse_add(net, sk->sk_prot, -1); in isotp_release()
1251 struct sock *sk = sock->sk; in isotp_bind()
1256 canid_t tx_id = addr->can_addr.tp.tx_id; in isotp_bind()
1257 canid_t rx_id = addr->can_addr.tp.rx_id; in isotp_bind()
1262 return -EINVAL; in isotp_bind()
1264 if (addr->can_family != AF_CAN) in isotp_bind()
1265 return -EINVAL; in isotp_bind()
1273 /* give feedback on wrong CAN-ID value */ in isotp_bind()
1274 if (tx_id != addr->can_addr.tp.tx_id) in isotp_bind()
1275 return -EINVAL; in isotp_bind()
1284 /* give feedback on wrong CAN-ID value */ in isotp_bind()
1285 if (rx_id != addr->can_addr.tp.rx_id) in isotp_bind()
1286 return -EINVAL; in isotp_bind()
1289 if (!addr->can_ifindex) in isotp_bind()
1290 return -ENODEV; in isotp_bind()
1294 if (so->bound) { in isotp_bind()
1295 err = -EINVAL; in isotp_bind()
1301 err = -EADDRNOTAVAIL; in isotp_bind()
1305 dev = dev_get_by_index(net, addr->can_ifindex); in isotp_bind()
1307 err = -ENODEV; in isotp_bind()
1310 if (dev->type != ARPHRD_CAN) { in isotp_bind()
1312 err = -ENODEV; in isotp_bind()
1315 if (dev->mtu < so->ll.mtu) { in isotp_bind()
1317 err = -EINVAL; in isotp_bind()
1320 if (!(dev->flags & IFF_UP)) in isotp_bind()
1323 ifindex = dev->ifindex; in isotp_bind()
1330 so->cfecho = 0; in isotp_bind()
1339 so->ifindex = ifindex; in isotp_bind()
1340 so->rxid = rx_id; in isotp_bind()
1341 so->txid = tx_id; in isotp_bind()
1342 so->bound = 1; in isotp_bind()
1348 sk->sk_err = ENETDOWN; in isotp_bind()
1359 struct sock *sk = sock->sk; in isotp_getname()
1363 return -EOPNOTSUPP; in isotp_getname()
1366 addr->can_family = AF_CAN; in isotp_getname()
1367 addr->can_ifindex = so->ifindex; in isotp_getname()
1368 addr->can_addr.tp.rx_id = so->rxid; in isotp_getname()
1369 addr->can_addr.tp.tx_id = so->txid; in isotp_getname()
1377 struct sock *sk = sock->sk; in isotp_setsockopt_locked()
1381 if (so->bound) in isotp_setsockopt_locked()
1382 return -EISCONN; in isotp_setsockopt_locked()
1387 return -EINVAL; in isotp_setsockopt_locked()
1389 if (copy_from_sockptr(&so->opt, optval, optlen)) in isotp_setsockopt_locked()
1390 return -EFAULT; in isotp_setsockopt_locked()
1393 if (!(so->opt.flags & CAN_ISOTP_RX_EXT_ADDR)) in isotp_setsockopt_locked()
1394 so->opt.rx_ext_address = so->opt.ext_address; in isotp_setsockopt_locked()
1399 so->opt.flags &= ~CAN_ISOTP_CF_BROADCAST; in isotp_setsockopt_locked()
1402 ret = -EINVAL; in isotp_setsockopt_locked()
1406 if (so->opt.frame_txtime) { in isotp_setsockopt_locked()
1407 if (so->opt.frame_txtime == CAN_ISOTP_FRAME_TXTIME_ZERO) in isotp_setsockopt_locked()
1408 so->frame_txtime = 0; in isotp_setsockopt_locked()
1410 so->frame_txtime = so->opt.frame_txtime; in isotp_setsockopt_locked()
1416 return -EINVAL; in isotp_setsockopt_locked()
1418 if (copy_from_sockptr(&so->rxfc, optval, optlen)) in isotp_setsockopt_locked()
1419 return -EFAULT; in isotp_setsockopt_locked()
1424 return -EINVAL; in isotp_setsockopt_locked()
1426 if (copy_from_sockptr(&so->force_tx_stmin, optval, optlen)) in isotp_setsockopt_locked()
1427 return -EFAULT; in isotp_setsockopt_locked()
1432 return -EINVAL; in isotp_setsockopt_locked()
1434 if (copy_from_sockptr(&so->force_rx_stmin, optval, optlen)) in isotp_setsockopt_locked()
1435 return -EFAULT; in isotp_setsockopt_locked()
1443 return -EFAULT; in isotp_setsockopt_locked()
1445 /* check for correct ISO 11898-1 DLC data length */ in isotp_setsockopt_locked()
1447 return -EINVAL; in isotp_setsockopt_locked()
1450 return -EINVAL; in isotp_setsockopt_locked()
1454 return -EINVAL; in isotp_setsockopt_locked()
1456 memcpy(&so->ll, &ll, sizeof(ll)); in isotp_setsockopt_locked()
1459 so->tx.ll_dl = ll.tx_dl; in isotp_setsockopt_locked()
1461 return -EINVAL; in isotp_setsockopt_locked()
1466 ret = -ENOPROTOOPT; in isotp_setsockopt_locked()
1476 struct sock *sk = sock->sk; in isotp_setsockopt()
1480 return -EINVAL; in isotp_setsockopt()
1491 struct sock *sk = sock->sk; in isotp_getsockopt()
1497 return -EINVAL; in isotp_getsockopt()
1499 return -EFAULT; in isotp_getsockopt()
1501 return -EINVAL; in isotp_getsockopt()
1506 val = &so->opt; in isotp_getsockopt()
1511 val = &so->rxfc; in isotp_getsockopt()
1516 val = &so->force_tx_stmin; in isotp_getsockopt()
1521 val = &so->force_rx_stmin; in isotp_getsockopt()
1526 val = &so->ll; in isotp_getsockopt()
1530 return -ENOPROTOOPT; in isotp_getsockopt()
1534 return -EFAULT; in isotp_getsockopt()
1536 return -EFAULT; in isotp_getsockopt()
1543 struct sock *sk = &so->sk; in isotp_notify()
1548 if (so->ifindex != dev->ifindex) in isotp_notify()
1555 if (so->bound) { in isotp_notify()
1557 can_rx_unregister(dev_net(dev), dev, so->rxid, in isotp_notify()
1558 SINGLE_MASK(so->rxid), in isotp_notify()
1561 can_rx_unregister(dev_net(dev), dev, so->txid, in isotp_notify()
1562 SINGLE_MASK(so->txid), in isotp_notify()
1566 so->ifindex = 0; in isotp_notify()
1567 so->bound = 0; in isotp_notify()
1570 sk->sk_err = ENODEV; in isotp_notify()
1576 sk->sk_err = ENETDOWN; in isotp_notify()
1588 if (dev->type != ARPHRD_CAN) in isotp_notifier()
1610 so->ifindex = 0; in isotp_init()
1611 so->bound = 0; in isotp_init()
1613 so->opt.flags = CAN_ISOTP_DEFAULT_FLAGS; in isotp_init()
1614 so->opt.ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS; in isotp_init()
1615 so->opt.rx_ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS; in isotp_init()
1616 so->opt.rxpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT; in isotp_init()
1617 so->opt.txpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT; in isotp_init()
1618 so->opt.frame_txtime = CAN_ISOTP_DEFAULT_FRAME_TXTIME; in isotp_init()
1619 so->frame_txtime = CAN_ISOTP_DEFAULT_FRAME_TXTIME; in isotp_init()
1620 so->rxfc.bs = CAN_ISOTP_DEFAULT_RECV_BS; in isotp_init()
1621 so->rxfc.stmin = CAN_ISOTP_DEFAULT_RECV_STMIN; in isotp_init()
1622 so->rxfc.wftmax = CAN_ISOTP_DEFAULT_RECV_WFTMAX; in isotp_init()
1623 so->ll.mtu = CAN_ISOTP_DEFAULT_LL_MTU; in isotp_init()
1624 so->ll.tx_dl = CAN_ISOTP_DEFAULT_LL_TX_DL; in isotp_init()
1625 so->ll.tx_flags = CAN_ISOTP_DEFAULT_LL_TX_FLAGS; in isotp_init()
1628 so->tx.ll_dl = so->ll.tx_dl; in isotp_init()
1630 so->rx.state = ISOTP_IDLE; in isotp_init()
1631 so->tx.state = ISOTP_IDLE; in isotp_init()
1633 so->rx.buf = so->rx.sbuf; in isotp_init()
1634 so->tx.buf = so->tx.sbuf; in isotp_init()
1635 so->rx.buflen = ARRAY_SIZE(so->rx.sbuf); in isotp_init()
1636 so->tx.buflen = ARRAY_SIZE(so->tx.sbuf); in isotp_init()
1638 hrtimer_setup(&so->rxtimer, isotp_rx_timer_handler, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT); in isotp_init()
1639 hrtimer_setup(&so->txtimer, isotp_tx_timer_handler, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT); in isotp_init()
1640 hrtimer_setup(&so->txfrtimer, isotp_txfr_timer_handler, CLOCK_MONOTONIC, in isotp_init()
1643 init_waitqueue_head(&so->wait); in isotp_init()
1644 spin_lock_init(&so->rx_lock); in isotp_init()
1647 list_add_tail(&so->notifier, &isotp_notifier_list); in isotp_init()
1653 static __poll_t isotp_poll(struct file *file, struct socket *sock, poll_table *wait) in isotp_poll() argument
1655 struct sock *sk = sock->sk; in isotp_poll()
1658 __poll_t mask = datagram_poll(file, sock, wait); in isotp_poll()
1659 poll_wait(file, &so->wait, wait); in isotp_poll()
1661 /* Check for false positives due to TX state */ in isotp_poll()
1662 if ((mask & EPOLLWRNORM) && (so->tx.state != ISOTP_IDLE)) in isotp_poll()
1671 /* no ioctls for socket layer -> hand it down to NIC layer */ in isotp_sock_no_ioctlcmd()
1672 return -ENOIOCTLCMD; in isotp_sock_no_ioctlcmd()