Linux Audio

Check our new training course

Linux debugging, profiling, tracing and performance analysis training

Apr 14-17, 2025
Register
Loading...
v3.15
   1/*
   2 *	Copyright IBM Corp. 2004, 2007
   3 *	Authors:	Belinda Thompson (belindat@us.ibm.com)
   4 *			Andy Richter (richtera@us.ibm.com)
   5 *			Peter Tiedemann (ptiedem@de.ibm.com)
   6 */
   7
   8/*
   9	This module exports functions to be used by CCS:
  10	EXPORT_SYMBOL(ctc_mpc_alloc_channel);
  11	EXPORT_SYMBOL(ctc_mpc_establish_connectivity);
  12	EXPORT_SYMBOL(ctc_mpc_dealloc_ch);
  13	EXPORT_SYMBOL(ctc_mpc_flow_control);
  14*/
  15
  16#undef DEBUG
  17#undef DEBUGDATA
  18#undef DEBUGCCW
  19
  20#define KMSG_COMPONENT "ctcm"
  21#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
  22
  23#include <linux/module.h>
  24#include <linux/init.h>
  25#include <linux/kernel.h>
  26#include <linux/slab.h>
  27#include <linux/errno.h>
  28#include <linux/types.h>
  29#include <linux/interrupt.h>
  30#include <linux/timer.h>
  31#include <linux/sched.h>
  32
  33#include <linux/signal.h>
  34#include <linux/string.h>
  35#include <linux/proc_fs.h>
  36
  37#include <linux/ip.h>
  38#include <linux/if_arp.h>
  39#include <linux/tcp.h>
  40#include <linux/skbuff.h>
  41#include <linux/ctype.h>
  42#include <linux/netdevice.h>
  43#include <net/dst.h>
  44
  45#include <linux/io.h>		/* instead of <asm/io.h> ok ? */
  46#include <asm/ccwdev.h>
  47#include <asm/ccwgroup.h>
  48#include <linux/bitops.h>	/* instead of <asm/bitops.h> ok ? */
  49#include <linux/uaccess.h>	/* instead of <asm/uaccess.h> ok ? */
  50#include <linux/wait.h>
  51#include <linux/moduleparam.h>
  52#include <asm/idals.h>
  53
  54#include "ctcm_main.h"
  55#include "ctcm_mpc.h"
  56#include "ctcm_fsms.h"
  57
  58static const struct xid2 init_xid = {
  59	.xid2_type_id	=	XID_FM2,
  60	.xid2_len	=	0x45,
  61	.xid2_adj_id	=	0,
  62	.xid2_rlen	=	0x31,
  63	.xid2_resv1	=	0,
  64	.xid2_flag1	=	0,
  65	.xid2_fmtt	=	0,
  66	.xid2_flag4	=	0x80,
  67	.xid2_resv2	=	0,
  68	.xid2_tgnum	=	0,
  69	.xid2_sender_id	=	0,
  70	.xid2_flag2	=	0,
  71	.xid2_option	=	XID2_0,
  72	.xid2_resv3	=	"\x00",
  73	.xid2_resv4	=	0,
  74	.xid2_dlc_type	=	XID2_READ_SIDE,
  75	.xid2_resv5	=	0,
  76	.xid2_mpc_flag	=	0,
  77	.xid2_resv6	=	0,
  78	.xid2_buf_len	=	(MPC_BUFSIZE_DEFAULT - 35),
  79};
  80
  81static const struct th_header thnorm = {
  82	.th_seg		=	0x00,
  83	.th_ch_flag	=	TH_IS_XID,
  84	.th_blk_flag	=	TH_DATA_IS_XID,
  85	.th_is_xid	=	0x01,
  86	.th_seq_num	=	0x00000000,
  87};
  88
  89static const struct th_header thdummy = {
  90	.th_seg		=	0x00,
  91	.th_ch_flag	=	0x00,
  92	.th_blk_flag	=	TH_DATA_IS_XID,
  93	.th_is_xid	=	0x01,
  94	.th_seq_num	=	0x00000000,
  95};
  96
  97/*
  98 * Definition of one MPC group
  99 */
 100
 101/*
 102 * Compatibility macros for busy handling
 103 * of network devices.
 104 */
 105
 106static void ctcmpc_unpack_skb(struct channel *ch, struct sk_buff *pskb);
 107
 108/*
 109 * MPC Group state machine actions (static prototypes)
 110 */
 111static void mpc_action_nop(fsm_instance *fsm, int event, void *arg);
 112static void mpc_action_go_ready(fsm_instance *fsm, int event, void *arg);
 113static void mpc_action_go_inop(fsm_instance *fi, int event, void *arg);
 114static void mpc_action_timeout(fsm_instance *fi, int event, void *arg);
 115static int  mpc_validate_xid(struct mpcg_info *mpcginfo);
 116static void mpc_action_yside_xid(fsm_instance *fsm, int event, void *arg);
 117static void mpc_action_doxid0(fsm_instance *fsm, int event, void *arg);
 118static void mpc_action_doxid7(fsm_instance *fsm, int event, void *arg);
 119static void mpc_action_xside_xid(fsm_instance *fsm, int event, void *arg);
 120static void mpc_action_rcvd_xid0(fsm_instance *fsm, int event, void *arg);
 121static void mpc_action_rcvd_xid7(fsm_instance *fsm, int event, void *arg);
 122
 123#ifdef DEBUGDATA
 124/*-------------------------------------------------------------------*
 125* Dump buffer format						     *
 126*								     *
 127*--------------------------------------------------------------------*/
 128void ctcmpc_dumpit(char *buf, int len)
 129{
 130	__u32	ct, sw, rm, dup;
 131	char	*ptr, *rptr;
 132	char	tbuf[82], tdup[82];
 133	#ifdef CONFIG_64BIT
 134	char	addr[22];
 135	#else
 136	char	addr[12];
 137	#endif
 138	char	boff[12];
 139	char	bhex[82], duphex[82];
 140	char	basc[40];
 141
 142	sw  = 0;
 143	rptr = ptr = buf;
 144	rm  = 16;
 145	duphex[0] = 0x00;
 146	dup = 0;
 147
 148	for (ct = 0; ct < len; ct++, ptr++, rptr++) {
 149		if (sw == 0) {
 150			#ifdef CONFIG_64BIT
 151			sprintf(addr, "%16.16llx", (__u64)rptr);
 152			#else
 153			sprintf(addr, "%8.8X", (__u32)rptr);
 154			#endif
 155
 156			sprintf(boff, "%4.4X", (__u32)ct);
 157			bhex[0] = '\0';
 158			basc[0] = '\0';
 159		}
 160		if ((sw == 4) || (sw == 12))
 161			strcat(bhex, " ");
 162		if (sw == 8)
 163			strcat(bhex, "	");
 164
 165		#if CONFIG_64BIT
 166		sprintf(tbuf, "%2.2llX", (__u64)*ptr);
 167		#else
 168		sprintf(tbuf, "%2.2X", (__u32)*ptr);
 169		#endif
 170
 171		tbuf[2] = '\0';
 172		strcat(bhex, tbuf);
 173		if ((0 != isprint(*ptr)) && (*ptr >= 0x20))
 174			basc[sw] = *ptr;
 175		else
 176			basc[sw] = '.';
 177
 178		basc[sw+1] = '\0';
 179		sw++;
 180		rm--;
 181		if (sw != 16)
 182			continue;
 183		if ((strcmp(duphex, bhex)) != 0) {
 184			if (dup != 0) {
 185				sprintf(tdup,
 186					"Duplicate as above to %s", addr);
 187				ctcm_pr_debug("		       --- %s ---\n",
 188						tdup);
 189			}
 190			ctcm_pr_debug("   %s (+%s) : %s  [%s]\n",
 191					addr, boff, bhex, basc);
 192			dup = 0;
 193			strcpy(duphex, bhex);
 194		} else
 195			dup++;
 196
 197		sw = 0;
 198		rm = 16;
 199	}  /* endfor */
 200
 201	if (sw != 0) {
 202		for ( ; rm > 0; rm--, sw++) {
 203			if ((sw == 4) || (sw == 12))
 204				strcat(bhex, " ");
 205			if (sw == 8)
 206				strcat(bhex, "	");
 207			strcat(bhex, "	");
 208			strcat(basc, " ");
 209		}
 210		if (dup != 0) {
 211			sprintf(tdup, "Duplicate as above to %s", addr);
 212			ctcm_pr_debug("		       --- %s ---\n", tdup);
 213		}
 214		ctcm_pr_debug("   %s (+%s) : %s  [%s]\n",
 215					addr, boff, bhex, basc);
 216	} else {
 217		if (dup >= 1) {
 218			sprintf(tdup, "Duplicate as above to %s", addr);
 219			ctcm_pr_debug("		       --- %s ---\n", tdup);
 220		}
 221		if (dup != 0) {
 222			ctcm_pr_debug("   %s (+%s) : %s  [%s]\n",
 223				addr, boff, bhex, basc);
 224		}
 225	}
 226
 227	return;
 228
 229}   /*	 end of ctcmpc_dumpit  */
 230#endif
 231
 232#ifdef DEBUGDATA
 233/*
 234 * Dump header and first 16 bytes of an sk_buff for debugging purposes.
 235 *
 236 * skb		The sk_buff to dump.
 237 * offset	Offset relative to skb-data, where to start the dump.
 238 */
 239void ctcmpc_dump_skb(struct sk_buff *skb, int offset)
 240{
 241	__u8 *p = skb->data;
 242	struct th_header *header;
 243	struct pdu *pheader;
 244	int bl = skb->len;
 245	int i;
 246
 247	if (p == NULL)
 248		return;
 249
 250	p += offset;
 251	header = (struct th_header *)p;
 252
 253	ctcm_pr_debug("dump:\n");
 254	ctcm_pr_debug("skb len=%d \n", skb->len);
 255	if (skb->len > 2) {
 256		switch (header->th_ch_flag) {
 257		case TH_HAS_PDU:
 258			break;
 259		case 0x00:
 260		case TH_IS_XID:
 261			if ((header->th_blk_flag == TH_DATA_IS_XID) &&
 262			   (header->th_is_xid == 0x01))
 263				goto dumpth;
 264		case TH_SWEEP_REQ:
 265				goto dumpth;
 266		case TH_SWEEP_RESP:
 267				goto dumpth;
 268		default:
 269			break;
 270		}
 271
 272		pheader = (struct pdu *)p;
 273		ctcm_pr_debug("pdu->offset: %d hex: %04x\n",
 274			       pheader->pdu_offset, pheader->pdu_offset);
 275		ctcm_pr_debug("pdu->flag  : %02x\n", pheader->pdu_flag);
 276		ctcm_pr_debug("pdu->proto : %02x\n", pheader->pdu_proto);
 277		ctcm_pr_debug("pdu->seq   : %02x\n", pheader->pdu_seq);
 278					goto dumpdata;
 279
 280dumpth:
 281		ctcm_pr_debug("th->seg     : %02x\n", header->th_seg);
 282		ctcm_pr_debug("th->ch      : %02x\n", header->th_ch_flag);
 283		ctcm_pr_debug("th->blk_flag: %02x\n", header->th_blk_flag);
 284		ctcm_pr_debug("th->type    : %s\n",
 285			       (header->th_is_xid) ? "DATA" : "XID");
 286		ctcm_pr_debug("th->seqnum  : %04x\n", header->th_seq_num);
 287
 288	}
 289dumpdata:
 290	if (bl > 32)
 291		bl = 32;
 292	ctcm_pr_debug("data: ");
 293	for (i = 0; i < bl; i++)
 294		ctcm_pr_debug("%02x%s", *p++, (i % 16) ? " " : "\n");
 295	ctcm_pr_debug("\n");
 296}
 297#endif
 298
 299static struct net_device *ctcmpc_get_dev(int port_num)
 300{
 301	char device[20];
 302	struct net_device *dev;
 303	struct ctcm_priv *priv;
 304
 305	sprintf(device, "%s%i", MPC_DEVICE_NAME, port_num);
 306
 307	dev = __dev_get_by_name(&init_net, device);
 308
 309	if (dev == NULL) {
 310		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 311			"%s: Device not found by name: %s",
 312					CTCM_FUNTAIL, device);
 313		return NULL;
 314	}
 315	priv = dev->ml_priv;
 316	if (priv == NULL) {
 317		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 318			"%s(%s): dev->ml_priv is NULL",
 319					CTCM_FUNTAIL, device);
 320		return NULL;
 321	}
 322	if (priv->mpcg == NULL) {
 323		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 324			"%s(%s): priv->mpcg is NULL",
 325					CTCM_FUNTAIL, device);
 326		return NULL;
 327	}
 328	return dev;
 329}
 330
 331/*
 332 * ctc_mpc_alloc_channel
 333 *	(exported interface)
 334 *
 335 * Device Initialization :
 336 *	ACTPATH  driven IO operations
 337 */
 338int ctc_mpc_alloc_channel(int port_num, void (*callback)(int, int))
 339{
 340	struct net_device *dev;
 341	struct mpc_group *grp;
 342	struct ctcm_priv *priv;
 343
 344	dev = ctcmpc_get_dev(port_num);
 345	if (dev == NULL)
 346		return 1;
 347	priv = dev->ml_priv;
 348	grp = priv->mpcg;
 349
 350	grp->allochanfunc = callback;
 351	grp->port_num = port_num;
 352	grp->port_persist = 1;
 353
 354	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_INFO,
 355			"%s(%s): state=%s",
 356			CTCM_FUNTAIL, dev->name, fsm_getstate_str(grp->fsm));
 357
 358	switch (fsm_getstate(grp->fsm)) {
 359	case MPCG_STATE_INOP:
 360		/* Group is in the process of terminating */
 361		grp->alloc_called = 1;
 362		break;
 363	case MPCG_STATE_RESET:
 364		/* MPC Group will transition to state		  */
 365		/* MPCG_STATE_XID2INITW iff the minimum number	  */
 366		/* of 1 read and 1 write channel have successfully*/
 367		/* activated					  */
 368		/*fsm_newstate(grp->fsm, MPCG_STATE_XID2INITW);*/
 369		if (callback)
 370			grp->send_qllc_disc = 1;
 371	case MPCG_STATE_XID0IOWAIT:
 372		fsm_deltimer(&grp->timer);
 373		grp->outstanding_xid2 = 0;
 374		grp->outstanding_xid7 = 0;
 375		grp->outstanding_xid7_p2 = 0;
 376		grp->saved_xid2 = NULL;
 377		if (callback)
 378			ctcm_open(dev);
 379		fsm_event(priv->fsm, DEV_EVENT_START, dev);
 380		break;
 381	case MPCG_STATE_READY:
 382		/* XID exchanges completed after PORT was activated */
 383		/* Link station already active			    */
 384		/* Maybe timing issue...retry callback		    */
 385		grp->allocchan_callback_retries++;
 386		if (grp->allocchan_callback_retries < 4) {
 387			if (grp->allochanfunc)
 388				grp->allochanfunc(grp->port_num,
 389						  grp->group_max_buflen);
 390		} else {
 391			/* there are problems...bail out	    */
 392			/* there may be a state mismatch so restart */
 393			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 394			grp->allocchan_callback_retries = 0;
 395		}
 396		break;
 397	}
 398
 399	return 0;
 400}
 401EXPORT_SYMBOL(ctc_mpc_alloc_channel);
 402
 403/*
 404 * ctc_mpc_establish_connectivity
 405 *	(exported interface)
 406 */
 407void ctc_mpc_establish_connectivity(int port_num,
 408				void (*callback)(int, int, int))
 409{
 410	struct net_device *dev;
 411	struct mpc_group *grp;
 412	struct ctcm_priv *priv;
 413	struct channel *rch, *wch;
 414
 415	dev = ctcmpc_get_dev(port_num);
 416	if (dev == NULL)
 417		return;
 418	priv = dev->ml_priv;
 419	grp = priv->mpcg;
 420	rch = priv->channel[CTCM_READ];
 421	wch = priv->channel[CTCM_WRITE];
 422
 423	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_INFO,
 424			"%s(%s): state=%s",
 425			CTCM_FUNTAIL, dev->name, fsm_getstate_str(grp->fsm));
 426
 427	grp->estconnfunc = callback;
 428	grp->port_num = port_num;
 429
 430	switch (fsm_getstate(grp->fsm)) {
 431	case MPCG_STATE_READY:
 432		/* XID exchanges completed after PORT was activated */
 433		/* Link station already active			    */
 434		/* Maybe timing issue...retry callback		    */
 435		fsm_deltimer(&grp->timer);
 436		grp->estconn_callback_retries++;
 437		if (grp->estconn_callback_retries < 4) {
 438			if (grp->estconnfunc) {
 439				grp->estconnfunc(grp->port_num, 0,
 440						grp->group_max_buflen);
 441				grp->estconnfunc = NULL;
 442			}
 443		} else {
 444			/* there are problems...bail out	 */
 445			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 446			grp->estconn_callback_retries = 0;
 447		}
 448		break;
 449	case MPCG_STATE_INOP:
 450	case MPCG_STATE_RESET:
 451		/* MPC Group is not ready to start XID - min num of */
 452		/* 1 read and 1 write channel have not been acquired*/
 453
 454		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 455			"%s(%s): REJECTED - inactive channels",
 456					CTCM_FUNTAIL, dev->name);
 457		if (grp->estconnfunc) {
 458			grp->estconnfunc(grp->port_num, -1, 0);
 459			grp->estconnfunc = NULL;
 460		}
 461		break;
 462	case MPCG_STATE_XID2INITW:
 463		/* alloc channel was called but no XID exchange    */
 464		/* has occurred. initiate xside XID exchange	   */
 465		/* make sure yside XID0 processing has not started */
 466
 467		if ((fsm_getstate(rch->fsm) > CH_XID0_PENDING) ||
 468			(fsm_getstate(wch->fsm) > CH_XID0_PENDING)) {
 469			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 470				"%s(%s): ABORT - PASSIVE XID",
 471					CTCM_FUNTAIL, dev->name);
 472			break;
 473		}
 474		grp->send_qllc_disc = 1;
 475		fsm_newstate(grp->fsm, MPCG_STATE_XID0IOWAIT);
 476		fsm_deltimer(&grp->timer);
 477		fsm_addtimer(&grp->timer, MPC_XID_TIMEOUT_VALUE,
 478						MPCG_EVENT_TIMER, dev);
 479		grp->outstanding_xid7 = 0;
 480		grp->outstanding_xid7_p2 = 0;
 481		grp->saved_xid2 = NULL;
 482		if ((rch->in_mpcgroup) &&
 483				(fsm_getstate(rch->fsm) == CH_XID0_PENDING))
 484			fsm_event(grp->fsm, MPCG_EVENT_XID0DO, rch);
 485		else {
 486			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 487				"%s(%s): RX-%s not ready for ACTIVE XID0",
 488					CTCM_FUNTAIL, dev->name, rch->id);
 489			if (grp->estconnfunc) {
 490				grp->estconnfunc(grp->port_num, -1, 0);
 491				grp->estconnfunc = NULL;
 492			}
 493			fsm_deltimer(&grp->timer);
 494				goto done;
 495		}
 496		if ((wch->in_mpcgroup) &&
 497				(fsm_getstate(wch->fsm) == CH_XID0_PENDING))
 498			fsm_event(grp->fsm, MPCG_EVENT_XID0DO, wch);
 499		else {
 500			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 501				"%s(%s): WX-%s not ready for ACTIVE XID0",
 502					CTCM_FUNTAIL, dev->name, wch->id);
 503			if (grp->estconnfunc) {
 504				grp->estconnfunc(grp->port_num, -1, 0);
 505				grp->estconnfunc = NULL;
 506			}
 507			fsm_deltimer(&grp->timer);
 508				goto done;
 509			}
 510		break;
 511	case MPCG_STATE_XID0IOWAIT:
 512		/* already in active XID negotiations */
 513	default:
 514		break;
 515	}
 516
 517done:
 518	CTCM_PR_DEBUG("Exit %s()\n", __func__);
 519	return;
 520}
 521EXPORT_SYMBOL(ctc_mpc_establish_connectivity);
 522
 523/*
 524 * ctc_mpc_dealloc_ch
 525 *	(exported interface)
 526 */
 527void ctc_mpc_dealloc_ch(int port_num)
 528{
 529	struct net_device *dev;
 530	struct ctcm_priv *priv;
 531	struct mpc_group *grp;
 532
 533	dev = ctcmpc_get_dev(port_num);
 534	if (dev == NULL)
 535		return;
 536	priv = dev->ml_priv;
 537	grp = priv->mpcg;
 538
 539	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_DEBUG,
 540			"%s: %s: refcount = %d\n",
 541			CTCM_FUNTAIL, dev->name, netdev_refcnt_read(dev));
 542
 543	fsm_deltimer(&priv->restart_timer);
 544	grp->channels_terminating = 0;
 545	fsm_deltimer(&grp->timer);
 546	grp->allochanfunc = NULL;
 547	grp->estconnfunc = NULL;
 548	grp->port_persist = 0;
 549	grp->send_qllc_disc = 0;
 550	fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 551
 552	ctcm_close(dev);
 553	return;
 554}
 555EXPORT_SYMBOL(ctc_mpc_dealloc_ch);
 556
 557/*
 558 * ctc_mpc_flow_control
 559 *	(exported interface)
 560 */
 561void ctc_mpc_flow_control(int port_num, int flowc)
 562{
 563	struct ctcm_priv *priv;
 564	struct mpc_group *grp;
 565	struct net_device *dev;
 566	struct channel *rch;
 567	int mpcg_state;
 568
 569	dev = ctcmpc_get_dev(port_num);
 570	if (dev == NULL)
 571		return;
 572	priv = dev->ml_priv;
 573	grp = priv->mpcg;
 574
 575	CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_DEBUG,
 576			"%s: %s: flowc = %d",
 577				CTCM_FUNTAIL, dev->name, flowc);
 578
 579	rch = priv->channel[CTCM_READ];
 580
 581	mpcg_state = fsm_getstate(grp->fsm);
 582	switch (flowc) {
 583	case 1:
 584		if (mpcg_state == MPCG_STATE_FLOWC)
 585			break;
 586		if (mpcg_state == MPCG_STATE_READY) {
 587			if (grp->flow_off_called == 1)
 588				grp->flow_off_called = 0;
 589			else
 590				fsm_newstate(grp->fsm, MPCG_STATE_FLOWC);
 591			break;
 592		}
 593		break;
 594	case 0:
 595		if (mpcg_state == MPCG_STATE_FLOWC) {
 596			fsm_newstate(grp->fsm, MPCG_STATE_READY);
 597			/* ensure any data that has accumulated */
 598			/* on the io_queue will now be sen t	*/
 599			tasklet_schedule(&rch->ch_tasklet);
 600		}
 601		/* possible race condition			*/
 602		if (mpcg_state == MPCG_STATE_READY) {
 603			grp->flow_off_called = 1;
 604			break;
 605		}
 606		break;
 607	}
 608
 609}
 610EXPORT_SYMBOL(ctc_mpc_flow_control);
 611
 612static int mpc_send_qllc_discontact(struct net_device *);
 613
 614/*
 615 * helper function of ctcmpc_unpack_skb
 616*/
 617static void mpc_rcvd_sweep_resp(struct mpcg_info *mpcginfo)
 618{
 619	struct channel	  *rch = mpcginfo->ch;
 620	struct net_device *dev = rch->netdev;
 621	struct ctcm_priv   *priv = dev->ml_priv;
 622	struct mpc_group  *grp = priv->mpcg;
 623	struct channel	  *ch = priv->channel[CTCM_WRITE];
 624
 625	CTCM_PR_DEBUG("%s: ch=0x%p id=%s\n", __func__, ch, ch->id);
 626	CTCM_D3_DUMP((char *)mpcginfo->sweep, TH_SWEEP_LENGTH);
 627
 628	grp->sweep_rsp_pend_num--;
 629
 630	if ((grp->sweep_req_pend_num == 0) &&
 631			(grp->sweep_rsp_pend_num == 0)) {
 632		fsm_deltimer(&ch->sweep_timer);
 633		grp->in_sweep = 0;
 634		rch->th_seq_num = 0x00;
 635		ch->th_seq_num = 0x00;
 636		ctcm_clear_busy_do(dev);
 637	}
 638
 639	kfree(mpcginfo);
 640
 641	return;
 642
 643}
 644
 645/*
 646 * helper function of mpc_rcvd_sweep_req
 647 * which is a helper of ctcmpc_unpack_skb
 648 */
 649static void ctcmpc_send_sweep_resp(struct channel *rch)
 650{
 651	struct net_device *dev = rch->netdev;
 652	struct ctcm_priv *priv = dev->ml_priv;
 653	struct mpc_group *grp = priv->mpcg;
 654	struct th_sweep *header;
 655	struct sk_buff *sweep_skb;
 656	struct channel *ch  = priv->channel[CTCM_WRITE];
 657
 658	CTCM_PR_DEBUG("%s: ch=0x%p id=%s\n", __func__, rch, rch->id);
 659
 660	sweep_skb = __dev_alloc_skb(MPC_BUFSIZE_DEFAULT, GFP_ATOMIC | GFP_DMA);
 661	if (sweep_skb == NULL) {
 662		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 663			"%s(%s): sweep_skb allocation ERROR\n",
 664			CTCM_FUNTAIL, rch->id);
 665		goto done;
 666	}
 667
 668	header = kmalloc(sizeof(struct th_sweep), gfp_type());
 669
 670	if (!header) {
 671		dev_kfree_skb_any(sweep_skb);
 672		goto done;
 673	}
 674
 675	header->th.th_seg	= 0x00 ;
 676	header->th.th_ch_flag	= TH_SWEEP_RESP;
 677	header->th.th_blk_flag	= 0x00;
 678	header->th.th_is_xid	= 0x00;
 679	header->th.th_seq_num	= 0x00;
 680	header->sw.th_last_seq	= ch->th_seq_num;
 681
 682	memcpy(skb_put(sweep_skb, TH_SWEEP_LENGTH), header, TH_SWEEP_LENGTH);
 683
 684	kfree(header);
 685
 686	dev->trans_start = jiffies;
 687	skb_queue_tail(&ch->sweep_queue, sweep_skb);
 688
 689	fsm_addtimer(&ch->sweep_timer, 100, CTC_EVENT_RSWEEP_TIMER, ch);
 690
 691	return;
 692
 693done:
 694	grp->in_sweep = 0;
 695	ctcm_clear_busy_do(dev);
 696	fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 697
 698	return;
 699}
 700
 701/*
 702 * helper function of ctcmpc_unpack_skb
 703 */
 704static void mpc_rcvd_sweep_req(struct mpcg_info *mpcginfo)
 705{
 706	struct channel	  *rch     = mpcginfo->ch;
 707	struct net_device *dev     = rch->netdev;
 708	struct ctcm_priv  *priv = dev->ml_priv;
 709	struct mpc_group  *grp  = priv->mpcg;
 710	struct channel	  *ch	   = priv->channel[CTCM_WRITE];
 711
 712	if (do_debug)
 713		CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_DEBUG,
 714			" %s(): ch=0x%p id=%s\n", __func__, ch, ch->id);
 715
 716	if (grp->in_sweep == 0) {
 717		grp->in_sweep = 1;
 718		ctcm_test_and_set_busy(dev);
 719		grp->sweep_req_pend_num = grp->active_channels[CTCM_READ];
 720		grp->sweep_rsp_pend_num = grp->active_channels[CTCM_READ];
 721	}
 722
 723	CTCM_D3_DUMP((char *)mpcginfo->sweep, TH_SWEEP_LENGTH);
 724
 725	grp->sweep_req_pend_num--;
 726	ctcmpc_send_sweep_resp(ch);
 727	kfree(mpcginfo);
 728	return;
 729}
 730
 731/*
 732  * MPC Group Station FSM definitions
 733 */
 734static const char *mpcg_event_names[] = {
 735	[MPCG_EVENT_INOP]	= "INOP Condition",
 736	[MPCG_EVENT_DISCONC]	= "Discontact Received",
 737	[MPCG_EVENT_XID0DO]	= "Channel Active - Start XID",
 738	[MPCG_EVENT_XID2]	= "XID2 Received",
 739	[MPCG_EVENT_XID2DONE]	= "XID0 Complete",
 740	[MPCG_EVENT_XID7DONE]	= "XID7 Complete",
 741	[MPCG_EVENT_TIMER]	= "XID Setup Timer",
 742	[MPCG_EVENT_DOIO]	= "XID DoIO",
 743};
 744
 745static const char *mpcg_state_names[] = {
 746	[MPCG_STATE_RESET]	= "Reset",
 747	[MPCG_STATE_INOP]	= "INOP",
 748	[MPCG_STATE_XID2INITW]	= "Passive XID- XID0 Pending Start",
 749	[MPCG_STATE_XID2INITX]	= "Passive XID- XID0 Pending Complete",
 750	[MPCG_STATE_XID7INITW]	= "Passive XID- XID7 Pending P1 Start",
 751	[MPCG_STATE_XID7INITX]	= "Passive XID- XID7 Pending P2 Complete",
 752	[MPCG_STATE_XID0IOWAIT]	= "Active  XID- XID0 Pending Start",
 753	[MPCG_STATE_XID0IOWAIX]	= "Active  XID- XID0 Pending Complete",
 754	[MPCG_STATE_XID7INITI]	= "Active  XID- XID7 Pending Start",
 755	[MPCG_STATE_XID7INITZ]	= "Active  XID- XID7 Pending Complete ",
 756	[MPCG_STATE_XID7INITF]	= "XID        - XID7 Complete ",
 757	[MPCG_STATE_FLOWC]	= "FLOW CONTROL ON",
 758	[MPCG_STATE_READY]	= "READY",
 759};
 760
 761/*
 762 * The MPC Group Station FSM
 763 *   22 events
 764 */
 765static const fsm_node mpcg_fsm[] = {
 766	{ MPCG_STATE_RESET,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 767	{ MPCG_STATE_INOP,	MPCG_EVENT_INOP,	mpc_action_nop        },
 768	{ MPCG_STATE_FLOWC,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 769
 770	{ MPCG_STATE_READY,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 771	{ MPCG_STATE_READY,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 772
 773	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_XID0DO,	mpc_action_doxid0     },
 774	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid0  },
 775	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 776	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 777	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_DOIO,	mpc_action_yside_xid  },
 778
 779	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_XID0DO,	mpc_action_doxid0     },
 780	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid0  },
 781	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 782	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 783	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_DOIO,	mpc_action_yside_xid  },
 784
 785	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_XID2DONE,	mpc_action_doxid7     },
 786	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 787	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid7  },
 788	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 789	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 790	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_XID7DONE,	mpc_action_doxid7     },
 791	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_DOIO,	mpc_action_yside_xid  },
 792
 793	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 794	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid7  },
 795	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 796	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_XID7DONE,	mpc_action_doxid7     },
 797	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 798	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_DOIO,	mpc_action_yside_xid  },
 799
 800	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_XID0DO,	mpc_action_doxid0     },
 801	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_DISCONC,	mpc_action_discontact },
 802	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_XID2,	mpc_action_rcvd_xid0  },
 803	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_INOP,	mpc_action_go_inop    },
 804	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_TIMER,	mpc_action_timeout    },
 805	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_DOIO,	mpc_action_xside_xid  },
 806
 807	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_XID0DO,	mpc_action_doxid0     },
 808	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_DISCONC,	mpc_action_discontact },
 809	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_XID2,	mpc_action_rcvd_xid0  },
 810	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_INOP,	mpc_action_go_inop    },
 811	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_TIMER,	mpc_action_timeout    },
 812	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_DOIO,	mpc_action_xside_xid  },
 813
 814	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_XID2DONE,	mpc_action_doxid7     },
 815	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid7  },
 816	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 817	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 818	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 819	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_XID7DONE,	mpc_action_doxid7     },
 820	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_DOIO,	mpc_action_xside_xid  },
 821
 822	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid7  },
 823	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_XID7DONE,	mpc_action_doxid7     },
 824	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 825	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 826	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 827	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_DOIO,	mpc_action_xside_xid  },
 828
 829	{ MPCG_STATE_XID7INITF,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 830	{ MPCG_STATE_XID7INITF,	MPCG_EVENT_XID7DONE,	mpc_action_go_ready   },
 831};
 832
 833static int mpcg_fsm_len = ARRAY_SIZE(mpcg_fsm);
 834
 835/*
 836 * MPC Group Station FSM action
 837 * CTCM_PROTO_MPC only
 838 */
 839static void mpc_action_go_ready(fsm_instance *fsm, int event, void *arg)
 840{
 841	struct net_device *dev = arg;
 842	struct ctcm_priv *priv = dev->ml_priv;
 843	struct mpc_group *grp = priv->mpcg;
 844
 845	if (grp == NULL) {
 846		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 847			"%s(%s): No MPC group",
 848				CTCM_FUNTAIL, dev->name);
 849		return;
 850	}
 851
 852	fsm_deltimer(&grp->timer);
 853
 854	if (grp->saved_xid2->xid2_flag2 == 0x40) {
 855		priv->xid->xid2_flag2 = 0x00;
 856		if (grp->estconnfunc) {
 857			grp->estconnfunc(grp->port_num, 1,
 858					grp->group_max_buflen);
 859			grp->estconnfunc = NULL;
 860		} else if (grp->allochanfunc)
 861			grp->send_qllc_disc = 1;
 862
 863		fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 864		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 865				"%s(%s): fails",
 866					CTCM_FUNTAIL, dev->name);
 867		return;
 868	}
 869
 870	grp->port_persist = 1;
 871	grp->out_of_sequence = 0;
 872	grp->estconn_called = 0;
 873
 874	tasklet_hi_schedule(&grp->mpc_tasklet2);
 875
 876	return;
 877}
 878
 879/*
 880 * helper of ctcm_init_netdevice
 881 * CTCM_PROTO_MPC only
 882 */
 883void mpc_group_ready(unsigned long adev)
 884{
 885	struct net_device *dev = (struct net_device *)adev;
 886	struct ctcm_priv *priv = dev->ml_priv;
 887	struct mpc_group *grp = priv->mpcg;
 888	struct channel *ch = NULL;
 889
 890	if (grp == NULL) {
 891		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 892			"%s(%s): No MPC group",
 893				CTCM_FUNTAIL, dev->name);
 894		return;
 895	}
 896
 897	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_NOTICE,
 898		"%s: %s: GROUP TRANSITIONED TO READY, maxbuf = %d\n",
 899			CTCM_FUNTAIL, dev->name, grp->group_max_buflen);
 900
 901	fsm_newstate(grp->fsm, MPCG_STATE_READY);
 902
 903	/* Put up a read on the channel */
 904	ch = priv->channel[CTCM_READ];
 905	ch->pdu_seq = 0;
 906	CTCM_PR_DBGDATA("ctcmpc: %s() ToDCM_pdu_seq= %08x\n" ,
 907			__func__, ch->pdu_seq);
 908
 909	ctcmpc_chx_rxidle(ch->fsm, CTC_EVENT_START, ch);
 910	/* Put the write channel in idle state */
 911	ch = priv->channel[CTCM_WRITE];
 912	if (ch->collect_len > 0) {
 913		spin_lock(&ch->collect_lock);
 914		ctcm_purge_skb_queue(&ch->collect_queue);
 915		ch->collect_len = 0;
 916		spin_unlock(&ch->collect_lock);
 917	}
 918	ctcm_chx_txidle(ch->fsm, CTC_EVENT_START, ch);
 919	ctcm_clear_busy(dev);
 920
 921	if (grp->estconnfunc) {
 922		grp->estconnfunc(grp->port_num, 0,
 923				    grp->group_max_buflen);
 924		grp->estconnfunc = NULL;
 925	} else 	if (grp->allochanfunc)
 926		grp->allochanfunc(grp->port_num, grp->group_max_buflen);
 927
 928	grp->send_qllc_disc = 1;
 929	grp->changed_side = 0;
 930
 931	return;
 932
 933}
 934
 935/*
 936 * Increment the MPC Group Active Channel Counts
 937 * helper of dev_action (called from channel fsm)
 938 */
 939void mpc_channel_action(struct channel *ch, int direction, int action)
 940{
 941	struct net_device  *dev  = ch->netdev;
 942	struct ctcm_priv   *priv = dev->ml_priv;
 943	struct mpc_group   *grp  = priv->mpcg;
 944
 945	if (grp == NULL) {
 946		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 947			"%s(%s): No MPC group",
 948				CTCM_FUNTAIL, dev->name);
 949		return;
 950	}
 951
 952	CTCM_PR_DEBUG("enter %s: ch=0x%p id=%s\n", __func__, ch, ch->id);
 953
 954	CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
 955		"%s: %i / Grp:%s total_channels=%i, active_channels: "
 956		"read=%i, write=%i\n", __func__, action,
 957		fsm_getstate_str(grp->fsm), grp->num_channel_paths,
 958		grp->active_channels[CTCM_READ],
 959		grp->active_channels[CTCM_WRITE]);
 960
 961	if ((action == MPC_CHANNEL_ADD) && (ch->in_mpcgroup == 0)) {
 962		grp->num_channel_paths++;
 963		grp->active_channels[direction]++;
 964		grp->outstanding_xid2++;
 965		ch->in_mpcgroup = 1;
 966
 967		if (ch->xid_skb != NULL)
 968			dev_kfree_skb_any(ch->xid_skb);
 969
 970		ch->xid_skb = __dev_alloc_skb(MPC_BUFSIZE_DEFAULT,
 971					GFP_ATOMIC | GFP_DMA);
 972		if (ch->xid_skb == NULL) {
 973			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 974				"%s(%s): Couldn't alloc ch xid_skb\n",
 975				CTCM_FUNTAIL, dev->name);
 976			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 977			return;
 978		}
 979		ch->xid_skb_data = ch->xid_skb->data;
 980		ch->xid_th = (struct th_header *)ch->xid_skb->data;
 981		skb_put(ch->xid_skb, TH_HEADER_LENGTH);
 982		ch->xid = (struct xid2 *)skb_tail_pointer(ch->xid_skb);
 983		skb_put(ch->xid_skb, XID2_LENGTH);
 984		ch->xid_id = skb_tail_pointer(ch->xid_skb);
 985		ch->xid_skb->data = ch->xid_skb_data;
 986		skb_reset_tail_pointer(ch->xid_skb);
 987		ch->xid_skb->len = 0;
 988
 989		memcpy(skb_put(ch->xid_skb, grp->xid_skb->len),
 990				grp->xid_skb->data,
 991				grp->xid_skb->len);
 992
 993		ch->xid->xid2_dlc_type =
 994			((CHANNEL_DIRECTION(ch->flags) == CTCM_READ)
 995				? XID2_READ_SIDE : XID2_WRITE_SIDE);
 996
 997		if (CHANNEL_DIRECTION(ch->flags) == CTCM_WRITE)
 998			ch->xid->xid2_buf_len = 0x00;
 999
