Lines Matching full:so
180 static u32 isotp_bc_flags(struct isotp_sock *so) in isotp_bc_flags() argument
182 return so->opt.flags & ISOTP_ALL_BC_FLAGS; in isotp_bc_flags()
185 static bool isotp_register_rxid(struct isotp_sock *so) in isotp_register_rxid() argument
188 return (isotp_bc_flags(so) == 0); in isotp_register_rxid()
193 struct isotp_sock *so = container_of(hrtimer, struct isotp_sock, in isotp_rx_timer_handler() local
195 struct sock *sk = &so->sk; in isotp_rx_timer_handler()
197 if (so->rx.state == ISOTP_WAIT_DATA) { in isotp_rx_timer_handler()
206 so->rx.state = ISOTP_IDLE; in isotp_rx_timer_handler()
217 struct isotp_sock *so = isotp_sk(sk); in isotp_send_fc() local
220 nskb = alloc_skb(so->ll.mtu + sizeof(struct can_skb_priv), gfp_any()); in isotp_send_fc()
224 dev = dev_get_by_index(sock_net(sk), so->ifindex); in isotp_send_fc()
237 skb_put_zero(nskb, so->ll.mtu); in isotp_send_fc()
240 ncf->can_id = so->txid; in isotp_send_fc()
242 if (so->opt.flags & CAN_ISOTP_TX_PADDING) { in isotp_send_fc()
243 memset(ncf->data, so->opt.txpad_content, CAN_MAX_DLEN); in isotp_send_fc()
250 ncf->data[ae + 1] = so->rxfc.bs; in isotp_send_fc()
251 ncf->data[ae + 2] = so->rxfc.stmin; in isotp_send_fc()
254 ncf->data[0] = so->opt.ext_address; in isotp_send_fc()
256 ncf->flags = so->ll.tx_flags; in isotp_send_fc()
266 so->rx.bs = 0; in isotp_send_fc()
269 so->lastrxcf_tstamp = ktime_set(0, 0); in isotp_send_fc()
272 hrtimer_start(&so->rxtimer, ktime_set(ISOTP_FC_TIMEOUT, 0), in isotp_send_fc()
331 static int check_pad(struct isotp_sock *so, struct canfd_frame *cf, in check_pad() argument
337 if (!(so->opt.flags & CAN_ISOTP_RX_PADDING)) { in check_pad()
338 if (so->opt.flags & CAN_ISOTP_CHK_PAD_LEN) in check_pad()
346 if ((so->opt.flags & CAN_ISOTP_CHK_PAD_LEN) && in check_pad()
351 if (so->opt.flags & CAN_ISOTP_CHK_PAD_DATA) { in check_pad()
359 static void isotp_send_cframe(struct isotp_sock *so);
361 static int isotp_rcv_fc(struct isotp_sock *so, struct canfd_frame *cf, int ae) in isotp_rcv_fc() argument
363 struct sock *sk = &so->sk; in isotp_rcv_fc()
365 if (so->tx.state != ISOTP_WAIT_FC && in isotp_rcv_fc()
366 so->tx.state != ISOTP_WAIT_FIRST_FC) in isotp_rcv_fc()
369 hrtimer_cancel(&so->txtimer); in isotp_rcv_fc()
372 ((so->opt.flags & ISOTP_CHECK_PADDING) && in isotp_rcv_fc()
373 check_pad(so, cf, ae + FC_CONTENT_SZ, so->opt.rxpad_content))) { in isotp_rcv_fc()
379 so->tx.state = ISOTP_IDLE; in isotp_rcv_fc()
380 wake_up_interruptible(&so->wait); in isotp_rcv_fc()
385 if (so->tx.state == ISOTP_WAIT_FIRST_FC) { in isotp_rcv_fc()
386 so->txfc.bs = cf->data[ae + 1]; in isotp_rcv_fc()
387 so->txfc.stmin = cf->data[ae + 2]; in isotp_rcv_fc()
390 if (so->txfc.stmin > 0x7F && in isotp_rcv_fc()
391 (so->txfc.stmin < 0xF1 || so->txfc.stmin > 0xF9)) in isotp_rcv_fc()
392 so->txfc.stmin = 0x7F; in isotp_rcv_fc()
394 so->tx_gap = ktime_set(0, 0); in isotp_rcv_fc()
396 so->tx_gap = ktime_add_ns(so->tx_gap, so->frame_txtime); in isotp_rcv_fc()
398 if (so->opt.flags & CAN_ISOTP_FORCE_TXSTMIN) in isotp_rcv_fc()
399 so->tx_gap = ktime_add_ns(so->tx_gap, in isotp_rcv_fc()
400 so->force_tx_stmin); in isotp_rcv_fc()
401 else if (so->txfc.stmin < 0x80) in isotp_rcv_fc()
402 so->tx_gap = ktime_add_ns(so->tx_gap, in isotp_rcv_fc()
403 so->txfc.stmin * 1000000); in isotp_rcv_fc()
405 so->tx_gap = ktime_add_ns(so->tx_gap, in isotp_rcv_fc()
406 (so->txfc.stmin - 0xF0) in isotp_rcv_fc()
408 so->tx.state = ISOTP_WAIT_FC; in isotp_rcv_fc()
413 so->tx.bs = 0; in isotp_rcv_fc()
414 so->tx.state = ISOTP_SENDING; in isotp_rcv_fc()
416 hrtimer_start(&so->txtimer, ktime_set(ISOTP_ECHO_TIMEOUT, 0), in isotp_rcv_fc()
418 isotp_send_cframe(so); in isotp_rcv_fc()
423 hrtimer_start(&so->txtimer, ktime_set(ISOTP_FC_TIMEOUT, 0), in isotp_rcv_fc()
436 so->tx.state = ISOTP_IDLE; in isotp_rcv_fc()
437 wake_up_interruptible(&so->wait); in isotp_rcv_fc()
445 struct isotp_sock *so = isotp_sk(sk); in isotp_rcv_sf() local
448 hrtimer_cancel(&so->rxtimer); in isotp_rcv_sf()
449 so->rx.state = ISOTP_IDLE; in isotp_rcv_sf()
454 if ((so->opt.flags & ISOTP_CHECK_PADDING) && in isotp_rcv_sf()
455 check_pad(so, cf, pcilen + len, so->opt.rxpad_content)) { in isotp_rcv_sf()
477 struct isotp_sock *so = isotp_sk(sk); in isotp_rcv_ff() local
482 hrtimer_cancel(&so->rxtimer); in isotp_rcv_ff()
483 so->rx.state = ISOTP_IDLE; in isotp_rcv_ff()
486 so->rx.ll_dl = padlen(cf->len); in isotp_rcv_ff()
489 if (cf->len != so->rx.ll_dl) in isotp_rcv_ff()
493 so->rx.len = (cf->data[ae] & 0x0F) << 8; in isotp_rcv_ff()
494 so->rx.len += cf->data[ae + 1]; in isotp_rcv_ff()
497 if (so->rx.len) { in isotp_rcv_ff()
501 so->rx.len = cf->data[ae + 2] << 24; in isotp_rcv_ff()
502 so->rx.len += cf->data[ae + 3] << 16; in isotp_rcv_ff()
503 so->rx.len += cf->data[ae + 4] << 8; in isotp_rcv_ff()
504 so->rx.len += cf->data[ae + 5]; in isotp_rcv_ff()
509 off = (so->rx.ll_dl > CAN_MAX_DLEN) ? 1 : 0; in isotp_rcv_ff()
511 if (so->rx.len + ae + off + ff_pci_sz < so->rx.ll_dl) in isotp_rcv_ff()
515 if (so->rx.len > so->rx.buflen && so->rx.buflen < max_pdu_size) { in isotp_rcv_ff()
519 so->rx.buf = newbuf; in isotp_rcv_ff()
520 so->rx.buflen = max_pdu_size; in isotp_rcv_ff()
524 if (so->rx.len > so->rx.buflen) { in isotp_rcv_ff()
531 so->rx.idx = 0; in isotp_rcv_ff()
532 for (i = ae + ff_pci_sz; i < so->rx.ll_dl; i++) in isotp_rcv_ff()
533 so->rx.buf[so->rx.idx++] = cf->data[i]; in isotp_rcv_ff()
536 so->rx.sn = 1; in isotp_rcv_ff()
537 so->rx.state = ISOTP_WAIT_DATA; in isotp_rcv_ff()
540 if (so->opt.flags & CAN_ISOTP_LISTEN_MODE) in isotp_rcv_ff()
551 struct isotp_sock *so = isotp_sk(sk); in isotp_rcv_cf() local
555 if (so->rx.state != ISOTP_WAIT_DATA) in isotp_rcv_cf()
559 if (so->opt.flags & CAN_ISOTP_FORCE_RXSTMIN) { in isotp_rcv_cf()
560 if (ktime_to_ns(ktime_sub(skb->tstamp, so->lastrxcf_tstamp)) < in isotp_rcv_cf()
561 so->force_rx_stmin) in isotp_rcv_cf()
564 so->lastrxcf_tstamp = skb->tstamp; in isotp_rcv_cf()
567 hrtimer_cancel(&so->rxtimer); in isotp_rcv_cf()
570 if (cf->len > so->rx.ll_dl) in isotp_rcv_cf()
574 if (cf->len < so->rx.ll_dl) { in isotp_rcv_cf()
576 if (so->rx.len - so->rx.idx > so->rx.ll_dl - ae - N_PCI_SZ) in isotp_rcv_cf()
580 if ((cf->data[ae] & 0x0F) != so->rx.sn) { in isotp_rcv_cf()
587 so->rx.state = ISOTP_IDLE; in isotp_rcv_cf()
590 so->rx.sn++; in isotp_rcv_cf()
591 so->rx.sn %= 16; in isotp_rcv_cf()
594 so->rx.buf[so->rx.idx++] = cf->data[i]; in isotp_rcv_cf()
595 if (so->rx.idx >= so->rx.len) in isotp_rcv_cf()
599 if (so->rx.idx >= so->rx.len) { in isotp_rcv_cf()
601 so->rx.state = ISOTP_IDLE; in isotp_rcv_cf()
603 if ((so->opt.flags & ISOTP_CHECK_PADDING) && in isotp_rcv_cf()
604 check_pad(so, cf, i + 1, so->opt.rxpad_content)) { in isotp_rcv_cf()
612 nskb = alloc_skb(so->rx.len, gfp_any()); in isotp_rcv_cf()
616 memcpy(skb_put(nskb, so->rx.len), so->rx.buf, in isotp_rcv_cf()
617 so->rx.len); in isotp_rcv_cf()
626 if (!so->rxfc.bs || ++so->rx.bs < so->rxfc.bs) { in isotp_rcv_cf()
628 hrtimer_start(&so->rxtimer, ktime_set(ISOTP_FC_TIMEOUT, 0), in isotp_rcv_cf()
634 if (so->opt.flags & CAN_ISOTP_LISTEN_MODE) in isotp_rcv_cf()
637 /* we reached the specified blocksize so->rxfc.bs */ in isotp_rcv_cf()
645 struct isotp_sock *so = isotp_sk(sk); in isotp_rcv() local
647 int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0; in isotp_rcv()
653 if (skb->len != so->ll.mtu) in isotp_rcv()
659 if (ae && cf->data[0] != so->opt.rx_ext_address) in isotp_rcv()
668 spin_lock(&so->rx_lock); in isotp_rcv()
670 if (so->opt.flags & CAN_ISOTP_HALF_DUPLEX) { in isotp_rcv()
672 if ((so->tx.state != ISOTP_IDLE && n_pci_type != N_PCI_FC) || in isotp_rcv()
673 (so->rx.state != ISOTP_IDLE && n_pci_type == N_PCI_FC)) in isotp_rcv()
680 isotp_rcv_fc(so, cf, ae); in isotp_rcv()
701 * If so take care of the increased SF PCI size in isotp_rcv()
725 spin_unlock(&so->rx_lock); in isotp_rcv()
728 static void isotp_fill_dataframe(struct canfd_frame *cf, struct isotp_sock *so, in isotp_fill_dataframe() argument
732 int space = so->tx.ll_dl - pcilen; in isotp_fill_dataframe()
733 int num = min_t(int, so->tx.len - so->tx.idx, space); in isotp_fill_dataframe()
736 cf->can_id = so->txid; in isotp_fill_dataframe()
740 if (so->opt.flags & CAN_ISOTP_TX_PADDING) { in isotp_fill_dataframe()
743 memset(cf->data, so->opt.txpad_content, cf->len); in isotp_fill_dataframe()
753 cf->data[pcilen + i] = so->tx.buf[so->tx.idx++]; in isotp_fill_dataframe()
756 cf->data[0] = so->opt.ext_address; in isotp_fill_dataframe()
759 static void isotp_send_cframe(struct isotp_sock *so) in isotp_send_cframe() argument
761 struct sock *sk = &so->sk; in isotp_send_cframe()
766 int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0; in isotp_send_cframe()
768 dev = dev_get_by_index(sock_net(sk), so->ifindex); in isotp_send_cframe()
772 skb = alloc_skb(so->ll.mtu + sizeof(struct can_skb_priv), GFP_ATOMIC); in isotp_send_cframe()
783 skb_put_zero(skb, so->ll.mtu); in isotp_send_cframe()
786 isotp_fill_dataframe(cf, so, ae, 0); in isotp_send_cframe()
789 cf->data[ae] = N_PCI_CF | so->tx.sn++; in isotp_send_cframe()
790 so->tx.sn %= 16; in isotp_send_cframe()
791 so->tx.bs++; in isotp_send_cframe()
793 cf->flags = so->ll.tx_flags; in isotp_send_cframe()
799 if (so->cfecho) in isotp_send_cframe()
800 pr_notice_once("can-isotp: cfecho is %08X != 0\n", so->cfecho); in isotp_send_cframe()
803 so->cfecho = *(u32 *)cf->data; in isotp_send_cframe()
816 static void isotp_create_fframe(struct canfd_frame *cf, struct isotp_sock *so, in isotp_create_fframe() argument
822 cf->can_id = so->txid; in isotp_create_fframe()
823 cf->len = so->tx.ll_dl; in isotp_create_fframe()
825 cf->data[0] = so->opt.ext_address; in isotp_create_fframe()
828 if (so->tx.len > MAX_12BIT_PDU_SIZE) { in isotp_create_fframe()
832 cf->data[ae + 2] = (u8)(so->tx.len >> 24) & 0xFFU; in isotp_create_fframe()
833 cf->data[ae + 3] = (u8)(so->tx.len >> 16) & 0xFFU; in isotp_create_fframe()
834 cf->data[ae + 4] = (u8)(so->tx.len >> 8) & 0xFFU; in isotp_create_fframe()
835 cf->data[ae + 5] = (u8)so->tx.len & 0xFFU; in isotp_create_fframe()
839 cf->data[ae] = (u8)(so->tx.len >> 8) | N_PCI_FF; in isotp_create_fframe()
840 cf->data[ae + 1] = (u8)so->tx.len & 0xFFU; in isotp_create_fframe()
845 for (i = ae + ff_pci_sz; i < so->tx.ll_dl; i++) in isotp_create_fframe()
846 cf->data[i] = so->tx.buf[so->tx.idx++]; in isotp_create_fframe()
848 so->tx.sn = 1; in isotp_create_fframe()
854 struct isotp_sock *so = isotp_sk(sk); in isotp_rcv_echo() local
858 if (skb->sk != sk || so->cfecho != *(u32 *)cf->data) in isotp_rcv_echo()
862 hrtimer_cancel(&so->txtimer); in isotp_rcv_echo()
865 so->cfecho = 0; in isotp_rcv_echo()
867 if (so->tx.idx >= so->tx.len) { in isotp_rcv_echo()
869 so->tx.state = ISOTP_IDLE; in isotp_rcv_echo()
870 wake_up_interruptible(&so->wait); in isotp_rcv_echo()
874 if (so->txfc.bs && so->tx.bs >= so->txfc.bs) { in isotp_rcv_echo()
876 so->tx.state = ISOTP_WAIT_FC; in isotp_rcv_echo()
877 hrtimer_start(&so->txtimer, ktime_set(ISOTP_FC_TIMEOUT, 0), in isotp_rcv_echo()
883 if (!so->tx_gap) { in isotp_rcv_echo()
885 hrtimer_start(&so->txtimer, ktime_set(ISOTP_ECHO_TIMEOUT, 0), in isotp_rcv_echo()
887 isotp_send_cframe(so); in isotp_rcv_echo()
892 hrtimer_start(&so->txfrtimer, so->tx_gap, HRTIMER_MODE_REL_SOFT); in isotp_rcv_echo()
897 struct isotp_sock *so = container_of(hrtimer, struct isotp_sock, in isotp_tx_timer_handler() local
899 struct sock *sk = &so->sk; in isotp_tx_timer_handler()
902 if (so->tx.state == ISOTP_IDLE || so->tx.state == ISOTP_SHUTDOWN) in isotp_tx_timer_handler()
913 so->tx.state = ISOTP_IDLE; in isotp_tx_timer_handler()
914 wake_up_interruptible(&so->wait); in isotp_tx_timer_handler()
921 struct isotp_sock *so = container_of(hrtimer, struct isotp_sock, in isotp_txfr_timer_handler() local
925 hrtimer_start(&so->txtimer, ktime_set(ISOTP_ECHO_TIMEOUT, 0), in isotp_txfr_timer_handler()
929 if (so->tx.state == ISOTP_SENDING && !so->cfecho) in isotp_txfr_timer_handler()
930 isotp_send_cframe(so); in isotp_txfr_timer_handler()
938 struct isotp_sock *so = isotp_sk(sk); in isotp_sendmsg() local
942 int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0; in isotp_sendmsg()
943 int wait_tx_done = (so->opt.flags & CAN_ISOTP_WAIT_TX_DONE) ? 1 : 0; in isotp_sendmsg()
948 if (!so->bound || so->tx.state == ISOTP_SHUTDOWN) in isotp_sendmsg()
951 while (cmpxchg(&so->tx.state, ISOTP_IDLE, ISOTP_SENDING) != ISOTP_IDLE) { in isotp_sendmsg()
956 if (so->tx.state == ISOTP_SHUTDOWN) in isotp_sendmsg()
960 err = wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE); in isotp_sendmsg()
966 if (size > so->tx.buflen && so->tx.buflen < max_pdu_size) { in isotp_sendmsg()
970 so->tx.buf = newbuf; in isotp_sendmsg()
971 so->tx.buflen = max_pdu_size; in isotp_sendmsg()
975 if (!size || size > so->tx.buflen) { in isotp_sendmsg()
981 off = (so->tx.ll_dl > CAN_MAX_DLEN) ? 1 : 0; in isotp_sendmsg()
984 if ((isotp_bc_flags(so) == CAN_ISOTP_SF_BROADCAST) && in isotp_sendmsg()
985 (size > so->tx.ll_dl - SF_PCI_SZ4 - ae - off)) { in isotp_sendmsg()
990 err = memcpy_from_msg(so->tx.buf, msg, size); in isotp_sendmsg()
994 dev = dev_get_by_index(sock_net(sk), so->ifindex); in isotp_sendmsg()
1000 skb = sock_alloc_send_skb(sk, so->ll.mtu + sizeof(struct can_skb_priv), in isotp_sendmsg()
1011 so->tx.len = size; in isotp_sendmsg()
1012 so->tx.idx = 0; in isotp_sendmsg()
1015 skb_put_zero(skb, so->ll.mtu); in isotp_sendmsg()
1018 if (so->cfecho) in isotp_sendmsg()
1019 pr_notice_once("can-isotp: uninit cfecho %08X\n", so->cfecho); in isotp_sendmsg()
1022 if (size <= so->tx.ll_dl - SF_PCI_SZ4 - ae - off) { in isotp_sendmsg()
1035 isotp_fill_dataframe(cf, so, ae, off); in isotp_sendmsg()
1047 so->cfecho = *(u32 *)cf->data; in isotp_sendmsg()
1051 isotp_create_fframe(cf, so, ae); in isotp_sendmsg()
1053 if (isotp_bc_flags(so) == CAN_ISOTP_CF_BROADCAST) { in isotp_sendmsg()
1055 if (so->opt.flags & CAN_ISOTP_FORCE_TXSTMIN) in isotp_sendmsg()
1056 so->tx_gap = ktime_set(0, so->force_tx_stmin); in isotp_sendmsg()
1058 so->tx_gap = ktime_set(0, so->frame_txtime); in isotp_sendmsg()
1061 so->txfc.bs = 0; in isotp_sendmsg()
1064 so->cfecho = *(u32 *)cf->data; in isotp_sendmsg()
1067 so->tx.state = ISOTP_WAIT_FIRST_FC; in isotp_sendmsg()
1073 so->cfecho = 0; in isotp_sendmsg()
1077 hrtimer_start(&so->txtimer, ktime_set(hrtimer_sec, 0), in isotp_sendmsg()
1081 cf->flags = so->ll.tx_flags; in isotp_sendmsg()
1092 hrtimer_cancel(&so->txtimer); in isotp_sendmsg()
1095 so->cfecho = 0; in isotp_sendmsg()
1102 err = wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE); in isotp_sendmsg()
1115 so->tx.state = ISOTP_IDLE; in isotp_sendmsg()
1116 hrtimer_cancel(&so->txfrtimer); in isotp_sendmsg()
1117 hrtimer_cancel(&so->txtimer); in isotp_sendmsg()
1120 so->tx.state = ISOTP_IDLE; in isotp_sendmsg()
1121 wake_up_interruptible(&so->wait); in isotp_sendmsg()
1131 struct isotp_sock *so = isotp_sk(sk); in isotp_recvmsg() local
1137 if (!so->bound) in isotp_recvmsg()
1173 struct isotp_sock *so; in isotp_release() local
1179 so = isotp_sk(sk); in isotp_release()
1183 while (wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE) == 0 && in isotp_release()
1184 cmpxchg(&so->tx.state, ISOTP_IDLE, ISOTP_SHUTDOWN) != ISOTP_IDLE) in isotp_release()
1188 so->tx.state = ISOTP_SHUTDOWN; in isotp_release()
1189 so->rx.state = ISOTP_IDLE; in isotp_release()
1192 while (isotp_busy_notifier == so) { in isotp_release()
1197 list_del(&so->notifier); in isotp_release()
1203 if (so->bound) { in isotp_release()
1204 if (so->ifindex) { in isotp_release()
1207 dev = dev_get_by_index(net, so->ifindex); in isotp_release()
1209 if (isotp_register_rxid(so)) in isotp_release()
1210 can_rx_unregister(net, dev, so->rxid, in isotp_release()
1211 SINGLE_MASK(so->rxid), in isotp_release()
1214 can_rx_unregister(net, dev, so->txid, in isotp_release()
1215 SINGLE_MASK(so->txid), in isotp_release()
1223 hrtimer_cancel(&so->txfrtimer); in isotp_release()
1224 hrtimer_cancel(&so->txtimer); in isotp_release()
1225 hrtimer_cancel(&so->rxtimer); in isotp_release()
1227 so->ifindex = 0; in isotp_release()
1228 so->bound = 0; in isotp_release()
1230 if (so->rx.buf != so->rx.sbuf) in isotp_release()
1231 kfree(so->rx.buf); in isotp_release()
1233 if (so->tx.buf != so->tx.sbuf) in isotp_release()
1234 kfree(so->tx.buf); in isotp_release()
1249 struct isotp_sock *so = isotp_sk(sk); in isotp_bind() local
1275 if (isotp_register_rxid(so)) { in isotp_bind()
1291 if (so->bound) { in isotp_bind()
1297 if (isotp_register_rxid(so) && rx_id == tx_id) { in isotp_bind()
1312 if (dev->mtu < so->ll.mtu) { in isotp_bind()
1322 if (isotp_register_rxid(so)) in isotp_bind()
1327 so->cfecho = 0; in isotp_bind()
1336 so->ifindex = ifindex; in isotp_bind()
1337 so->rxid = rx_id; in isotp_bind()
1338 so->txid = tx_id; in isotp_bind()
1339 so->bound = 1; in isotp_bind()
1357 struct isotp_sock *so = isotp_sk(sk); in isotp_getname() local
1364 addr->can_ifindex = so->ifindex; in isotp_getname()
1365 addr->can_addr.tp.rx_id = so->rxid; in isotp_getname()
1366 addr->can_addr.tp.tx_id = so->txid; in isotp_getname()
1375 struct isotp_sock *so = isotp_sk(sk); in isotp_setsockopt_locked() local
1378 if (so->bound) in isotp_setsockopt_locked()
1386 if (copy_from_sockptr(&so->opt, optval, optlen)) in isotp_setsockopt_locked()
1390 if (!(so->opt.flags & CAN_ISOTP_RX_EXT_ADDR)) in isotp_setsockopt_locked()
1391 so->opt.rx_ext_address = so->opt.ext_address; in isotp_setsockopt_locked()
1394 if (isotp_bc_flags(so) == ISOTP_ALL_BC_FLAGS) { in isotp_setsockopt_locked()
1396 so->opt.flags &= ~CAN_ISOTP_CF_BROADCAST; in isotp_setsockopt_locked()
1403 if (so->opt.frame_txtime) { in isotp_setsockopt_locked()
1404 if (so->opt.frame_txtime == CAN_ISOTP_FRAME_TXTIME_ZERO) in isotp_setsockopt_locked()
1405 so->frame_txtime = 0; in isotp_setsockopt_locked()
1407 so->frame_txtime = so->opt.frame_txtime; in isotp_setsockopt_locked()
1415 if (copy_from_sockptr(&so->rxfc, optval, optlen)) in isotp_setsockopt_locked()
1423 if (copy_from_sockptr(&so->force_tx_stmin, optval, optlen)) in isotp_setsockopt_locked()
1431 if (copy_from_sockptr(&so->force_rx_stmin, optval, optlen)) in isotp_setsockopt_locked()
1453 memcpy(&so->ll, &ll, sizeof(ll)); in isotp_setsockopt_locked()
1456 so->tx.ll_dl = ll.tx_dl; in isotp_setsockopt_locked()
1489 struct isotp_sock *so = isotp_sk(sk); in isotp_getsockopt() local
1503 val = &so->opt; in isotp_getsockopt()
1508 val = &so->rxfc; in isotp_getsockopt()
1513 val = &so->force_tx_stmin; in isotp_getsockopt()
1518 val = &so->force_rx_stmin; in isotp_getsockopt()
1523 val = &so->ll; in isotp_getsockopt()
1537 static void isotp_notify(struct isotp_sock *so, unsigned long msg, in isotp_notify() argument
1540 struct sock *sk = &so->sk; in isotp_notify()
1545 if (so->ifindex != dev->ifindex) in isotp_notify()
1552 if (so->bound) { in isotp_notify()
1553 if (isotp_register_rxid(so)) in isotp_notify()
1554 can_rx_unregister(dev_net(dev), dev, so->rxid, in isotp_notify()
1555 SINGLE_MASK(so->rxid), in isotp_notify()
1558 can_rx_unregister(dev_net(dev), dev, so->txid, in isotp_notify()
1559 SINGLE_MASK(so->txid), in isotp_notify()
1563 so->ifindex = 0; in isotp_notify()
1564 so->bound = 0; in isotp_notify()
1605 struct isotp_sock *so = isotp_sk(sk); in isotp_init() local
1607 so->ifindex = 0; in isotp_init()
1608 so->bound = 0; in isotp_init()
1610 so->opt.flags = CAN_ISOTP_DEFAULT_FLAGS; in isotp_init()
1611 so->opt.ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS; in isotp_init()
1612 so->opt.rx_ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS; in isotp_init()
1613 so->opt.rxpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT; in isotp_init()
1614 so->opt.txpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT; in isotp_init()
1615 so->opt.frame_txtime = CAN_ISOTP_DEFAULT_FRAME_TXTIME; in isotp_init()
1616 so->frame_txtime = CAN_ISOTP_DEFAULT_FRAME_TXTIME; in isotp_init()
1617 so->rxfc.bs = CAN_ISOTP_DEFAULT_RECV_BS; in isotp_init()
1618 so->rxfc.stmin = CAN_ISOTP_DEFAULT_RECV_STMIN; in isotp_init()
1619 so->rxfc.wftmax = CAN_ISOTP_DEFAULT_RECV_WFTMAX; in isotp_init()
1620 so->ll.mtu = CAN_ISOTP_DEFAULT_LL_MTU; in isotp_init()
1621 so->ll.tx_dl = CAN_ISOTP_DEFAULT_LL_TX_DL; in isotp_init()
1622 so->ll.tx_flags = CAN_ISOTP_DEFAULT_LL_TX_FLAGS; in isotp_init()
1625 so->tx.ll_dl = so->ll.tx_dl; in isotp_init()
1627 so->rx.state = ISOTP_IDLE; in isotp_init()
1628 so->tx.state = ISOTP_IDLE; in isotp_init()
1630 so->rx.buf = so->rx.sbuf; in isotp_init()
1631 so->tx.buf = so->tx.sbuf; in isotp_init()
1632 so->rx.buflen = ARRAY_SIZE(so->rx.sbuf); in isotp_init()
1633 so->tx.buflen = ARRAY_SIZE(so->tx.sbuf); in isotp_init()
1635 hrtimer_init(&so->rxtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT); in isotp_init()
1636 so->rxtimer.function = isotp_rx_timer_handler; in isotp_init()
1637 hrtimer_init(&so->txtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT); in isotp_init()
1638 so->txtimer.function = isotp_tx_timer_handler; in isotp_init()
1639 hrtimer_init(&so->txfrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT); in isotp_init()
1640 so->txfrtimer.function = isotp_txfr_timer_handler; in isotp_init()
1642 init_waitqueue_head(&so->wait); in isotp_init()
1643 spin_lock_init(&so->rx_lock); in isotp_init()
1646 list_add_tail(&so->notifier, &isotp_notifier_list); in isotp_init()
1655 struct isotp_sock *so = isotp_sk(sk); in isotp_poll() local
1658 poll_wait(file, &so->wait, wait); in isotp_poll()
1661 if ((mask & EPOLLWRNORM) && (so->tx.state != ISOTP_IDLE)) in isotp_poll()