Lines Matching +full:- +full:grp
1 // SPDX-License-Identifier: GPL-2.0
79 .xid2_buf_len = (MPC_BUFSIZE_DEFAULT - 35),
125 /*-------------------------------------------------------------------*
128 *--------------------------------------------------------------------*/
169 rm--; in ctcmpc_dumpit()
176 ctcm_pr_debug(" --- %s ---\n", in ctcmpc_dumpit()
191 for ( ; rm > 0; rm--, sw++) { in ctcmpc_dumpit()
202 ctcm_pr_debug(" --- %s ---\n", tdup); in ctcmpc_dumpit()
210 ctcm_pr_debug(" --- %s ---\n", tdup); in ctcmpc_dumpit()
228 * offset Offset relative to skb-data, where to start the dump.
232 __u8 *p = skb->data; in ctcmpc_dump_skb()
235 int bl = skb->len; in ctcmpc_dump_skb()
245 ctcm_pr_debug("skb len=%d \n", skb->len); in ctcmpc_dump_skb()
246 if (skb->len > 2) { in ctcmpc_dump_skb()
247 switch (header->th_ch_flag) { in ctcmpc_dump_skb()
252 if ((header->th_blk_flag == TH_DATA_IS_XID) && in ctcmpc_dump_skb()
253 (header->th_is_xid == 0x01)) in ctcmpc_dump_skb()
264 ctcm_pr_debug("pdu->offset: %d hex: %04x\n", in ctcmpc_dump_skb()
265 pheader->pdu_offset, pheader->pdu_offset); in ctcmpc_dump_skb()
266 ctcm_pr_debug("pdu->flag : %02x\n", pheader->pdu_flag); in ctcmpc_dump_skb()
267 ctcm_pr_debug("pdu->proto : %02x\n", pheader->pdu_proto); in ctcmpc_dump_skb()
268 ctcm_pr_debug("pdu->seq : %02x\n", pheader->pdu_seq); in ctcmpc_dump_skb()
272 ctcm_pr_debug("th->seg : %02x\n", header->th_seg); in ctcmpc_dump_skb()
273 ctcm_pr_debug("th->ch : %02x\n", header->th_ch_flag); in ctcmpc_dump_skb()
274 ctcm_pr_debug("th->blk_flag: %02x\n", header->th_blk_flag); in ctcmpc_dump_skb()
275 ctcm_pr_debug("th->type : %s\n", in ctcmpc_dump_skb()
276 (header->th_is_xid) ? "DATA" : "XID"); in ctcmpc_dump_skb()
277 ctcm_pr_debug("th->seqnum : %04x\n", header->th_seq_num); in ctcmpc_dump_skb()
306 priv = dev->ml_priv; in ctcmpc_get_dev()
309 "%s(%s): dev->ml_priv is NULL", in ctcmpc_get_dev()
313 if (priv->mpcg == NULL) { in ctcmpc_get_dev()
315 "%s(%s): priv->mpcg is NULL", in ctcmpc_get_dev()
332 struct mpc_group *grp; in ctc_mpc_alloc_channel() local
338 priv = dev->ml_priv; in ctc_mpc_alloc_channel()
339 grp = priv->mpcg; in ctc_mpc_alloc_channel()
341 grp->allochanfunc = callback; in ctc_mpc_alloc_channel()
342 grp->port_num = port_num; in ctc_mpc_alloc_channel()
343 grp->port_persist = 1; in ctc_mpc_alloc_channel()
347 CTCM_FUNTAIL, dev->name, fsm_getstate_str(grp->fsm)); in ctc_mpc_alloc_channel()
349 switch (fsm_getstate(grp->fsm)) { in ctc_mpc_alloc_channel()
352 grp->alloc_called = 1; in ctc_mpc_alloc_channel()
359 /*fsm_newstate(grp->fsm, MPCG_STATE_XID2INITW);*/ in ctc_mpc_alloc_channel()
361 grp->send_qllc_disc = 1; in ctc_mpc_alloc_channel()
364 fsm_deltimer(&grp->timer); in ctc_mpc_alloc_channel()
365 grp->outstanding_xid2 = 0; in ctc_mpc_alloc_channel()
366 grp->outstanding_xid7 = 0; in ctc_mpc_alloc_channel()
367 grp->outstanding_xid7_p2 = 0; in ctc_mpc_alloc_channel()
368 grp->saved_xid2 = NULL; in ctc_mpc_alloc_channel()
371 fsm_event(priv->fsm, DEV_EVENT_START, dev); in ctc_mpc_alloc_channel()
377 grp->allocchan_callback_retries++; in ctc_mpc_alloc_channel()
378 if (grp->allocchan_callback_retries < 4) { in ctc_mpc_alloc_channel()
379 if (grp->allochanfunc) in ctc_mpc_alloc_channel()
380 grp->allochanfunc(grp->port_num, in ctc_mpc_alloc_channel()
381 grp->group_max_buflen); in ctc_mpc_alloc_channel()
385 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in ctc_mpc_alloc_channel()
386 grp->allocchan_callback_retries = 0; in ctc_mpc_alloc_channel()
403 struct mpc_group *grp; in ctc_mpc_establish_connectivity() local
410 priv = dev->ml_priv; in ctc_mpc_establish_connectivity()
411 grp = priv->mpcg; in ctc_mpc_establish_connectivity()
412 rch = priv->channel[CTCM_READ]; in ctc_mpc_establish_connectivity()
413 wch = priv->channel[CTCM_WRITE]; in ctc_mpc_establish_connectivity()
417 CTCM_FUNTAIL, dev->name, fsm_getstate_str(grp->fsm)); in ctc_mpc_establish_connectivity()
419 grp->estconnfunc = callback; in ctc_mpc_establish_connectivity()
420 grp->port_num = port_num; in ctc_mpc_establish_connectivity()
422 switch (fsm_getstate(grp->fsm)) { in ctc_mpc_establish_connectivity()
427 fsm_deltimer(&grp->timer); in ctc_mpc_establish_connectivity()
428 grp->estconn_callback_retries++; in ctc_mpc_establish_connectivity()
429 if (grp->estconn_callback_retries < 4) { in ctc_mpc_establish_connectivity()
430 if (grp->estconnfunc) { in ctc_mpc_establish_connectivity()
431 grp->estconnfunc(grp->port_num, 0, in ctc_mpc_establish_connectivity()
432 grp->group_max_buflen); in ctc_mpc_establish_connectivity()
433 grp->estconnfunc = NULL; in ctc_mpc_establish_connectivity()
437 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in ctc_mpc_establish_connectivity()
438 grp->estconn_callback_retries = 0; in ctc_mpc_establish_connectivity()
443 /* MPC Group is not ready to start XID - min num of */ in ctc_mpc_establish_connectivity()
447 "%s(%s): REJECTED - inactive channels", in ctc_mpc_establish_connectivity()
448 CTCM_FUNTAIL, dev->name); in ctc_mpc_establish_connectivity()
449 if (grp->estconnfunc) { in ctc_mpc_establish_connectivity()
450 grp->estconnfunc(grp->port_num, -1, 0); in ctc_mpc_establish_connectivity()
451 grp->estconnfunc = NULL; in ctc_mpc_establish_connectivity()
459 if ((fsm_getstate(rch->fsm) > CH_XID0_PENDING) || in ctc_mpc_establish_connectivity()
460 (fsm_getstate(wch->fsm) > CH_XID0_PENDING)) { in ctc_mpc_establish_connectivity()
462 "%s(%s): ABORT - PASSIVE XID", in ctc_mpc_establish_connectivity()
463 CTCM_FUNTAIL, dev->name); in ctc_mpc_establish_connectivity()
466 grp->send_qllc_disc = 1; in ctc_mpc_establish_connectivity()
467 fsm_newstate(grp->fsm, MPCG_STATE_XID0IOWAIT); in ctc_mpc_establish_connectivity()
468 fsm_deltimer(&grp->timer); in ctc_mpc_establish_connectivity()
469 fsm_addtimer(&grp->timer, MPC_XID_TIMEOUT_VALUE, in ctc_mpc_establish_connectivity()
471 grp->outstanding_xid7 = 0; in ctc_mpc_establish_connectivity()
472 grp->outstanding_xid7_p2 = 0; in ctc_mpc_establish_connectivity()
473 grp->saved_xid2 = NULL; in ctc_mpc_establish_connectivity()
474 if ((rch->in_mpcgroup) && in ctc_mpc_establish_connectivity()
475 (fsm_getstate(rch->fsm) == CH_XID0_PENDING)) in ctc_mpc_establish_connectivity()
476 fsm_event(grp->fsm, MPCG_EVENT_XID0DO, rch); in ctc_mpc_establish_connectivity()
479 "%s(%s): RX-%s not ready for ACTIVE XID0", in ctc_mpc_establish_connectivity()
480 CTCM_FUNTAIL, dev->name, rch->id); in ctc_mpc_establish_connectivity()
481 if (grp->estconnfunc) { in ctc_mpc_establish_connectivity()
482 grp->estconnfunc(grp->port_num, -1, 0); in ctc_mpc_establish_connectivity()
483 grp->estconnfunc = NULL; in ctc_mpc_establish_connectivity()
485 fsm_deltimer(&grp->timer); in ctc_mpc_establish_connectivity()
488 if ((wch->in_mpcgroup) && in ctc_mpc_establish_connectivity()
489 (fsm_getstate(wch->fsm) == CH_XID0_PENDING)) in ctc_mpc_establish_connectivity()
490 fsm_event(grp->fsm, MPCG_EVENT_XID0DO, wch); in ctc_mpc_establish_connectivity()
493 "%s(%s): WX-%s not ready for ACTIVE XID0", in ctc_mpc_establish_connectivity()
494 CTCM_FUNTAIL, dev->name, wch->id); in ctc_mpc_establish_connectivity()
495 if (grp->estconnfunc) { in ctc_mpc_establish_connectivity()
496 grp->estconnfunc(grp->port_num, -1, 0); in ctc_mpc_establish_connectivity()
497 grp->estconnfunc = NULL; in ctc_mpc_establish_connectivity()
499 fsm_deltimer(&grp->timer); in ctc_mpc_establish_connectivity()
523 struct mpc_group *grp; in ctc_mpc_dealloc_ch() local
528 priv = dev->ml_priv; in ctc_mpc_dealloc_ch()
529 grp = priv->mpcg; in ctc_mpc_dealloc_ch()
533 CTCM_FUNTAIL, dev->name, netdev_refcnt_read(dev)); in ctc_mpc_dealloc_ch()
535 fsm_deltimer(&priv->restart_timer); in ctc_mpc_dealloc_ch()
536 grp->channels_terminating = 0; in ctc_mpc_dealloc_ch()
537 fsm_deltimer(&grp->timer); in ctc_mpc_dealloc_ch()
538 grp->allochanfunc = NULL; in ctc_mpc_dealloc_ch()
539 grp->estconnfunc = NULL; in ctc_mpc_dealloc_ch()
540 grp->port_persist = 0; in ctc_mpc_dealloc_ch()
541 grp->send_qllc_disc = 0; in ctc_mpc_dealloc_ch()
542 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in ctc_mpc_dealloc_ch()
556 struct mpc_group *grp; in ctc_mpc_flow_control() local
564 priv = dev->ml_priv; in ctc_mpc_flow_control()
565 grp = priv->mpcg; in ctc_mpc_flow_control()
569 CTCM_FUNTAIL, dev->name, flowc); in ctc_mpc_flow_control()
571 rch = priv->channel[CTCM_READ]; in ctc_mpc_flow_control()
573 mpcg_state = fsm_getstate(grp->fsm); in ctc_mpc_flow_control()
579 if (grp->flow_off_called == 1) in ctc_mpc_flow_control()
580 grp->flow_off_called = 0; in ctc_mpc_flow_control()
582 fsm_newstate(grp->fsm, MPCG_STATE_FLOWC); in ctc_mpc_flow_control()
588 fsm_newstate(grp->fsm, MPCG_STATE_READY); in ctc_mpc_flow_control()
591 tasklet_schedule(&rch->ch_tasklet); in ctc_mpc_flow_control()
595 grp->flow_off_called = 1; in ctc_mpc_flow_control()
611 struct channel *rch = mpcginfo->ch; in mpc_rcvd_sweep_resp()
612 struct net_device *dev = rch->netdev; in mpc_rcvd_sweep_resp()
613 struct ctcm_priv *priv = dev->ml_priv; in mpc_rcvd_sweep_resp()
614 struct mpc_group *grp = priv->mpcg; in mpc_rcvd_sweep_resp() local
615 struct channel *ch = priv->channel[CTCM_WRITE]; in mpc_rcvd_sweep_resp()
617 CTCM_PR_DEBUG("%s: ch=0x%p id=%s\n", __func__, ch, ch->id); in mpc_rcvd_sweep_resp()
618 CTCM_D3_DUMP((char *)mpcginfo->sweep, TH_SWEEP_LENGTH); in mpc_rcvd_sweep_resp()
620 grp->sweep_rsp_pend_num--; in mpc_rcvd_sweep_resp()
622 if ((grp->sweep_req_pend_num == 0) && in mpc_rcvd_sweep_resp()
623 (grp->sweep_rsp_pend_num == 0)) { in mpc_rcvd_sweep_resp()
624 fsm_deltimer(&ch->sweep_timer); in mpc_rcvd_sweep_resp()
625 grp->in_sweep = 0; in mpc_rcvd_sweep_resp()
626 rch->th_seq_num = 0x00; in mpc_rcvd_sweep_resp()
627 ch->th_seq_num = 0x00; in mpc_rcvd_sweep_resp()
641 struct net_device *dev = rch->netdev; in ctcmpc_send_sweep_resp()
642 struct ctcm_priv *priv = dev->ml_priv; in ctcmpc_send_sweep_resp()
643 struct mpc_group *grp = priv->mpcg; in ctcmpc_send_sweep_resp() local
646 struct channel *ch = priv->channel[CTCM_WRITE]; in ctcmpc_send_sweep_resp()
648 CTCM_PR_DEBUG("%s: ch=0x%p id=%s\n", __func__, rch, rch->id); in ctcmpc_send_sweep_resp()
654 CTCM_FUNTAIL, rch->id); in ctcmpc_send_sweep_resp()
659 header->th.th_ch_flag = TH_SWEEP_RESP; in ctcmpc_send_sweep_resp()
660 header->sw.th_last_seq = ch->th_seq_num; in ctcmpc_send_sweep_resp()
663 skb_queue_tail(&ch->sweep_queue, sweep_skb); in ctcmpc_send_sweep_resp()
665 fsm_addtimer(&ch->sweep_timer, 100, CTC_EVENT_RSWEEP_TIMER, ch); in ctcmpc_send_sweep_resp()
670 grp->in_sweep = 0; in ctcmpc_send_sweep_resp()
672 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in ctcmpc_send_sweep_resp()
682 struct channel *rch = mpcginfo->ch; in mpc_rcvd_sweep_req()
683 struct net_device *dev = rch->netdev; in mpc_rcvd_sweep_req()
684 struct ctcm_priv *priv = dev->ml_priv; in mpc_rcvd_sweep_req()
685 struct mpc_group *grp = priv->mpcg; in mpc_rcvd_sweep_req() local
686 struct channel *ch = priv->channel[CTCM_WRITE]; in mpc_rcvd_sweep_req()
690 " %s(): ch=0x%p id=%s\n", __func__, ch, ch->id); in mpc_rcvd_sweep_req()
692 if (grp->in_sweep == 0) { in mpc_rcvd_sweep_req()
693 grp->in_sweep = 1; in mpc_rcvd_sweep_req()
695 grp->sweep_req_pend_num = grp->active_channels[CTCM_READ]; in mpc_rcvd_sweep_req()
696 grp->sweep_rsp_pend_num = grp->active_channels[CTCM_READ]; in mpc_rcvd_sweep_req()
699 CTCM_D3_DUMP((char *)mpcginfo->sweep, TH_SWEEP_LENGTH); in mpc_rcvd_sweep_req()
701 grp->sweep_req_pend_num--; in mpc_rcvd_sweep_req()
713 [MPCG_EVENT_XID0DO] = "Channel Active - Start XID",
724 [MPCG_STATE_XID2INITW] = "Passive XID- XID0 Pending Start",
725 [MPCG_STATE_XID2INITX] = "Passive XID- XID0 Pending Complete",
726 [MPCG_STATE_XID7INITW] = "Passive XID- XID7 Pending P1 Start",
727 [MPCG_STATE_XID7INITX] = "Passive XID- XID7 Pending P2 Complete",
728 [MPCG_STATE_XID0IOWAIT] = "Active XID- XID0 Pending Start",
729 [MPCG_STATE_XID0IOWAIX] = "Active XID- XID0 Pending Complete",
730 [MPCG_STATE_XID7INITI] = "Active XID- XID7 Pending Start",
731 [MPCG_STATE_XID7INITZ] = "Active XID- XID7 Pending Complete ",
732 [MPCG_STATE_XID7INITF] = "XID - XID7 Complete ",
818 struct ctcm_priv *priv = dev->ml_priv; in mpc_action_go_ready()
819 struct mpc_group *grp = priv->mpcg; in mpc_action_go_ready() local
821 if (grp == NULL) { in mpc_action_go_ready()
824 CTCM_FUNTAIL, dev->name); in mpc_action_go_ready()
828 fsm_deltimer(&grp->timer); in mpc_action_go_ready()
830 if (grp->saved_xid2->xid2_flag2 == 0x40) { in mpc_action_go_ready()
831 priv->xid->xid2_flag2 = 0x00; in mpc_action_go_ready()
832 if (grp->estconnfunc) { in mpc_action_go_ready()
833 grp->estconnfunc(grp->port_num, 1, in mpc_action_go_ready()
834 grp->group_max_buflen); in mpc_action_go_ready()
835 grp->estconnfunc = NULL; in mpc_action_go_ready()
836 } else if (grp->allochanfunc) in mpc_action_go_ready()
837 grp->send_qllc_disc = 1; in mpc_action_go_ready()
839 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in mpc_action_go_ready()
842 CTCM_FUNTAIL, dev->name); in mpc_action_go_ready()
846 grp->port_persist = 1; in mpc_action_go_ready()
847 grp->out_of_sequence = 0; in mpc_action_go_ready()
848 grp->estconn_called = 0; in mpc_action_go_ready()
850 tasklet_hi_schedule(&grp->mpc_tasklet2); in mpc_action_go_ready()
862 struct ctcm_priv *priv = dev->ml_priv; in mpc_group_ready()
863 struct mpc_group *grp = priv->mpcg; in mpc_group_ready() local
866 if (grp == NULL) { in mpc_group_ready()
869 CTCM_FUNTAIL, dev->name); in mpc_group_ready()
875 CTCM_FUNTAIL, dev->name, grp->group_max_buflen); in mpc_group_ready()
877 fsm_newstate(grp->fsm, MPCG_STATE_READY); in mpc_group_ready()
880 ch = priv->channel[CTCM_READ]; in mpc_group_ready()
881 ch->pdu_seq = 0; in mpc_group_ready()
883 __func__, ch->pdu_seq); in mpc_group_ready()
885 ctcmpc_chx_rxidle(ch->fsm, CTC_EVENT_START, ch); in mpc_group_ready()
887 ch = priv->channel[CTCM_WRITE]; in mpc_group_ready()
888 if (ch->collect_len > 0) { in mpc_group_ready()
889 spin_lock(&ch->collect_lock); in mpc_group_ready()
890 ctcm_purge_skb_queue(&ch->collect_queue); in mpc_group_ready()
891 ch->collect_len = 0; in mpc_group_ready()
892 spin_unlock(&ch->collect_lock); in mpc_group_ready()
894 ctcm_chx_txidle(ch->fsm, CTC_EVENT_START, ch); in mpc_group_ready()
897 if (grp->estconnfunc) { in mpc_group_ready()
898 grp->estconnfunc(grp->port_num, 0, in mpc_group_ready()
899 grp->group_max_buflen); in mpc_group_ready()
900 grp->estconnfunc = NULL; in mpc_group_ready()
901 } else if (grp->allochanfunc) { in mpc_group_ready()
902 grp->allochanfunc(grp->port_num, grp->group_max_buflen); in mpc_group_ready()
905 grp->send_qllc_disc = 1; in mpc_group_ready()
906 grp->changed_side = 0; in mpc_group_ready()
918 struct net_device *dev = ch->netdev; in mpc_channel_action()
919 struct ctcm_priv *priv = dev->ml_priv; in mpc_channel_action()
920 struct mpc_group *grp = priv->mpcg; in mpc_channel_action() local
922 if (grp == NULL) { in mpc_channel_action()
925 CTCM_FUNTAIL, dev->name); in mpc_channel_action()
929 CTCM_PR_DEBUG("enter %s: ch=0x%p id=%s\n", __func__, ch, ch->id); in mpc_channel_action()
932 "%s: %i / Grp:%s total_channels=%i, active_channels: " in mpc_channel_action()
934 fsm_getstate_str(grp->fsm), grp->num_channel_paths, in mpc_channel_action()
935 grp->active_channels[CTCM_READ], in mpc_channel_action()
936 grp->active_channels[CTCM_WRITE]); in mpc_channel_action()
938 if ((action == MPC_CHANNEL_ADD) && (ch->in_mpcgroup == 0)) { in mpc_channel_action()
939 grp->num_channel_paths++; in mpc_channel_action()
940 grp->active_channels[direction]++; in mpc_channel_action()
941 grp->outstanding_xid2++; in mpc_channel_action()
942 ch->in_mpcgroup = 1; in mpc_channel_action()
944 if (ch->xid_skb != NULL) in mpc_channel_action()
945 dev_kfree_skb_any(ch->xid_skb); in mpc_channel_action()
947 ch->xid_skb = __dev_alloc_skb(MPC_BUFSIZE_DEFAULT, in mpc_channel_action()
949 if (ch->xid_skb == NULL) { in mpc_channel_action()
952 CTCM_FUNTAIL, dev->name); in mpc_channel_action()
953 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in mpc_channel_action()
956 ch->xid_skb_data = ch->xid_skb->data; in mpc_channel_action()
957 ch->xid_th = (struct th_header *)ch->xid_skb->data; in mpc_channel_action()
958 skb_put(ch->xid_skb, TH_HEADER_LENGTH); in mpc_channel_action()
959 ch->xid = (struct xid2 *)skb_tail_pointer(ch->xid_skb); in mpc_channel_action()
960 skb_put(ch->xid_skb, XID2_LENGTH); in mpc_channel_action()
961 ch->xid_id = skb_tail_pointer(ch->xid_skb); in mpc_channel_action()
962 ch->xid_skb->data = ch->xid_skb_data; in mpc_channel_action()
963 skb_reset_tail_pointer(ch->xid_skb); in mpc_channel_action()
964 ch->xid_skb->len = 0; in mpc_channel_action()
966 skb_put_data(ch->xid_skb, grp->xid_skb->data, in mpc_channel_action()
967 grp->xid_skb->len); in mpc_channel_action()
969 ch->xid->xid2_dlc_type = in mpc_channel_action()
970 ((CHANNEL_DIRECTION(ch->flags) == CTCM_READ) in mpc_channel_action()
973 if (CHANNEL_DIRECTION(ch->flags) == CTCM_WRITE) in mpc_channel_action()
974 ch->xid->xid2_buf_len = 0x00; in mpc_channel_action()
976 ch->xid_skb->data = ch->xid_skb_data; in mpc_channel_action()
977 skb_reset_tail_pointer(ch->xid_skb); in mpc_channel_action()
978 ch->xid_skb->len = 0; in mpc_channel_action()
980 fsm_newstate(ch->fsm, CH_XID0_PENDING); in mpc_channel_action()
982 if ((grp->active_channels[CTCM_READ] > 0) && in mpc_channel_action()
983 (grp->active_channels[CTCM_WRITE] > 0) && in mpc_channel_action()
984 (fsm_getstate(grp->fsm) < MPCG_STATE_XID2INITW)) { in mpc_channel_action()
985 fsm_newstate(grp->fsm, MPCG_STATE_XID2INITW); in mpc_channel_action()
988 __func__, dev->name); in mpc_channel_action()
991 (ch->in_mpcgroup == 1)) { in mpc_channel_action()
992 ch->in_mpcgroup = 0; in mpc_channel_action()
993 grp->num_channel_paths--; in mpc_channel_action()
994 grp->active_channels[direction]--; in mpc_channel_action()
996 if (ch->xid_skb != NULL) in mpc_channel_action()
997 dev_kfree_skb_any(ch->xid_skb); in mpc_channel_action()
998 ch->xid_skb = NULL; in mpc_channel_action()
1000 if (grp->channels_terminating) in mpc_channel_action()
1003 if (((grp->active_channels[CTCM_READ] == 0) && in mpc_channel_action()
1004 (grp->active_channels[CTCM_WRITE] > 0)) in mpc_channel_action()
1005 || ((grp->active_channels[CTCM_WRITE] == 0) && in mpc_channel_action()
1006 (grp->active_channels[CTCM_READ] > 0))) in mpc_channel_action()
1007 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in mpc_channel_action()
1011 "exit %s: %i / Grp:%s total_channels=%i, active_channels: " in mpc_channel_action()
1013 fsm_getstate_str(grp->fsm), grp->num_channel_paths, in mpc_channel_action()
1014 grp->active_channels[CTCM_READ], in mpc_channel_action()
1015 grp->active_channels[CTCM_WRITE]); in mpc_channel_action()
1017 CTCM_PR_DEBUG("exit %s: ch=0x%p id=%s\n", __func__, ch, ch->id); in mpc_channel_action()
1030 struct net_device *dev = ch->netdev; in ctcmpc_unpack_skb()
1031 struct ctcm_priv *priv = dev->ml_priv; in ctcmpc_unpack_skb()
1032 struct mpc_group *grp = priv->mpcg; in ctcmpc_unpack_skb() local
1044 __func__, dev->name, smp_processor_id(), ch->id); in ctcmpc_unpack_skb()
1046 header = (struct th_header *)pskb->data; in ctcmpc_unpack_skb()
1047 if ((header->th_seg == 0) && in ctcmpc_unpack_skb()
1048 (header->th_ch_flag == 0) && in ctcmpc_unpack_skb()
1049 (header->th_blk_flag == 0) && in ctcmpc_unpack_skb()
1050 (header->th_seq_num == 0)) in ctcmpc_unpack_skb()
1055 CTCM_PR_DBGDATA("%s: pskb len: %04x \n", __func__, pskb->len); in ctcmpc_unpack_skb()
1057 pskb->dev = dev; in ctcmpc_unpack_skb()
1058 pskb->ip_summed = CHECKSUM_UNNECESSARY; in ctcmpc_unpack_skb()
1061 if (likely(header->th_ch_flag == TH_HAS_PDU)) { in ctcmpc_unpack_skb()
1063 if ((fsm_getstate(grp->fsm) == MPCG_STATE_FLOWC) || in ctcmpc_unpack_skb()
1064 ((fsm_getstate(grp->fsm) == MPCG_STATE_READY) && in ctcmpc_unpack_skb()
1065 (header->th_seq_num != ch->th_seq_num + 1) && in ctcmpc_unpack_skb()
1066 (ch->th_seq_num != 0))) { in ctcmpc_unpack_skb()
1073 grp->out_of_sequence += 1; in ctcmpc_unpack_skb()
1075 skb_queue_tail(&ch->io_queue, pskb); in ctcmpc_unpack_skb()
1078 ch->th_seq_num + 1, header->th_seq_num); in ctcmpc_unpack_skb()
1082 grp->out_of_sequence = 0; in ctcmpc_unpack_skb()
1083 ch->th_seq_num = header->th_seq_num; in ctcmpc_unpack_skb()
1086 __func__, ch->th_seq_num); in ctcmpc_unpack_skb()
1088 if (unlikely(fsm_getstate(grp->fsm) != MPCG_STATE_READY)) in ctcmpc_unpack_skb()
1090 while ((pskb->len > 0) && !pdu_last_seen) { in ctcmpc_unpack_skb()
1091 curr_pdu = (struct pdu *)pskb->data; in ctcmpc_unpack_skb()
1094 CTCM_D3_DUMP((char *)pskb->data, PDU_HEADER_LENGTH); in ctcmpc_unpack_skb()
1096 __func__, pskb->len); in ctcmpc_unpack_skb()
1100 if (curr_pdu->pdu_flag & PDU_LAST) in ctcmpc_unpack_skb()
1102 if (curr_pdu->pdu_flag & PDU_CNTL) in ctcmpc_unpack_skb()
1103 pskb->protocol = htons(ETH_P_SNAP); in ctcmpc_unpack_skb()
1105 pskb->protocol = htons(ETH_P_SNA_DIX); in ctcmpc_unpack_skb()
1107 if ((pskb->len <= 0) || (pskb->len > ch->max_bufsize)) { in ctcmpc_unpack_skb()
1111 CTCM_FUNTAIL, dev->name, pskb->len); in ctcmpc_unpack_skb()
1113 priv->stats.rx_dropped++; in ctcmpc_unpack_skb()
1114 priv->stats.rx_length_errors++; in ctcmpc_unpack_skb()
1118 new_len = curr_pdu->pdu_offset; in ctcmpc_unpack_skb()
1121 if ((new_len == 0) || (new_len > pskb->len)) { in ctcmpc_unpack_skb()
1127 CTCM_FUNTAIL, dev->name, new_len); in ctcmpc_unpack_skb()
1135 CTCM_FUNTAIL, dev->name); in ctcmpc_unpack_skb()
1136 priv->stats.rx_dropped++; in ctcmpc_unpack_skb()
1137 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in ctcmpc_unpack_skb()
1140 skb_put_data(skb, pskb->data, new_len); in ctcmpc_unpack_skb()
1143 skb->dev = pskb->dev; in ctcmpc_unpack_skb()
1144 skb->protocol = pskb->protocol; in ctcmpc_unpack_skb()
1145 skb->ip_summed = CHECKSUM_UNNECESSARY; in ctcmpc_unpack_skb()
1146 *((__u32 *) skb_push(skb, 4)) = ch->pdu_seq; in ctcmpc_unpack_skb()
1147 ch->pdu_seq++; in ctcmpc_unpack_skb()
1151 __func__, ch->pdu_seq); in ctcmpc_unpack_skb()
1154 (unsigned long)skb, skb->len); in ctcmpc_unpack_skb()
1157 ctcmpc_dump32((char *)skb->data, skb->len); in ctcmpc_unpack_skb()
1160 skblen = skb->len; in ctcmpc_unpack_skb()
1162 priv->stats.rx_packets++; in ctcmpc_unpack_skb()
1163 priv->stats.rx_bytes += skblen; in ctcmpc_unpack_skb()
1171 mpcginfo->ch = ch; in ctcmpc_unpack_skb()
1172 mpcginfo->th = header; in ctcmpc_unpack_skb()
1173 mpcginfo->skb = pskb; in ctcmpc_unpack_skb()
1174 CTCM_PR_DEBUG("%s: Not PDU - may be control pkt\n", in ctcmpc_unpack_skb()
1177 sweep = (struct th_sweep *)pskb->data; in ctcmpc_unpack_skb()
1178 mpcginfo->sweep = sweep; in ctcmpc_unpack_skb()
1179 if (header->th_ch_flag == TH_SWEEP_REQ) in ctcmpc_unpack_skb()
1181 else if (header->th_ch_flag == TH_SWEEP_RESP) in ctcmpc_unpack_skb()
1183 else if (header->th_blk_flag == TH_DATA_IS_XID) { in ctcmpc_unpack_skb()
1184 struct xid2 *thisxid = (struct xid2 *)pskb->data; in ctcmpc_unpack_skb()
1186 mpcginfo->xid = thisxid; in ctcmpc_unpack_skb()
1187 fsm_event(grp->fsm, MPCG_EVENT_XID2, mpcginfo); in ctcmpc_unpack_skb()
1188 } else if (header->th_blk_flag == TH_DISCONTACT) in ctcmpc_unpack_skb()
1189 fsm_event(grp->fsm, MPCG_EVENT_DISCONC, mpcginfo); in ctcmpc_unpack_skb()
1190 else if (header->th_seq_num != 0) { in ctcmpc_unpack_skb()
1193 CTCM_FUNTAIL, dev->name); in ctcmpc_unpack_skb()
1194 priv->stats.rx_dropped++; in ctcmpc_unpack_skb()
1195 /* mpcginfo only used for non-data transfers */ in ctcmpc_unpack_skb()
1197 ctcmpc_dump_skb(pskb, -8); in ctcmpc_unpack_skb()
1205 dev_warn(&dev->dev, in ctcmpc_unpack_skb()
1208 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in ctcmpc_unpack_skb()
1212 __func__, dev->name, ch, ch->id); in ctcmpc_unpack_skb()
1227 struct net_device *dev = ch->netdev; in ctcmpc_bh()
1228 struct ctcm_priv *priv = dev->ml_priv; in ctcmpc_bh()
1229 struct mpc_group *grp = priv->mpcg; in ctcmpc_bh() local
1232 dev->name, smp_processor_id(), __func__, ch->id); in ctcmpc_bh()
1234 while ((fsm_getstate(grp->fsm) != MPCG_STATE_FLOWC) && in ctcmpc_bh()
1235 (skb = skb_dequeue(&ch->io_queue))) { in ctcmpc_bh()
1237 if (grp->out_of_sequence > 20) { in ctcmpc_bh()
1241 grp->out_of_sequence = 0; in ctcmpc_bh()
1242 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in ctcmpc_bh()
1245 if (skb == skb_peek(&ch->io_queue)) in ctcmpc_bh()
1249 __func__, dev->name, ch, ch->id); in ctcmpc_bh()
1258 struct mpc_group *grp; in ctcmpc_init_mpc_group() local
1263 grp = kzalloc(sizeof(struct mpc_group), GFP_KERNEL); in ctcmpc_init_mpc_group()
1264 if (grp == NULL) in ctcmpc_init_mpc_group()
1267 grp->fsm = init_fsm("mpcg", mpcg_state_names, mpcg_event_names, in ctcmpc_init_mpc_group()
1270 if (grp->fsm == NULL) { in ctcmpc_init_mpc_group()
1271 kfree(grp); in ctcmpc_init_mpc_group()
1275 fsm_newstate(grp->fsm, MPCG_STATE_RESET); in ctcmpc_init_mpc_group()
1276 fsm_settimer(grp->fsm, &grp->timer); in ctcmpc_init_mpc_group()
1278 grp->xid_skb = in ctcmpc_init_mpc_group()
1280 if (grp->xid_skb == NULL) { in ctcmpc_init_mpc_group()
1281 kfree_fsm(grp->fsm); in ctcmpc_init_mpc_group()
1282 kfree(grp); in ctcmpc_init_mpc_group()
1286 grp->xid_skb_data = grp->xid_skb->data; in ctcmpc_init_mpc_group()
1287 grp->xid_th = (struct th_header *)grp->xid_skb->data; in ctcmpc_init_mpc_group()
1288 skb_put_data(grp->xid_skb, &thnorm, TH_HEADER_LENGTH); in ctcmpc_init_mpc_group()
1290 grp->xid = (struct xid2 *)skb_tail_pointer(grp->xid_skb); in ctcmpc_init_mpc_group()
1291 skb_put_data(grp->xid_skb, &init_xid, XID2_LENGTH); in ctcmpc_init_mpc_group()
1292 grp->xid->xid2_adj_id = jiffies | 0xfff00000; in ctcmpc_init_mpc_group()
1293 grp->xid->xid2_sender_id = jiffies; in ctcmpc_init_mpc_group()
1295 grp->xid_id = skb_tail_pointer(grp->xid_skb); in ctcmpc_init_mpc_group()
1296 skb_put_data(grp->xid_skb, "VTAM", 4); in ctcmpc_init_mpc_group()
1298 grp->rcvd_xid_skb = in ctcmpc_init_mpc_group()
1300 if (grp->rcvd_xid_skb == NULL) { in ctcmpc_init_mpc_group()
1301 kfree_fsm(grp->fsm); in ctcmpc_init_mpc_group()
1302 dev_kfree_skb(grp->xid_skb); in ctcmpc_init_mpc_group()
1303 kfree(grp); in ctcmpc_init_mpc_group()
1306 grp->rcvd_xid_data = grp->rcvd_xid_skb->data; in ctcmpc_init_mpc_group()
1307 grp->rcvd_xid_th = (struct th_header *)grp->rcvd_xid_skb->data; in ctcmpc_init_mpc_group()
1308 skb_put_data(grp->rcvd_xid_skb, &thnorm, TH_HEADER_LENGTH); in ctcmpc_init_mpc_group()
1309 grp->saved_xid2 = NULL; in ctcmpc_init_mpc_group()
1310 priv->xid = grp->xid; in ctcmpc_init_mpc_group()
1311 priv->mpcg = grp; in ctcmpc_init_mpc_group()
1312 return grp; in ctcmpc_init_mpc_group()
1341 struct mpc_group *grp; in mpc_action_go_inop() local
1344 CTCM_PR_DEBUG("Enter %s: %s\n", __func__, dev->name); in mpc_action_go_inop()
1346 priv = dev->ml_priv; in mpc_action_go_inop()
1347 grp = priv->mpcg; in mpc_action_go_inop()
1348 grp->flow_off_called = 0; in mpc_action_go_inop()
1349 fsm_deltimer(&grp->timer); in mpc_action_go_inop()
1350 if (grp->channels_terminating) in mpc_action_go_inop()
1353 grp->channels_terminating = 1; in mpc_action_go_inop()
1354 grp->saved_state = fsm_getstate(grp->fsm); in mpc_action_go_inop()
1355 fsm_newstate(grp->fsm, MPCG_STATE_INOP); in mpc_action_go_inop()
1356 if (grp->saved_state > MPCG_STATE_XID7INITF) in mpc_action_go_inop()
1359 CTCM_FUNTAIL, dev->name); in mpc_action_go_inop()
1360 if ((grp->saved_state != MPCG_STATE_RESET) || in mpc_action_go_inop()
1362 (grp->port_persist == 0)) in mpc_action_go_inop()
1363 fsm_deltimer(&priv->restart_timer); in mpc_action_go_inop()
1365 wch = priv->channel[CTCM_WRITE]; in mpc_action_go_inop()
1367 switch (grp->saved_state) { in mpc_action_go_inop()
1383 tasklet_hi_schedule(&wch->ch_disc_tasklet); in mpc_action_go_inop()
1386 grp->xid2_tgnum = 0; in mpc_action_go_inop()
1387 grp->group_max_buflen = 0; /*min of all received */ in mpc_action_go_inop()
1388 grp->outstanding_xid2 = 0; in mpc_action_go_inop()
1389 grp->outstanding_xid7 = 0; in mpc_action_go_inop()
1390 grp->outstanding_xid7_p2 = 0; in mpc_action_go_inop()
1391 grp->saved_xid2 = NULL; in mpc_action_go_inop()
1392 grp->xidnogood = 0; in mpc_action_go_inop()
1393 grp->changed_side = 0; in mpc_action_go_inop()
1395 grp->rcvd_xid_skb->data = grp->rcvd_xid_data; in mpc_action_go_inop()
1396 skb_reset_tail_pointer(grp->rcvd_xid_skb); in mpc_action_go_inop()
1397 grp->rcvd_xid_skb->len = 0; in mpc_action_go_inop()
1398 grp->rcvd_xid_th = (struct th_header *)grp->rcvd_xid_skb->data; in mpc_action_go_inop()
1399 skb_put_data(grp->rcvd_xid_skb, &thnorm, TH_HEADER_LENGTH); in mpc_action_go_inop()
1401 if (grp->send_qllc_disc == 1) { in mpc_action_go_inop()
1402 grp->send_qllc_disc = 0; in mpc_action_go_inop()
1411 if ((grp->port_persist == 1) || (grp->alloc_called)) { in mpc_action_go_inop()
1412 grp->alloc_called = 0; in mpc_action_go_inop()
1413 fsm_deltimer(&priv->restart_timer); in mpc_action_go_inop()
1414 fsm_addtimer(&priv->restart_timer, 500, DEV_EVENT_RESTART, dev); in mpc_action_go_inop()
1415 fsm_newstate(grp->fsm, MPCG_STATE_RESET); in mpc_action_go_inop()
1416 if (grp->saved_state > MPCG_STATE_XID7INITF) in mpc_action_go_inop()
1419 CTCM_FUNTAIL, dev->name); in mpc_action_go_inop()
1421 fsm_deltimer(&priv->restart_timer); in mpc_action_go_inop()
1422 fsm_addtimer(&priv->restart_timer, 500, DEV_EVENT_STOP, dev); in mpc_action_go_inop()
1423 fsm_newstate(grp->fsm, MPCG_STATE_RESET); in mpc_action_go_inop()
1426 CTCM_FUNTAIL, dev->name); in mpc_action_go_inop()
1443 struct mpc_group *grp; in mpc_action_timeout() local
1447 priv = dev->ml_priv; in mpc_action_timeout()
1448 grp = priv->mpcg; in mpc_action_timeout()
1449 wch = priv->channel[CTCM_WRITE]; in mpc_action_timeout()
1450 rch = priv->channel[CTCM_READ]; in mpc_action_timeout()
1452 switch (fsm_getstate(grp->fsm)) { in mpc_action_timeout()
1457 if ((fsm_getstate(rch->fsm) == CH_XID0_PENDING) && in mpc_action_timeout()
1458 (fsm_getstate(wch->fsm) == CH_XID0_PENDING)) in mpc_action_timeout()
1462 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in mpc_action_timeout()
1467 CTCM_FUNTAIL, dev->name); in mpc_action_timeout()
1478 struct channel *ch = mpcginfo->ch; in mpc_action_discontact()
1481 struct mpc_group *grp; in mpc_action_discontact() local
1484 dev = ch->netdev; in mpc_action_discontact()
1486 priv = dev->ml_priv; in mpc_action_discontact()
1490 CTCM_FUNTAIL, dev->name, ch->id); in mpc_action_discontact()
1491 grp = priv->mpcg; in mpc_action_discontact()
1492 grp->send_qllc_disc = 1; in mpc_action_discontact()
1493 fsm_event(grp->fsm, MPCG_EVENT_INOP, dev); in mpc_action_discontact()
1502 * MPC Group Station - not part of FSM
1512 spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags); in mpc_action_send_discontact()
1513 rc = ccw_device_start(ch->cdev, &ch->ccw[15], 0, 0xff, 0); in mpc_action_send_discontact()
1514 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags); in mpc_action_send_discontact()
1531 struct channel *ch = mpcginfo->ch; in mpc_validate_xid()
1532 struct net_device *dev = ch->netdev; in mpc_validate_xid()
1533 struct ctcm_priv *priv = dev->ml_priv; in mpc_validate_xid()
1534 struct mpc_group *grp = priv->mpcg; in mpc_validate_xid() local
1535 struct xid2 *xid = mpcginfo->xid; in mpc_validate_xid()
1548 CTCM_FUNTAIL, ch->id); in mpc_validate_xid()
1555 if (((CHANNEL_DIRECTION(ch->flags) == CTCM_READ) ? XID2_WRITE_SIDE : in mpc_validate_xid()
1556 XID2_READ_SIDE) != xid->xid2_dlc_type) { in mpc_validate_xid()
1561 CTCM_FUNTAIL, ch->id); in mpc_validate_xid()
1565 if (xid->xid2_dlc_type == XID2_READ_SIDE) { in mpc_validate_xid()
1567 grp->group_max_buflen, xid->xid2_buf_len); in mpc_validate_xid()
1569 if (grp->group_max_buflen == 0 || grp->group_max_buflen > in mpc_validate_xid()
1570 xid->xid2_buf_len - len) in mpc_validate_xid()
1571 grp->group_max_buflen = xid->xid2_buf_len - len; in mpc_validate_xid()
1574 if (grp->saved_xid2 == NULL) { in mpc_validate_xid()
1575 grp->saved_xid2 = in mpc_validate_xid()
1576 (struct xid2 *)skb_tail_pointer(grp->rcvd_xid_skb); in mpc_validate_xid()
1578 skb_put_data(grp->rcvd_xid_skb, xid, XID2_LENGTH); in mpc_validate_xid()
1579 grp->rcvd_xid_skb->data = grp->rcvd_xid_data; in mpc_validate_xid()
1581 skb_reset_tail_pointer(grp->rcvd_xid_skb); in mpc_validate_xid()
1582 grp->rcvd_xid_skb->len = 0; in mpc_validate_xid()
1585 our_id = (__u64)priv->xid->xid2_adj_id; in mpc_validate_xid()
1587 our_id = our_id + priv->xid->xid2_sender_id; in mpc_validate_xid()
1588 their_id = (__u64)xid->xid2_adj_id; in mpc_validate_xid()
1590 their_id = their_id + xid->xid2_sender_id; in mpc_validate_xid()
1593 grp->roll = XSIDE; in mpc_validate_xid()
1595 "%s(%s): WE HAVE LOW ID - TAKE XSIDE", in mpc_validate_xid()
1596 CTCM_FUNTAIL, ch->id); in mpc_validate_xid()
1598 grp->roll = YSIDE; in mpc_validate_xid()
1600 "%s(%s): WE HAVE HIGH ID - TAKE YSIDE", in mpc_validate_xid()
1601 CTCM_FUNTAIL, ch->id); in mpc_validate_xid()
1605 if (xid->xid2_flag4 != grp->saved_xid2->xid2_flag4) { in mpc_validate_xid()
1610 CTCM_FUNTAIL, ch->id); in mpc_validate_xid()
1612 if (xid->xid2_flag2 == 0x40) { in mpc_validate_xid()
1614 /* XID REJECTED - xid NOGOOD */ in mpc_validate_xid()
1617 CTCM_FUNTAIL, ch->id); in mpc_validate_xid()
1619 if (xid->xid2_adj_id != grp->saved_xid2->xid2_adj_id) { in mpc_validate_xid()
1621 /* XID REJECTED - Adjacent Station ID Mismatch */ in mpc_validate_xid()
1624 CTCM_FUNTAIL, ch->id); in mpc_validate_xid()
1626 if (xid->xid2_sender_id != grp->saved_xid2->xid2_sender_id) { in mpc_validate_xid()
1628 /* XID REJECTED - Sender Address Mismatch */ in mpc_validate_xid()
1631 CTCM_FUNTAIL, ch->id); in mpc_validate_xid()
1636 dev_warn(&dev->dev, in mpc_validate_xid()
1639 priv->xid->xid2_flag2 = 0x40; in mpc_validate_xid()
1640 grp->saved_xid2->xid2_flag2 = 0x40; in mpc_validate_xid()
1659 __func__, smp_processor_id(), ch, ch->id); in mpc_action_side_xid()
1665 * skb data-buffer referencing: in mpc_action_side_xid()
1667 ch->trans_skb->data = ch->trans_skb_data; in mpc_action_side_xid()
1668 skb_reset_tail_pointer(ch->trans_skb); in mpc_action_side_xid()
1669 ch->trans_skb->len = 0; in mpc_action_side_xid()
1674 memset(ch->trans_skb->data, 0, 16); in mpc_action_side_xid()
1675 ch->rcvd_xid_th = (struct th_header *)ch->trans_skb_data; in mpc_action_side_xid()
1677 skb_put(ch->trans_skb, TH_HEADER_LENGTH); in mpc_action_side_xid()
1678 ch->rcvd_xid = (struct xid2 *)skb_tail_pointer(ch->trans_skb); in mpc_action_side_xid()
1680 skb_put(ch->trans_skb, XID2_LENGTH); in mpc_action_side_xid()
1681 ch->rcvd_xid_id = skb_tail_pointer(ch->trans_skb); in mpc_action_side_xid()
1683 ch->trans_skb->data = ch->trans_skb_data; in mpc_action_side_xid()
1684 skb_reset_tail_pointer(ch->trans_skb); in mpc_action_side_xid()
1685 ch->trans_skb->len = 0; in mpc_action_side_xid()
1687 /* non-checking rewrite of above skb data-buffer referencing: */ in mpc_action_side_xid()
1689 memset(ch->trans_skb->data, 0, 16); in mpc_action_side_xid()
1690 ch->rcvd_xid_th = (struct th_header *)ch->trans_skb_data; in mpc_action_side_xid()
1691 ch->rcvd_xid = (struct xid2 *)(ch->trans_skb_data + TH_HEADER_LENGTH); in mpc_action_side_xid()
1692 ch->rcvd_xid_id = ch->trans_skb_data + TH_HEADER_LENGTH + XID2_LENGTH; in mpc_action_side_xid()
1695 ch->ccw[8].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1696 ch->ccw[8].count = 0; in mpc_action_side_xid()
1697 ch->ccw[8].cda = 0x00; in mpc_action_side_xid()
1699 if (!(ch->xid_th && ch->xid && ch->xid_id)) in mpc_action_side_xid()
1702 CTCM_FUNTAIL, ch->id, ch->xid_th, ch->xid, ch->xid_id); in mpc_action_side_xid()
1706 if (ch->xid_th == NULL) in mpc_action_side_xid()
1708 ch->ccw[9].cmd_code = CCW_CMD_WRITE; in mpc_action_side_xid()
1709 ch->ccw[9].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1710 ch->ccw[9].count = TH_HEADER_LENGTH; in mpc_action_side_xid()
1711 ch->ccw[9].cda = virt_to_phys(ch->xid_th); in mpc_action_side_xid()
1713 if (ch->xid == NULL) in mpc_action_side_xid()
1715 ch->ccw[10].cmd_code = CCW_CMD_WRITE; in mpc_action_side_xid()
1716 ch->ccw[10].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1717 ch->ccw[10].count = XID2_LENGTH; in mpc_action_side_xid()
1718 ch->ccw[10].cda = virt_to_phys(ch->xid); in mpc_action_side_xid()
1720 ch->ccw[11].cmd_code = CCW_CMD_READ; in mpc_action_side_xid()
1721 ch->ccw[11].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1722 ch->ccw[11].count = TH_HEADER_LENGTH; in mpc_action_side_xid()
1723 ch->ccw[11].cda = virt_to_phys(ch->rcvd_xid_th); in mpc_action_side_xid()
1725 ch->ccw[12].cmd_code = CCW_CMD_READ; in mpc_action_side_xid()
1726 ch->ccw[12].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1727 ch->ccw[12].count = XID2_LENGTH; in mpc_action_side_xid()
1728 ch->ccw[12].cda = virt_to_phys(ch->rcvd_xid); in mpc_action_side_xid()
1730 ch->ccw[13].cmd_code = CCW_CMD_READ; in mpc_action_side_xid()
1731 ch->ccw[13].cda = virt_to_phys(ch->rcvd_xid_id); in mpc_action_side_xid()
1734 ch->ccw[9].cmd_code = CCW_CMD_READ; in mpc_action_side_xid()
1735 ch->ccw[9].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1736 ch->ccw[9].count = TH_HEADER_LENGTH; in mpc_action_side_xid()
1737 ch->ccw[9].cda = virt_to_phys(ch->rcvd_xid_th); in mpc_action_side_xid()
1739 ch->ccw[10].cmd_code = CCW_CMD_READ; in mpc_action_side_xid()
1740 ch->ccw[10].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1741 ch->ccw[10].count = XID2_LENGTH; in mpc_action_side_xid()
1742 ch->ccw[10].cda = virt_to_phys(ch->rcvd_xid); in mpc_action_side_xid()
1744 if (ch->xid_th == NULL) in mpc_action_side_xid()
1746 ch->ccw[11].cmd_code = CCW_CMD_WRITE; in mpc_action_side_xid()
1747 ch->ccw[11].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1748 ch->ccw[11].count = TH_HEADER_LENGTH; in mpc_action_side_xid()
1749 ch->ccw[11].cda = virt_to_phys(ch->xid_th); in mpc_action_side_xid()
1751 if (ch->xid == NULL) in mpc_action_side_xid()
1753 ch->ccw[12].cmd_code = CCW_CMD_WRITE; in mpc_action_side_xid()
1754 ch->ccw[12].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1755 ch->ccw[12].count = XID2_LENGTH; in mpc_action_side_xid()
1756 ch->ccw[12].cda = virt_to_phys(ch->xid); in mpc_action_side_xid()
1758 if (ch->xid_id == NULL) in mpc_action_side_xid()
1760 ch->ccw[13].cmd_code = CCW_CMD_WRITE; in mpc_action_side_xid()
1761 ch->ccw[13].cda = virt_to_phys(ch->xid_id); in mpc_action_side_xid()
1764 ch->ccw[13].flags = CCW_FLAG_SLI | CCW_FLAG_CC; in mpc_action_side_xid()
1765 ch->ccw[13].count = 4; in mpc_action_side_xid()
1767 ch->ccw[14].cmd_code = CCW_CMD_NOOP; in mpc_action_side_xid()
1768 ch->ccw[14].flags = CCW_FLAG_SLI; in mpc_action_side_xid()
1769 ch->ccw[14].count = 0; in mpc_action_side_xid()
1770 ch->ccw[14].cda = 0; in mpc_action_side_xid()
1772 CTCM_CCW_DUMP((char *)&ch->ccw[8], sizeof(struct ccw1) * 7); in mpc_action_side_xid()
1773 CTCM_D3_DUMP((char *)ch->xid_th, TH_HEADER_LENGTH); in mpc_action_side_xid()
1774 CTCM_D3_DUMP((char *)ch->xid, XID2_LENGTH); in mpc_action_side_xid()
1775 CTCM_D3_DUMP((char *)ch->xid_id, 4); in mpc_action_side_xid()
1781 spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags); in mpc_action_side_xid()
1785 fsm_addtimer(&ch->timer, 5000 , CTC_EVENT_TIMER, ch); in mpc_action_side_xid()
1786 rc = ccw_device_start(ch->cdev, &ch->ccw[8], 0, 0xff, 0); in mpc_action_side_xid()
1789 spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags); in mpc_action_side_xid()
1793 (side == XSIDE) ? "x-side XID" : "y-side XID"); in mpc_action_side_xid()
1798 __func__, ch, ch->id); in mpc_action_side_xid()
1828 struct net_device *dev = ch->netdev; in mpc_action_doxid0()
1829 struct ctcm_priv *priv = dev->ml_priv; in mpc_action_doxid0()
1830 struct mpc_group *grp = priv->mpcg; in mpc_action_doxid0() local
1833 __func__, smp_processor_id(), ch, ch->id); in mpc_action_doxid0()
1835 if (ch->xid == NULL) { in mpc_action_doxid0()
1837 "%s(%s): ch->xid == NULL", in mpc_action_doxid0()
1838 CTCM_FUNTAIL, dev->name); in mpc_action_doxid0()
1842 fsm_newstate(ch->fsm, CH_XID0_INPROGRESS); in mpc_action_doxid0()
1844 ch->xid->xid2_option = XID2_0; in mpc_action_doxid0()
1846 switch (fsm_getstate(grp->fsm)) { in mpc_action_doxid0()
1849 ch->ccw[8].cmd_code = CCW_CMD_SENSE_CMD; in mpc_action_doxid0()
1853 ch->ccw[8].cmd_code = CCW_CMD_WRITE_CTL; in mpc_action_doxid0()
1857 fsm_event(grp->fsm, MPCG_EVENT_DOIO, ch); in mpc_action_doxid0()
1869 struct ctcm_priv *priv = dev->ml_priv; in mpc_action_doxid7()
1870 struct mpc_group *grp = NULL; in mpc_action_doxid7() local
1875 grp = priv->mpcg; in mpc_action_doxid7()
1876 if (grp == NULL) in mpc_action_doxid7()
1880 struct channel *ch = priv->channel[direction]; in mpc_action_doxid7()
1881 struct xid2 *thisxid = ch->xid; in mpc_action_doxid7()
1882 ch->xid_skb->data = ch->xid_skb_data; in mpc_action_doxid7()
1883 skb_reset_tail_pointer(ch->xid_skb); in mpc_action_doxid7()
1884 ch->xid_skb->len = 0; in mpc_action_doxid7()
1885 thisxid->xid2_option = XID2_7; in mpc_action_doxid7()
1889 if (grp->outstanding_xid7_p2 > 0) { in mpc_action_doxid7()
1890 if (grp->roll == YSIDE) { in mpc_action_doxid7()
1891 if (fsm_getstate(ch->fsm) == CH_XID7_PENDING1) { in mpc_action_doxid7()
1892 fsm_newstate(ch->fsm, CH_XID7_PENDING2); in mpc_action_doxid7()
1893 ch->ccw[8].cmd_code = CCW_CMD_SENSE_CMD; in mpc_action_doxid7()
1894 skb_put_data(ch->xid_skb, &thdummy, in mpc_action_doxid7()
1898 } else if (fsm_getstate(ch->fsm) < CH_XID7_PENDING2) { in mpc_action_doxid7()
1899 fsm_newstate(ch->fsm, CH_XID7_PENDING2); in mpc_action_doxid7()
1900 ch->ccw[8].cmd_code = CCW_CMD_WRITE_CTL; in mpc_action_doxid7()
1901 skb_put_data(ch->xid_skb, &thnorm, in mpc_action_doxid7()
1907 if (grp->roll == YSIDE) { in mpc_action_doxid7()
1908 if (fsm_getstate(ch->fsm) < CH_XID7_PENDING4) { in mpc_action_doxid7()
1909 fsm_newstate(ch->fsm, CH_XID7_PENDING4); in mpc_action_doxid7()
1910 skb_put_data(ch->xid_skb, &thnorm, in mpc_action_doxid7()
1912 ch->ccw[8].cmd_code = CCW_CMD_WRITE_CTL; in mpc_action_doxid7()
1915 } else if (fsm_getstate(ch->fsm) == CH_XID7_PENDING3) { in mpc_action_doxid7()
1916 fsm_newstate(ch->fsm, CH_XID7_PENDING4); in mpc_action_doxid7()
1917 ch->ccw[8].cmd_code = CCW_CMD_SENSE_CMD; in mpc_action_doxid7()
1918 skb_put_data(ch->xid_skb, &thdummy, in mpc_action_doxid7()
1925 fsm_event(grp->fsm, MPCG_EVENT_DOIO, ch); in mpc_action_doxid7()
1939 struct channel *ch = mpcginfo->ch; in mpc_action_rcvd_xid0()
1940 struct net_device *dev = ch->netdev; in mpc_action_rcvd_xid0()
1941 struct ctcm_priv *priv = dev->ml_priv; in mpc_action_rcvd_xid0()
1942 struct mpc_group *grp = priv->mpcg; in mpc_action_rcvd_xid0() local
1944 CTCM_PR_DEBUG("%s: ch-id:%s xid2:%i xid7:%i xidt_p2:%i \n", in mpc_action_rcvd_xid0()
1945 __func__, ch->id, grp->outstanding_xid2, in mpc_action_rcvd_xid0()
1946 grp->outstanding_xid7, grp->outstanding_xid7_p2); in mpc_action_rcvd_xid0()
1948 if (fsm_getstate(ch->fsm) < CH_XID7_PENDING) in mpc_action_rcvd_xid0()
1949 fsm_newstate(ch->fsm, CH_XID7_PENDING); in mpc_action_rcvd_xid0()
1951 grp->outstanding_xid2--; in mpc_action_rcvd_xid0()
1952 grp->outstanding_xid7++; in mpc_action_rcvd_xid0()
1953 grp->outstanding_xid7_p2++; in mpc_action_rcvd_xid0()
1957 switch (fsm_getstate(grp->fsm)) { in mpc_action_rcvd_xid0()
1959 fsm_newstate(grp->fsm, MPCG_STATE_XID2INITX); in mpc_action_rcvd_xid0()
1963 fsm_newstate(grp->fsm, MPCG_STATE_XID0IOWAIX); in mpc_action_rcvd_xid0()
1967 if (grp->outstanding_xid2 == 0) { in mpc_action_rcvd_xid0()
1968 fsm_newstate(grp->fsm, MPCG_STATE_XID7INITW); in mpc_action_rcvd_xid0()
1970 fsm_event(grp->fsm, MPCG_EVENT_XID2DONE, dev); in mpc_action_rcvd_xid0()
1974 if (grp->outstanding_xid2 == 0) { in mpc_action_rcvd_xid0()
1975 fsm_newstate(grp->fsm, MPCG_STATE_XID7INITI); in mpc_action_rcvd_xid0()
1977 fsm_event(grp->fsm, MPCG_EVENT_XID2DONE, dev); in mpc_action_rcvd_xid0()
1983 __func__, ch->id, grp->outstanding_xid2, in mpc_action_rcvd_xid0()
1984 grp->outstanding_xid7, grp->outstanding_xid7_p2); in mpc_action_rcvd_xid0()
1986 __func__, ch->id, in mpc_action_rcvd_xid0()
1987 fsm_getstate_str(grp->fsm), fsm_getstate_str(ch->fsm)); in mpc_action_rcvd_xid0()
2000 struct channel *ch = mpcginfo->ch; in mpc_action_rcvd_xid7()
2001 struct net_device *dev = ch->netdev; in mpc_action_rcvd_xid7()
2002 struct ctcm_priv *priv = dev->ml_priv; in mpc_action_rcvd_xid7()
2003 struct mpc_group *grp = priv->mpcg; in mpc_action_rcvd_xid7() local
2006 __func__, smp_processor_id(), ch, ch->id); in mpc_action_rcvd_xid7()
2008 __func__, grp->outstanding_xid7, grp->outstanding_xid7_p2); in mpc_action_rcvd_xid7()
2010 grp->outstanding_xid7--; in mpc_action_rcvd_xid7()
2011 ch->xid_skb->data = ch->xid_skb_data; in mpc_action_rcvd_xid7()
2012 skb_reset_tail_pointer(ch->xid_skb); in mpc_action_rcvd_xid7()
2013 ch->xid_skb->len = 0; in mpc_action_rcvd_xid7()
2015 switch (fsm_getstate(grp->fsm)) { in mpc_action_rcvd_xid7()
2017 fsm_newstate(grp->fsm, MPCG_STATE_XID7INITZ); in mpc_action_rcvd_xid7()
2021 fsm_newstate(grp->fsm, MPCG_STATE_XID7INITX); in mpc_action_rcvd_xid7()
2026 if (grp->outstanding_xid7 == 0) { in mpc_action_rcvd_xid7()
2027 if (grp->outstanding_xid7_p2 > 0) { in mpc_action_rcvd_xid7()
2028 grp->outstanding_xid7 = in mpc_action_rcvd_xid7()
2029 grp->outstanding_xid7_p2; in mpc_action_rcvd_xid7()
2030 grp->outstanding_xid7_p2 = 0; in mpc_action_rcvd_xid7()
2032 fsm_newstate(grp->fsm, MPCG_STATE_XID7INITF); in mpc_action_rcvd_xid7()
2035 fsm_event(grp->fsm, MPCG_EVENT_XID7DONE, dev); in mpc_action_rcvd_xid7()
2052 struct ctcm_priv *priv = dev->ml_priv; in mpc_send_qllc_discontact()
2053 struct mpc_group *grp = priv->mpcg; in mpc_send_qllc_discontact() local
2056 __func__, mpcg_state_names[grp->saved_state]); in mpc_send_qllc_discontact()
2058 switch (grp->saved_state) { in mpc_send_qllc_discontact()
2071 if (grp->estconnfunc) { in mpc_send_qllc_discontact()
2072 grp->estconnfunc(grp->port_num, -1, 0); in mpc_send_qllc_discontact()
2073 grp->estconnfunc = NULL; in mpc_send_qllc_discontact()
2079 grp->send_qllc_disc = 2; in mpc_send_qllc_discontact()
2085 CTCM_FUNTAIL, dev->name); in mpc_send_qllc_discontact()
2086 priv->stats.rx_dropped++; in mpc_send_qllc_discontact()
2087 return -ENOMEM; in mpc_send_qllc_discontact()
2091 qllcptr->qllc_address = 0xcc; in mpc_send_qllc_discontact()
2092 qllcptr->qllc_commands = 0x03; in mpc_send_qllc_discontact()
2097 CTCM_FUNTAIL, dev->name); in mpc_send_qllc_discontact()
2099 return -ENOMEM; in mpc_send_qllc_discontact()
2103 priv->channel[CTCM_READ]->pdu_seq; in mpc_send_qllc_discontact()
2104 priv->channel[CTCM_READ]->pdu_seq++; in mpc_send_qllc_discontact()
2106 __func__, priv->channel[CTCM_READ]->pdu_seq); in mpc_send_qllc_discontact()
2110 priv->channel[CTCM_READ]->pdu_seq = 0x00; in mpc_send_qllc_discontact()
2112 skb->dev = dev; in mpc_send_qllc_discontact()
2113 skb->protocol = htons(ETH_P_SNAP); in mpc_send_qllc_discontact()
2114 skb->ip_summed = CHECKSUM_UNNECESSARY; in mpc_send_qllc_discontact()
2116 CTCM_D3_DUMP(skb->data, (sizeof(struct qllc) + 4)); in mpc_send_qllc_discontact()
2127 /* --- This is the END my friend --- */