1000		ch->xid_skb->data = ch->xid_skb_data;
1001		skb_reset_tail_pointer(ch->xid_skb);
1002		ch->xid_skb->len = 0;
1003
1004		fsm_newstate(ch->fsm, CH_XID0_PENDING);
1005
1006		if ((grp->active_channels[CTCM_READ] > 0) &&
1007		    (grp->active_channels[CTCM_WRITE] > 0) &&
1008			(fsm_getstate(grp->fsm) < MPCG_STATE_XID2INITW)) {
1009			fsm_newstate(grp->fsm, MPCG_STATE_XID2INITW);
1010			CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_NOTICE,
1011				"%s: %s: MPC GROUP CHANNELS ACTIVE\n",
1012						__func__, dev->name);
1013		}
1014	} else if ((action == MPC_CHANNEL_REMOVE) &&
1015			(ch->in_mpcgroup == 1)) {
1016		ch->in_mpcgroup = 0;
1017		grp->num_channel_paths--;
1018		grp->active_channels[direction]--;
1019
1020		if (ch->xid_skb != NULL)
1021			dev_kfree_skb_any(ch->xid_skb);
1022		ch->xid_skb = NULL;
1023
1024		if (grp->channels_terminating)
1025					goto done;
1026
1027		if (((grp->active_channels[CTCM_READ] == 0) &&
1028					(grp->active_channels[CTCM_WRITE] > 0))
1029			|| ((grp->active_channels[CTCM_WRITE] == 0) &&
1030					(grp->active_channels[CTCM_READ] > 0)))
1031			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1032	}
1033done:
1034	CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_DEBUG,
1035		"exit %s: %i / Grp:%s total_channels=%i, active_channels: "
1036		"read=%i, write=%i\n", __func__, action,
1037		fsm_getstate_str(grp->fsm), grp->num_channel_paths,
1038		grp->active_channels[CTCM_READ],
1039		grp->active_channels[CTCM_WRITE]);
1040
1041	CTCM_PR_DEBUG("exit %s: ch=0x%p id=%s\n", __func__, ch, ch->id);
1042}
1043
1044/**
1045 * Unpack a just received skb and hand it over to
1046 * upper layers.
1047 * special MPC version of unpack_skb.
1048 *
1049 * ch		The channel where this skb has been received.
1050 * pskb		The received skb.
1051 */
1052static void ctcmpc_unpack_skb(struct channel *ch, struct sk_buff *pskb)
1053{
1054	struct net_device *dev	= ch->netdev;
1055	struct ctcm_priv *priv = dev->ml_priv;
1056	struct mpc_group *grp = priv->mpcg;
1057	struct pdu *curr_pdu;
1058	struct mpcg_info *mpcginfo;
1059	struct th_header *header = NULL;
1060	struct th_sweep *sweep = NULL;
1061	int pdu_last_seen = 0;
1062	__u32 new_len;
1063	struct sk_buff *skb;
1064	int skblen;
1065	int sendrc = 0;
1066
1067	CTCM_PR_DEBUG("ctcmpc enter: %s() %s cp:%i ch:%s\n",
1068			__func__, dev->name, smp_processor_id(), ch->id);
1069
1070	header = (struct th_header *)pskb->data;
1071	if ((header->th_seg == 0) &&
1072		(header->th_ch_flag == 0) &&
1073		(header->th_blk_flag == 0) &&
1074		(header->th_seq_num == 0))
1075		/* nothing for us */	goto done;
1076
1077	CTCM_PR_DBGDATA("%s: th_header\n", __func__);
1078	CTCM_D3_DUMP((char *)header, TH_HEADER_LENGTH);
1079	CTCM_PR_DBGDATA("%s: pskb len: %04x \n", __func__, pskb->len);
1080
1081	pskb->dev = dev;
1082	pskb->ip_summed = CHECKSUM_UNNECESSARY;
1083	skb_pull(pskb, TH_HEADER_LENGTH);
1084
1085	if (likely(header->th_ch_flag == TH_HAS_PDU)) {
1086		CTCM_PR_DBGDATA("%s: came into th_has_pdu\n", __func__);
1087		if ((fsm_getstate(grp->fsm) == MPCG_STATE_FLOWC) ||
1088		   ((fsm_getstate(grp->fsm) == MPCG_STATE_READY) &&
1089		    (header->th_seq_num != ch->th_seq_num + 1) &&
1090		    (ch->th_seq_num != 0))) {
1091			/* This is NOT the next segment		*
1092			 * we are not the correct race winner	*
1093			 * go away and let someone else win	*
1094			 * BUT..this only applies if xid negot	*
1095			 * is done				*
1096			*/
1097			grp->out_of_sequence += 1;
1098			__skb_push(pskb, TH_HEADER_LENGTH);
1099			skb_queue_tail(&ch->io_queue, pskb);
1100			CTCM_PR_DBGDATA("%s: th_seq_num expect:%08x "
1101					"got:%08x\n", __func__,
1102				ch->th_seq_num + 1, header->th_seq_num);
1103
1104			return;
1105		}
1106		grp->out_of_sequence = 0;
1107		ch->th_seq_num = header->th_seq_num;
1108
1109		CTCM_PR_DBGDATA("ctcmpc: %s() FromVTAM_th_seq=%08x\n",
1110					__func__, ch->th_seq_num);
1111
1112		if (unlikely(fsm_getstate(grp->fsm) != MPCG_STATE_READY))
1113					goto done;
1114		while ((pskb->len > 0) && !pdu_last_seen) {
1115			curr_pdu = (struct pdu *)pskb->data;
1116
1117			CTCM_PR_DBGDATA("%s: pdu_header\n", __func__);
1118			CTCM_D3_DUMP((char *)pskb->data, PDU_HEADER_LENGTH);
1119			CTCM_PR_DBGDATA("%s: pskb len: %04x \n",
1120						__func__, pskb->len);
1121
1122			skb_pull(pskb, PDU_HEADER_LENGTH);
1123
1124			if (curr_pdu->pdu_flag & PDU_LAST)
1125				pdu_last_seen = 1;
1126			if (curr_pdu->pdu_flag & PDU_CNTL)
1127				pskb->protocol = htons(ETH_P_SNAP);
1128			else
1129				pskb->protocol = htons(ETH_P_SNA_DIX);
1130
1131			if ((pskb->len <= 0) || (pskb->len > ch->max_bufsize)) {
1132				CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1133					"%s(%s): Dropping packet with "
1134					"illegal siize %d",
1135					CTCM_FUNTAIL, dev->name, pskb->len);
1136
1137				priv->stats.rx_dropped++;
1138				priv->stats.rx_length_errors++;
1139					goto done;
1140			}
1141			skb_reset_mac_header(pskb);
1142			new_len = curr_pdu->pdu_offset;
1143			CTCM_PR_DBGDATA("%s: new_len: %04x \n",
1144						__func__, new_len);
1145			if ((new_len == 0) || (new_len > pskb->len)) {
1146				/* should never happen		    */
1147				/* pskb len must be hosed...bail out */
1148				CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1149					"%s(%s): non valid pdu_offset: %04x",
1150					/* "data may be lost", */
1151					CTCM_FUNTAIL, dev->name, new_len);
1152				goto done;
1153			}
1154			skb = __dev_alloc_skb(new_len+4, GFP_ATOMIC);
1155
1156			if (!skb) {
1157				CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1158					"%s(%s): MEMORY allocation error",
1159						CTCM_FUNTAIL, dev->name);
1160				priv->stats.rx_dropped++;
1161				fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1162						goto done;
1163			}
1164			memcpy(skb_put(skb, new_len), pskb->data, new_len);
1165
1166			skb_reset_mac_header(skb);
1167			skb->dev = pskb->dev;
1168			skb->protocol = pskb->protocol;
1169			skb->ip_summed = CHECKSUM_UNNECESSARY;
1170			*((__u32 *) skb_push(skb, 4)) = ch->pdu_seq;
1171			ch->pdu_seq++;
1172
1173			if (do_debug_data) {
1174				ctcm_pr_debug("%s: ToDCM_pdu_seq= %08x\n",
1175						__func__, ch->pdu_seq);
1176				ctcm_pr_debug("%s: skb:%0lx "
1177					"skb len: %d \n", __func__,
1178					(unsigned long)skb, skb->len);
1179				ctcm_pr_debug("%s: up to 32 bytes "
1180					"of pdu_data sent\n", __func__);
1181				ctcmpc_dump32((char *)skb->data, skb->len);
1182			}
1183
1184			skblen = skb->len;
1185			sendrc = netif_rx(skb);
1186			priv->stats.rx_packets++;
1187			priv->stats.rx_bytes += skblen;
1188			skb_pull(pskb, new_len); /* point to next PDU */
1189		}
1190	} else {
1191		mpcginfo = kmalloc(sizeof(struct mpcg_info), gfp_type());
1192		if (mpcginfo == NULL)
1193					goto done;
1194
1195		mpcginfo->ch = ch;
1196		mpcginfo->th = header;
1197		mpcginfo->skb = pskb;
1198		CTCM_PR_DEBUG("%s: Not PDU - may be control pkt\n",
1199					__func__);
1200		/*  it's a sweep?   */
1201		sweep = (struct th_sweep *)pskb->data;
1202		mpcginfo->sweep = sweep;
1203		if (header->th_ch_flag == TH_SWEEP_REQ)
1204			mpc_rcvd_sweep_req(mpcginfo);
1205		else if (header->th_ch_flag == TH_SWEEP_RESP)
1206			mpc_rcvd_sweep_resp(mpcginfo);
1207		else if (header->th_blk_flag == TH_DATA_IS_XID) {
1208			struct xid2 *thisxid = (struct xid2 *)pskb->data;
1209			skb_pull(pskb, XID2_LENGTH);
1210			mpcginfo->xid = thisxid;
1211			fsm_event(grp->fsm, MPCG_EVENT_XID2, mpcginfo);
1212		} else if (header->th_blk_flag == TH_DISCONTACT)
1213			fsm_event(grp->fsm, MPCG_EVENT_DISCONC, mpcginfo);
1214		else if (header->th_seq_num != 0) {
1215			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1216				"%s(%s): control pkt expected\n",
1217						CTCM_FUNTAIL, dev->name);
1218			priv->stats.rx_dropped++;
1219			/* mpcginfo only used for non-data transfers */
1220			kfree(mpcginfo);
1221			if (do_debug_data)
1222				ctcmpc_dump_skb(pskb, -8);
1223		}
1224	}
1225done:
1226
1227	dev_kfree_skb_any(pskb);
1228	if (sendrc == NET_RX_DROP) {
1229		dev_warn(&dev->dev,
1230			"The network backlog for %s is exceeded, "
1231			"package dropped\n", __func__);
1232		fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1233	}
1234
1235	CTCM_PR_DEBUG("exit %s: %s: ch=0x%p id=%s\n",
1236			__func__, dev->name, ch, ch->id);
1237}
1238
1239/**
1240 * tasklet helper for mpc's skb unpacking.
1241 *
1242 * ch		The channel to work on.
1243 * Allow flow control back pressure to occur here.
1244 * Throttling back channel can result in excessive
1245 * channel inactivity and system deact of channel
1246 */
1247void ctcmpc_bh(unsigned long thischan)
1248{
1249	struct channel	  *ch	= (struct channel *)thischan;
1250	struct sk_buff	  *skb;
1251	struct net_device *dev	= ch->netdev;
1252	struct ctcm_priv  *priv	= dev->ml_priv;
1253	struct mpc_group  *grp	= priv->mpcg;
1254
1255	CTCM_PR_DEBUG("%s cp:%i enter:  %s() %s\n",
1256	       dev->name, smp_processor_id(), __func__, ch->id);
1257	/* caller has requested driver to throttle back */
1258	while ((fsm_getstate(grp->fsm) != MPCG_STATE_FLOWC) &&
1259			(skb = skb_dequeue(&ch->io_queue))) {
1260		ctcmpc_unpack_skb(ch, skb);
1261		if (grp->out_of_sequence > 20) {
1262			/* assume data loss has occurred if */
1263			/* missing seq_num for extended     */
1264			/* period of time		    */
1265			grp->out_of_sequence = 0;
1266			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1267			break;
1268		}
1269		if (skb == skb_peek(&ch->io_queue))
1270			break;
1271	}
1272	CTCM_PR_DEBUG("exit %s: %s: ch=0x%p id=%s\n",
1273			__func__, dev->name, ch, ch->id);
1274	return;
1275}
1276
1277/*
1278 *  MPC Group Initializations
1279 */
1280struct mpc_group *ctcmpc_init_mpc_group(struct ctcm_priv *priv)
1281{
1282	struct mpc_group *grp;
1283
1284	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_INFO,
1285			"Enter %s(%p)", CTCM_FUNTAIL, priv);
1286
1287	grp = kzalloc(sizeof(struct mpc_group), GFP_KERNEL);
1288	if (grp == NULL)
1289		return NULL;
1290
1291	grp->fsm = init_fsm("mpcg", mpcg_state_names, mpcg_event_names,
1292			MPCG_NR_STATES, MPCG_NR_EVENTS, mpcg_fsm,
1293			mpcg_fsm_len, GFP_KERNEL);
1294	if (grp->fsm == NULL) {
1295		kfree(grp);
1296		return NULL;
1297	}
1298
1299	fsm_newstate(grp->fsm, MPCG_STATE_RESET);
1300	fsm_settimer(grp->fsm, &grp->timer);
1301
1302	grp->xid_skb =
1303		 __dev_alloc_skb(MPC_BUFSIZE_DEFAULT, GFP_ATOMIC | GFP_DMA);
1304	if (grp->xid_skb == NULL) {
1305		kfree_fsm(grp->fsm);
1306		kfree(grp);
1307		return NULL;
1308	}
1309	/*  base xid for all channels in group  */
1310	grp->xid_skb_data = grp->xid_skb->data;
1311	grp->xid_th = (struct th_header *)grp->xid_skb->data;
1312	memcpy(skb_put(grp->xid_skb, TH_HEADER_LENGTH),
1313			&thnorm, TH_HEADER_LENGTH);
1314
1315	grp->xid = (struct xid2 *)skb_tail_pointer(grp->xid_skb);
1316	memcpy(skb_put(grp->xid_skb, XID2_LENGTH), &init_xid, XID2_LENGTH);
1317	grp->xid->xid2_adj_id = jiffies | 0xfff00000;
1318	grp->xid->xid2_sender_id = jiffies;
1319
1320	grp->xid_id = skb_tail_pointer(grp->xid_skb);
1321	memcpy(skb_put(grp->xid_skb, 4), "VTAM", 4);
1322
1323	grp->rcvd_xid_skb =
1324		__dev_alloc_skb(MPC_BUFSIZE_DEFAULT, GFP_ATOMIC|GFP_DMA);
1325	if (grp->rcvd_xid_skb == NULL) {
1326		kfree_fsm(grp->fsm);
1327		dev_kfree_skb(grp->xid_skb);
1328		kfree(grp);
1329		return NULL;
1330	}
1331	grp->rcvd_xid_data = grp->rcvd_xid_skb->data;
1332	grp->rcvd_xid_th = (struct th_header *)grp->rcvd_xid_skb->data;
1333	memcpy(skb_put(grp->rcvd_xid_skb, TH_HEADER_LENGTH),
1334			&thnorm, TH_HEADER_LENGTH);
1335	grp->saved_xid2 = NULL;
1336	priv->xid = grp->xid;
1337	priv->mpcg = grp;
1338	return grp;
1339}
1340
1341/*
1342 * The MPC Group Station FSM
1343 */
1344
1345/*
1346 * MPC Group Station FSM actions
1347 * CTCM_PROTO_MPC only
1348 */
1349
1350/**
1351 * NOP action for statemachines
1352 */
1353static void mpc_action_nop(fsm_instance *fi, int event, void *arg)
1354{
1355}
1356
1357/*
1358 * invoked when the device transitions to dev_stopped
1359 * MPC will stop each individual channel if a single XID failure
1360 * occurs, or will intitiate all channels be stopped if a GROUP
1361 * level failure occurs.
1362 */
1363static void mpc_action_go_inop(fsm_instance *fi, int event, void *arg)
1364{
1365	struct net_device  *dev = arg;
1366	struct ctcm_priv    *priv;
1367	struct mpc_group *grp;
1368	struct channel *wch;
1369
1370	CTCM_PR_DEBUG("Enter %s: %s\n",	__func__, dev->name);
1371
1372	priv  = dev->ml_priv;
1373	grp =  priv->mpcg;
1374	grp->flow_off_called = 0;
1375	fsm_deltimer(&grp->timer);
1376	if (grp->channels_terminating)
1377			return;
1378
1379	grp->channels_terminating = 1;
1380	grp->saved_state = fsm_getstate(grp->fsm);
1381	fsm_newstate(grp->fsm, MPCG_STATE_INOP);
1382	if (grp->saved_state > MPCG_STATE_XID7INITF)
1383		CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
1384			"%s(%s): MPC GROUP INOPERATIVE",
1385				CTCM_FUNTAIL, dev->name);
1386	if ((grp->saved_state != MPCG_STATE_RESET) ||
1387		/* dealloc_channel has been called */
1388		(grp->port_persist == 0))
1389		fsm_deltimer(&priv->restart_timer);
1390
1391	wch = priv->channel[CTCM_WRITE];
1392
1393	switch (grp->saved_state) {
1394	case MPCG_STATE_RESET:
1395	case MPCG_STATE_INOP:
1396	case MPCG_STATE_XID2INITW:
1397	case MPCG_STATE_XID0IOWAIT:
1398	case MPCG_STATE_XID2INITX:
1399	case MPCG_STATE_XID7INITW:
1400	case MPCG_STATE_XID7INITX:
1401	case MPCG_STATE_XID0IOWAIX:
1402	case MPCG_STATE_XID7INITI:
1403	case MPCG_STATE_XID7INITZ:
1404	case MPCG_STATE_XID7INITF:
1405		break;
1406	case MPCG_STATE_FLOWC:
1407	case MPCG_STATE_READY:
1408	default:
1409		tasklet_hi_schedule(&wch->ch_disc_tasklet);
1410	}
1411
1412	grp->xid2_tgnum = 0;
1413	grp->group_max_buflen = 0;  /*min of all received */
1414	grp->outstanding_xid2 = 0;
1415	grp->outstanding_xid7 = 0;
1416	grp->outstanding_xid7_p2 = 0;
1417	grp->saved_xid2 = NULL;
1418	grp->xidnogood = 0;
1419	grp->changed_side = 0;
1420
1421	grp->rcvd_xid_skb->data = grp->rcvd_xid_data;
1422	skb_reset_tail_pointer(grp->rcvd_xid_skb);
1423	grp->rcvd_xid_skb->len = 0;
1424	grp->rcvd_xid_th = (struct th_header *)grp->rcvd_xid_skb->data;
1425	memcpy(skb_put(grp->rcvd_xid_skb, TH_HEADER_LENGTH), &thnorm,
1426	       TH_HEADER_LENGTH);
1427
1428	if (grp->send_qllc_disc == 1) {
1429		grp->send_qllc_disc = 0;
1430		mpc_send_qllc_discontact(dev);
1431	}
1432
1433	/* DO NOT issue DEV_EVENT_STOP directly out of this code */
1434	/* This can result in INOP of VTAM PU due to halting of  */
1435	/* outstanding IO which causes a sense to be returned	 */
1436	/* Only about 3 senses are allowed and then IOS/VTAM will*/
1437	/* become unreachable without manual intervention	 */
1438	if ((grp->port_persist == 1) || (grp->alloc_called)) {
1439		grp->alloc_called = 0;
1440		fsm_deltimer(&priv->restart_timer);
1441		fsm_addtimer(&priv->restart_timer, 500, DEV_EVENT_RESTART, dev);
1442		fsm_newstate(grp->fsm, MPCG_STATE_RESET);
1443		if (grp->saved_state > MPCG_STATE_XID7INITF)
1444			CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_ALWAYS,
1445				"%s(%s): MPC GROUP RECOVERY SCHEDULED",
1446					CTCM_FUNTAIL, dev->name);
1447	} else {
1448		fsm_deltimer(&priv->restart_timer);
1449		fsm_addtimer(&priv->restart_timer, 500, DEV_EVENT_STOP, dev);
1450		fsm_newstate(grp->fsm, MPCG_STATE_RESET);
1451		CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_ALWAYS,
1452			"%s(%s): NO MPC GROUP RECOVERY ATTEMPTED",
1453						CTCM_FUNTAIL, dev->name);
1454	}
1455}
1456
1457/**
1458 * Handle mpc group  action timeout.
1459 * MPC Group Station FSM action
1460 * CTCM_PROTO_MPC only
1461 *
1462 * fi		An instance of an mpc_group fsm.
1463 * event	The event, just happened.
1464 * arg		Generic pointer, casted from net_device * upon call.
1465 */
1466static void mpc_action_timeout(fsm_instance *fi, int event, void *arg)
1467{
1468	struct net_device *dev = arg;
1469	struct ctcm_priv *priv;
1470	struct mpc_group *grp;
1471	struct channel *wch;
1472	struct channel *rch;
1473
1474	priv = dev->ml_priv;
1475	grp = priv->mpcg;
1476	wch = priv->channel[CTCM_WRITE];
1477	rch = priv->channel[CTCM_READ];
1478
1479	switch (fsm_getstate(grp->fsm)) {
1480	case MPCG_STATE_XID2INITW:
1481		/* Unless there is outstanding IO on the  */
1482		/* channel just return and wait for ATTN  */
1483		/* interrupt to begin XID negotiations	  */
1484		if ((fsm_getstate(rch->fsm) == CH_XID0_PENDING) &&
1485		   (fsm_getstate(wch->fsm) == CH_XID0_PENDING))
1486			break;
1487	default:
1488		fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1489	}
1490
1491	CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_DEBUG,
1492			"%s: dev=%s exit",
1493			CTCM_FUNTAIL, dev->name);
1494	return;
1495}
1496
1497/*
1498 * MPC Group Station FSM action
1499 * CTCM_PROTO_MPC only
1500 */
1501void mpc_action_discontact(fsm_instance *fi, int event, void *arg)
1502{
1503	struct mpcg_info   *mpcginfo   = arg;
1504	struct channel	   *ch	       = mpcginfo->ch;
1505	struct net_device  *dev;
1506	struct ctcm_priv   *priv;
1507	struct mpc_group   *grp;
1508
1509	if (ch) {
1510		dev = ch->netdev;
1511		if (dev) {
1512			priv = dev->ml_priv;
1513			if (priv) {
1514				CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
1515					"%s: %s: %s\n",
1516					CTCM_FUNTAIL, dev->name, ch->id);
1517				grp = priv->mpcg;
1518				grp->send_qllc_disc = 1;
1519				fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1520			}
1521		}
1522	}
1523
1524	return;
1525}
1526
1527/*
1528 * MPC Group Station - not part of FSM
1529 * CTCM_PROTO_MPC only
1530 * called from add_channel in ctcm_main.c
1531 */
1532void mpc_action_send_discontact(unsigned long thischan)
1533{
1534	int rc;
1535	struct channel	*ch = (struct channel *)thischan;
1536	unsigned long	saveflags = 0;
1537
1538	spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1539	rc = ccw_device_start(ch->cdev, &ch->ccw[15],
1540					(unsigned long)ch, 0xff, 0);
1541	spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
1542
1543	if (rc != 0) {
1544		ctcm_ccw_check_rc(ch, rc, (char *)__func__);
1545	}
1546
1547	return;
1548}
1549
1550
1551/*
1552 * helper function of mpc FSM
1553 * CTCM_PROTO_MPC only
1554 * mpc_action_rcvd_xid7
1555*/
1556static int mpc_validate_xid(struct mpcg_info *mpcginfo)
1557{
1558	struct channel	   *ch	 = mpcginfo->ch;
1559	struct net_device  *dev  = ch->netdev;
1560	struct ctcm_priv   *priv = dev->ml_priv;
1561	struct mpc_group   *grp  = priv->mpcg;
1562	struct xid2	   *xid  = mpcginfo->xid;
1563	int	rc	 = 0;
1564	__u64	our_id   = 0;
1565	__u64   their_id = 0;
1566	int	len = TH_HEADER_LENGTH + PDU_HEADER_LENGTH;
1567
1568	CTCM_PR_DEBUG("Enter %s: xid=%p\n", __func__, xid);
1569
1570	if (xid == NULL) {
1571		rc = 1;
1572		/* XID REJECTED: xid == NULL */
1573		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1574			"%s(%s): xid = NULL",
1575				CTCM_FUNTAIL, ch->id);
1576			goto done;
1577	}
1578
1579	CTCM_D3_DUMP((char *)xid, XID2_LENGTH);
1580
1581	/*the received direction should be the opposite of ours  */
1582	if (((CHANNEL_DIRECTION(ch->flags) == CTCM_READ) ? XID2_WRITE_SIDE :
1583				XID2_READ_SIDE) != xid->xid2_dlc_type) {
1584		rc = 2;
1585		/* XID REJECTED: r/w channel pairing mismatch */
1586		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1587			"%s(%s): r/w channel pairing mismatch",
1588				CTCM_FUNTAIL, ch->id);
1589			goto done;
1590	}
1591
1592	if (xid->xid2_dlc_type == XID2_READ_SIDE) {
1593		CTCM_PR_DEBUG("%s: grpmaxbuf:%d xid2buflen:%d\n", __func__,
1594				grp->group_max_buflen, xid->xid2_buf_len);
1595
1596		if (grp->group_max_buflen == 0 || grp->group_max_buflen >
1597						xid->xid2_buf_len - len)
1598			grp->group_max_buflen = xid->xid2_buf_len - len;
1599	}
1600
1601	if (grp->saved_xid2 == NULL) {
1602		grp->saved_xid2 =
1603			(struct xid2 *)skb_tail_pointer(grp->rcvd_xid_skb);
1604
1605		memcpy(skb_put(grp->rcvd_xid_skb,
1606					XID2_LENGTH), xid, XID2_LENGTH);
1607		grp->rcvd_xid_skb->data = grp->rcvd_xid_data;
1608
1609		skb_reset_tail_pointer(grp->rcvd_xid_skb);
1610		grp->rcvd_xid_skb->len = 0;
1611
1612		/* convert two 32 bit numbers into 1 64 bit for id compare */
1613		our_id = (__u64)priv->xid->xid2_adj_id;
1614		our_id = our_id << 32;
1615		our_id = our_id + priv->xid->xid2_sender_id;
1616		their_id = (__u64)xid->xid2_adj_id;
1617		their_id = their_id << 32;
1618		their_id = their_id + xid->xid2_sender_id;
1619		/* lower id assume the xside role */
1620		if (our_id < their_id) {
1621			grp->roll = XSIDE;
1622			CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
1623				"%s(%s): WE HAVE LOW ID - TAKE XSIDE",
1624					CTCM_FUNTAIL, ch->id);
1625		} else {
1626			grp->roll = YSIDE;
1627			CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
1628				"%s(%s): WE HAVE HIGH ID - TAKE YSIDE",
1629					CTCM_FUNTAIL, ch->id);
1630		}
1631
1632	} else {
1633		if (xid->xid2_flag4 != grp->saved_xid2->xid2_flag4) {
1634			rc = 3;
1635			/* XID REJECTED: xid flag byte4 mismatch */
1636			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1637				"%s(%s): xid flag byte4 mismatch",
1638					CTCM_FUNTAIL, ch->id);
1639		}
1640		if (xid->xid2_flag2 == 0x40) {
1641			rc = 4;
1642			/* XID REJECTED - xid NOGOOD */
1643			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1644				"%s(%s): xid NOGOOD",
1645					CTCM_FUNTAIL, ch->id);
1646		}
1647		if (xid->xid2_adj_id != grp->saved_xid2->xid2_adj_id) {
1648			rc = 5;
1649			/* XID REJECTED - Adjacent Station ID Mismatch */
1650			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1651				"%s(%s): Adjacent Station ID Mismatch",
1652					CTCM_FUNTAIL, ch->id);
1653		}
1654		if (xid->xid2_sender_id != grp->saved_xid2->xid2_sender_id) {
1655			rc = 6;
1656			/* XID REJECTED - Sender Address Mismatch */
1657			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1658				"%s(%s): Sender Address Mismatch",
1659					CTCM_FUNTAIL, ch->id);
1660		}
1661	}
1662done:
1663	if (rc) {
1664		dev_warn(&dev->dev,
1665			"The XID used in the MPC protocol is not valid, "
1666			"rc = %d\n", rc);
1667		priv->xid->xid2_flag2 = 0x40;
1668		grp->saved_xid2->xid2_flag2 = 0x40;
1669	}
1670
1671	return rc;
1672}
1673
1674/*
1675 * MPC Group Station FSM action
1676 * CTCM_PROTO_MPC only
1677 */
1678static void mpc_action_side_xid(fsm_instance *fsm, void *arg, int side)
1679{
1680	struct channel *ch = arg;
1681	int rc = 0;
1682	int gotlock = 0;
1683	unsigned long saveflags = 0;	/* avoids compiler warning with
1684					   spin_unlock_irqrestore */
1685
1686	CTCM_PR_DEBUG("Enter %s: cp=%i ch=0x%p id=%s\n",
1687			__func__, smp_processor_id(), ch, ch->id);
1688
1689	if (ctcm_checkalloc_buffer(ch))
1690					goto done;
1691
1692	/*
1693	 * skb data-buffer referencing:
1694	 */
1695	ch->trans_skb->data = ch->trans_skb_data;
1696	skb_reset_tail_pointer(ch->trans_skb);
1697	ch->trans_skb->len = 0;
1698	/* result of the previous 3 statements is NOT always
1699	 * already set after ctcm_checkalloc_buffer
1700	 * because of possible reuse of the trans_skb
1701	 */
1702	memset(ch->trans_skb->data, 0, 16);
1703	ch->rcvd_xid_th =  (struct th_header *)ch->trans_skb_data;
1704	/* check is main purpose here: */
1705	skb_put(ch->trans_skb, TH_HEADER_LENGTH);
1706	ch->rcvd_xid = (struct xid2 *)skb_tail_pointer(ch->trans_skb);
1707	/* check is main purpose here: */
1708	skb_put(ch->trans_skb, XID2_LENGTH);
1709	ch->rcvd_xid_id = skb_tail_pointer(ch->trans_skb);
1710	/* cleanup back to startpoint */
1711	ch->trans_skb->data = ch->trans_skb_data;
1712	skb_reset_tail_pointer(ch->trans_skb);
1713	ch->trans_skb->len = 0;
1714
1715	/* non-checking rewrite of above skb data-buffer referencing: */
1716	/*
1717	memset(ch->trans_skb->data, 0, 16);
1718	ch->rcvd_xid_th =  (struct th_header *)ch->trans_skb_data;
1719	ch->rcvd_xid = (struct xid2 *)(ch->trans_skb_data + TH_HEADER_LENGTH);
1720	ch->rcvd_xid_id = ch->trans_skb_data + TH_HEADER_LENGTH + XID2_LENGTH;
1721	 */
1722
1723	ch->ccw[8].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1724	ch->ccw[8].count	= 0;
1725	ch->ccw[8].cda		= 0x00;
1726
1727	if (!(ch->xid_th && ch->xid && ch->xid_id))
1728		CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_INFO,
1729			"%s(%s): xid_th=%p, xid=%p, xid_id=%p",
1730			CTCM_FUNTAIL, ch->id, ch->xid_th, ch->xid, ch->xid_id);
1731
1732	if (side == XSIDE) {
1733		/* mpc_action_xside_xid */
1734		if (ch->xid_th == NULL)
1735				goto done;
1736		ch->ccw[9].cmd_code	= CCW_CMD_WRITE;
1737		ch->ccw[9].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1738		ch->ccw[9].count	= TH_HEADER_LENGTH;
1739		ch->ccw[9].cda		= virt_to_phys(ch->xid_th);
1740
1741		if (ch->xid == NULL)
1742				goto done;
1743		ch->ccw[10].cmd_code	= CCW_CMD_WRITE;
1744		ch->ccw[10].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1745		ch->ccw[10].count	= XID2_LENGTH;
1746		ch->ccw[10].cda		= virt_to_phys(ch->xid);
1747
1748		ch->ccw[11].cmd_code	= CCW_CMD_READ;
1749		ch->ccw[11].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1750		ch->ccw[11].count	= TH_HEADER_LENGTH;
1751		ch->ccw[11].cda		= virt_to_phys(ch->rcvd_xid_th);
1752
1753		ch->ccw[12].cmd_code	= CCW_CMD_READ;
1754		ch->ccw[12].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1755		ch->ccw[12].count	= XID2_LENGTH;
1756		ch->ccw[12].cda		= virt_to_phys(ch->rcvd_xid);
1757
1758		ch->ccw[13].cmd_code	= CCW_CMD_READ;
1759		ch->ccw[13].cda		= virt_to_phys(ch->rcvd_xid_id);
1760
1761	} else { /* side == YSIDE : mpc_action_yside_xid */
1762		ch->ccw[9].cmd_code	= CCW_CMD_READ;
1763		ch->ccw[9].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1764		ch->ccw[9].count	= TH_HEADER_LENGTH;
1765		ch->ccw[9].cda		= virt_to_phys(ch->rcvd_xid_th);
1766
1767		ch->ccw[10].cmd_code	= CCW_CMD_READ;
1768		ch->ccw[10].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1769		ch->ccw[10].count	= XID2_LENGTH;
1770		ch->ccw[10].cda		= virt_to_phys(ch->rcvd_xid);
1771
1772		if (ch->xid_th == NULL)
1773				goto done;
1774		ch->ccw[11].cmd_code	= CCW_CMD_WRITE;
1775		ch->ccw[11].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1776		ch->ccw[11].count	= TH_HEADER_LENGTH;
1777		ch->ccw[11].cda		= virt_to_phys(ch->xid_th);
1778
1779		if (ch->xid == NULL)
1780				goto done;
1781		ch->ccw[12].cmd_code	= CCW_CMD_WRITE;
1782		ch->ccw[12].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1783		ch->ccw[12].count	= XID2_LENGTH;
1784		ch->ccw[12].cda		= virt_to_phys(ch->xid);
1785
1786		if (ch->xid_id == NULL)
1787				goto done;
1788		ch->ccw[13].cmd_code	= CCW_CMD_WRITE;
1789		ch->ccw[13].cda		= virt_to_phys(ch->xid_id);
1790
1791	}
1792	ch->ccw[13].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1793	ch->ccw[13].count	= 4;
1794
1795	ch->ccw[14].cmd_code	= CCW_CMD_NOOP;
1796	ch->ccw[14].flags	= CCW_FLAG_SLI;
1797	ch->ccw[14].count	= 0;
1798	ch->ccw[14].cda		= 0;
1799
1800	CTCM_CCW_DUMP((char *)&ch->ccw[8], sizeof(struct ccw1) * 7);
1801	CTCM_D3_DUMP((char *)ch->xid_th, TH_HEADER_LENGTH);
1802	CTCM_D3_DUMP((char *)ch->xid, XID2_LENGTH);
1803	CTCM_D3_DUMP((char *)ch->xid_id, 4);
1804
1805	if (!in_irq()) {
1806			 /* Such conditional locking is a known problem for
1807			  * sparse because its static undeterministic.
1808			  * Warnings should be ignored here. */
1809		spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1810		gotlock = 1;
1811	}
1812
1813	fsm_addtimer(&ch->timer, 5000 , CTC_EVENT_TIMER, ch);
1814	rc = ccw_device_start(ch->cdev, &ch->ccw[8],
1815				(unsigned long)ch, 0xff, 0);
1816
1817	if (gotlock)	/* see remark above about conditional locking */
1818		spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
1819
1820	if (rc != 0) {
1821		ctcm_ccw_check_rc(ch, rc,
1822				(side == XSIDE) ? "x-side XID" : "y-side XID");
1823	}
1824
1825done:
1826	CTCM_PR_DEBUG("Exit %s: ch=0x%p id=%s\n",
1827				__func__, ch, ch->id);
1828	return;
1829
1830}
1831
1832/*
1833 * MPC Group Station FSM action
1834 * CTCM_PROTO_MPC only
1835 */
1836static void mpc_action_xside_xid(fsm_instance *fsm, int event, void *arg)
1837{
1838	mpc_action_side_xid(fsm, arg, XSIDE);
1839}
1840
1841/*
1842 * MPC Group Station FSM action
1843 * CTCM_PROTO_MPC only
1844 */
1845static void mpc_action_yside_xid(fsm_instance *fsm, int event, void *arg)
1846{
1847	mpc_action_side_xid(fsm, arg, YSIDE);
1848}
1849
1850/*
1851 * MPC Group Station FSM action
1852 * CTCM_PROTO_MPC only
1853 */
1854static void mpc_action_doxid0(fsm_instance *fsm, int event, void *arg)
1855{
1856	struct channel	   *ch   = arg;
1857	struct net_device  *dev  = ch->netdev;
1858	struct ctcm_priv   *priv = dev->ml_priv;
1859	struct mpc_group   *grp  = priv->mpcg;
1860
1861	CTCM_PR_DEBUG("Enter %s: cp=%i ch=0x%p id=%s\n",
1862			__func__, smp_processor_id(), ch, ch->id);
1863
1864	if (ch->xid == NULL) {
1865		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1866			"%s(%s): ch->xid == NULL",
1867				CTCM_FUNTAIL, dev->name);
1868		return;
1869	}
1870
1871	fsm_newstate(ch->fsm, CH_XID0_INPROGRESS);
1872
1873	ch->xid->xid2_option =	XID2_0;
1874
1875	switch (fsm_getstate(grp->fsm)) {
1876	case MPCG_STATE_XID2INITW:
1877	case MPCG_STATE_XID2INITX:
1878		ch->ccw[8].cmd_code = CCW_CMD_SENSE_CMD;
1879		break;
1880	case MPCG_STATE_XID0IOWAIT:
1881	case MPCG_STATE_XID0IOWAIX:
1882		ch->ccw[8].cmd_code = CCW_CMD_WRITE_CTL;
1883		break;
1884	}
1885
1886	fsm_event(grp->fsm, MPCG_EVENT_DOIO, ch);
1887
1888	return;
1889}
1890
1891/*
1892 * MPC Group Station FSM action
1893 * CTCM_PROTO_MPC only
1894*/
1895static void mpc_action_doxid7(fsm_instance *fsm, int event, void *arg)
1896{
1897	struct net_device *dev = arg;
1898	struct ctcm_priv  *priv = dev->ml_priv;
1899	struct mpc_group  *grp  = NULL;
1900	int direction;
1901	int send = 0;
1902
1903	if (priv)
1904		grp = priv->mpcg;
1905	if (grp == NULL)
1906		return;
1907
1908	for (direction = CTCM_READ; direction <= CTCM_WRITE; direction++) {
1909		struct channel *ch = priv->channel[direction];
1910		struct xid2 *thisxid = ch->xid;
1911		ch->xid_skb->data = ch->xid_skb_data;
1912		skb_reset_tail_pointer(ch->xid_skb);
1913		ch->xid_skb->len = 0;
1914		thisxid->xid2_option = XID2_7;
1915		send = 0;
1916
1917		/* xid7 phase 1 */
1918		if (grp->outstanding_xid7_p2 > 0) {
1919			if (grp->roll == YSIDE) {
1920				if (fsm_getstate(ch->fsm) == CH_XID7_PENDING1) {
1921					fsm_newstate(ch->fsm, CH_XID7_PENDING2);
1922					ch->ccw[8].cmd_code = CCW_CMD_SENSE_CMD;
1923					memcpy(skb_put(ch->xid_skb,
1924							TH_HEADER_LENGTH),
1925					       &thdummy, TH_HEADER_LENGTH);
1926					send = 1;
1927				}
1928			} else if (fsm_getstate(ch->fsm) < CH_XID7_PENDING2) {
1929					fsm_newstate(ch->fsm, CH_XID7_PENDING2);
1930					ch->ccw[8].cmd_code = CCW_CMD_WRITE_CTL;
1931					memcpy(skb_put(ch->xid_skb,
1932						       TH_HEADER_LENGTH),
1933					       &thnorm, TH_HEADER_LENGTH);
1934					send = 1;
1935			}
1936		} else {
1937			/* xid7 phase 2 */
1938			if (grp->roll == YSIDE) {
1939				if (fsm_getstate(ch->fsm) < CH_XID7_PENDING4) {
1940					fsm_newstate(ch->fsm, CH_XID7_PENDING4);
1941					memcpy(skb_put(ch->xid_skb,
1942						       TH_HEADER_LENGTH),
1943					       &thnorm, TH_HEADER_LENGTH);
1944					ch->ccw[8].cmd_code = CCW_CMD_WRITE_CTL;
1945					send = 1;
1946				}
1947			} else if (fsm_getstate(ch->fsm) == CH_XID7_PENDING3) {
1948				fsm_newstate(ch->fsm, CH_XID7_PENDING4);
1949				ch->ccw[8].cmd_code = CCW_CMD_SENSE_CMD;
1950				memcpy(skb_put(ch->xid_skb, TH_HEADER_LENGTH),
1951						&thdummy, TH_HEADER_LENGTH);
1952				send = 1;
1953			}
1954		}
1955
1956		if (send)
1957			fsm_event(grp->fsm, MPCG_EVENT_DOIO, ch);
1958	}
1959
1960	return;
1961}
1962
1963/*
1964 * MPC Group Station FSM action
1965 * CTCM_PROTO_MPC only
1966 */
1967static void mpc_action_rcvd_xid0(fsm_instance *fsm, int event, void *arg)
1968{
1969
1970	struct mpcg_info   *mpcginfo  = arg;
1971	struct channel	   *ch   = mpcginfo->ch;
1972	struct net_device  *dev  = ch->netdev;
1973	struct ctcm_priv   *priv = dev->ml_priv;
1974	struct mpc_group   *grp  = priv->mpcg;
1975
1976	CTCM_PR_DEBUG("%s: ch-id:%s xid2:%i xid7:%i xidt_p2:%i \n",
1977			__func__, ch->id, grp->outstanding_xid2,
1978			grp->outstanding_xid7, grp->outstanding_xid7_p2);
1979
1980	if (fsm_getstate(ch->fsm) < CH_XID7_PENDING)
1981		fsm_newstate(ch->fsm, CH_XID7_PENDING);
1982
1983	grp->outstanding_xid2--;
1984	grp->outstanding_xid7++;
1985	grp->outstanding_xid7_p2++;
1986
1987	/* must change state before validating xid to */
1988	/* properly handle interim interrupts received*/
1989	switch (fsm_getstate(grp->fsm)) {
1990	case MPCG_STATE_XID2INITW:
1991		fsm_newstate(grp->fsm, MPCG_STATE_XID2INITX);
1992		mpc_validate_xid(mpcginfo);
1993		break;
1994	case MPCG_STATE_XID0IOWAIT:
1995		fsm_newstate(grp->fsm, MPCG_STATE_XID0IOWAIX);
1996		mpc_validate_xid(mpcginfo);
1997		break;
1998	case MPCG_STATE_XID2INITX:
1999		if (grp->outstanding_xid2 == 0) {
2000			fsm_newstate(grp->fsm, MPCG_STATE_XID7INITW);
2001			mpc_validate_xid(mpcginfo);
2002			fsm_event(grp->fsm, MPCG_EVENT_XID2DONE, dev);
2003		}
2004		break;
2005	case MPCG_STATE_XID0IOWAIX:
2006		if (grp->outstanding_xid2 == 0) {
2007			fsm_newstate(grp->fsm, MPCG_STATE_XID7INITI);
2008			mpc_validate_xid(mpcginfo);
2009			fsm_event(grp->fsm, MPCG_EVENT_XID2DONE, dev);
2010		}
2011		break;
2012	}
2013	kfree(mpcginfo);
2014
2015	CTCM_PR_DEBUG("ctcmpc:%s() %s xid2:%i xid7:%i xidt_p2:%i \n",
2016		__func__, ch->id, grp->outstanding_xid2,
2017		grp->outstanding_xid7, grp->outstanding_xid7_p2);
2018	CTCM_PR_DEBUG("ctcmpc:%s() %s grpstate: %s chanstate: %s \n",
2019		__func__, ch->id,
2020		fsm_getstate_str(grp->fsm), fsm_getstate_str(ch->fsm));
2021	return;
2022
2023}
2024
2025
2026/*
2027 * MPC Group Station FSM action
2028 * CTCM_PROTO_MPC only
2029 */
2030static void mpc_action_rcvd_xid7(fsm_instance *fsm, int event, void *arg)
2031{
2032	struct mpcg_info   *mpcginfo   = arg;
2033	struct channel	   *ch	       = mpcginfo->ch;
2034	struct net_device  *dev        = ch->netdev;
2035	struct ctcm_priv   *priv    = dev->ml_priv;
2036	struct mpc_group   *grp     = priv->mpcg;
2037
2038	CTCM_PR_DEBUG("Enter %s: cp=%i ch=0x%p id=%s\n",
2039		__func__, smp_processor_id(), ch, ch->id);
2040	CTCM_PR_DEBUG("%s: outstanding_xid7: %i, outstanding_xid7_p2: %i\n",
2041		__func__, grp->outstanding_xid7, grp->outstanding_xid7_p2);
2042
2043	grp->outstanding_xid7--;
2044	ch->xid_skb->data = ch->xid_skb_data;
2045	skb_reset_tail_pointer(ch->xid_skb);
2046	ch->xid_skb->len = 0;
2047
2048	switch (fsm_getstate(grp->fsm)) {
2049	case MPCG_STATE_XID7INITI:
2050		fsm_newstate(grp->fsm, MPCG_STATE_XID7INITZ);
2051		mpc_validate_xid(mpcginfo);
2052		break;
2053	case MPCG_STATE_XID7INITW:
2054		fsm_newstate(grp->fsm, MPCG_STATE_XID7INITX);
2055		mpc_validate_xid(mpcginfo);
2056		break;
2057	case MPCG_STATE_XID7INITZ:
2058	case MPCG_STATE_XID7INITX:
2059		if (grp->outstanding_xid7 == 0) {
2060			if (grp->outstanding_xid7_p2 > 0) {
2061				grp->outstanding_xid7 =
2062					grp->outstanding_xid7_p2;
2063				grp->outstanding_xid7_p2 = 0;
2064			} else
2065				fsm_newstate(grp->fsm, MPCG_STATE_XID7INITF);
2066
2067			mpc_validate_xid(mpcginfo);
2068			fsm_event(grp->fsm, MPCG_EVENT_XID7DONE, dev);
2069			break;
2070		}
2071		mpc_validate_xid(mpcginfo);
2072		break;
2073	}
2074	kfree(mpcginfo);
2075	return;
2076}
2077
2078/*
2079 * mpc_action helper of an MPC Group Station FSM action
2080 * CTCM_PROTO_MPC only
2081 */
2082static int mpc_send_qllc_discontact(struct net_device *dev)
2083{
2084	__u32	new_len	= 0;
2085	struct sk_buff   *skb;
2086	struct qllc      *qllcptr;
2087	struct ctcm_priv *priv = dev->ml_priv;
2088	struct mpc_group *grp = priv->mpcg;
2089
2090	CTCM_PR_DEBUG("%s: GROUP STATE: %s\n",
2091		__func__, mpcg_state_names[grp->saved_state]);
2092
2093	switch (grp->saved_state) {
2094	/*
2095	 * establish conn callback function is
2096	 * preferred method to report failure
2097	 */
2098	case MPCG_STATE_XID0IOWAIT:
2099	case MPCG_STATE_XID0IOWAIX:
2100	case MPCG_STATE_XID7INITI:
2101	case MPCG_STATE_XID7INITZ:
2102	case MPCG_STATE_XID2INITW:
2103	case MPCG_STATE_XID2INITX:
2104	case MPCG_STATE_XID7INITW:
2105	case MPCG_STATE_XID7INITX:
2106		if (grp->estconnfunc) {
2107			grp->estconnfunc(grp->port_num, -1, 0);
2108			grp->estconnfunc = NULL;
2109			break;
2110		}
2111	case MPCG_STATE_FLOWC:
2112	case MPCG_STATE_READY:
2113		grp->send_qllc_disc = 2;
2114		new_len = sizeof(struct qllc);
2115		qllcptr = kzalloc(new_len, gfp_type() | GFP_DMA);
2116		if (qllcptr == NULL) {
2117			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
2118				"%s(%s): qllcptr allocation error",
2119						CTCM_FUNTAIL, dev->name);
2120			return -ENOMEM;
2121		}
2122
2123		qllcptr->qllc_address = 0xcc;
2124		qllcptr->qllc_commands = 0x03;
2125
2126		skb = __dev_alloc_skb(new_len, GFP_ATOMIC);
2127
2128		if (skb == NULL) {
2129			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
2130				"%s(%s): skb allocation error",
2131						CTCM_FUNTAIL, dev->name);
2132			priv->stats.rx_dropped++;
2133			kfree(qllcptr);
2134			return -ENOMEM;
2135		}
2136
2137		memcpy(skb_put(skb, new_len), qllcptr, new_len);
2138		kfree(qllcptr);
2139
2140		if (skb_headroom(skb) < 4) {
2141			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
2142				"%s(%s): skb_headroom error",
2143						CTCM_FUNTAIL, dev->name);
2144			dev_kfree_skb_any(skb);
2145			return -ENOMEM;
2146		}
2147
2148		*((__u32 *)skb_push(skb, 4)) =
2149			priv->channel[CTCM_READ]->pdu_seq;
2150		priv->channel[CTCM_READ]->pdu_seq++;
2151		CTCM_PR_DBGDATA("ctcmpc: %s ToDCM_pdu_seq= %08x\n",
2152				__func__, priv->channel[CTCM_READ]->pdu_seq);
2153
2154		/* receipt of CC03 resets anticipated sequence number on
2155		      receiving side */
2156		priv->channel[CTCM_READ]->pdu_seq = 0x00;
2157		skb_reset_mac_header(skb);
2158		skb->dev = dev;
2159		skb->protocol = htons(ETH_P_SNAP);
2160		skb->ip_summed = CHECKSUM_UNNECESSARY;
2161
2162		CTCM_D3_DUMP(skb->data, (sizeof(struct qllc) + 4));
2163
2164		netif_rx(skb);
2165		break;
2166	default:
2167		break;
2168
2169	}
2170
2171	return 0;
2172}
2173/* --- This is the END my friend --- */
2174
v4.6
   1/*
   2 *	Copyright IBM Corp. 2004, 2007
   3 *	Authors:	Belinda Thompson (belindat@us.ibm.com)
   4 *			Andy Richter (richtera@us.ibm.com)
   5 *			Peter Tiedemann (ptiedem@de.ibm.com)
   6 */
   7
   8/*
   9	This module exports functions to be used by CCS:
  10	EXPORT_SYMBOL(ctc_mpc_alloc_channel);
  11	EXPORT_SYMBOL(ctc_mpc_establish_connectivity);
  12	EXPORT_SYMBOL(ctc_mpc_dealloc_ch);
  13	EXPORT_SYMBOL(ctc_mpc_flow_control);
  14*/
  15
  16#undef DEBUG
  17#undef DEBUGDATA
  18#undef DEBUGCCW
  19
  20#define KMSG_COMPONENT "ctcm"
  21#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
  22
  23#include <linux/module.h>
  24#include <linux/init.h>
  25#include <linux/kernel.h>
  26#include <linux/slab.h>
  27#include <linux/errno.h>
  28#include <linux/types.h>
  29#include <linux/interrupt.h>
  30#include <linux/timer.h>
  31#include <linux/sched.h>
  32
  33#include <linux/signal.h>
  34#include <linux/string.h>
  35#include <linux/proc_fs.h>
  36
  37#include <linux/ip.h>
  38#include <linux/if_arp.h>
  39#include <linux/tcp.h>
  40#include <linux/skbuff.h>
  41#include <linux/ctype.h>
  42#include <linux/netdevice.h>
  43#include <net/dst.h>
  44
  45#include <linux/io.h>		/* instead of <asm/io.h> ok ? */
  46#include <asm/ccwdev.h>
  47#include <asm/ccwgroup.h>
  48#include <linux/bitops.h>	/* instead of <asm/bitops.h> ok ? */
  49#include <linux/uaccess.h>	/* instead of <asm/uaccess.h> ok ? */
  50#include <linux/wait.h>
  51#include <linux/moduleparam.h>
  52#include <asm/idals.h>
  53
  54#include "ctcm_main.h"
  55#include "ctcm_mpc.h"
  56#include "ctcm_fsms.h"
  57
  58static const struct xid2 init_xid = {
  59	.xid2_type_id	=	XID_FM2,
  60	.xid2_len	=	0x45,
  61	.xid2_adj_id	=	0,
  62	.xid2_rlen	=	0x31,
  63	.xid2_resv1	=	0,
  64	.xid2_flag1	=	0,
  65	.xid2_fmtt	=	0,
  66	.xid2_flag4	=	0x80,
  67	.xid2_resv2	=	0,
  68	.xid2_tgnum	=	0,
  69	.xid2_sender_id	=	0,
  70	.xid2_flag2	=	0,
  71	.xid2_option	=	XID2_0,
  72	.xid2_resv3	=	"\x00",
  73	.xid2_resv4	=	0,
  74	.xid2_dlc_type	=	XID2_READ_SIDE,
  75	.xid2_resv5	=	0,
  76	.xid2_mpc_flag	=	0,
  77	.xid2_resv6	=	0,
  78	.xid2_buf_len	=	(MPC_BUFSIZE_DEFAULT - 35),
  79};
  80
  81static const struct th_header thnorm = {
  82	.th_seg		=	0x00,
  83	.th_ch_flag	=	TH_IS_XID,
  84	.th_blk_flag	=	TH_DATA_IS_XID,
  85	.th_is_xid	=	0x01,
  86	.th_seq_num	=	0x00000000,
  87};
  88
  89static const struct th_header thdummy = {
  90	.th_seg		=	0x00,
  91	.th_ch_flag	=	0x00,
  92	.th_blk_flag	=	TH_DATA_IS_XID,
  93	.th_is_xid	=	0x01,
  94	.th_seq_num	=	0x00000000,
  95};
  96
  97/*
  98 * Definition of one MPC group
  99 */
 100
 101/*
 102 * Compatibility macros for busy handling
 103 * of network devices.
 104 */
 105
 106static void ctcmpc_unpack_skb(struct channel *ch, struct sk_buff *pskb);
 107
 108/*
 109 * MPC Group state machine actions (static prototypes)
 110 */
 111static void mpc_action_nop(fsm_instance *fsm, int event, void *arg);
 112static void mpc_action_go_ready(fsm_instance *fsm, int event, void *arg);
 113static void mpc_action_go_inop(fsm_instance *fi, int event, void *arg);
 114static void mpc_action_timeout(fsm_instance *fi, int event, void *arg);
 115static int  mpc_validate_xid(struct mpcg_info *mpcginfo);
 116static void mpc_action_yside_xid(fsm_instance *fsm, int event, void *arg);
 117static void mpc_action_doxid0(fsm_instance *fsm, int event, void *arg);
 118static void mpc_action_doxid7(fsm_instance *fsm, int event, void *arg);
 119static void mpc_action_xside_xid(fsm_instance *fsm, int event, void *arg);
 120static void mpc_action_rcvd_xid0(fsm_instance *fsm, int event, void *arg);
 121static void mpc_action_rcvd_xid7(fsm_instance *fsm, int event, void *arg);
 122
 123#ifdef DEBUGDATA
 124/*-------------------------------------------------------------------*
 125* Dump buffer format						     *
 126*								     *
 127*--------------------------------------------------------------------*/
 128void ctcmpc_dumpit(char *buf, int len)
 129{
 130	__u32	ct, sw, rm, dup;
 131	char	*ptr, *rptr;
 132	char	tbuf[82], tdup[82];
 
 133	char	addr[22];
 
 
 
 134	char	boff[12];
 135	char	bhex[82], duphex[82];
 136	char	basc[40];
 137
 138	sw  = 0;
 139	rptr = ptr = buf;
 140	rm  = 16;
 141	duphex[0] = 0x00;
 142	dup = 0;
 143
 144	for (ct = 0; ct < len; ct++, ptr++, rptr++) {
 145		if (sw == 0) {
 
 146			sprintf(addr, "%16.16llx", (__u64)rptr);
 
 
 
 147
 148			sprintf(boff, "%4.4X", (__u32)ct);
 149			bhex[0] = '\0';
 150			basc[0] = '\0';
 151		}
 152		if ((sw == 4) || (sw == 12))
 153			strcat(bhex, " ");
 154		if (sw == 8)
 155			strcat(bhex, "	");
 156
 
 157		sprintf(tbuf, "%2.2llX", (__u64)*ptr);
 
 
 
 158
 159		tbuf[2] = '\0';
 160		strcat(bhex, tbuf);
 161		if ((0 != isprint(*ptr)) && (*ptr >= 0x20))
 162			basc[sw] = *ptr;
 163		else
 164			basc[sw] = '.';
 165
 166		basc[sw+1] = '\0';
 167		sw++;
 168		rm--;
 169		if (sw != 16)
 170			continue;
 171		if ((strcmp(duphex, bhex)) != 0) {
 172			if (dup != 0) {
 173				sprintf(tdup,
 174					"Duplicate as above to %s", addr);
 175				ctcm_pr_debug("		       --- %s ---\n",
 176						tdup);
 177			}
 178			ctcm_pr_debug("   %s (+%s) : %s  [%s]\n",
 179					addr, boff, bhex, basc);
 180			dup = 0;
 181			strcpy(duphex, bhex);
 182		} else
 183			dup++;
 184
 185		sw = 0;
 186		rm = 16;
 187	}  /* endfor */
 188
 189	if (sw != 0) {
 190		for ( ; rm > 0; rm--, sw++) {
 191			if ((sw == 4) || (sw == 12))
 192				strcat(bhex, " ");
 193			if (sw == 8)
 194				strcat(bhex, "	");
 195			strcat(bhex, "	");
 196			strcat(basc, " ");
 197		}
 198		if (dup != 0) {
 199			sprintf(tdup, "Duplicate as above to %s", addr);
 200			ctcm_pr_debug("		       --- %s ---\n", tdup);
 201		}
 202		ctcm_pr_debug("   %s (+%s) : %s  [%s]\n",
 203					addr, boff, bhex, basc);
 204	} else {
 205		if (dup >= 1) {
 206			sprintf(tdup, "Duplicate as above to %s", addr);
 207			ctcm_pr_debug("		       --- %s ---\n", tdup);
 208		}
 209		if (dup != 0) {
 210			ctcm_pr_debug("   %s (+%s) : %s  [%s]\n",
 211				addr, boff, bhex, basc);
 212		}
 213	}
 214
 215	return;
 216
 217}   /*	 end of ctcmpc_dumpit  */
 218#endif
 219
 220#ifdef DEBUGDATA
 221/*
 222 * Dump header and first 16 bytes of an sk_buff for debugging purposes.
 223 *
 224 * skb		The sk_buff to dump.
 225 * offset	Offset relative to skb-data, where to start the dump.
 226 */
 227void ctcmpc_dump_skb(struct sk_buff *skb, int offset)
 228{
 229	__u8 *p = skb->data;
 230	struct th_header *header;
 231	struct pdu *pheader;
 232	int bl = skb->len;
 233	int i;
 234
 235	if (p == NULL)
 236		return;
 237
 238	p += offset;
 239	header = (struct th_header *)p;
 240
 241	ctcm_pr_debug("dump:\n");
 242	ctcm_pr_debug("skb len=%d \n", skb->len);
 243	if (skb->len > 2) {
 244		switch (header->th_ch_flag) {
 245		case TH_HAS_PDU:
 246			break;
 247		case 0x00:
 248		case TH_IS_XID:
 249			if ((header->th_blk_flag == TH_DATA_IS_XID) &&
 250			   (header->th_is_xid == 0x01))
 251				goto dumpth;
 252		case TH_SWEEP_REQ:
 253				goto dumpth;
 254		case TH_SWEEP_RESP:
 255				goto dumpth;
 256		default:
 257			break;
 258		}
 259
 260		pheader = (struct pdu *)p;
 261		ctcm_pr_debug("pdu->offset: %d hex: %04x\n",
 262			       pheader->pdu_offset, pheader->pdu_offset);
 263		ctcm_pr_debug("pdu->flag  : %02x\n", pheader->pdu_flag);
 264		ctcm_pr_debug("pdu->proto : %02x\n", pheader->pdu_proto);
 265		ctcm_pr_debug("pdu->seq   : %02x\n", pheader->pdu_seq);
 266					goto dumpdata;
 267
 268dumpth:
 269		ctcm_pr_debug("th->seg     : %02x\n", header->th_seg);
 270		ctcm_pr_debug("th->ch      : %02x\n", header->th_ch_flag);
 271		ctcm_pr_debug("th->blk_flag: %02x\n", header->th_blk_flag);
 272		ctcm_pr_debug("th->type    : %s\n",
 273			       (header->th_is_xid) ? "DATA" : "XID");
 274		ctcm_pr_debug("th->seqnum  : %04x\n", header->th_seq_num);
 275
 276	}
 277dumpdata:
 278	if (bl > 32)
 279		bl = 32;
 280	ctcm_pr_debug("data: ");
 281	for (i = 0; i < bl; i++)
 282		ctcm_pr_debug("%02x%s", *p++, (i % 16) ? " " : "\n");
 283	ctcm_pr_debug("\n");
 284}
 285#endif
 286
 287static struct net_device *ctcmpc_get_dev(int port_num)
 288{
 289	char device[20];
 290	struct net_device *dev;
 291	struct ctcm_priv *priv;
 292
 293	sprintf(device, "%s%i", MPC_DEVICE_NAME, port_num);
 294
 295	dev = __dev_get_by_name(&init_net, device);
 296
 297	if (dev == NULL) {
 298		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 299			"%s: Device not found by name: %s",
 300					CTCM_FUNTAIL, device);
 301		return NULL;
 302	}
 303	priv = dev->ml_priv;
 304	if (priv == NULL) {
 305		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 306			"%s(%s): dev->ml_priv is NULL",
 307					CTCM_FUNTAIL, device);
 308		return NULL;
 309	}
 310	if (priv->mpcg == NULL) {
 311		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 312			"%s(%s): priv->mpcg is NULL",
 313					CTCM_FUNTAIL, device);
 314		return NULL;
 315	}
 316	return dev;
 317}
 318
 319/*
 320 * ctc_mpc_alloc_channel
 321 *	(exported interface)
 322 *
 323 * Device Initialization :
 324 *	ACTPATH  driven IO operations
 325 */
 326int ctc_mpc_alloc_channel(int port_num, void (*callback)(int, int))
 327{
 328	struct net_device *dev;
 329	struct mpc_group *grp;
 330	struct ctcm_priv *priv;
 331
 332	dev = ctcmpc_get_dev(port_num);
 333	if (dev == NULL)
 334		return 1;
 335	priv = dev->ml_priv;
 336	grp = priv->mpcg;
 337
 338	grp->allochanfunc = callback;
 339	grp->port_num = port_num;
 340	grp->port_persist = 1;
 341
 342	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_INFO,
 343			"%s(%s): state=%s",
 344			CTCM_FUNTAIL, dev->name, fsm_getstate_str(grp->fsm));
 345
 346	switch (fsm_getstate(grp->fsm)) {
 347	case MPCG_STATE_INOP:
 348		/* Group is in the process of terminating */
 349		grp->alloc_called = 1;
 350		break;
 351	case MPCG_STATE_RESET:
 352		/* MPC Group will transition to state		  */
 353		/* MPCG_STATE_XID2INITW iff the minimum number	  */
 354		/* of 1 read and 1 write channel have successfully*/
 355		/* activated					  */
 356		/*fsm_newstate(grp->fsm, MPCG_STATE_XID2INITW);*/
 357		if (callback)
 358			grp->send_qllc_disc = 1;
 359	case MPCG_STATE_XID0IOWAIT:
 360		fsm_deltimer(&grp->timer);
 361		grp->outstanding_xid2 = 0;
 362		grp->outstanding_xid7 = 0;
 363		grp->outstanding_xid7_p2 = 0;
 364		grp->saved_xid2 = NULL;
 365		if (callback)
 366			ctcm_open(dev);
 367		fsm_event(priv->fsm, DEV_EVENT_START, dev);
 368		break;
 369	case MPCG_STATE_READY:
 370		/* XID exchanges completed after PORT was activated */
 371		/* Link station already active			    */
 372		/* Maybe timing issue...retry callback		    */
 373		grp->allocchan_callback_retries++;
 374		if (grp->allocchan_callback_retries < 4) {
 375			if (grp->allochanfunc)
 376				grp->allochanfunc(grp->port_num,
 377						  grp->group_max_buflen);
 378		} else {
 379			/* there are problems...bail out	    */
 380			/* there may be a state mismatch so restart */
 381			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 382			grp->allocchan_callback_retries = 0;
 383		}
 384		break;
 385	}
 386
 387	return 0;
 388}
 389EXPORT_SYMBOL(ctc_mpc_alloc_channel);
 390
 391/*
 392 * ctc_mpc_establish_connectivity
 393 *	(exported interface)
 394 */
 395void ctc_mpc_establish_connectivity(int port_num,
 396				void (*callback)(int, int, int))
 397{
 398	struct net_device *dev;
 399	struct mpc_group *grp;
 400	struct ctcm_priv *priv;
 401	struct channel *rch, *wch;
 402
 403	dev = ctcmpc_get_dev(port_num);
 404	if (dev == NULL)
 405		return;
 406	priv = dev->ml_priv;
 407	grp = priv->mpcg;
 408	rch = priv->channel[CTCM_READ];
 409	wch = priv->channel[CTCM_WRITE];
 410
 411	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_INFO,
 412			"%s(%s): state=%s",
 413			CTCM_FUNTAIL, dev->name, fsm_getstate_str(grp->fsm));
 414
 415	grp->estconnfunc = callback;
 416	grp->port_num = port_num;
 417
 418	switch (fsm_getstate(grp->fsm)) {
 419	case MPCG_STATE_READY:
 420		/* XID exchanges completed after PORT was activated */
 421		/* Link station already active			    */
 422		/* Maybe timing issue...retry callback		    */
 423		fsm_deltimer(&grp->timer);
 424		grp->estconn_callback_retries++;
 425		if (grp->estconn_callback_retries < 4) {
 426			if (grp->estconnfunc) {
 427				grp->estconnfunc(grp->port_num, 0,
 428						grp->group_max_buflen);
 429				grp->estconnfunc = NULL;
 430			}
 431		} else {
 432			/* there are problems...bail out	 */
 433			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 434			grp->estconn_callback_retries = 0;
 435		}
 436		break;
 437	case MPCG_STATE_INOP:
 438	case MPCG_STATE_RESET:
 439		/* MPC Group is not ready to start XID - min num of */
 440		/* 1 read and 1 write channel have not been acquired*/
 441
 442		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 443			"%s(%s): REJECTED - inactive channels",
 444					CTCM_FUNTAIL, dev->name);
 445		if (grp->estconnfunc) {
 446			grp->estconnfunc(grp->port_num, -1, 0);
 447			grp->estconnfunc = NULL;
 448		}
 449		break;
 450	case MPCG_STATE_XID2INITW:
 451		/* alloc channel was called but no XID exchange    */
 452		/* has occurred. initiate xside XID exchange	   */
 453		/* make sure yside XID0 processing has not started */
 454
 455		if ((fsm_getstate(rch->fsm) > CH_XID0_PENDING) ||
 456			(fsm_getstate(wch->fsm) > CH_XID0_PENDING)) {
 457			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 458				"%s(%s): ABORT - PASSIVE XID",
 459					CTCM_FUNTAIL, dev->name);
 460			break;
 461		}
 462		grp->send_qllc_disc = 1;
 463		fsm_newstate(grp->fsm, MPCG_STATE_XID0IOWAIT);
 464		fsm_deltimer(&grp->timer);
 465		fsm_addtimer(&grp->timer, MPC_XID_TIMEOUT_VALUE,
 466						MPCG_EVENT_TIMER, dev);
 467		grp->outstanding_xid7 = 0;
 468		grp->outstanding_xid7_p2 = 0;
 469		grp->saved_xid2 = NULL;
 470		if ((rch->in_mpcgroup) &&
 471				(fsm_getstate(rch->fsm) == CH_XID0_PENDING))
 472			fsm_event(grp->fsm, MPCG_EVENT_XID0DO, rch);
 473		else {
 474			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 475				"%s(%s): RX-%s not ready for ACTIVE XID0",
 476					CTCM_FUNTAIL, dev->name, rch->id);
 477			if (grp->estconnfunc) {
 478				grp->estconnfunc(grp->port_num, -1, 0);
 479				grp->estconnfunc = NULL;
 480			}
 481			fsm_deltimer(&grp->timer);
 482				goto done;
 483		}
 484		if ((wch->in_mpcgroup) &&
 485				(fsm_getstate(wch->fsm) == CH_XID0_PENDING))
 486			fsm_event(grp->fsm, MPCG_EVENT_XID0DO, wch);
 487		else {
 488			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 489				"%s(%s): WX-%s not ready for ACTIVE XID0",
 490					CTCM_FUNTAIL, dev->name, wch->id);
 491			if (grp->estconnfunc) {
 492				grp->estconnfunc(grp->port_num, -1, 0);
 493				grp->estconnfunc = NULL;
 494			}
 495			fsm_deltimer(&grp->timer);
 496				goto done;
 497			}
 498		break;
 499	case MPCG_STATE_XID0IOWAIT:
 500		/* already in active XID negotiations */
 501	default:
 502		break;
 503	}
 504
 505done:
 506	CTCM_PR_DEBUG("Exit %s()\n", __func__);
 507	return;
 508}
 509EXPORT_SYMBOL(ctc_mpc_establish_connectivity);
 510
 511/*
 512 * ctc_mpc_dealloc_ch
 513 *	(exported interface)
 514 */
 515void ctc_mpc_dealloc_ch(int port_num)
 516{
 517	struct net_device *dev;
 518	struct ctcm_priv *priv;
 519	struct mpc_group *grp;
 520
 521	dev = ctcmpc_get_dev(port_num);
 522	if (dev == NULL)
 523		return;
 524	priv = dev->ml_priv;
 525	grp = priv->mpcg;
 526
 527	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_DEBUG,
 528			"%s: %s: refcount = %d\n",
 529			CTCM_FUNTAIL, dev->name, netdev_refcnt_read(dev));
 530
 531	fsm_deltimer(&priv->restart_timer);
 532	grp->channels_terminating = 0;
 533	fsm_deltimer(&grp->timer);
 534	grp->allochanfunc = NULL;
 535	grp->estconnfunc = NULL;
 536	grp->port_persist = 0;
 537	grp->send_qllc_disc = 0;
 538	fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 539
 540	ctcm_close(dev);
 541	return;
 542}
 543EXPORT_SYMBOL(ctc_mpc_dealloc_ch);
 544
 545/*
 546 * ctc_mpc_flow_control
 547 *	(exported interface)
 548 */
 549void ctc_mpc_flow_control(int port_num, int flowc)
 550{
 551	struct ctcm_priv *priv;
 552	struct mpc_group *grp;
 553	struct net_device *dev;
 554	struct channel *rch;
 555	int mpcg_state;
 556
 557	dev = ctcmpc_get_dev(port_num);
 558	if (dev == NULL)
 559		return;
 560	priv = dev->ml_priv;
 561	grp = priv->mpcg;
 562
 563	CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_DEBUG,
 564			"%s: %s: flowc = %d",
 565				CTCM_FUNTAIL, dev->name, flowc);
 566
 567	rch = priv->channel[CTCM_READ];
 568
 569	mpcg_state = fsm_getstate(grp->fsm);
 570	switch (flowc) {
 571	case 1:
 572		if (mpcg_state == MPCG_STATE_FLOWC)
 573			break;
 574		if (mpcg_state == MPCG_STATE_READY) {
 575			if (grp->flow_off_called == 1)
 576				grp->flow_off_called = 0;
 577			else
 578				fsm_newstate(grp->fsm, MPCG_STATE_FLOWC);
 579			break;
 580		}
 581		break;
 582	case 0:
 583		if (mpcg_state == MPCG_STATE_FLOWC) {
 584			fsm_newstate(grp->fsm, MPCG_STATE_READY);
 585			/* ensure any data that has accumulated */
 586			/* on the io_queue will now be sen t	*/
 587			tasklet_schedule(&rch->ch_tasklet);
 588		}
 589		/* possible race condition			*/
 590		if (mpcg_state == MPCG_STATE_READY) {
 591			grp->flow_off_called = 1;
 592			break;
 593		}
 594		break;
 595	}
 596
 597}
 598EXPORT_SYMBOL(ctc_mpc_flow_control);
 599
 600static int mpc_send_qllc_discontact(struct net_device *);
 601
 602/*
 603 * helper function of ctcmpc_unpack_skb
 604*/
 605static void mpc_rcvd_sweep_resp(struct mpcg_info *mpcginfo)
 606{
 607	struct channel	  *rch = mpcginfo->ch;
 608	struct net_device *dev = rch->netdev;
 609	struct ctcm_priv   *priv = dev->ml_priv;
 610	struct mpc_group  *grp = priv->mpcg;
 611	struct channel	  *ch = priv->channel[CTCM_WRITE];
 612
 613	CTCM_PR_DEBUG("%s: ch=0x%p id=%s\n", __func__, ch, ch->id);
 614	CTCM_D3_DUMP((char *)mpcginfo->sweep, TH_SWEEP_LENGTH);
 615
 616	grp->sweep_rsp_pend_num--;
 617
 618	if ((grp->sweep_req_pend_num == 0) &&
 619			(grp->sweep_rsp_pend_num == 0)) {
 620		fsm_deltimer(&ch->sweep_timer);
 621		grp->in_sweep = 0;
 622		rch->th_seq_num = 0x00;
 623		ch->th_seq_num = 0x00;
 624		ctcm_clear_busy_do(dev);
 625	}
 626
 627	kfree(mpcginfo);
 628
 629	return;
 630
 631}
 632
 633/*
 634 * helper function of mpc_rcvd_sweep_req
 635 * which is a helper of ctcmpc_unpack_skb
 636 */
 637static void ctcmpc_send_sweep_resp(struct channel *rch)
 638{
 639	struct net_device *dev = rch->netdev;
 640	struct ctcm_priv *priv = dev->ml_priv;
 641	struct mpc_group *grp = priv->mpcg;
 642	struct th_sweep *header;
 643	struct sk_buff *sweep_skb;
 644	struct channel *ch  = priv->channel[CTCM_WRITE];
 645
 646	CTCM_PR_DEBUG("%s: ch=0x%p id=%s\n", __func__, rch, rch->id);
 647
 648	sweep_skb = __dev_alloc_skb(MPC_BUFSIZE_DEFAULT, GFP_ATOMIC | GFP_DMA);
 649	if (sweep_skb == NULL) {
 650		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 651			"%s(%s): sweep_skb allocation ERROR\n",
 652			CTCM_FUNTAIL, rch->id);
 653		goto done;
 654	}
 655
 656	header = kmalloc(sizeof(struct th_sweep), gfp_type());
 657
 658	if (!header) {
 659		dev_kfree_skb_any(sweep_skb);
 660		goto done;
 661	}
 662
 663	header->th.th_seg	= 0x00 ;
 664	header->th.th_ch_flag	= TH_SWEEP_RESP;
 665	header->th.th_blk_flag	= 0x00;
 666	header->th.th_is_xid	= 0x00;
 667	header->th.th_seq_num	= 0x00;
 668	header->sw.th_last_seq	= ch->th_seq_num;
 669
 670	memcpy(skb_put(sweep_skb, TH_SWEEP_LENGTH), header, TH_SWEEP_LENGTH);
 671
 672	kfree(header);
 673
 674	dev->trans_start = jiffies;
 675	skb_queue_tail(&ch->sweep_queue, sweep_skb);
 676
 677	fsm_addtimer(&ch->sweep_timer, 100, CTC_EVENT_RSWEEP_TIMER, ch);
 678
 679	return;
 680
 681done:
 682	grp->in_sweep = 0;
 683	ctcm_clear_busy_do(dev);
 684	fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 685
 686	return;
 687}
 688
 689/*
 690 * helper function of ctcmpc_unpack_skb
 691 */
 692static void mpc_rcvd_sweep_req(struct mpcg_info *mpcginfo)
 693{
 694	struct channel	  *rch     = mpcginfo->ch;
 695	struct net_device *dev     = rch->netdev;
 696	struct ctcm_priv  *priv = dev->ml_priv;
 697	struct mpc_group  *grp  = priv->mpcg;
 698	struct channel	  *ch	   = priv->channel[CTCM_WRITE];
 699
 700	if (do_debug)
 701		CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_DEBUG,
 702			" %s(): ch=0x%p id=%s\n", __func__, ch, ch->id);
 703
 704	if (grp->in_sweep == 0) {
 705		grp->in_sweep = 1;
 706		ctcm_test_and_set_busy(dev);
 707		grp->sweep_req_pend_num = grp->active_channels[CTCM_READ];
 708		grp->sweep_rsp_pend_num = grp->active_channels[CTCM_READ];
 709	}
 710
 711	CTCM_D3_DUMP((char *)mpcginfo->sweep, TH_SWEEP_LENGTH);
 712
 713	grp->sweep_req_pend_num--;
 714	ctcmpc_send_sweep_resp(ch);
 715	kfree(mpcginfo);
 716	return;
 717}
 718
 719/*
 720  * MPC Group Station FSM definitions
 721 */
 722static const char *mpcg_event_names[] = {
 723	[MPCG_EVENT_INOP]	= "INOP Condition",
 724	[MPCG_EVENT_DISCONC]	= "Discontact Received",
 725	[MPCG_EVENT_XID0DO]	= "Channel Active - Start XID",
 726	[MPCG_EVENT_XID2]	= "XID2 Received",
 727	[MPCG_EVENT_XID2DONE]	= "XID0 Complete",
 728	[MPCG_EVENT_XID7DONE]	= "XID7 Complete",
 729	[MPCG_EVENT_TIMER]	= "XID Setup Timer",
 730	[MPCG_EVENT_DOIO]	= "XID DoIO",
 731};
 732
 733static const char *mpcg_state_names[] = {
 734	[MPCG_STATE_RESET]	= "Reset",
 735	[MPCG_STATE_INOP]	= "INOP",
 736	[MPCG_STATE_XID2INITW]	= "Passive XID- XID0 Pending Start",
 737	[MPCG_STATE_XID2INITX]	= "Passive XID- XID0 Pending Complete",
 738	[MPCG_STATE_XID7INITW]	= "Passive XID- XID7 Pending P1 Start",
 739	[MPCG_STATE_XID7INITX]	= "Passive XID- XID7 Pending P2 Complete",
 740	[MPCG_STATE_XID0IOWAIT]	= "Active  XID- XID0 Pending Start",
 741	[MPCG_STATE_XID0IOWAIX]	= "Active  XID- XID0 Pending Complete",
 742	[MPCG_STATE_XID7INITI]	= "Active  XID- XID7 Pending Start",
 743	[MPCG_STATE_XID7INITZ]	= "Active  XID- XID7 Pending Complete ",
 744	[MPCG_STATE_XID7INITF]	= "XID        - XID7 Complete ",
 745	[MPCG_STATE_FLOWC]	= "FLOW CONTROL ON",
 746	[MPCG_STATE_READY]	= "READY",
 747};
 748
 749/*
 750 * The MPC Group Station FSM
 751 *   22 events
 752 */
 753static const fsm_node mpcg_fsm[] = {
 754	{ MPCG_STATE_RESET,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 755	{ MPCG_STATE_INOP,	MPCG_EVENT_INOP,	mpc_action_nop        },
 756	{ MPCG_STATE_FLOWC,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 757
 758	{ MPCG_STATE_READY,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 759	{ MPCG_STATE_READY,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 760
 761	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_XID0DO,	mpc_action_doxid0     },
 762	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid0  },
 763	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 764	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 765	{ MPCG_STATE_XID2INITW,	MPCG_EVENT_DOIO,	mpc_action_yside_xid  },
 766
 767	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_XID0DO,	mpc_action_doxid0     },
 768	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid0  },
 769	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 770	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 771	{ MPCG_STATE_XID2INITX,	MPCG_EVENT_DOIO,	mpc_action_yside_xid  },
 772
 773	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_XID2DONE,	mpc_action_doxid7     },
 774	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 775	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid7  },
 776	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 777	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 778	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_XID7DONE,	mpc_action_doxid7     },
 779	{ MPCG_STATE_XID7INITW,	MPCG_EVENT_DOIO,	mpc_action_yside_xid  },
 780
 781	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 782	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid7  },
 783	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 784	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_XID7DONE,	mpc_action_doxid7     },
 785	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 786	{ MPCG_STATE_XID7INITX,	MPCG_EVENT_DOIO,	mpc_action_yside_xid  },
 787
 788	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_XID0DO,	mpc_action_doxid0     },
 789	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_DISCONC,	mpc_action_discontact },
 790	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_XID2,	mpc_action_rcvd_xid0  },
 791	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_INOP,	mpc_action_go_inop    },
 792	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_TIMER,	mpc_action_timeout    },
 793	{ MPCG_STATE_XID0IOWAIT, MPCG_EVENT_DOIO,	mpc_action_xside_xid  },
 794
 795	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_XID0DO,	mpc_action_doxid0     },
 796	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_DISCONC,	mpc_action_discontact },
 797	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_XID2,	mpc_action_rcvd_xid0  },
 798	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_INOP,	mpc_action_go_inop    },
 799	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_TIMER,	mpc_action_timeout    },
 800	{ MPCG_STATE_XID0IOWAIX, MPCG_EVENT_DOIO,	mpc_action_xside_xid  },
 801
 802	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_XID2DONE,	mpc_action_doxid7     },
 803	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid7  },
 804	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 805	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 806	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 807	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_XID7DONE,	mpc_action_doxid7     },
 808	{ MPCG_STATE_XID7INITI,	MPCG_EVENT_DOIO,	mpc_action_xside_xid  },
 809
 810	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_XID2,	mpc_action_rcvd_xid7  },
 811	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_XID7DONE,	mpc_action_doxid7     },
 812	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_DISCONC,	mpc_action_discontact },
 813	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 814	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_TIMER,	mpc_action_timeout    },
 815	{ MPCG_STATE_XID7INITZ,	MPCG_EVENT_DOIO,	mpc_action_xside_xid  },
 816
 817	{ MPCG_STATE_XID7INITF,	MPCG_EVENT_INOP,	mpc_action_go_inop    },
 818	{ MPCG_STATE_XID7INITF,	MPCG_EVENT_XID7DONE,	mpc_action_go_ready   },
 819};
 820
 821static int mpcg_fsm_len = ARRAY_SIZE(mpcg_fsm);
 822
 823/*
 824 * MPC Group Station FSM action
 825 * CTCM_PROTO_MPC only
 826 */
 827static void mpc_action_go_ready(fsm_instance *fsm, int event, void *arg)
 828{
 829	struct net_device *dev = arg;
 830	struct ctcm_priv *priv = dev->ml_priv;
 831	struct mpc_group *grp = priv->mpcg;
 832
 833	if (grp == NULL) {
 834		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 835			"%s(%s): No MPC group",
 836				CTCM_FUNTAIL, dev->name);
 837		return;
 838	}
 839
 840	fsm_deltimer(&grp->timer);
 841
 842	if (grp->saved_xid2->xid2_flag2 == 0x40) {
 843		priv->xid->xid2_flag2 = 0x00;
 844		if (grp->estconnfunc) {
 845			grp->estconnfunc(grp->port_num, 1,
 846					grp->group_max_buflen);
 847			grp->estconnfunc = NULL;
 848		} else if (grp->allochanfunc)
 849			grp->send_qllc_disc = 1;
 850
 851		fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 852		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 853				"%s(%s): fails",
 854					CTCM_FUNTAIL, dev->name);
 855		return;
 856	}
 857
 858	grp->port_persist = 1;
 859	grp->out_of_sequence = 0;
 860	grp->estconn_called = 0;
 861
 862	tasklet_hi_schedule(&grp->mpc_tasklet2);
 863
 864	return;
 865}
 866
 867/*
 868 * helper of ctcm_init_netdevice
 869 * CTCM_PROTO_MPC only
 870 */
 871void mpc_group_ready(unsigned long adev)
 872{
 873	struct net_device *dev = (struct net_device *)adev;
 874	struct ctcm_priv *priv = dev->ml_priv;
 875	struct mpc_group *grp = priv->mpcg;
 876	struct channel *ch = NULL;
 877
 878	if (grp == NULL) {
 879		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 880			"%s(%s): No MPC group",
 881				CTCM_FUNTAIL, dev->name);
 882		return;
 883	}
 884
 885	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_NOTICE,
 886		"%s: %s: GROUP TRANSITIONED TO READY, maxbuf = %d\n",
 887			CTCM_FUNTAIL, dev->name, grp->group_max_buflen);
 888
 889	fsm_newstate(grp->fsm, MPCG_STATE_READY);
 890
 891	/* Put up a read on the channel */
 892	ch = priv->channel[CTCM_READ];
 893	ch->pdu_seq = 0;
 894	CTCM_PR_DBGDATA("ctcmpc: %s() ToDCM_pdu_seq= %08x\n" ,
 895			__func__, ch->pdu_seq);
 896
 897	ctcmpc_chx_rxidle(ch->fsm, CTC_EVENT_START, ch);
 898	/* Put the write channel in idle state */
 899	ch = priv->channel[CTCM_WRITE];
 900	if (ch->collect_len > 0) {
 901		spin_lock(&ch->collect_lock);
 902		ctcm_purge_skb_queue(&ch->collect_queue);
 903		ch->collect_len = 0;
 904		spin_unlock(&ch->collect_lock);
 905	}
 906	ctcm_chx_txidle(ch->fsm, CTC_EVENT_START, ch);
 907	ctcm_clear_busy(dev);
 908
 909	if (grp->estconnfunc) {
 910		grp->estconnfunc(grp->port_num, 0,
 911				    grp->group_max_buflen);
 912		grp->estconnfunc = NULL;
 913	} else 	if (grp->allochanfunc)
 914		grp->allochanfunc(grp->port_num, grp->group_max_buflen);
 915
 916	grp->send_qllc_disc = 1;
 917	grp->changed_side = 0;
 918
 919	return;
 920
 921}
 922
 923/*
 924 * Increment the MPC Group Active Channel Counts
 925 * helper of dev_action (called from channel fsm)
 926 */
 927void mpc_channel_action(struct channel *ch, int direction, int action)
 928{
 929	struct net_device  *dev  = ch->netdev;
 930	struct ctcm_priv   *priv = dev->ml_priv;
 931	struct mpc_group   *grp  = priv->mpcg;
 932
 933	if (grp == NULL) {
 934		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 935			"%s(%s): No MPC group",
 936				CTCM_FUNTAIL, dev->name);
 937		return;
 938	}
 939
 940	CTCM_PR_DEBUG("enter %s: ch=0x%p id=%s\n", __func__, ch, ch->id);
 941
 942	CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
 943		"%s: %i / Grp:%s total_channels=%i, active_channels: "
 944		"read=%i, write=%i\n", __func__, action,
 945		fsm_getstate_str(grp->fsm), grp->num_channel_paths,
 946		grp->active_channels[CTCM_READ],
 947		grp->active_channels[CTCM_WRITE]);
 948
 949	if ((action == MPC_CHANNEL_ADD) && (ch->in_mpcgroup == 0)) {
 950		grp->num_channel_paths++;
 951		grp->active_channels[direction]++;
 952		grp->outstanding_xid2++;
 953		ch->in_mpcgroup = 1;
 954
 955		if (ch->xid_skb != NULL)
 956			dev_kfree_skb_any(ch->xid_skb);
 957
 958		ch->xid_skb = __dev_alloc_skb(MPC_BUFSIZE_DEFAULT,
 959					GFP_ATOMIC | GFP_DMA);
 960		if (ch->xid_skb == NULL) {
 961			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
 962				"%s(%s): Couldn't alloc ch xid_skb\n",
 963				CTCM_FUNTAIL, dev->name);
 964			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
 965			return;
 966		}
 967		ch->xid_skb_data = ch->xid_skb->data;
 968		ch->xid_th = (struct th_header *)ch->xid_skb->data;
 969		skb_put(ch->xid_skb, TH_HEADER_LENGTH);
 970		ch->xid = (struct xid2 *)skb_tail_pointer(ch->xid_skb);
 971		skb_put(ch->xid_skb, XID2_LENGTH);
 972		ch->xid_id = skb_tail_pointer(ch->xid_skb);
 973		ch->xid_skb->data = ch->xid_skb_data;
 974		skb_reset_tail_pointer(ch->xid_skb);
 975		ch->xid_skb->len = 0;
 976
 977		memcpy(skb_put(ch->xid_skb, grp->xid_skb->len),
 978				grp->xid_skb->data,
 979				grp->xid_skb->len);
 980
 981		ch->xid->xid2_dlc_type =
 982			((CHANNEL_DIRECTION(ch->flags) == CTCM_READ)
 983				? XID2_READ_SIDE : XID2_WRITE_SIDE);
 984
 985		if (CHANNEL_DIRECTION(ch->flags) == CTCM_WRITE)
 986			ch->xid->xid2_buf_len = 0x00;
 987
 988		ch->xid_skb->data = ch->xid_skb_data;
 989		skb_reset_tail_pointer(ch->xid_skb);
 990		ch->xid_skb->len = 0;
 991
 992		fsm_newstate(ch->fsm, CH_XID0_PENDING);
 993
 994		if ((grp->active_channels[CTCM_READ] > 0) &&
 995		    (grp->active_channels[CTCM_WRITE] > 0) &&
 996			(fsm_getstate(grp->fsm) < MPCG_STATE_XID2INITW)) {
 997			fsm_newstate(grp->fsm, MPCG_STATE_XID2INITW);
 998			CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_NOTICE,
 999				"%s: %s: MPC GROUP CHANNELS ACTIVE\n",
1000						__func__, dev->name);
1001		}
1002	} else if ((action == MPC_CHANNEL_REMOVE) &&
1003			(ch->in_mpcgroup == 1)) {
1004		ch->in_mpcgroup = 0;
1005		grp->num_channel_paths--;
1006		grp->active_channels[direction]--;
1007
1008		if (ch->xid_skb != NULL)
1009			dev_kfree_skb_any(ch->xid_skb);
1010		ch->xid_skb = NULL;
1011
1012		if (grp->channels_terminating)
1013					goto done;
1014
1015		if (((grp->active_channels[CTCM_READ] == 0) &&
1016					(grp->active_channels[CTCM_WRITE] > 0))
1017			|| ((grp->active_channels[CTCM_WRITE] == 0) &&
1018					(grp->active_channels[CTCM_READ] > 0)))
1019			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1020	}
1021done:
1022	CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_DEBUG,
1023		"exit %s: %i / Grp:%s total_channels=%i, active_channels: "
1024		"read=%i, write=%i\n", __func__, action,
1025		fsm_getstate_str(grp->fsm), grp->num_channel_paths,
1026		grp->active_channels[CTCM_READ],
1027		grp->active_channels[CTCM_WRITE]);
1028
1029	CTCM_PR_DEBUG("exit %s: ch=0x%p id=%s\n", __func__, ch, ch->id);
1030}
1031
1032/**
1033 * Unpack a just received skb and hand it over to
1034 * upper layers.
1035 * special MPC version of unpack_skb.
1036 *
1037 * ch		The channel where this skb has been received.
1038 * pskb		The received skb.
1039 */
1040static void ctcmpc_unpack_skb(struct channel *ch, struct sk_buff *pskb)
1041{
1042	struct net_device *dev	= ch->netdev;
1043	struct ctcm_priv *priv = dev->ml_priv;
1044	struct mpc_group *grp = priv->mpcg;
1045	struct pdu *curr_pdu;
1046	struct mpcg_info *mpcginfo;
1047	struct th_header *header = NULL;
1048	struct th_sweep *sweep = NULL;
1049	int pdu_last_seen = 0;
1050	__u32 new_len;
1051	struct sk_buff *skb;
1052	int skblen;
1053	int sendrc = 0;
1054
1055	CTCM_PR_DEBUG("ctcmpc enter: %s() %s cp:%i ch:%s\n",
1056			__func__, dev->name, smp_processor_id(), ch->id);
1057
1058	header = (struct th_header *)pskb->data;
1059	if ((header->th_seg == 0) &&
1060		(header->th_ch_flag == 0) &&
1061		(header->th_blk_flag == 0) &&
1062		(header->th_seq_num == 0))
1063		/* nothing for us */	goto done;
1064
1065	CTCM_PR_DBGDATA("%s: th_header\n", __func__);
1066	CTCM_D3_DUMP((char *)header, TH_HEADER_LENGTH);
1067	CTCM_PR_DBGDATA("%s: pskb len: %04x \n", __func__, pskb->len);
1068
1069	pskb->dev = dev;
1070	pskb->ip_summed = CHECKSUM_UNNECESSARY;
1071	skb_pull(pskb, TH_HEADER_LENGTH);
1072
1073	if (likely(header->th_ch_flag == TH_HAS_PDU)) {
1074		CTCM_PR_DBGDATA("%s: came into th_has_pdu\n", __func__);
1075		if ((fsm_getstate(grp->fsm) == MPCG_STATE_FLOWC) ||
1076		   ((fsm_getstate(grp->fsm) == MPCG_STATE_READY) &&
1077		    (header->th_seq_num != ch->th_seq_num + 1) &&
1078		    (ch->th_seq_num != 0))) {
1079			/* This is NOT the next segment		*
1080			 * we are not the correct race winner	*
1081			 * go away and let someone else win	*
1082			 * BUT..this only applies if xid negot	*
1083			 * is done				*
1084			*/
1085			grp->out_of_sequence += 1;
1086			__skb_push(pskb, TH_HEADER_LENGTH);
1087			skb_queue_tail(&ch->io_queue, pskb);
1088			CTCM_PR_DBGDATA("%s: th_seq_num expect:%08x "
1089					"got:%08x\n", __func__,
1090				ch->th_seq_num + 1, header->th_seq_num);
1091
1092			return;
1093		}
1094		grp->out_of_sequence = 0;
1095		ch->th_seq_num = header->th_seq_num;
1096
1097		CTCM_PR_DBGDATA("ctcmpc: %s() FromVTAM_th_seq=%08x\n",
1098					__func__, ch->th_seq_num);
1099
1100		if (unlikely(fsm_getstate(grp->fsm) != MPCG_STATE_READY))
1101					goto done;
1102		while ((pskb->len > 0) && !pdu_last_seen) {
1103			curr_pdu = (struct pdu *)pskb->data;
1104
1105			CTCM_PR_DBGDATA("%s: pdu_header\n", __func__);
1106			CTCM_D3_DUMP((char *)pskb->data, PDU_HEADER_LENGTH);
1107			CTCM_PR_DBGDATA("%s: pskb len: %04x \n",
1108						__func__, pskb->len);
1109
1110			skb_pull(pskb, PDU_HEADER_LENGTH);
1111
1112			if (curr_pdu->pdu_flag & PDU_LAST)
1113				pdu_last_seen = 1;
1114			if (curr_pdu->pdu_flag & PDU_CNTL)
1115				pskb->protocol = htons(ETH_P_SNAP);
1116			else
1117				pskb->protocol = htons(ETH_P_SNA_DIX);
1118
1119			if ((pskb->len <= 0) || (pskb->len > ch->max_bufsize)) {
1120				CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1121					"%s(%s): Dropping packet with "
1122					"illegal siize %d",
1123					CTCM_FUNTAIL, dev->name, pskb->len);
1124
1125				priv->stats.rx_dropped++;
1126				priv->stats.rx_length_errors++;
1127					goto done;
1128			}
1129			skb_reset_mac_header(pskb);
1130			new_len = curr_pdu->pdu_offset;
1131			CTCM_PR_DBGDATA("%s: new_len: %04x \n",
1132						__func__, new_len);
1133			if ((new_len == 0) || (new_len > pskb->len)) {
1134				/* should never happen		    */
1135				/* pskb len must be hosed...bail out */
1136				CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1137					"%s(%s): non valid pdu_offset: %04x",
1138					/* "data may be lost", */
1139					CTCM_FUNTAIL, dev->name, new_len);
1140				goto done;
1141			}
1142			skb = __dev_alloc_skb(new_len+4, GFP_ATOMIC);
1143
1144			if (!skb) {
1145				CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1146					"%s(%s): MEMORY allocation error",
1147						CTCM_FUNTAIL, dev->name);
1148				priv->stats.rx_dropped++;
1149				fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1150						goto done;
1151			}
1152			memcpy(skb_put(skb, new_len), pskb->data, new_len);
1153
1154			skb_reset_mac_header(skb);
1155			skb->dev = pskb->dev;
1156			skb->protocol = pskb->protocol;
1157			skb->ip_summed = CHECKSUM_UNNECESSARY;
1158			*((__u32 *) skb_push(skb, 4)) = ch->pdu_seq;
1159			ch->pdu_seq++;
1160
1161			if (do_debug_data) {
1162				ctcm_pr_debug("%s: ToDCM_pdu_seq= %08x\n",
1163						__func__, ch->pdu_seq);
1164				ctcm_pr_debug("%s: skb:%0lx "
1165					"skb len: %d \n", __func__,
1166					(unsigned long)skb, skb->len);
1167				ctcm_pr_debug("%s: up to 32 bytes "
1168					"of pdu_data sent\n", __func__);
1169				ctcmpc_dump32((char *)skb->data, skb->len);
1170			}
1171
1172			skblen = skb->len;
1173			sendrc = netif_rx(skb);
1174			priv->stats.rx_packets++;
1175			priv->stats.rx_bytes += skblen;
1176			skb_pull(pskb, new_len); /* point to next PDU */
1177		}
1178	} else {
1179		mpcginfo = kmalloc(sizeof(struct mpcg_info), gfp_type());
1180		if (mpcginfo == NULL)
1181					goto done;
1182
1183		mpcginfo->ch = ch;
1184		mpcginfo->th = header;
1185		mpcginfo->skb = pskb;
1186		CTCM_PR_DEBUG("%s: Not PDU - may be control pkt\n",
1187					__func__);
1188		/*  it's a sweep?   */
1189		sweep = (struct th_sweep *)pskb->data;
1190		mpcginfo->sweep = sweep;
1191		if (header->th_ch_flag == TH_SWEEP_REQ)
1192			mpc_rcvd_sweep_req(mpcginfo);
1193		else if (header->th_ch_flag == TH_SWEEP_RESP)
1194			mpc_rcvd_sweep_resp(mpcginfo);
1195		else if (header->th_blk_flag == TH_DATA_IS_XID) {
1196			struct xid2 *thisxid = (struct xid2 *)pskb->data;
1197			skb_pull(pskb, XID2_LENGTH);
1198			mpcginfo->xid = thisxid;
1199			fsm_event(grp->fsm, MPCG_EVENT_XID2, mpcginfo);
1200		} else if (header->th_blk_flag == TH_DISCONTACT)
1201			fsm_event(grp->fsm, MPCG_EVENT_DISCONC, mpcginfo);
1202		else if (header->th_seq_num != 0) {
1203			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1204				"%s(%s): control pkt expected\n",
1205						CTCM_FUNTAIL, dev->name);
1206			priv->stats.rx_dropped++;
1207			/* mpcginfo only used for non-data transfers */
1208			kfree(mpcginfo);
1209			if (do_debug_data)
1210				ctcmpc_dump_skb(pskb, -8);
1211		}
1212	}
1213done:
1214
1215	dev_kfree_skb_any(pskb);
1216	if (sendrc == NET_RX_DROP) {
1217		dev_warn(&dev->dev,
1218			"The network backlog for %s is exceeded, "
1219			"package dropped\n", __func__);
1220		fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1221	}
1222
1223	CTCM_PR_DEBUG("exit %s: %s: ch=0x%p id=%s\n",
1224			__func__, dev->name, ch, ch->id);
1225}
1226
1227/**
1228 * tasklet helper for mpc's skb unpacking.
1229 *
1230 * ch		The channel to work on.
1231 * Allow flow control back pressure to occur here.
1232 * Throttling back channel can result in excessive
1233 * channel inactivity and system deact of channel
1234 */
1235void ctcmpc_bh(unsigned long thischan)
1236{
1237	struct channel	  *ch	= (struct channel *)thischan;
1238	struct sk_buff	  *skb;
1239	struct net_device *dev	= ch->netdev;
1240	struct ctcm_priv  *priv	= dev->ml_priv;
1241	struct mpc_group  *grp	= priv->mpcg;
1242
1243	CTCM_PR_DEBUG("%s cp:%i enter:  %s() %s\n",
1244	       dev->name, smp_processor_id(), __func__, ch->id);
1245	/* caller has requested driver to throttle back */
1246	while ((fsm_getstate(grp->fsm) != MPCG_STATE_FLOWC) &&
1247			(skb = skb_dequeue(&ch->io_queue))) {
1248		ctcmpc_unpack_skb(ch, skb);
1249		if (grp->out_of_sequence > 20) {
1250			/* assume data loss has occurred if */
1251			/* missing seq_num for extended     */
1252			/* period of time		    */
1253			grp->out_of_sequence = 0;
1254			fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1255			break;
1256		}
1257		if (skb == skb_peek(&ch->io_queue))
1258			break;
1259	}
1260	CTCM_PR_DEBUG("exit %s: %s: ch=0x%p id=%s\n",
1261			__func__, dev->name, ch, ch->id);
1262	return;
1263}
1264
1265/*
1266 *  MPC Group Initializations
1267 */
1268struct mpc_group *ctcmpc_init_mpc_group(struct ctcm_priv *priv)
1269{
1270	struct mpc_group *grp;
1271
1272	CTCM_DBF_TEXT_(MPC_SETUP, CTC_DBF_INFO,
1273			"Enter %s(%p)", CTCM_FUNTAIL, priv);
1274
1275	grp = kzalloc(sizeof(struct mpc_group), GFP_KERNEL);
1276	if (grp == NULL)
1277		return NULL;
1278
1279	grp->fsm = init_fsm("mpcg", mpcg_state_names, mpcg_event_names,
1280			MPCG_NR_STATES, MPCG_NR_EVENTS, mpcg_fsm,
1281			mpcg_fsm_len, GFP_KERNEL);
1282	if (grp->fsm == NULL) {
1283		kfree(grp);
1284		return NULL;
1285	}
1286
1287	fsm_newstate(grp->fsm, MPCG_STATE_RESET);
1288	fsm_settimer(grp->fsm, &grp->timer);
1289
1290	grp->xid_skb =
1291		 __dev_alloc_skb(MPC_BUFSIZE_DEFAULT, GFP_ATOMIC | GFP_DMA);
1292	if (grp->xid_skb == NULL) {
1293		kfree_fsm(grp->fsm);
1294		kfree(grp);
1295		return NULL;
1296	}
1297	/*  base xid for all channels in group  */
1298	grp->xid_skb_data = grp->xid_skb->data;
1299	grp->xid_th = (struct th_header *)grp->xid_skb->data;
1300	memcpy(skb_put(grp->xid_skb, TH_HEADER_LENGTH),
1301			&thnorm, TH_HEADER_LENGTH);
1302
1303	grp->xid = (struct xid2 *)skb_tail_pointer(grp->xid_skb);
1304	memcpy(skb_put(grp->xid_skb, XID2_LENGTH), &init_xid, XID2_LENGTH);
1305	grp->xid->xid2_adj_id = jiffies | 0xfff00000;
1306	grp->xid->xid2_sender_id = jiffies;
1307
1308	grp->xid_id = skb_tail_pointer(grp->xid_skb);
1309	memcpy(skb_put(grp->xid_skb, 4), "VTAM", 4);
1310
1311	grp->rcvd_xid_skb =
1312		__dev_alloc_skb(MPC_BUFSIZE_DEFAULT, GFP_ATOMIC|GFP_DMA);
1313	if (grp->rcvd_xid_skb == NULL) {
1314		kfree_fsm(grp->fsm);
1315		dev_kfree_skb(grp->xid_skb);
1316		kfree(grp);
1317		return NULL;
1318	}
1319	grp->rcvd_xid_data = grp->rcvd_xid_skb->data;
1320	grp->rcvd_xid_th = (struct th_header *)grp->rcvd_xid_skb->data;
1321	memcpy(skb_put(grp->rcvd_xid_skb, TH_HEADER_LENGTH),
1322			&thnorm, TH_HEADER_LENGTH);
1323	grp->saved_xid2 = NULL;
1324	priv->xid = grp->xid;
1325	priv->mpcg = grp;
1326	return grp;
1327}
1328
1329/*
1330 * The MPC Group Station FSM
1331 */
1332
1333/*
1334 * MPC Group Station FSM actions
1335 * CTCM_PROTO_MPC only
1336 */
1337
1338/**
1339 * NOP action for statemachines
1340 */
1341static void mpc_action_nop(fsm_instance *fi, int event, void *arg)
1342{
1343}
1344
1345/*
1346 * invoked when the device transitions to dev_stopped
1347 * MPC will stop each individual channel if a single XID failure
1348 * occurs, or will intitiate all channels be stopped if a GROUP
1349 * level failure occurs.
1350 */
1351static void mpc_action_go_inop(fsm_instance *fi, int event, void *arg)
1352{
1353	struct net_device  *dev = arg;
1354	struct ctcm_priv    *priv;
1355	struct mpc_group *grp;
1356	struct channel *wch;
1357
1358	CTCM_PR_DEBUG("Enter %s: %s\n",	__func__, dev->name);
1359
1360	priv  = dev->ml_priv;
1361	grp =  priv->mpcg;
1362	grp->flow_off_called = 0;
1363	fsm_deltimer(&grp->timer);
1364	if (grp->channels_terminating)
1365			return;
1366
1367	grp->channels_terminating = 1;
1368	grp->saved_state = fsm_getstate(grp->fsm);
1369	fsm_newstate(grp->fsm, MPCG_STATE_INOP);
1370	if (grp->saved_state > MPCG_STATE_XID7INITF)
1371		CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
1372			"%s(%s): MPC GROUP INOPERATIVE",
1373				CTCM_FUNTAIL, dev->name);
1374	if ((grp->saved_state != MPCG_STATE_RESET) ||
1375		/* dealloc_channel has been called */
1376		(grp->port_persist == 0))
1377		fsm_deltimer(&priv->restart_timer);
1378
1379	wch = priv->channel[CTCM_WRITE];
1380
1381	switch (grp->saved_state) {
1382	case MPCG_STATE_RESET:
1383	case MPCG_STATE_INOP:
1384	case MPCG_STATE_XID2INITW:
1385	case MPCG_STATE_XID0IOWAIT:
1386	case MPCG_STATE_XID2INITX:
1387	case MPCG_STATE_XID7INITW:
1388	case MPCG_STATE_XID7INITX:
1389	case MPCG_STATE_XID0IOWAIX:
1390	case MPCG_STATE_XID7INITI:
1391	case MPCG_STATE_XID7INITZ:
1392	case MPCG_STATE_XID7INITF:
1393		break;
1394	case MPCG_STATE_FLOWC:
1395	case MPCG_STATE_READY:
1396	default:
1397		tasklet_hi_schedule(&wch->ch_disc_tasklet);
1398	}
1399
1400	grp->xid2_tgnum = 0;
1401	grp->group_max_buflen = 0;  /*min of all received */
1402	grp->outstanding_xid2 = 0;
1403	grp->outstanding_xid7 = 0;
1404	grp->outstanding_xid7_p2 = 0;
1405	grp->saved_xid2 = NULL;
1406	grp->xidnogood = 0;
1407	grp->changed_side = 0;
1408
1409	grp->rcvd_xid_skb->data = grp->rcvd_xid_data;
1410	skb_reset_tail_pointer(grp->rcvd_xid_skb);
1411	grp->rcvd_xid_skb->len = 0;
1412	grp->rcvd_xid_th = (struct th_header *)grp->rcvd_xid_skb->data;
1413	memcpy(skb_put(grp->rcvd_xid_skb, TH_HEADER_LENGTH), &thnorm,
1414	       TH_HEADER_LENGTH);
1415
1416	if (grp->send_qllc_disc == 1) {
1417		grp->send_qllc_disc = 0;
1418		mpc_send_qllc_discontact(dev);
1419	}
1420
1421	/* DO NOT issue DEV_EVENT_STOP directly out of this code */
1422	/* This can result in INOP of VTAM PU due to halting of  */
1423	/* outstanding IO which causes a sense to be returned	 */
1424	/* Only about 3 senses are allowed and then IOS/VTAM will*/
1425	/* become unreachable without manual intervention	 */
1426	if ((grp->port_persist == 1) || (grp->alloc_called)) {
1427		grp->alloc_called = 0;
1428		fsm_deltimer(&priv->restart_timer);
1429		fsm_addtimer(&priv->restart_timer, 500, DEV_EVENT_RESTART, dev);
1430		fsm_newstate(grp->fsm, MPCG_STATE_RESET);
1431		if (grp->saved_state > MPCG_STATE_XID7INITF)
1432			CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_ALWAYS,
1433				"%s(%s): MPC GROUP RECOVERY SCHEDULED",
1434					CTCM_FUNTAIL, dev->name);
1435	} else {
1436		fsm_deltimer(&priv->restart_timer);
1437		fsm_addtimer(&priv->restart_timer, 500, DEV_EVENT_STOP, dev);
1438		fsm_newstate(grp->fsm, MPCG_STATE_RESET);
1439		CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_ALWAYS,
1440			"%s(%s): NO MPC GROUP RECOVERY ATTEMPTED",
1441						CTCM_FUNTAIL, dev->name);
1442	}
1443}
1444
1445/**
1446 * Handle mpc group  action timeout.
1447 * MPC Group Station FSM action
1448 * CTCM_PROTO_MPC only
1449 *
1450 * fi		An instance of an mpc_group fsm.
1451 * event	The event, just happened.
1452 * arg		Generic pointer, casted from net_device * upon call.
1453 */
1454static void mpc_action_timeout(fsm_instance *fi, int event, void *arg)
1455{
1456	struct net_device *dev = arg;
1457	struct ctcm_priv *priv;
1458	struct mpc_group *grp;
1459	struct channel *wch;
1460	struct channel *rch;
1461
1462	priv = dev->ml_priv;
1463	grp = priv->mpcg;
1464	wch = priv->channel[CTCM_WRITE];
1465	rch = priv->channel[CTCM_READ];
1466
1467	switch (fsm_getstate(grp->fsm)) {
1468	case MPCG_STATE_XID2INITW:
1469		/* Unless there is outstanding IO on the  */
1470		/* channel just return and wait for ATTN  */
1471		/* interrupt to begin XID negotiations	  */
1472		if ((fsm_getstate(rch->fsm) == CH_XID0_PENDING) &&
1473		   (fsm_getstate(wch->fsm) == CH_XID0_PENDING))
1474			break;
1475	default:
1476		fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1477	}
1478
1479	CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_DEBUG,
1480			"%s: dev=%s exit",
1481			CTCM_FUNTAIL, dev->name);
1482	return;
1483}
1484
1485/*
1486 * MPC Group Station FSM action
1487 * CTCM_PROTO_MPC only
1488 */
1489void mpc_action_discontact(fsm_instance *fi, int event, void *arg)
1490{
1491	struct mpcg_info   *mpcginfo   = arg;
1492	struct channel	   *ch	       = mpcginfo->ch;
1493	struct net_device  *dev;
1494	struct ctcm_priv   *priv;
1495	struct mpc_group   *grp;
1496
1497	if (ch) {
1498		dev = ch->netdev;
1499		if (dev) {
1500			priv = dev->ml_priv;
1501			if (priv) {
1502				CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
1503					"%s: %s: %s\n",
1504					CTCM_FUNTAIL, dev->name, ch->id);
1505				grp = priv->mpcg;
1506				grp->send_qllc_disc = 1;
1507				fsm_event(grp->fsm, MPCG_EVENT_INOP, dev);
1508			}
1509		}
1510	}
1511
1512	return;
1513}
1514
1515/*
1516 * MPC Group Station - not part of FSM
1517 * CTCM_PROTO_MPC only
1518 * called from add_channel in ctcm_main.c
1519 */
1520void mpc_action_send_discontact(unsigned long thischan)
1521{
1522	int rc;
1523	struct channel	*ch = (struct channel *)thischan;
1524	unsigned long	saveflags = 0;
1525
1526	spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1527	rc = ccw_device_start(ch->cdev, &ch->ccw[15],
1528					(unsigned long)ch, 0xff, 0);
1529	spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
1530
1531	if (rc != 0) {
1532		ctcm_ccw_check_rc(ch, rc, (char *)__func__);
1533	}
1534
1535	return;
1536}
1537
1538
1539/*
1540 * helper function of mpc FSM
1541 * CTCM_PROTO_MPC only
1542 * mpc_action_rcvd_xid7
1543*/
1544static int mpc_validate_xid(struct mpcg_info *mpcginfo)
1545{
1546	struct channel	   *ch	 = mpcginfo->ch;
1547	struct net_device  *dev  = ch->netdev;
1548	struct ctcm_priv   *priv = dev->ml_priv;
1549	struct mpc_group   *grp  = priv->mpcg;
1550	struct xid2	   *xid  = mpcginfo->xid;
1551	int	rc	 = 0;
1552	__u64	our_id   = 0;
1553	__u64   their_id = 0;
1554	int	len = TH_HEADER_LENGTH + PDU_HEADER_LENGTH;
1555
1556	CTCM_PR_DEBUG("Enter %s: xid=%p\n", __func__, xid);
1557
1558	if (xid == NULL) {
1559		rc = 1;
1560		/* XID REJECTED: xid == NULL */
1561		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1562			"%s(%s): xid = NULL",
1563				CTCM_FUNTAIL, ch->id);
1564			goto done;
1565	}
1566
1567	CTCM_D3_DUMP((char *)xid, XID2_LENGTH);
1568
1569	/*the received direction should be the opposite of ours  */
1570	if (((CHANNEL_DIRECTION(ch->flags) == CTCM_READ) ? XID2_WRITE_SIDE :
1571				XID2_READ_SIDE) != xid->xid2_dlc_type) {
1572		rc = 2;
1573		/* XID REJECTED: r/w channel pairing mismatch */
1574		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1575			"%s(%s): r/w channel pairing mismatch",
1576				CTCM_FUNTAIL, ch->id);
1577			goto done;
1578	}
1579
1580	if (xid->xid2_dlc_type == XID2_READ_SIDE) {
1581		CTCM_PR_DEBUG("%s: grpmaxbuf:%d xid2buflen:%d\n", __func__,
1582				grp->group_max_buflen, xid->xid2_buf_len);
1583
1584		if (grp->group_max_buflen == 0 || grp->group_max_buflen >
1585						xid->xid2_buf_len - len)
1586			grp->group_max_buflen = xid->xid2_buf_len - len;
1587	}
1588
1589	if (grp->saved_xid2 == NULL) {
1590		grp->saved_xid2 =
1591			(struct xid2 *)skb_tail_pointer(grp->rcvd_xid_skb);
1592
1593		memcpy(skb_put(grp->rcvd_xid_skb,
1594					XID2_LENGTH), xid, XID2_LENGTH);
1595		grp->rcvd_xid_skb->data = grp->rcvd_xid_data;
1596
1597		skb_reset_tail_pointer(grp->rcvd_xid_skb);
1598		grp->rcvd_xid_skb->len = 0;
1599
1600		/* convert two 32 bit numbers into 1 64 bit for id compare */
1601		our_id = (__u64)priv->xid->xid2_adj_id;
1602		our_id = our_id << 32;
1603		our_id = our_id + priv->xid->xid2_sender_id;
1604		their_id = (__u64)xid->xid2_adj_id;
1605		their_id = their_id << 32;
1606		their_id = their_id + xid->xid2_sender_id;
1607		/* lower id assume the xside role */
1608		if (our_id < their_id) {
1609			grp->roll = XSIDE;
1610			CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
1611				"%s(%s): WE HAVE LOW ID - TAKE XSIDE",
1612					CTCM_FUNTAIL, ch->id);
1613		} else {
1614			grp->roll = YSIDE;
1615			CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_NOTICE,
1616				"%s(%s): WE HAVE HIGH ID - TAKE YSIDE",
1617					CTCM_FUNTAIL, ch->id);
1618		}
1619
1620	} else {
1621		if (xid->xid2_flag4 != grp->saved_xid2->xid2_flag4) {
1622			rc = 3;
1623			/* XID REJECTED: xid flag byte4 mismatch */
1624			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1625				"%s(%s): xid flag byte4 mismatch",
1626					CTCM_FUNTAIL, ch->id);
1627		}
1628		if (xid->xid2_flag2 == 0x40) {
1629			rc = 4;
1630			/* XID REJECTED - xid NOGOOD */
1631			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1632				"%s(%s): xid NOGOOD",
1633					CTCM_FUNTAIL, ch->id);
1634		}
1635		if (xid->xid2_adj_id != grp->saved_xid2->xid2_adj_id) {
1636			rc = 5;
1637			/* XID REJECTED - Adjacent Station ID Mismatch */
1638			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1639				"%s(%s): Adjacent Station ID Mismatch",
1640					CTCM_FUNTAIL, ch->id);
1641		}
1642		if (xid->xid2_sender_id != grp->saved_xid2->xid2_sender_id) {
1643			rc = 6;
1644			/* XID REJECTED - Sender Address Mismatch */
1645			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1646				"%s(%s): Sender Address Mismatch",
1647					CTCM_FUNTAIL, ch->id);
1648		}
1649	}
1650done:
1651	if (rc) {
1652		dev_warn(&dev->dev,
1653			"The XID used in the MPC protocol is not valid, "
1654			"rc = %d\n", rc);
1655		priv->xid->xid2_flag2 = 0x40;
1656		grp->saved_xid2->xid2_flag2 = 0x40;
1657	}
1658
1659	return rc;
1660}
1661
1662/*
1663 * MPC Group Station FSM action
1664 * CTCM_PROTO_MPC only
1665 */
1666static void mpc_action_side_xid(fsm_instance *fsm, void *arg, int side)
1667{
1668	struct channel *ch = arg;
1669	int rc = 0;
1670	int gotlock = 0;
1671	unsigned long saveflags = 0;	/* avoids compiler warning with
1672					   spin_unlock_irqrestore */
1673
1674	CTCM_PR_DEBUG("Enter %s: cp=%i ch=0x%p id=%s\n",
1675			__func__, smp_processor_id(), ch, ch->id);
1676
1677	if (ctcm_checkalloc_buffer(ch))
1678					goto done;
1679
1680	/*
1681	 * skb data-buffer referencing:
1682	 */
1683	ch->trans_skb->data = ch->trans_skb_data;
1684	skb_reset_tail_pointer(ch->trans_skb);
1685	ch->trans_skb->len = 0;
1686	/* result of the previous 3 statements is NOT always
1687	 * already set after ctcm_checkalloc_buffer
1688	 * because of possible reuse of the trans_skb
1689	 */
1690	memset(ch->trans_skb->data, 0, 16);
1691	ch->rcvd_xid_th =  (struct th_header *)ch->trans_skb_data;
1692	/* check is main purpose here: */
1693	skb_put(ch->trans_skb, TH_HEADER_LENGTH);
1694	ch->rcvd_xid = (struct xid2 *)skb_tail_pointer(ch->trans_skb);
1695	/* check is main purpose here: */
1696	skb_put(ch->trans_skb, XID2_LENGTH);
1697	ch->rcvd_xid_id = skb_tail_pointer(ch->trans_skb);
1698	/* cleanup back to startpoint */
1699	ch->trans_skb->data = ch->trans_skb_data;
1700	skb_reset_tail_pointer(ch->trans_skb);
1701	ch->trans_skb->len = 0;
1702
1703	/* non-checking rewrite of above skb data-buffer referencing: */
1704	/*
1705	memset(ch->trans_skb->data, 0, 16);
1706	ch->rcvd_xid_th =  (struct th_header *)ch->trans_skb_data;
1707	ch->rcvd_xid = (struct xid2 *)(ch->trans_skb_data + TH_HEADER_LENGTH);
1708	ch->rcvd_xid_id = ch->trans_skb_data + TH_HEADER_LENGTH + XID2_LENGTH;
1709	 */
1710
1711	ch->ccw[8].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1712	ch->ccw[8].count	= 0;
1713	ch->ccw[8].cda		= 0x00;
1714
1715	if (!(ch->xid_th && ch->xid && ch->xid_id))
1716		CTCM_DBF_TEXT_(MPC_TRACE, CTC_DBF_INFO,
1717			"%s(%s): xid_th=%p, xid=%p, xid_id=%p",
1718			CTCM_FUNTAIL, ch->id, ch->xid_th, ch->xid, ch->xid_id);
1719
1720	if (side == XSIDE) {
1721		/* mpc_action_xside_xid */
1722		if (ch->xid_th == NULL)
1723				goto done;
1724		ch->ccw[9].cmd_code	= CCW_CMD_WRITE;
1725		ch->ccw[9].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1726		ch->ccw[9].count	= TH_HEADER_LENGTH;
1727		ch->ccw[9].cda		= virt_to_phys(ch->xid_th);
1728
1729		if (ch->xid == NULL)
1730				goto done;
1731		ch->ccw[10].cmd_code	= CCW_CMD_WRITE;
1732		ch->ccw[10].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1733		ch->ccw[10].count	= XID2_LENGTH;
1734		ch->ccw[10].cda		= virt_to_phys(ch->xid);
1735
1736		ch->ccw[11].cmd_code	= CCW_CMD_READ;
1737		ch->ccw[11].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1738		ch->ccw[11].count	= TH_HEADER_LENGTH;
1739		ch->ccw[11].cda		= virt_to_phys(ch->rcvd_xid_th);
1740
1741		ch->ccw[12].cmd_code	= CCW_CMD_READ;
1742		ch->ccw[12].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1743		ch->ccw[12].count	= XID2_LENGTH;
1744		ch->ccw[12].cda		= virt_to_phys(ch->rcvd_xid);
1745
1746		ch->ccw[13].cmd_code	= CCW_CMD_READ;
1747		ch->ccw[13].cda		= virt_to_phys(ch->rcvd_xid_id);
1748
1749	} else { /* side == YSIDE : mpc_action_yside_xid */
1750		ch->ccw[9].cmd_code	= CCW_CMD_READ;
1751		ch->ccw[9].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1752		ch->ccw[9].count	= TH_HEADER_LENGTH;
1753		ch->ccw[9].cda		= virt_to_phys(ch->rcvd_xid_th);
1754
1755		ch->ccw[10].cmd_code	= CCW_CMD_READ;
1756		ch->ccw[10].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1757		ch->ccw[10].count	= XID2_LENGTH;
1758		ch->ccw[10].cda		= virt_to_phys(ch->rcvd_xid);
1759
1760		if (ch->xid_th == NULL)
1761				goto done;
1762		ch->ccw[11].cmd_code	= CCW_CMD_WRITE;
1763		ch->ccw[11].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1764		ch->ccw[11].count	= TH_HEADER_LENGTH;
1765		ch->ccw[11].cda		= virt_to_phys(ch->xid_th);
1766
1767		if (ch->xid == NULL)
1768				goto done;
1769		ch->ccw[12].cmd_code	= CCW_CMD_WRITE;
1770		ch->ccw[12].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1771		ch->ccw[12].count	= XID2_LENGTH;
1772		ch->ccw[12].cda		= virt_to_phys(ch->xid);
1773
1774		if (ch->xid_id == NULL)
1775				goto done;
1776		ch->ccw[13].cmd_code	= CCW_CMD_WRITE;
1777		ch->ccw[13].cda		= virt_to_phys(ch->xid_id);
1778
1779	}
1780	ch->ccw[13].flags	= CCW_FLAG_SLI | CCW_FLAG_CC;
1781	ch->ccw[13].count	= 4;
1782
1783	ch->ccw[14].cmd_code	= CCW_CMD_NOOP;
1784	ch->ccw[14].flags	= CCW_FLAG_SLI;
1785	ch->ccw[14].count	= 0;
1786	ch->ccw[14].cda		= 0;
1787
1788	CTCM_CCW_DUMP((char *)&ch->ccw[8], sizeof(struct ccw1) * 7);
1789	CTCM_D3_DUMP((char *)ch->xid_th, TH_HEADER_LENGTH);
1790	CTCM_D3_DUMP((char *)ch->xid, XID2_LENGTH);
1791	CTCM_D3_DUMP((char *)ch->xid_id, 4);
1792
1793	if (!in_irq()) {
1794			 /* Such conditional locking is a known problem for
1795			  * sparse because its static undeterministic.
1796			  * Warnings should be ignored here. */
1797		spin_lock_irqsave(get_ccwdev_lock(ch->cdev), saveflags);
1798		gotlock = 1;
1799	}
1800
1801	fsm_addtimer(&ch->timer, 5000 , CTC_EVENT_TIMER, ch);
1802	rc = ccw_device_start(ch->cdev, &ch->ccw[8],
1803				(unsigned long)ch, 0xff, 0);
1804
1805	if (gotlock)	/* see remark above about conditional locking */
1806		spin_unlock_irqrestore(get_ccwdev_lock(ch->cdev), saveflags);
1807
1808	if (rc != 0) {
1809		ctcm_ccw_check_rc(ch, rc,
1810				(side == XSIDE) ? "x-side XID" : "y-side XID");
1811	}
1812
1813done:
1814	CTCM_PR_DEBUG("Exit %s: ch=0x%p id=%s\n",
1815				__func__, ch, ch->id);
1816	return;
1817
1818}
1819
1820/*
1821 * MPC Group Station FSM action
1822 * CTCM_PROTO_MPC only
1823 */
1824static void mpc_action_xside_xid(fsm_instance *fsm, int event, void *arg)
1825{
1826	mpc_action_side_xid(fsm, arg, XSIDE);
1827}
1828
1829/*
1830 * MPC Group Station FSM action
1831 * CTCM_PROTO_MPC only
1832 */
1833static void mpc_action_yside_xid(fsm_instance *fsm, int event, void *arg)
1834{
1835	mpc_action_side_xid(fsm, arg, YSIDE);
1836}
1837
1838/*
1839 * MPC Group Station FSM action
1840 * CTCM_PROTO_MPC only
1841 */
1842static void mpc_action_doxid0(fsm_instance *fsm, int event, void *arg)
1843{
1844	struct channel	   *ch   = arg;
1845	struct net_device  *dev  = ch->netdev;
1846	struct ctcm_priv   *priv = dev->ml_priv;
1847	struct mpc_group   *grp  = priv->mpcg;
1848
1849	CTCM_PR_DEBUG("Enter %s: cp=%i ch=0x%p id=%s\n",
1850			__func__, smp_processor_id(), ch, ch->id);
1851
1852	if (ch->xid == NULL) {
1853		CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
1854			"%s(%s): ch->xid == NULL",
1855				CTCM_FUNTAIL, dev->name);
1856		return;
1857	}
1858
1859	fsm_newstate(ch->fsm, CH_XID0_INPROGRESS);
1860
1861	ch->xid->xid2_option =	XID2_0;
1862
1863	switch (fsm_getstate(grp->fsm)) {
1864	case MPCG_STATE_XID2INITW:
1865	case MPCG_STATE_XID2INITX:
1866		ch->ccw[8].cmd_code = CCW_CMD_SENSE_CMD;
1867		break;
1868	case MPCG_STATE_XID0IOWAIT:
1869	case MPCG_STATE_XID0IOWAIX:
1870		ch->ccw[8].cmd_code = CCW_CMD_WRITE_CTL;
1871		break;
1872	}
1873
1874	fsm_event(grp->fsm, MPCG_EVENT_DOIO, ch);
1875
1876	return;
1877}
1878
1879/*
1880 * MPC Group Station FSM action
1881 * CTCM_PROTO_MPC only
1882*/
1883static void mpc_action_doxid7(fsm_instance *fsm, int event, void *arg)
1884{
1885	struct net_device *dev = arg;
1886	struct ctcm_priv  *priv = dev->ml_priv;
1887	struct mpc_group  *grp  = NULL;
1888	int direction;
1889	int send = 0;
1890
1891	if (priv)
1892		grp = priv->mpcg;
1893	if (grp == NULL)
1894		return;
1895
1896	for (direction = CTCM_READ; direction <= CTCM_WRITE; direction++) {
1897		struct channel *ch = priv->channel[direction];
1898		struct xid2 *thisxid = ch->xid;
1899		ch->xid_skb->data = ch->xid_skb_data;
1900		skb_reset_tail_pointer(ch->xid_skb);
1901		ch->xid_skb->len = 0;
1902		thisxid->xid2_option = XID2_7;
1903		send = 0;
1904
1905		/* xid7 phase 1 */
1906		if (grp->outstanding_xid7_p2 > 0) {
1907			if (grp->roll == YSIDE) {
1908				if (fsm_getstate(ch->fsm) == CH_XID7_PENDING1) {
1909					fsm_newstate(ch->fsm, CH_XID7_PENDING2);
1910					ch->ccw[8].cmd_code = CCW_CMD_SENSE_CMD;
1911					memcpy(skb_put(ch->xid_skb,
1912							TH_HEADER_LENGTH),
1913					       &thdummy, TH_HEADER_LENGTH);
1914					send = 1;
1915				}
1916			} else if (fsm_getstate(ch->fsm) < CH_XID7_PENDING2) {
1917					fsm_newstate(ch->fsm, CH_XID7_PENDING2);
1918					ch->ccw[8].cmd_code = CCW_CMD_WRITE_CTL;
1919					memcpy(skb_put(ch->xid_skb,
1920						       TH_HEADER_LENGTH),
1921					       &thnorm, TH_HEADER_LENGTH);
1922					send = 1;
1923			}
1924		} else {
1925			/* xid7 phase 2 */
1926			if (grp->roll == YSIDE) {
1927				if (fsm_getstate(ch->fsm) < CH_XID7_PENDING4) {
1928					fsm_newstate(ch->fsm, CH_XID7_PENDING4);
1929					memcpy(skb_put(ch->xid_skb,
1930						       TH_HEADER_LENGTH),
1931					       &thnorm, TH_HEADER_LENGTH);
1932					ch->ccw[8].cmd_code = CCW_CMD_WRITE_CTL;
1933					send = 1;
1934				}
1935			} else if (fsm_getstate(ch->fsm) == CH_XID7_PENDING3) {
1936				fsm_newstate(ch->fsm, CH_XID7_PENDING4);
1937				ch->ccw[8].cmd_code = CCW_CMD_SENSE_CMD;
1938				memcpy(skb_put(ch->xid_skb, TH_HEADER_LENGTH),
1939						&thdummy, TH_HEADER_LENGTH);
1940				send = 1;
1941			}
1942		}
1943
1944		if (send)
1945			fsm_event(grp->fsm, MPCG_EVENT_DOIO, ch);
1946	}
1947
1948	return;
1949}
1950
1951/*
1952 * MPC Group Station FSM action
1953 * CTCM_PROTO_MPC only
1954 */
1955static void mpc_action_rcvd_xid0(fsm_instance *fsm, int event, void *arg)
1956{
1957
1958	struct mpcg_info   *mpcginfo  = arg;
1959	struct channel	   *ch   = mpcginfo->ch;
1960	struct net_device  *dev  = ch->netdev;
1961	struct ctcm_priv   *priv = dev->ml_priv;
1962	struct mpc_group   *grp  = priv->mpcg;
1963
1964	CTCM_PR_DEBUG("%s: ch-id:%s xid2:%i xid7:%i xidt_p2:%i \n",
1965			__func__, ch->id, grp->outstanding_xid2,
1966			grp->outstanding_xid7, grp->outstanding_xid7_p2);
1967
1968	if (fsm_getstate(ch->fsm) < CH_XID7_PENDING)
1969		fsm_newstate(ch->fsm, CH_XID7_PENDING);
1970
1971	grp->outstanding_xid2--;
1972	grp->outstanding_xid7++;
1973	grp->outstanding_xid7_p2++;
1974
1975	/* must change state before validating xid to */
1976	/* properly handle interim interrupts received*/
1977	switch (fsm_getstate(grp->fsm)) {
1978	case MPCG_STATE_XID2INITW:
1979		fsm_newstate(grp->fsm, MPCG_STATE_XID2INITX);
1980		mpc_validate_xid(mpcginfo);
1981		break;
1982	case MPCG_STATE_XID0IOWAIT:
1983		fsm_newstate(grp->fsm, MPCG_STATE_XID0IOWAIX);
1984		mpc_validate_xid(mpcginfo);
1985		break;
1986	case MPCG_STATE_XID2INITX:
1987		if (grp->outstanding_xid2 == 0) {
1988			fsm_newstate(grp->fsm, MPCG_STATE_XID7INITW);
1989			mpc_validate_xid(mpcginfo);
1990			fsm_event(grp->fsm, MPCG_EVENT_XID2DONE, dev);
1991		}
1992		break;
1993	case MPCG_STATE_XID0IOWAIX:
1994		if (grp->outstanding_xid2 == 0) {
1995			fsm_newstate(grp->fsm, MPCG_STATE_XID7INITI);
1996			mpc_validate_xid(mpcginfo);
1997			fsm_event(grp->fsm, MPCG_EVENT_XID2DONE, dev);
1998		}
1999		break;
2000	}
2001	kfree(mpcginfo);
2002
2003	CTCM_PR_DEBUG("ctcmpc:%s() %s xid2:%i xid7:%i xidt_p2:%i \n",
2004		__func__, ch->id, grp->outstanding_xid2,
2005		grp->outstanding_xid7, grp->outstanding_xid7_p2);
2006	CTCM_PR_DEBUG("ctcmpc:%s() %s grpstate: %s chanstate: %s \n",
2007		__func__, ch->id,
2008		fsm_getstate_str(grp->fsm), fsm_getstate_str(ch->fsm));
2009	return;
2010
2011}
2012
2013
2014/*
2015 * MPC Group Station FSM action
2016 * CTCM_PROTO_MPC only
2017 */
2018static void mpc_action_rcvd_xid7(fsm_instance *fsm, int event, void *arg)
2019{
2020	struct mpcg_info   *mpcginfo   = arg;
2021	struct channel	   *ch	       = mpcginfo->ch;
2022	struct net_device  *dev        = ch->netdev;
2023	struct ctcm_priv   *priv    = dev->ml_priv;
2024	struct mpc_group   *grp     = priv->mpcg;
2025
2026	CTCM_PR_DEBUG("Enter %s: cp=%i ch=0x%p id=%s\n",
2027		__func__, smp_processor_id(), ch, ch->id);
2028	CTCM_PR_DEBUG("%s: outstanding_xid7: %i, outstanding_xid7_p2: %i\n",
2029		__func__, grp->outstanding_xid7, grp->outstanding_xid7_p2);
2030
2031	grp->outstanding_xid7--;
2032	ch->xid_skb->data = ch->xid_skb_data;
2033	skb_reset_tail_pointer(ch->xid_skb);
2034	ch->xid_skb->len = 0;
2035
2036	switch (fsm_getstate(grp->fsm)) {
2037	case MPCG_STATE_XID7INITI:
2038		fsm_newstate(grp->fsm, MPCG_STATE_XID7INITZ);
2039		mpc_validate_xid(mpcginfo);
2040		break;
2041	case MPCG_STATE_XID7INITW:
2042		fsm_newstate(grp->fsm, MPCG_STATE_XID7INITX);
2043		mpc_validate_xid(mpcginfo);
2044		break;
2045	case MPCG_STATE_XID7INITZ:
2046	case MPCG_STATE_XID7INITX:
2047		if (grp->outstanding_xid7 == 0) {
2048			if (grp->outstanding_xid7_p2 > 0) {
2049				grp->outstanding_xid7 =
2050					grp->outstanding_xid7_p2;
2051				grp->outstanding_xid7_p2 = 0;
2052			} else
2053				fsm_newstate(grp->fsm, MPCG_STATE_XID7INITF);
2054
2055			mpc_validate_xid(mpcginfo);
2056			fsm_event(grp->fsm, MPCG_EVENT_XID7DONE, dev);
2057			break;
2058		}
2059		mpc_validate_xid(mpcginfo);
2060		break;
2061	}
2062	kfree(mpcginfo);
2063	return;
2064}
2065
2066/*
2067 * mpc_action helper of an MPC Group Station FSM action
2068 * CTCM_PROTO_MPC only
2069 */
2070static int mpc_send_qllc_discontact(struct net_device *dev)
2071{
2072	__u32	new_len	= 0;
2073	struct sk_buff   *skb;
2074	struct qllc      *qllcptr;
2075	struct ctcm_priv *priv = dev->ml_priv;
2076	struct mpc_group *grp = priv->mpcg;
2077
2078	CTCM_PR_DEBUG("%s: GROUP STATE: %s\n",
2079		__func__, mpcg_state_names[grp->saved_state]);
2080
2081	switch (grp->saved_state) {
2082	/*
2083	 * establish conn callback function is
2084	 * preferred method to report failure
2085	 */
2086	case MPCG_STATE_XID0IOWAIT:
2087	case MPCG_STATE_XID0IOWAIX:
2088	case MPCG_STATE_XID7INITI:
2089	case MPCG_STATE_XID7INITZ:
2090	case MPCG_STATE_XID2INITW:
2091	case MPCG_STATE_XID2INITX:
2092	case MPCG_STATE_XID7INITW:
2093	case MPCG_STATE_XID7INITX:
2094		if (grp->estconnfunc) {
2095			grp->estconnfunc(grp->port_num, -1, 0);
2096			grp->estconnfunc = NULL;
2097			break;
2098		}
2099	case MPCG_STATE_FLOWC:
2100	case MPCG_STATE_READY:
2101		grp->send_qllc_disc = 2;
2102		new_len = sizeof(struct qllc);
2103		qllcptr = kzalloc(new_len, gfp_type() | GFP_DMA);
2104		if (qllcptr == NULL) {
2105			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
2106				"%s(%s): qllcptr allocation error",
2107						CTCM_FUNTAIL, dev->name);
2108			return -ENOMEM;
2109		}
2110
2111		qllcptr->qllc_address = 0xcc;
2112		qllcptr->qllc_commands = 0x03;
2113
2114		skb = __dev_alloc_skb(new_len, GFP_ATOMIC);
2115
2116		if (skb == NULL) {
2117			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
2118				"%s(%s): skb allocation error",
2119						CTCM_FUNTAIL, dev->name);
2120			priv->stats.rx_dropped++;
2121			kfree(qllcptr);
2122			return -ENOMEM;
2123		}
2124
2125		memcpy(skb_put(skb, new_len), qllcptr, new_len);
2126		kfree(qllcptr);
2127
2128		if (skb_headroom(skb) < 4) {
2129			CTCM_DBF_TEXT_(MPC_ERROR, CTC_DBF_ERROR,
2130				"%s(%s): skb_headroom error",
2131						CTCM_FUNTAIL, dev->name);
2132			dev_kfree_skb_any(skb);
2133			return -ENOMEM;
2134		}
2135
2136		*((__u32 *)skb_push(skb, 4)) =
2137			priv->channel[CTCM_READ]->pdu_seq;
2138		priv->channel[CTCM_READ]->pdu_seq++;
2139		CTCM_PR_DBGDATA("ctcmpc: %s ToDCM_pdu_seq= %08x\n",
2140				__func__, priv->channel[CTCM_READ]->pdu_seq);
2141
2142		/* receipt of CC03 resets anticipated sequence number on
2143		      receiving side */
2144		priv->channel[CTCM_READ]->pdu_seq = 0x00;
2145		skb_reset_mac_header(skb);
2146		skb->dev = dev;
2147		skb->protocol = htons(ETH_P_SNAP);
2148		skb->ip_summed = CHECKSUM_UNNECESSARY;
2149
2150		CTCM_D3_DUMP(skb->data, (sizeof(struct qllc) + 4));
2151
2152		netif_rx(skb);
2153		break;
2154	default:
2155		break;
2156
2157	}
2158
2159	return 0;
2160}
2161/* --- This is the END my friend --- */
2162