Lines Matching full:session
46 * connection managed session was terminated.
56 * close the session.
136 …return "System resources were needed for another task so this connection managed session was termi… in j1939_xtp_abort_to_str()
138 return "A timeout occurred and this is the connection abort to close the session."; in j1939_xtp_abort_to_str()
246 void j1939_session_get(struct j1939_session *session) in j1939_session_get() argument
248 kref_get(&session->kref); in j1939_session_get()
251 /* session completion functions */
252 static void __j1939_session_drop(struct j1939_session *session) in __j1939_session_drop() argument
254 if (!session->transmission) in __j1939_session_drop()
257 j1939_sock_pending_del(session->sk); in __j1939_session_drop()
258 sock_put(session->sk); in __j1939_session_drop()
261 static void j1939_session_destroy(struct j1939_session *session) in j1939_session_destroy() argument
265 if (session->transmission) { in j1939_session_destroy()
266 if (session->err) in j1939_session_destroy()
267 j1939_sk_errqueue(session, J1939_ERRQUEUE_TX_ABORT); in j1939_session_destroy()
269 j1939_sk_errqueue(session, J1939_ERRQUEUE_TX_ACK); in j1939_session_destroy()
270 } else if (session->err) { in j1939_session_destroy()
271 j1939_sk_errqueue(session, J1939_ERRQUEUE_RX_ABORT); in j1939_session_destroy()
274 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", __func__, session); in j1939_session_destroy()
276 WARN_ON_ONCE(!list_empty(&session->sk_session_queue_entry)); in j1939_session_destroy()
277 WARN_ON_ONCE(!list_empty(&session->active_session_list_entry)); in j1939_session_destroy()
279 while ((skb = skb_dequeue(&session->skb_queue)) != NULL) { in j1939_session_destroy()
284 __j1939_session_drop(session); in j1939_session_destroy()
285 j1939_priv_put(session->priv); in j1939_session_destroy()
286 kfree(session); in j1939_session_destroy()
291 struct j1939_session *session = container_of(kref, struct j1939_session, in __j1939_session_release() local
294 j1939_session_destroy(session); in __j1939_session_release()
297 void j1939_session_put(struct j1939_session *session) in j1939_session_put() argument
299 kref_put(&session->kref, __j1939_session_release); in j1939_session_put()
302 static void j1939_session_txtimer_cancel(struct j1939_session *session) in j1939_session_txtimer_cancel() argument
304 if (hrtimer_cancel(&session->txtimer)) in j1939_session_txtimer_cancel()
305 j1939_session_put(session); in j1939_session_txtimer_cancel()
308 static void j1939_session_rxtimer_cancel(struct j1939_session *session) in j1939_session_rxtimer_cancel() argument
310 if (hrtimer_cancel(&session->rxtimer)) in j1939_session_rxtimer_cancel()
311 j1939_session_put(session); in j1939_session_rxtimer_cancel()
314 void j1939_session_timers_cancel(struct j1939_session *session) in j1939_session_timers_cancel() argument
316 j1939_session_txtimer_cancel(session); in j1939_session_timers_cancel()
317 j1939_session_rxtimer_cancel(session); in j1939_session_timers_cancel()
325 static void j1939_session_skb_drop_old(struct j1939_session *session) in j1939_session_skb_drop_old() argument
332 if (skb_queue_len(&session->skb_queue) < 2) in j1939_session_skb_drop_old()
335 offset_start = session->pkt.tx_acked * 7; in j1939_session_skb_drop_old()
337 spin_lock_irqsave(&session->skb_queue.lock, flags); in j1939_session_skb_drop_old()
338 do_skb = skb_peek(&session->skb_queue); in j1939_session_skb_drop_old()
342 __skb_unlink(do_skb, &session->skb_queue); in j1939_session_skb_drop_old()
345 spin_unlock_irqrestore(&session->skb_queue.lock, flags); in j1939_session_skb_drop_old()
349 spin_unlock_irqrestore(&session->skb_queue.lock, flags); in j1939_session_skb_drop_old()
353 void j1939_session_skb_queue(struct j1939_session *session, in j1939_session_skb_queue() argument
357 struct j1939_priv *priv = session->priv; in j1939_session_skb_queue()
368 skb_queue_tail(&session->skb_queue, skb); in j1939_session_skb_queue()
372 sk_buff *j1939_session_skb_get_by_offset(struct j1939_session *session, in j1939_session_skb_get_by_offset() argument
375 struct j1939_priv *priv = session->priv; in j1939_session_skb_get_by_offset()
381 spin_lock_irqsave(&session->skb_queue.lock, flags); in j1939_session_skb_get_by_offset()
382 skb_queue_walk(&session->skb_queue, do_skb) { in j1939_session_skb_get_by_offset()
395 spin_unlock_irqrestore(&session->skb_queue.lock, flags); in j1939_session_skb_get_by_offset()
399 __func__, session, offset_start, in j1939_session_skb_get_by_offset()
400 skb_queue_len(&session->skb_queue)); in j1939_session_skb_get_by_offset()
405 static struct sk_buff *j1939_session_skb_get(struct j1939_session *session) in j1939_session_skb_get() argument
409 offset_start = session->pkt.dpo * 7; in j1939_session_skb_get()
410 return j1939_session_skb_get_by_offset(session, offset_start); in j1939_session_skb_get()
468 /* find existing session:
519 struct j1939_session *session; in j1939_session_get_by_addr_locked() local
523 list_for_each_entry(session, root, active_session_list_entry) { in j1939_session_get_by_addr_locked()
524 j1939_session_get(session); in j1939_session_get_by_addr_locked()
525 if (j1939_session_match(&session->skcb.addr, addr, reverse) && in j1939_session_get_by_addr_locked()
526 session->transmission == transmitter) in j1939_session_get_by_addr_locked()
527 return session; in j1939_session_get_by_addr_locked()
528 j1939_session_put(session); in j1939_session_get_by_addr_locked()
539 struct j1939_session *session; in j1939_session_get_simple() local
543 list_for_each_entry(session, &priv->active_session_list, in j1939_session_get_simple()
545 j1939_session_get(session); in j1939_session_get_simple()
546 if (session->skcb.addr.type == J1939_SIMPLE && in j1939_session_get_simple()
547 session->tskey == skcb->tskey && session->sk == skb->sk) in j1939_session_get_simple()
548 return session; in j1939_session_get_simple()
549 j1939_session_put(session); in j1939_session_get_simple()
560 struct j1939_session *session; in j1939_session_get_by_addr() local
563 session = j1939_session_get_by_addr_locked(priv, in j1939_session_get_by_addr()
568 return session; in j1939_session_get_by_addr()
632 static int j1939_tp_tx_dat(struct j1939_session *session, in j1939_tp_tx_dat() argument
635 struct j1939_priv *priv = session->priv; in j1939_tp_tx_dat()
638 skb = j1939_tp_tx_dat_new(priv, &session->skcb, in j1939_tp_tx_dat()
673 static inline int j1939_tp_tx_ctl(struct j1939_session *session, in j1939_tp_tx_ctl() argument
676 struct j1939_priv *priv = session->priv; in j1939_tp_tx_ctl()
678 return j1939_xtp_do_tx_ctl(priv, &session->skcb, in j1939_tp_tx_ctl()
680 session->skcb.addr.pgn, dat); in j1939_tp_tx_ctl()
700 void j1939_tp_schedule_txtimer(struct j1939_session *session, int msec) in j1939_tp_schedule_txtimer() argument
702 j1939_session_get(session); in j1939_tp_schedule_txtimer()
703 hrtimer_start(&session->txtimer, ms_to_ktime(msec), in j1939_tp_schedule_txtimer()
707 static inline void j1939_tp_set_rxtimeout(struct j1939_session *session, in j1939_tp_set_rxtimeout() argument
710 j1939_session_rxtimer_cancel(session); in j1939_tp_set_rxtimeout()
711 j1939_session_get(session); in j1939_tp_set_rxtimeout()
712 hrtimer_start(&session->rxtimer, ms_to_ktime(msec), in j1939_tp_set_rxtimeout()
716 static int j1939_session_tx_rts(struct j1939_session *session) in j1939_session_tx_rts() argument
723 dat[1] = (session->total_message_size >> 0); in j1939_session_tx_rts()
724 dat[2] = (session->total_message_size >> 8); in j1939_session_tx_rts()
725 dat[3] = session->pkt.total; in j1939_session_tx_rts()
727 if (session->skcb.addr.type == J1939_ETP) { in j1939_session_tx_rts()
729 dat[1] = (session->total_message_size >> 0); in j1939_session_tx_rts()
730 dat[2] = (session->total_message_size >> 8); in j1939_session_tx_rts()
731 dat[3] = (session->total_message_size >> 16); in j1939_session_tx_rts()
732 dat[4] = (session->total_message_size >> 24); in j1939_session_tx_rts()
733 } else if (j1939_cb_is_broadcast(&session->skcb)) { in j1939_session_tx_rts()
736 session->pkt.tx = 0; in j1939_session_tx_rts()
742 if (dat[0] == session->last_txcmd) in j1939_session_tx_rts()
746 ret = j1939_tp_tx_ctl(session, false, dat); in j1939_session_tx_rts()
750 session->last_txcmd = dat[0]; in j1939_session_tx_rts()
752 j1939_tp_schedule_txtimer(session, 50); in j1939_session_tx_rts()
753 j1939_tp_set_rxtimeout(session, 250); in j1939_session_tx_rts()
755 j1939_tp_set_rxtimeout(session, 1250); in j1939_session_tx_rts()
758 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", __func__, session); in j1939_session_tx_rts()
763 static int j1939_session_tx_dpo(struct j1939_session *session) in j1939_session_tx_dpo() argument
772 session->pkt.dpo = session->pkt.tx_acked; in j1939_session_tx_dpo()
773 pkt = session->pkt.dpo; in j1939_session_tx_dpo()
774 dat[1] = session->pkt.last - session->pkt.tx_acked; in j1939_session_tx_dpo()
779 ret = j1939_tp_tx_ctl(session, false, dat); in j1939_session_tx_dpo()
783 session->last_txcmd = dat[0]; in j1939_session_tx_dpo()
784 j1939_tp_set_rxtimeout(session, 1250); in j1939_session_tx_dpo()
785 session->pkt.tx = session->pkt.tx_acked; in j1939_session_tx_dpo()
787 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", __func__, session); in j1939_session_tx_dpo()
792 static int j1939_session_tx_dat(struct j1939_session *session) in j1939_session_tx_dat() argument
794 struct j1939_priv *priv = session->priv; in j1939_session_tx_dat()
803 se_skb = j1939_session_skb_get_by_offset(session, session->pkt.tx * 7); in j1939_session_tx_dat()
811 if (session->skcb.addr.type != J1939_ETP && in j1939_session_tx_dat()
812 j1939_cb_is_broadcast(&session->skcb)) in j1939_session_tx_dat()
813 pkt_end = session->pkt.total; in j1939_session_tx_dat()
815 pkt_end = session->pkt.last; in j1939_session_tx_dat()
817 while (session->pkt.tx < pkt_end) { in j1939_session_tx_dat()
818 dat[0] = session->pkt.tx - session->pkt.dpo + 1; in j1939_session_tx_dat()
819 offset = (session->pkt.tx * 7) - se_skcb->offset; in j1939_session_tx_dat()
827 __func__, session, se_skcb->offset, in j1939_session_tx_dat()
828 se_skb->len , session->pkt.tx); in j1939_session_tx_dat()
839 ret = j1939_tp_tx_dat(session, dat, len + 1); in j1939_session_tx_dat()
845 __func__, session, ret); in j1939_session_tx_dat()
849 session->last_txcmd = 0xff; in j1939_session_tx_dat()
851 session->pkt.tx++; in j1939_session_tx_dat()
852 pdelay = j1939_cb_is_broadcast(&session->skcb) ? 50 : in j1939_session_tx_dat()
855 if (session->pkt.tx < session->pkt.total && pdelay) { in j1939_session_tx_dat()
856 j1939_tp_schedule_txtimer(session, pdelay); in j1939_session_tx_dat()
862 j1939_tp_set_rxtimeout(session, 250); in j1939_session_tx_dat()
873 static int j1939_xtp_txnext_transmiter(struct j1939_session *session) in j1939_xtp_txnext_transmiter() argument
875 struct j1939_priv *priv = session->priv; in j1939_xtp_txnext_transmiter()
878 if (!j1939_tp_im_transmitter(&session->skcb)) { in j1939_xtp_txnext_transmiter()
880 __func__, session); in j1939_xtp_txnext_transmiter()
884 switch (session->last_cmd) { in j1939_xtp_txnext_transmiter()
886 ret = j1939_session_tx_rts(session); in j1939_xtp_txnext_transmiter()
890 if (session->last_txcmd != J1939_ETP_CMD_DPO) { in j1939_xtp_txnext_transmiter()
891 ret = j1939_session_tx_dpo(session); in j1939_xtp_txnext_transmiter()
901 ret = j1939_session_tx_dat(session); in j1939_xtp_txnext_transmiter()
906 __func__, session, session->last_cmd); in j1939_xtp_txnext_transmiter()
912 static int j1939_session_tx_cts(struct j1939_session *session) in j1939_session_tx_cts() argument
914 struct j1939_priv *priv = session->priv; in j1939_session_tx_cts()
919 if (!j1939_sk_recv_match(priv, &session->skcb)) in j1939_session_tx_cts()
922 len = session->pkt.total - session->pkt.rx; in j1939_session_tx_cts()
923 len = min3(len, session->pkt.block, j1939_tp_block ?: 255); in j1939_session_tx_cts()
926 if (session->skcb.addr.type == J1939_ETP) { in j1939_session_tx_cts()
927 pkt = session->pkt.rx + 1; in j1939_session_tx_cts()
936 dat[2] = session->pkt.rx + 1; in j1939_session_tx_cts()
939 if (dat[0] == session->last_txcmd) in j1939_session_tx_cts()
943 ret = j1939_tp_tx_ctl(session, true, dat); in j1939_session_tx_cts()
949 session->last_txcmd = dat[0]; in j1939_session_tx_cts()
950 j1939_tp_set_rxtimeout(session, 1250); in j1939_session_tx_cts()
952 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", __func__, session); in j1939_session_tx_cts()
957 static int j1939_session_tx_eoma(struct j1939_session *session) in j1939_session_tx_eoma() argument
959 struct j1939_priv *priv = session->priv; in j1939_session_tx_eoma()
963 if (!j1939_sk_recv_match(priv, &session->skcb)) in j1939_session_tx_eoma()
968 if (session->skcb.addr.type == J1939_ETP) { in j1939_session_tx_eoma()
970 dat[1] = session->total_message_size >> 0; in j1939_session_tx_eoma()
971 dat[2] = session->total_message_size >> 8; in j1939_session_tx_eoma()
972 dat[3] = session->total_message_size >> 16; in j1939_session_tx_eoma()
973 dat[4] = session->total_message_size >> 24; in j1939_session_tx_eoma()
976 dat[1] = session->total_message_size; in j1939_session_tx_eoma()
977 dat[2] = session->total_message_size >> 8; in j1939_session_tx_eoma()
978 dat[3] = session->pkt.total; in j1939_session_tx_eoma()
981 if (dat[0] == session->last_txcmd) in j1939_session_tx_eoma()
985 ret = j1939_tp_tx_ctl(session, true, dat); in j1939_session_tx_eoma()
989 session->last_txcmd = dat[0]; in j1939_session_tx_eoma()
992 j1939_tp_set_rxtimeout(session, 1250); in j1939_session_tx_eoma()
994 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", __func__, session); in j1939_session_tx_eoma()
999 static int j1939_xtp_txnext_receiver(struct j1939_session *session) in j1939_xtp_txnext_receiver() argument
1001 struct j1939_priv *priv = session->priv; in j1939_xtp_txnext_receiver()
1004 if (!j1939_tp_im_receiver(&session->skcb)) { in j1939_xtp_txnext_receiver()
1006 __func__, session); in j1939_xtp_txnext_receiver()
1010 switch (session->last_cmd) { in j1939_xtp_txnext_receiver()
1013 ret = j1939_session_tx_cts(session); in j1939_xtp_txnext_receiver()
1020 if ((session->skcb.addr.type == J1939_TP && in j1939_xtp_txnext_receiver()
1021 j1939_cb_is_broadcast(&session->skcb))) in j1939_xtp_txnext_receiver()
1024 if (session->pkt.rx >= session->pkt.total) { in j1939_xtp_txnext_receiver()
1025 ret = j1939_session_tx_eoma(session); in j1939_xtp_txnext_receiver()
1026 } else if (session->pkt.rx >= session->pkt.last) { in j1939_xtp_txnext_receiver()
1027 session->last_txcmd = 0; in j1939_xtp_txnext_receiver()
1028 ret = j1939_session_tx_cts(session); in j1939_xtp_txnext_receiver()
1033 __func__, session, session->last_cmd); in j1939_xtp_txnext_receiver()
1039 static int j1939_simple_txnext(struct j1939_session *session) in j1939_simple_txnext() argument
1041 struct j1939_priv *priv = session->priv; in j1939_simple_txnext()
1042 struct sk_buff *se_skb = j1939_session_skb_get(session); in j1939_simple_txnext()
1057 j1939_tp_set_rxtimeout(session, J1939_SIMPLE_ECHO_TIMEOUT_MS); in j1939_simple_txnext()
1063 j1939_sk_errqueue(session, J1939_ERRQUEUE_TX_SCHED); in j1939_simple_txnext()
1064 j1939_sk_queue_activate_next(session); in j1939_simple_txnext()
1075 static bool j1939_session_deactivate_locked(struct j1939_session *session) in j1939_session_deactivate_locked() argument
1079 lockdep_assert_held(&session->priv->active_session_list_lock); in j1939_session_deactivate_locked()
1081 if (session->state >= J1939_SESSION_ACTIVE && in j1939_session_deactivate_locked()
1082 session->state < J1939_SESSION_ACTIVE_MAX) { in j1939_session_deactivate_locked()
1085 list_del_init(&session->active_session_list_entry); in j1939_session_deactivate_locked()
1086 session->state = J1939_SESSION_DONE; in j1939_session_deactivate_locked()
1087 j1939_session_put(session); in j1939_session_deactivate_locked()
1093 static bool j1939_session_deactivate(struct j1939_session *session) in j1939_session_deactivate() argument
1095 struct j1939_priv *priv = session->priv; in j1939_session_deactivate()
1099 active = j1939_session_deactivate_locked(session); in j1939_session_deactivate()
1106 j1939_session_deactivate_activate_next(struct j1939_session *session) in j1939_session_deactivate_activate_next() argument
1108 if (j1939_session_deactivate(session)) in j1939_session_deactivate_activate_next()
1109 j1939_sk_queue_activate_next(session); in j1939_session_deactivate_activate_next()
1112 static void __j1939_session_cancel(struct j1939_session *session, in __j1939_session_cancel() argument
1115 struct j1939_priv *priv = session->priv; in __j1939_session_cancel()
1118 lockdep_assert_held(&session->priv->active_session_list_lock); in __j1939_session_cancel()
1120 session->err = j1939_xtp_abort_to_errno(priv, err); in __j1939_session_cancel()
1121 session->state = J1939_SESSION_WAITING_ABORT; in __j1939_session_cancel()
1123 if (!j1939_cb_is_broadcast(&session->skcb)) { in __j1939_session_cancel()
1124 j1939_xtp_tx_abort(priv, &session->skcb, in __j1939_session_cancel()
1125 !session->transmission, in __j1939_session_cancel()
1126 err, session->skcb.addr.pgn); in __j1939_session_cancel()
1129 if (session->sk) in __j1939_session_cancel()
1130 j1939_sk_send_loop_abort(session->sk, session->err); in __j1939_session_cancel()
1133 static void j1939_session_cancel(struct j1939_session *session, in j1939_session_cancel() argument
1136 j1939_session_list_lock(session->priv); in j1939_session_cancel()
1138 if (session->state >= J1939_SESSION_ACTIVE && in j1939_session_cancel()
1139 session->state < J1939_SESSION_WAITING_ABORT) { in j1939_session_cancel()
1140 j1939_tp_set_rxtimeout(session, J1939_XTP_ABORT_TIMEOUT_MS); in j1939_session_cancel()
1141 __j1939_session_cancel(session, err); in j1939_session_cancel()
1144 j1939_session_list_unlock(session->priv); in j1939_session_cancel()
1146 if (!session->sk) in j1939_session_cancel()
1147 j1939_sk_errqueue(session, J1939_ERRQUEUE_RX_ABORT); in j1939_session_cancel()
1152 struct j1939_session *session = in j1939_tp_txtimer() local
1154 struct j1939_priv *priv = session->priv; in j1939_tp_txtimer()
1157 if (session->skcb.addr.type == J1939_SIMPLE) { in j1939_tp_txtimer()
1158 ret = j1939_simple_txnext(session); in j1939_tp_txtimer()
1160 if (session->transmission) in j1939_tp_txtimer()
1161 ret = j1939_xtp_txnext_transmiter(session); in j1939_tp_txtimer()
1163 ret = j1939_xtp_txnext_receiver(session); in j1939_tp_txtimer()
1169 if (session->tx_retry < J1939_XTP_TX_RETRY_LIMIT) { in j1939_tp_txtimer()
1170 session->tx_retry++; in j1939_tp_txtimer()
1171 j1939_tp_schedule_txtimer(session, in j1939_tp_txtimer()
1175 __func__, session); in j1939_tp_txtimer()
1176 session->err = -ENETUNREACH; in j1939_tp_txtimer()
1177 j1939_session_rxtimer_cancel(session); in j1939_tp_txtimer()
1178 j1939_session_deactivate_activate_next(session); in j1939_tp_txtimer()
1190 j1939_session_cancel(session, J1939_XTP_ABORT_ECTS_TOO_BIG); in j1939_tp_txtimer()
1193 session->tx_retry = 0; in j1939_tp_txtimer()
1197 __func__, session, ret); in j1939_tp_txtimer()
1198 if (session->skcb.addr.type != J1939_SIMPLE) { in j1939_tp_txtimer()
1199 j1939_session_cancel(session, J1939_XTP_ABORT_OTHER); in j1939_tp_txtimer()
1201 session->err = ret; in j1939_tp_txtimer()
1202 j1939_session_rxtimer_cancel(session); in j1939_tp_txtimer()
1203 j1939_session_deactivate_activate_next(session); in j1939_tp_txtimer()
1207 j1939_session_put(session); in j1939_tp_txtimer()
1212 static void j1939_session_completed(struct j1939_session *session) in j1939_session_completed() argument
1216 if (!session->transmission) { in j1939_session_completed()
1217 se_skb = j1939_session_skb_get(session); in j1939_session_completed()
1219 j1939_sk_recv(session->priv, se_skb); in j1939_session_completed()
1223 j1939_session_deactivate_activate_next(session); in j1939_session_completed()
1228 struct j1939_session *session = container_of(hrtimer, in j1939_tp_rxtimer() local
1231 struct j1939_priv *priv = session->priv; in j1939_tp_rxtimer()
1233 if (session->state == J1939_SESSION_WAITING_ABORT) { in j1939_tp_rxtimer()
1234 netdev_alert(priv->ndev, "%s: 0x%p: abort rx timeout. Force session deactivation\n", in j1939_tp_rxtimer()
1235 __func__, session); in j1939_tp_rxtimer()
1237 j1939_session_deactivate_activate_next(session); in j1939_tp_rxtimer()
1239 } else if (session->skcb.addr.type == J1939_SIMPLE) { in j1939_tp_rxtimer()
1241 __func__, session); in j1939_tp_rxtimer()
1246 session->err = -ETIME; in j1939_tp_rxtimer()
1247 j1939_session_deactivate(session); in j1939_tp_rxtimer()
1249 j1939_session_list_lock(session->priv); in j1939_tp_rxtimer()
1250 if (session->state >= J1939_SESSION_ACTIVE && in j1939_tp_rxtimer()
1251 session->state < J1939_SESSION_ACTIVE_MAX) { in j1939_tp_rxtimer()
1253 __func__, session); in j1939_tp_rxtimer()
1254 j1939_session_get(session); in j1939_tp_rxtimer()
1255 hrtimer_start(&session->rxtimer, in j1939_tp_rxtimer()
1258 __j1939_session_cancel(session, J1939_XTP_ABORT_TIMEOUT); in j1939_tp_rxtimer()
1260 j1939_session_list_unlock(session->priv); in j1939_tp_rxtimer()
1262 if (!session->sk) in j1939_tp_rxtimer()
1263 j1939_sk_errqueue(session, J1939_ERRQUEUE_RX_ABORT); in j1939_tp_rxtimer()
1266 j1939_session_put(session); in j1939_tp_rxtimer()
1271 static bool j1939_xtp_rx_cmd_bad_pgn(struct j1939_session *session, in j1939_xtp_rx_cmd_bad_pgn() argument
1276 struct j1939_priv *priv = session->priv; in j1939_xtp_rx_cmd_bad_pgn()
1280 if (session->skcb.addr.pgn == pgn) in j1939_xtp_rx_cmd_bad_pgn()
1319 …netdev_warn(priv->ndev, "%s: 0x%p: CMD 0x%02x with PGN 0x%05x for running session with different P… in j1939_xtp_rx_cmd_bad_pgn()
1320 __func__, session, cmd, pgn, session->skcb.addr.pgn); in j1939_xtp_rx_cmd_bad_pgn()
1331 struct j1939_session *session; in j1939_xtp_rx_abort_one() local
1334 session = j1939_session_get_by_addr(priv, &skcb->addr, reverse, in j1939_xtp_rx_abort_one()
1336 if (!session) in j1939_xtp_rx_abort_one()
1339 if (j1939_xtp_rx_cmd_bad_pgn(session, skb)) in j1939_xtp_rx_abort_one()
1343 session, j1939_xtp_ctl_to_pgn(skb->data), abort, in j1939_xtp_rx_abort_one()
1346 j1939_session_timers_cancel(session); in j1939_xtp_rx_abort_one()
1347 session->err = j1939_xtp_abort_to_errno(priv, abort); in j1939_xtp_rx_abort_one()
1348 if (session->sk) in j1939_xtp_rx_abort_one()
1349 j1939_sk_send_loop_abort(session->sk, session->err); in j1939_xtp_rx_abort_one()
1351 j1939_sk_errqueue(session, J1939_ERRQUEUE_RX_ABORT); in j1939_xtp_rx_abort_one()
1352 j1939_session_deactivate_activate_next(session); in j1939_xtp_rx_abort_one()
1355 j1939_session_put(session); in j1939_xtp_rx_abort_one()
1368 j1939_xtp_rx_eoma_one(struct j1939_session *session, struct sk_buff *skb) in j1939_xtp_rx_eoma_one() argument
1374 if (j1939_xtp_rx_cmd_bad_pgn(session, skb)) in j1939_xtp_rx_eoma_one()
1384 if (session->total_message_size != len) { in j1939_xtp_rx_eoma_one()
1385 netdev_warn_once(session->priv->ndev, in j1939_xtp_rx_eoma_one()
1387 __func__, session, session->total_message_size, in j1939_xtp_rx_eoma_one()
1391 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", __func__, session); in j1939_xtp_rx_eoma_one()
1393 session->pkt.tx_acked = session->pkt.total; in j1939_xtp_rx_eoma_one()
1394 j1939_session_timers_cancel(session); in j1939_xtp_rx_eoma_one()
1396 j1939_session_completed(session); in j1939_xtp_rx_eoma_one()
1404 struct j1939_session *session; in j1939_xtp_rx_eoma() local
1406 session = j1939_session_get_by_addr(priv, &skcb->addr, true, in j1939_xtp_rx_eoma()
1408 if (!session) in j1939_xtp_rx_eoma()
1411 j1939_xtp_rx_eoma_one(session, skb); in j1939_xtp_rx_eoma()
1412 j1939_session_put(session); in j1939_xtp_rx_eoma()
1416 j1939_xtp_rx_cts_one(struct j1939_session *session, struct sk_buff *skb) in j1939_xtp_rx_cts_one() argument
1424 if (j1939_xtp_rx_cmd_bad_pgn(session, skb)) in j1939_xtp_rx_cts_one()
1427 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", __func__, session); in j1939_xtp_rx_cts_one()
1429 if (session->last_cmd == dat[0]) { in j1939_xtp_rx_cts_one()
1434 if (session->skcb.addr.type == J1939_ETP) in j1939_xtp_rx_cts_one()
1441 else if (dat[1] > session->pkt.block /* 0xff for etp */) in j1939_xtp_rx_cts_one()
1445 session->pkt.tx_acked = pkt - 1; in j1939_xtp_rx_cts_one()
1446 j1939_session_skb_drop_old(session); in j1939_xtp_rx_cts_one()
1447 session->pkt.last = session->pkt.tx_acked + dat[1]; in j1939_xtp_rx_cts_one()
1448 if (session->pkt.last > session->pkt.total) in j1939_xtp_rx_cts_one()
1450 session->pkt.last = session->pkt.total; in j1939_xtp_rx_cts_one()
1452 session->pkt.tx = session->pkt.tx_acked; in j1939_xtp_rx_cts_one()
1454 session->last_cmd = dat[0]; in j1939_xtp_rx_cts_one()
1456 j1939_tp_set_rxtimeout(session, 1250); in j1939_xtp_rx_cts_one()
1457 if (session->transmission) { in j1939_xtp_rx_cts_one()
1458 if (session->pkt.tx_acked) in j1939_xtp_rx_cts_one()
1459 j1939_sk_errqueue(session, in j1939_xtp_rx_cts_one()
1461 j1939_session_txtimer_cancel(session); in j1939_xtp_rx_cts_one()
1462 j1939_tp_schedule_txtimer(session, 0); in j1939_xtp_rx_cts_one()
1466 j1939_tp_set_rxtimeout(session, 550); in j1939_xtp_rx_cts_one()
1471 j1939_session_timers_cancel(session); in j1939_xtp_rx_cts_one()
1472 j1939_session_cancel(session, err); in j1939_xtp_rx_cts_one()
1479 struct j1939_session *session; in j1939_xtp_rx_cts() local
1481 session = j1939_session_get_by_addr(priv, &skcb->addr, true, in j1939_xtp_rx_cts()
1483 if (!session) in j1939_xtp_rx_cts()
1485 j1939_xtp_rx_cts_one(session, skb); in j1939_xtp_rx_cts()
1486 j1939_session_put(session); in j1939_xtp_rx_cts()
1492 struct j1939_session *session; in j1939_session_new() local
1495 session = kzalloc(sizeof(*session), gfp_any()); in j1939_session_new()
1496 if (!session) in j1939_session_new()
1499 INIT_LIST_HEAD(&session->active_session_list_entry); in j1939_session_new()
1500 INIT_LIST_HEAD(&session->sk_session_queue_entry); in j1939_session_new()
1501 kref_init(&session->kref); in j1939_session_new()
1504 session->priv = priv; in j1939_session_new()
1505 session->total_message_size = size; in j1939_session_new()
1506 session->state = J1939_SESSION_NEW; in j1939_session_new()
1508 skb_queue_head_init(&session->skb_queue); in j1939_session_new()
1509 skb_queue_tail(&session->skb_queue, skb_get(skb)); in j1939_session_new()
1512 memcpy(&session->skcb, skcb, sizeof(session->skcb)); in j1939_session_new()
1514 hrtimer_init(&session->txtimer, CLOCK_MONOTONIC, in j1939_session_new()
1516 session->txtimer.function = j1939_tp_txtimer; in j1939_session_new()
1517 hrtimer_init(&session->rxtimer, CLOCK_MONOTONIC, in j1939_session_new()
1519 session->rxtimer.function = j1939_tp_rxtimer; in j1939_session_new()
1522 __func__, session, skcb->addr.sa, skcb->addr.da); in j1939_session_new()
1524 return session; in j1939_session_new()
1534 struct j1939_session *session; in j1939_session_fresh_new() local
1547 session = j1939_session_new(priv, skb, size); in j1939_session_fresh_new()
1548 if (!session) { in j1939_session_fresh_new()
1556 return session; in j1939_session_fresh_new()
1559 int j1939_session_activate(struct j1939_session *session) in j1939_session_activate() argument
1561 struct j1939_priv *priv = session->priv; in j1939_session_activate()
1566 if (session->skcb.addr.type != J1939_SIMPLE) in j1939_session_activate()
1569 &session->skcb.addr, false, in j1939_session_activate()
1570 session->transmission); in j1939_session_activate()
1575 WARN_ON_ONCE(session->state != J1939_SESSION_NEW); in j1939_session_activate()
1576 list_add_tail(&session->active_session_list_entry, in j1939_session_activate()
1578 j1939_session_get(session); in j1939_session_activate()
1579 session->state = J1939_SESSION_ACTIVE; in j1939_session_activate()
1581 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", in j1939_session_activate()
1582 __func__, session); in j1939_session_activate()
1595 struct j1939_session *session; in j1939_xtp_rx_rts_session_new() local
1632 session = j1939_session_fresh_new(priv, len, &skcb); in j1939_xtp_rx_rts_session_new()
1633 if (!session) { in j1939_xtp_rx_rts_session_new()
1640 session->pkt.total = (len + 6) / 7; in j1939_xtp_rx_rts_session_new()
1641 session->pkt.block = 0xff; in j1939_xtp_rx_rts_session_new()
1643 if (dat[3] != session->pkt.total) in j1939_xtp_rx_rts_session_new()
1645 __func__, session, session->pkt.total, in j1939_xtp_rx_rts_session_new()
1647 session->pkt.total = dat[3]; in j1939_xtp_rx_rts_session_new()
1648 session->pkt.block = min(dat[3], dat[4]); in j1939_xtp_rx_rts_session_new()
1651 session->pkt.rx = 0; in j1939_xtp_rx_rts_session_new()
1652 session->pkt.tx = 0; in j1939_xtp_rx_rts_session_new()
1654 session->tskey = priv->rx_tskey++; in j1939_xtp_rx_rts_session_new()
1655 j1939_sk_errqueue(session, J1939_ERRQUEUE_RX_RTS); in j1939_xtp_rx_rts_session_new()
1657 ret = j1939_session_activate(session); in j1939_xtp_rx_rts_session_new()
1661 * - A time lapse occurred, and a new session was initiated in j1939_xtp_rx_rts_session_new()
1668 …netdev_alert(priv->ndev, "%s: 0x%p: concurrent session with same addr (%02x %02x) is already activ… in j1939_xtp_rx_rts_session_new()
1669 __func__, session, skcb.addr.sa, skcb.addr.da); in j1939_xtp_rx_rts_session_new()
1670 j1939_session_put(session); in j1939_xtp_rx_rts_session_new()
1674 return session; in j1939_xtp_rx_rts_session_new()
1677 static int j1939_xtp_rx_rts_session_active(struct j1939_session *session, in j1939_xtp_rx_rts_session_active() argument
1681 struct j1939_priv *priv = session->priv; in j1939_xtp_rx_rts_session_active()
1683 if (!session->transmission) { in j1939_xtp_rx_rts_session_active()
1684 if (j1939_xtp_rx_cmd_bad_pgn(session, skb)) in j1939_xtp_rx_rts_session_active()
1687 /* RTS on active session */ in j1939_xtp_rx_rts_session_active()
1688 j1939_session_timers_cancel(session); in j1939_xtp_rx_rts_session_active()
1689 j1939_session_cancel(session, J1939_XTP_ABORT_BUSY); in j1939_xtp_rx_rts_session_active()
1692 if (session->last_cmd != 0) { in j1939_xtp_rx_rts_session_active()
1695 __func__, session, skcb->addr.sa, skcb->addr.da, in j1939_xtp_rx_rts_session_active()
1696 session->last_cmd); in j1939_xtp_rx_rts_session_active()
1698 j1939_session_timers_cancel(session); in j1939_xtp_rx_rts_session_active()
1699 j1939_session_cancel(session, J1939_XTP_ABORT_BUSY); in j1939_xtp_rx_rts_session_active()
1700 if (session->transmission) in j1939_xtp_rx_rts_session_active()
1701 j1939_session_deactivate_activate_next(session); in j1939_xtp_rx_rts_session_active()
1706 if (session->skcb.addr.sa != skcb->addr.sa || in j1939_xtp_rx_rts_session_active()
1707 session->skcb.addr.da != skcb->addr.da) in j1939_xtp_rx_rts_session_active()
1708 …netdev_warn(priv->ndev, "%s: 0x%p: session->skcb.addr.sa=0x%02x skcb->addr.sa=0x%02x session->skcb… in j1939_xtp_rx_rts_session_active()
1709 __func__, session, in j1939_xtp_rx_rts_session_active()
1710 session->skcb.addr.sa, skcb->addr.sa, in j1939_xtp_rx_rts_session_active()
1711 session->skcb.addr.da, skcb->addr.da); in j1939_xtp_rx_rts_session_active()
1716 session->skcb.addr.sa = skcb->addr.sa; in j1939_xtp_rx_rts_session_active()
1717 session->skcb.addr.da = skcb->addr.da; in j1939_xtp_rx_rts_session_active()
1719 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", __func__, session); in j1939_xtp_rx_rts_session_active()
1728 struct j1939_session *session; in j1939_xtp_rx_rts() local
1731 session = j1939_session_get_by_addr(priv, &skcb->addr, false, in j1939_xtp_rx_rts()
1734 if (!session) { in j1939_xtp_rx_rts()
1737 * we received our own RTS. A session has already been in j1939_xtp_rx_rts()
1743 * receiver session. in j1939_xtp_rx_rts()
1745 * The reasons the session is already destroyed might in j1939_xtp_rx_rts()
1747 * - user space closed socket was and the session was in j1939_xtp_rx_rts()
1749 * - session was aborted due to external abort message in j1939_xtp_rx_rts()
1753 session = j1939_xtp_rx_rts_session_new(priv, skb); in j1939_xtp_rx_rts()
1754 if (!session) { in j1939_xtp_rx_rts()
1756 netdev_info(priv->ndev, "%s: failed to create TP BAM session\n", in j1939_xtp_rx_rts()
1761 if (j1939_xtp_rx_rts_session_active(session, skb)) { in j1939_xtp_rx_rts()
1762 j1939_session_put(session); in j1939_xtp_rx_rts()
1766 session->last_cmd = cmd; in j1939_xtp_rx_rts()
1769 if (!session->transmission) in j1939_xtp_rx_rts()
1770 j1939_tp_set_rxtimeout(session, 750); in j1939_xtp_rx_rts()
1772 if (!session->transmission) { in j1939_xtp_rx_rts()
1773 j1939_session_txtimer_cancel(session); in j1939_xtp_rx_rts()
1774 j1939_tp_schedule_txtimer(session, 0); in j1939_xtp_rx_rts()
1776 j1939_tp_set_rxtimeout(session, 1250); in j1939_xtp_rx_rts()
1779 j1939_session_put(session); in j1939_xtp_rx_rts()
1782 static void j1939_xtp_rx_dpo_one(struct j1939_session *session, in j1939_xtp_rx_dpo_one() argument
1787 if (j1939_xtp_rx_cmd_bad_pgn(session, skb)) in j1939_xtp_rx_dpo_one()
1790 netdev_dbg(session->priv->ndev, "%s: 0x%p\n", __func__, session); in j1939_xtp_rx_dpo_one()
1793 session->pkt.dpo = j1939_etp_ctl_to_packet(skb->data); in j1939_xtp_rx_dpo_one()
1794 session->last_cmd = dat[0]; in j1939_xtp_rx_dpo_one()
1795 j1939_tp_set_rxtimeout(session, 750); in j1939_xtp_rx_dpo_one()
1797 if (!session->transmission) in j1939_xtp_rx_dpo_one()
1798 j1939_sk_errqueue(session, J1939_ERRQUEUE_RX_DPO); in j1939_xtp_rx_dpo_one()
1805 struct j1939_session *session; in j1939_xtp_rx_dpo() local
1807 session = j1939_session_get_by_addr(priv, &skcb->addr, false, in j1939_xtp_rx_dpo()
1809 if (!session) { in j1939_xtp_rx_dpo()
1815 j1939_xtp_rx_dpo_one(session, skb); in j1939_xtp_rx_dpo()
1816 j1939_session_put(session); in j1939_xtp_rx_dpo()
1819 static void j1939_xtp_rx_dat_one(struct j1939_session *session, in j1939_xtp_rx_dat_one() argument
1823 struct j1939_priv *priv = session->priv; in j1939_xtp_rx_dat_one()
1843 switch (session->last_cmd) { in j1939_xtp_rx_dat_one()
1858 session, session->last_cmd); in j1939_xtp_rx_dat_one()
1862 packet = (dat[0] - 1 + session->pkt.dpo); in j1939_xtp_rx_dat_one()
1863 if (packet > session->pkt.total || in j1939_xtp_rx_dat_one()
1864 (session->pkt.rx + 1) > session->pkt.total) { in j1939_xtp_rx_dat_one()
1866 __func__, session); in j1939_xtp_rx_dat_one()
1870 se_skb = j1939_session_skb_get_by_offset(session, packet * 7); in j1939_xtp_rx_dat_one()
1873 session); in j1939_xtp_rx_dat_one()
1884 __func__, session, nbytes, skb->len); in j1939_xtp_rx_dat_one()
1889 if (!session->transmission) { in j1939_xtp_rx_dat_one()
1898 __func__, session, in j1939_xtp_rx_dat_one()
1903 if (packet == session->pkt.rx) in j1939_xtp_rx_dat_one()
1904 session->pkt.rx++; in j1939_xtp_rx_dat_one()
1907 j1939_cb_is_broadcast(&session->skcb)) { in j1939_xtp_rx_dat_one()
1908 if (session->pkt.rx >= session->pkt.total) in j1939_xtp_rx_dat_one()
1914 if (session->pkt.rx >= session->pkt.last) in j1939_xtp_rx_dat_one()
1919 j1939_session_timers_cancel(session); in j1939_xtp_rx_dat_one()
1920 j1939_session_completed(session); in j1939_xtp_rx_dat_one()
1922 if (!session->transmission) in j1939_xtp_rx_dat_one()
1923 j1939_tp_set_rxtimeout(session, 750); in j1939_xtp_rx_dat_one()
1925 j1939_tp_set_rxtimeout(session, 1250); in j1939_xtp_rx_dat_one()
1926 if (!session->transmission) in j1939_xtp_rx_dat_one()
1927 j1939_tp_schedule_txtimer(session, 0); in j1939_xtp_rx_dat_one()
1929 j1939_tp_set_rxtimeout(session, 750); in j1939_xtp_rx_dat_one()
1931 session->last_cmd = 0xff; in j1939_xtp_rx_dat_one()
1933 j1939_session_put(session); in j1939_xtp_rx_dat_one()
1939 j1939_session_timers_cancel(session); in j1939_xtp_rx_dat_one()
1940 j1939_session_cancel(session, abort); in j1939_xtp_rx_dat_one()
1941 j1939_session_put(session); in j1939_xtp_rx_dat_one()
1947 struct j1939_session *session; in j1939_xtp_rx_dat() local
1952 session = j1939_session_get_by_addr(priv, &skcb->addr, false, in j1939_xtp_rx_dat()
1954 if (!session) in j1939_xtp_rx_dat()
1958 j1939_xtp_rx_dat_one(session, skb); in j1939_xtp_rx_dat()
1962 session = j1939_session_get_by_addr(priv, &skcb->addr, false, in j1939_xtp_rx_dat()
1964 if (!session) in j1939_xtp_rx_dat()
1968 j1939_xtp_rx_dat_one(session, skb); in j1939_xtp_rx_dat()
1972 session = j1939_session_get_by_addr(priv, &skcb->addr, false, in j1939_xtp_rx_dat()
1974 if (session) in j1939_xtp_rx_dat()
1975 j1939_xtp_rx_dat_one(session, skb); in j1939_xtp_rx_dat()
1984 struct j1939_session *session; in j1939_tp_send() local
2021 /* prepare new session */ in j1939_tp_send()
2022 session = j1939_session_new(priv, skb, size); in j1939_tp_send()
2023 if (!session) in j1939_tp_send()
2028 session->sk = skb->sk; in j1939_tp_send()
2029 session->transmission = true; in j1939_tp_send()
2030 session->pkt.total = (size + 6) / 7; in j1939_tp_send()
2031 session->pkt.block = skcb->addr.type == J1939_ETP ? 255 : in j1939_tp_send()
2032 min(j1939_tp_block ?: 255, session->pkt.total); in j1939_tp_send()
2034 if (j1939_cb_is_broadcast(&session->skcb)) in j1939_tp_send()
2036 session->pkt.last = session->pkt.total; in j1939_tp_send()
2038 skcb->tskey = atomic_inc_return(&session->sk->sk_tskey) - 1; in j1939_tp_send()
2039 session->tskey = skcb->tskey; in j1939_tp_send()
2041 return session; in j1939_tp_send()
2172 struct j1939_session *session; in j1939_simple_recv() local
2182 session = j1939_session_get_simple(priv, skb); in j1939_simple_recv()
2184 if (!session) { in j1939_simple_recv()
2191 j1939_session_timers_cancel(session); in j1939_simple_recv()
2192 j1939_session_deactivate(session); in j1939_simple_recv()
2193 j1939_session_put(session); in j1939_simple_recv()
2198 struct j1939_session *session, *saved; in j1939_cancel_active_session() local
2202 list_for_each_entry_safe(session, saved, in j1939_cancel_active_session()
2205 if (!sk || sk == session->sk) { in j1939_cancel_active_session()
2206 if (hrtimer_try_to_cancel(&session->txtimer) == 1) in j1939_cancel_active_session()
2207 j1939_session_put(session); in j1939_cancel_active_session()
2208 if (hrtimer_try_to_cancel(&session->rxtimer) == 1) in j1939_cancel_active_session()
2209 j1939_session_put(session); in j1939_cancel_active_session()
2211 session->err = ESHUTDOWN; in j1939_cancel_active_session()
2212 j1939_session_deactivate_locked(session); in j1939_cancel_active_session()