Lines Matching full:so
155 struct isotp_sock *so = container_of(hrtimer, struct isotp_sock, in isotp_rx_timer_handler() local
157 struct sock *sk = &so->sk; in isotp_rx_timer_handler()
159 if (so->rx.state == ISOTP_WAIT_DATA) { in isotp_rx_timer_handler()
168 so->rx.state = ISOTP_IDLE; in isotp_rx_timer_handler()
179 struct isotp_sock *so = isotp_sk(sk); in isotp_send_fc() local
182 nskb = alloc_skb(so->ll.mtu + sizeof(struct can_skb_priv), gfp_any()); in isotp_send_fc()
186 dev = dev_get_by_index(sock_net(sk), so->ifindex); in isotp_send_fc()
199 skb_put(nskb, so->ll.mtu); in isotp_send_fc()
202 ncf->can_id = so->txid; in isotp_send_fc()
204 if (so->opt.flags & CAN_ISOTP_TX_PADDING) { in isotp_send_fc()
205 memset(ncf->data, so->opt.txpad_content, CAN_MAX_DLEN); in isotp_send_fc()
212 ncf->data[ae + 1] = so->rxfc.bs; in isotp_send_fc()
213 ncf->data[ae + 2] = so->rxfc.stmin; in isotp_send_fc()
216 ncf->data[0] = so->opt.ext_address; in isotp_send_fc()
218 if (so->ll.mtu == CANFD_MTU) in isotp_send_fc()
219 ncf->flags = so->ll.tx_flags; in isotp_send_fc()
229 so->rx.bs = 0; in isotp_send_fc()
232 so->lastrxcf_tstamp = ktime_set(0, 0); in isotp_send_fc()
235 hrtimer_start(&so->rxtimer, ktime_set(1, 0), HRTIMER_MODE_REL_SOFT); in isotp_send_fc()
293 static int check_pad(struct isotp_sock *so, struct canfd_frame *cf, in check_pad() argument
299 if (!(so->opt.flags & CAN_ISOTP_RX_PADDING)) { in check_pad()
300 if (so->opt.flags & CAN_ISOTP_CHK_PAD_LEN) in check_pad()
308 if ((so->opt.flags & CAN_ISOTP_CHK_PAD_LEN) && in check_pad()
313 if (so->opt.flags & CAN_ISOTP_CHK_PAD_DATA) { in check_pad()
321 static int isotp_rcv_fc(struct isotp_sock *so, struct canfd_frame *cf, int ae) in isotp_rcv_fc() argument
323 struct sock *sk = &so->sk; in isotp_rcv_fc()
325 if (so->tx.state != ISOTP_WAIT_FC && in isotp_rcv_fc()
326 so->tx.state != ISOTP_WAIT_FIRST_FC) in isotp_rcv_fc()
329 hrtimer_cancel(&so->txtimer); in isotp_rcv_fc()
332 ((so->opt.flags & ISOTP_CHECK_PADDING) && in isotp_rcv_fc()
333 check_pad(so, cf, ae + FC_CONTENT_SZ, so->opt.rxpad_content))) { in isotp_rcv_fc()
339 so->tx.state = ISOTP_IDLE; in isotp_rcv_fc()
340 wake_up_interruptible(&so->wait); in isotp_rcv_fc()
345 if (so->tx.state == ISOTP_WAIT_FIRST_FC) { in isotp_rcv_fc()
346 so->txfc.bs = cf->data[ae + 1]; in isotp_rcv_fc()
347 so->txfc.stmin = cf->data[ae + 2]; in isotp_rcv_fc()
350 if (so->txfc.stmin > 0x7F && in isotp_rcv_fc()
351 (so->txfc.stmin < 0xF1 || so->txfc.stmin > 0xF9)) in isotp_rcv_fc()
352 so->txfc.stmin = 0x7F; in isotp_rcv_fc()
354 so->tx_gap = ktime_set(0, 0); in isotp_rcv_fc()
356 so->tx_gap = ktime_add_ns(so->tx_gap, so->opt.frame_txtime); in isotp_rcv_fc()
358 if (so->opt.flags & CAN_ISOTP_FORCE_TXSTMIN) in isotp_rcv_fc()
359 so->tx_gap = ktime_add_ns(so->tx_gap, in isotp_rcv_fc()
360 so->force_tx_stmin); in isotp_rcv_fc()
361 else if (so->txfc.stmin < 0x80) in isotp_rcv_fc()
362 so->tx_gap = ktime_add_ns(so->tx_gap, in isotp_rcv_fc()
363 so->txfc.stmin * 1000000); in isotp_rcv_fc()
365 so->tx_gap = ktime_add_ns(so->tx_gap, in isotp_rcv_fc()
366 (so->txfc.stmin - 0xF0) in isotp_rcv_fc()
368 so->tx.state = ISOTP_WAIT_FC; in isotp_rcv_fc()
373 so->tx.bs = 0; in isotp_rcv_fc()
374 so->tx.state = ISOTP_SENDING; in isotp_rcv_fc()
376 hrtimer_start(&so->txtimer, so->tx_gap, in isotp_rcv_fc()
382 hrtimer_start(&so->txtimer, ktime_set(1, 0), in isotp_rcv_fc()
395 so->tx.state = ISOTP_IDLE; in isotp_rcv_fc()
396 wake_up_interruptible(&so->wait); in isotp_rcv_fc()
404 struct isotp_sock *so = isotp_sk(sk); in isotp_rcv_sf() local
407 hrtimer_cancel(&so->rxtimer); in isotp_rcv_sf()
408 so->rx.state = ISOTP_IDLE; in isotp_rcv_sf()
413 if ((so->opt.flags & ISOTP_CHECK_PADDING) && in isotp_rcv_sf()
414 check_pad(so, cf, pcilen + len, so->opt.rxpad_content)) { in isotp_rcv_sf()
436 struct isotp_sock *so = isotp_sk(sk); in isotp_rcv_ff() local
441 hrtimer_cancel(&so->rxtimer); in isotp_rcv_ff()
442 so->rx.state = ISOTP_IDLE; in isotp_rcv_ff()
445 so->rx.ll_dl = padlen(cf->len); in isotp_rcv_ff()
448 if (cf->len != so->rx.ll_dl) in isotp_rcv_ff()
452 so->rx.len = (cf->data[ae] & 0x0F) << 8; in isotp_rcv_ff()
453 so->rx.len += cf->data[ae + 1]; in isotp_rcv_ff()
456 if (so->rx.len) { in isotp_rcv_ff()
460 so->rx.len = cf->data[ae + 2] << 24; in isotp_rcv_ff()
461 so->rx.len += cf->data[ae + 3] << 16; in isotp_rcv_ff()
462 so->rx.len += cf->data[ae + 4] << 8; in isotp_rcv_ff()
463 so->rx.len += cf->data[ae + 5]; in isotp_rcv_ff()
468 off = (so->rx.ll_dl > CAN_MAX_DLEN) ? 1 : 0; in isotp_rcv_ff()
470 if (so->rx.len + ae + off + ff_pci_sz < so->rx.ll_dl) in isotp_rcv_ff()
473 if (so->rx.len > MAX_MSG_LENGTH) { in isotp_rcv_ff()
480 so->rx.idx = 0; in isotp_rcv_ff()
481 for (i = ae + ff_pci_sz; i < so->rx.ll_dl; i++) in isotp_rcv_ff()
482 so->rx.buf[so->rx.idx++] = cf->data[i]; in isotp_rcv_ff()
485 so->rx.sn = 1; in isotp_rcv_ff()
486 so->rx.state = ISOTP_WAIT_DATA; in isotp_rcv_ff()
489 if (so->opt.flags & CAN_ISOTP_LISTEN_MODE) in isotp_rcv_ff()
500 struct isotp_sock *so = isotp_sk(sk); in isotp_rcv_cf() local
504 if (so->rx.state != ISOTP_WAIT_DATA) in isotp_rcv_cf()
508 if (so->opt.flags & CAN_ISOTP_FORCE_RXSTMIN) { in isotp_rcv_cf()
509 if (ktime_to_ns(ktime_sub(skb->tstamp, so->lastrxcf_tstamp)) < in isotp_rcv_cf()
510 so->force_rx_stmin) in isotp_rcv_cf()
513 so->lastrxcf_tstamp = skb->tstamp; in isotp_rcv_cf()
516 hrtimer_cancel(&so->rxtimer); in isotp_rcv_cf()
519 if (cf->len > so->rx.ll_dl) in isotp_rcv_cf()
523 if (cf->len < so->rx.ll_dl) { in isotp_rcv_cf()
525 if (so->rx.len - so->rx.idx > so->rx.ll_dl - ae - N_PCI_SZ) in isotp_rcv_cf()
529 if ((cf->data[ae] & 0x0F) != so->rx.sn) { in isotp_rcv_cf()
536 so->rx.state = ISOTP_IDLE; in isotp_rcv_cf()
539 so->rx.sn++; in isotp_rcv_cf()
540 so->rx.sn %= 16; in isotp_rcv_cf()
543 so->rx.buf[so->rx.idx++] = cf->data[i]; in isotp_rcv_cf()
544 if (so->rx.idx >= so->rx.len) in isotp_rcv_cf()
548 if (so->rx.idx >= so->rx.len) { in isotp_rcv_cf()
550 so->rx.state = ISOTP_IDLE; in isotp_rcv_cf()
552 if ((so->opt.flags & ISOTP_CHECK_PADDING) && in isotp_rcv_cf()
553 check_pad(so, cf, i + 1, so->opt.rxpad_content)) { in isotp_rcv_cf()
561 nskb = alloc_skb(so->rx.len, gfp_any()); in isotp_rcv_cf()
565 memcpy(skb_put(nskb, so->rx.len), so->rx.buf, in isotp_rcv_cf()
566 so->rx.len); in isotp_rcv_cf()
575 if (!so->rxfc.bs || ++so->rx.bs < so->rxfc.bs) { in isotp_rcv_cf()
577 hrtimer_start(&so->rxtimer, ktime_set(1, 0), in isotp_rcv_cf()
583 if (so->opt.flags & CAN_ISOTP_LISTEN_MODE) in isotp_rcv_cf()
586 /* we reached the specified blocksize so->rxfc.bs */ in isotp_rcv_cf()
594 struct isotp_sock *so = isotp_sk(sk); in isotp_rcv() local
596 int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0; in isotp_rcv()
602 if (skb->len != so->ll.mtu) in isotp_rcv()
608 if (ae && cf->data[0] != so->opt.rx_ext_address) in isotp_rcv()
613 if (so->opt.flags & CAN_ISOTP_HALF_DUPLEX) { in isotp_rcv()
615 if ((so->tx.state != ISOTP_IDLE && n_pci_type != N_PCI_FC) || in isotp_rcv()
616 (so->rx.state != ISOTP_IDLE && n_pci_type == N_PCI_FC)) in isotp_rcv()
623 isotp_rcv_fc(so, cf, ae); in isotp_rcv()
644 * If so take care of the increased SF PCI size in isotp_rcv()
668 static void isotp_fill_dataframe(struct canfd_frame *cf, struct isotp_sock *so, in isotp_fill_dataframe() argument
672 int space = so->tx.ll_dl - pcilen; in isotp_fill_dataframe()
673 int num = min_t(int, so->tx.len - so->tx.idx, space); in isotp_fill_dataframe()
676 cf->can_id = so->txid; in isotp_fill_dataframe()
680 if (so->opt.flags & CAN_ISOTP_TX_PADDING) { in isotp_fill_dataframe()
683 memset(cf->data, so->opt.txpad_content, cf->len); in isotp_fill_dataframe()
693 cf->data[pcilen + i] = so->tx.buf[so->tx.idx++]; in isotp_fill_dataframe()
696 cf->data[0] = so->opt.ext_address; in isotp_fill_dataframe()
699 static void isotp_create_fframe(struct canfd_frame *cf, struct isotp_sock *so, in isotp_create_fframe() argument
705 cf->can_id = so->txid; in isotp_create_fframe()
706 cf->len = so->tx.ll_dl; in isotp_create_fframe()
708 cf->data[0] = so->opt.ext_address; in isotp_create_fframe()
711 if (so->tx.len > 4095) { in isotp_create_fframe()
715 cf->data[ae + 2] = (u8)(so->tx.len >> 24) & 0xFFU; in isotp_create_fframe()
716 cf->data[ae + 3] = (u8)(so->tx.len >> 16) & 0xFFU; in isotp_create_fframe()
717 cf->data[ae + 4] = (u8)(so->tx.len >> 8) & 0xFFU; in isotp_create_fframe()
718 cf->data[ae + 5] = (u8)so->tx.len & 0xFFU; in isotp_create_fframe()
722 cf->data[ae] = (u8)(so->tx.len >> 8) | N_PCI_FF; in isotp_create_fframe()
723 cf->data[ae + 1] = (u8)so->tx.len & 0xFFU; in isotp_create_fframe()
728 for (i = ae + ff_pci_sz; i < so->tx.ll_dl; i++) in isotp_create_fframe()
729 cf->data[i] = so->tx.buf[so->tx.idx++]; in isotp_create_fframe()
731 so->tx.sn = 1; in isotp_create_fframe()
732 so->tx.state = ISOTP_WAIT_FIRST_FC; in isotp_create_fframe()
737 struct isotp_sock *so = container_of(hrtimer, struct isotp_sock, in isotp_tx_timer_handler() local
739 struct sock *sk = &so->sk; in isotp_tx_timer_handler()
745 int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0; in isotp_tx_timer_handler()
747 switch (so->tx.state) { in isotp_tx_timer_handler()
759 so->tx.state = ISOTP_IDLE; in isotp_tx_timer_handler()
760 wake_up_interruptible(&so->wait); in isotp_tx_timer_handler()
766 dev = dev_get_by_index(sock_net(sk), so->ifindex); in isotp_tx_timer_handler()
771 skb = alloc_skb(so->ll.mtu + sizeof(struct can_skb_priv), in isotp_tx_timer_handler()
783 skb_put(skb, so->ll.mtu); in isotp_tx_timer_handler()
786 isotp_fill_dataframe(cf, so, ae, 0); in isotp_tx_timer_handler()
789 cf->data[ae] = N_PCI_CF | so->tx.sn++; in isotp_tx_timer_handler()
790 so->tx.sn %= 16; in isotp_tx_timer_handler()
791 so->tx.bs++; in isotp_tx_timer_handler()
793 if (so->ll.mtu == CANFD_MTU) in isotp_tx_timer_handler()
794 cf->flags = so->ll.tx_flags; in isotp_tx_timer_handler()
804 if (so->tx.idx >= so->tx.len) { in isotp_tx_timer_handler()
806 so->tx.state = ISOTP_IDLE; in isotp_tx_timer_handler()
808 wake_up_interruptible(&so->wait); in isotp_tx_timer_handler()
812 if (so->txfc.bs && so->tx.bs >= so->txfc.bs) { in isotp_tx_timer_handler()
814 so->tx.state = ISOTP_WAIT_FC; in isotp_tx_timer_handler()
816 hrtimer_set_expires(&so->txtimer, in isotp_tx_timer_handler()
824 if (!so->tx_gap) in isotp_tx_timer_handler()
829 hrtimer_set_expires(&so->txtimer, in isotp_tx_timer_handler()
830 ktime_add(ktime_get(), so->tx_gap)); in isotp_tx_timer_handler()
844 struct isotp_sock *so = isotp_sk(sk); in isotp_sendmsg() local
848 int ae = (so->opt.flags & CAN_ISOTP_EXTEND_ADDR) ? 1 : 0; in isotp_sendmsg()
849 int wait_tx_done = (so->opt.flags & CAN_ISOTP_WAIT_TX_DONE) ? 1 : 0; in isotp_sendmsg()
853 if (!so->bound) in isotp_sendmsg()
857 if (so->tx.state != ISOTP_IDLE || wq_has_sleeper(&so->wait)) { in isotp_sendmsg()
862 wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE); in isotp_sendmsg()
868 err = memcpy_from_msg(so->tx.buf, msg, size); in isotp_sendmsg()
872 dev = dev_get_by_index(sock_net(sk), so->ifindex); in isotp_sendmsg()
876 skb = sock_alloc_send_skb(sk, so->ll.mtu + sizeof(struct can_skb_priv), in isotp_sendmsg()
887 so->tx.state = ISOTP_SENDING; in isotp_sendmsg()
888 so->tx.len = size; in isotp_sendmsg()
889 so->tx.idx = 0; in isotp_sendmsg()
892 skb_put(skb, so->ll.mtu); in isotp_sendmsg()
895 off = (so->tx.ll_dl > CAN_MAX_DLEN) ? 1 : 0; in isotp_sendmsg()
898 if (size <= so->tx.ll_dl - SF_PCI_SZ4 - ae - off) { in isotp_sendmsg()
911 isotp_fill_dataframe(cf, so, ae, off); in isotp_sendmsg()
922 so->tx.state = ISOTP_IDLE; in isotp_sendmsg()
923 wake_up_interruptible(&so->wait); in isotp_sendmsg()
930 isotp_create_fframe(cf, so, ae); in isotp_sendmsg()
933 hrtimer_start(&so->txtimer, ktime_set(1, 0), HRTIMER_MODE_REL_SOFT); in isotp_sendmsg()
937 if (so->ll.mtu == CANFD_MTU) in isotp_sendmsg()
938 cf->flags = so->ll.tx_flags; in isotp_sendmsg()
952 wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE); in isotp_sendmsg()
999 struct isotp_sock *so; in isotp_release() local
1005 so = isotp_sk(sk); in isotp_release()
1009 wait_event_interruptible(so->wait, so->tx.state == ISOTP_IDLE); in isotp_release()
1011 unregister_netdevice_notifier(&so->notifier); in isotp_release()
1015 hrtimer_cancel(&so->txtimer); in isotp_release()
1016 hrtimer_cancel(&so->rxtimer); in isotp_release()
1019 if (so->bound) { in isotp_release()
1020 if (so->ifindex) { in isotp_release()
1023 dev = dev_get_by_index(net, so->ifindex); in isotp_release()
1025 can_rx_unregister(net, dev, so->rxid, in isotp_release()
1026 SINGLE_MASK(so->rxid), in isotp_release()
1033 so->ifindex = 0; in isotp_release()
1034 so->bound = 0; in isotp_release()
1049 struct isotp_sock *so = isotp_sk(sk); in isotp_bind() local
1071 if (so->bound && addr->can_ifindex == so->ifindex && in isotp_bind()
1072 addr->can_addr.tp.rx_id == so->rxid && in isotp_bind()
1073 addr->can_addr.tp.tx_id == so->txid) in isotp_bind()
1086 if (dev->mtu < so->ll.mtu) { in isotp_bind()
1102 if (so->bound) { in isotp_bind()
1104 if (so->ifindex) { in isotp_bind()
1105 dev = dev_get_by_index(net, so->ifindex); in isotp_bind()
1107 can_rx_unregister(net, dev, so->rxid, in isotp_bind()
1108 SINGLE_MASK(so->rxid), in isotp_bind()
1116 so->ifindex = ifindex; in isotp_bind()
1117 so->rxid = addr->can_addr.tp.rx_id; in isotp_bind()
1118 so->txid = addr->can_addr.tp.tx_id; in isotp_bind()
1119 so->bound = 1; in isotp_bind()
1137 struct isotp_sock *so = isotp_sk(sk); in isotp_getname() local
1143 addr->can_ifindex = so->ifindex; in isotp_getname()
1144 addr->can_addr.tp.rx_id = so->rxid; in isotp_getname()
1145 addr->can_addr.tp.tx_id = so->txid; in isotp_getname()
1154 struct isotp_sock *so = isotp_sk(sk); in isotp_setsockopt() local
1160 if (so->bound) in isotp_setsockopt()
1168 if (copy_from_sockptr(&so->opt, optval, optlen)) in isotp_setsockopt()
1172 if (!(so->opt.flags & CAN_ISOTP_RX_EXT_ADDR)) in isotp_setsockopt()
1173 so->opt.rx_ext_address = so->opt.ext_address; in isotp_setsockopt()
1180 if (copy_from_sockptr(&so->rxfc, optval, optlen)) in isotp_setsockopt()
1188 if (copy_from_sockptr(&so->force_tx_stmin, optval, optlen)) in isotp_setsockopt()
1196 if (copy_from_sockptr(&so->force_rx_stmin, optval, optlen)) in isotp_setsockopt()
1217 memcpy(&so->ll, &ll, sizeof(ll)); in isotp_setsockopt()
1220 so->tx.ll_dl = ll.tx_dl; in isotp_setsockopt()
1237 struct isotp_sock *so = isotp_sk(sk); in isotp_getsockopt() local
1251 val = &so->opt; in isotp_getsockopt()
1256 val = &so->rxfc; in isotp_getsockopt()
1261 val = &so->force_tx_stmin; in isotp_getsockopt()
1266 val = &so->force_rx_stmin; in isotp_getsockopt()
1271 val = &so->ll; in isotp_getsockopt()
1289 struct isotp_sock *so = container_of(nb, struct isotp_sock, notifier); in isotp_notifier() local
1290 struct sock *sk = &so->sk; in isotp_notifier()
1298 if (so->ifindex != dev->ifindex) in isotp_notifier()
1305 if (so->bound) in isotp_notifier()
1306 can_rx_unregister(dev_net(dev), dev, so->rxid, in isotp_notifier()
1307 SINGLE_MASK(so->rxid), in isotp_notifier()
1310 so->ifindex = 0; in isotp_notifier()
1311 so->bound = 0; in isotp_notifier()
1331 struct isotp_sock *so = isotp_sk(sk); in isotp_init() local
1333 so->ifindex = 0; in isotp_init()
1334 so->bound = 0; in isotp_init()
1336 so->opt.flags = CAN_ISOTP_DEFAULT_FLAGS; in isotp_init()
1337 so->opt.ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS; in isotp_init()
1338 so->opt.rx_ext_address = CAN_ISOTP_DEFAULT_EXT_ADDRESS; in isotp_init()
1339 so->opt.rxpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT; in isotp_init()
1340 so->opt.txpad_content = CAN_ISOTP_DEFAULT_PAD_CONTENT; in isotp_init()
1341 so->opt.frame_txtime = CAN_ISOTP_DEFAULT_FRAME_TXTIME; in isotp_init()
1342 so->rxfc.bs = CAN_ISOTP_DEFAULT_RECV_BS; in isotp_init()
1343 so->rxfc.stmin = CAN_ISOTP_DEFAULT_RECV_STMIN; in isotp_init()
1344 so->rxfc.wftmax = CAN_ISOTP_DEFAULT_RECV_WFTMAX; in isotp_init()
1345 so->ll.mtu = CAN_ISOTP_DEFAULT_LL_MTU; in isotp_init()
1346 so->ll.tx_dl = CAN_ISOTP_DEFAULT_LL_TX_DL; in isotp_init()
1347 so->ll.tx_flags = CAN_ISOTP_DEFAULT_LL_TX_FLAGS; in isotp_init()
1350 so->tx.ll_dl = so->ll.tx_dl; in isotp_init()
1352 so->rx.state = ISOTP_IDLE; in isotp_init()
1353 so->tx.state = ISOTP_IDLE; in isotp_init()
1355 hrtimer_init(&so->rxtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT); in isotp_init()
1356 so->rxtimer.function = isotp_rx_timer_handler; in isotp_init()
1357 hrtimer_init(&so->txtimer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_SOFT); in isotp_init()
1358 so->txtimer.function = isotp_tx_timer_handler; in isotp_init()
1360 init_waitqueue_head(&so->wait); in isotp_init()
1362 so->notifier.notifier_call = isotp_notifier; in isotp_init()
1363 register_netdevice_notifier(&so->notifier); in isotp_init()