2 * drivers/s390/net/ctcm_main.c
4 * Copyright IBM Corp. 2001, 2009
6 * Original CTC driver(s):
7 * Fritz Elfert (felfert@millenux.com)
8 * Dieter Wellerdiek (wel@de.ibm.com)
9 * Martin Schwidefsky (schwidefsky@de.ibm.com)
10 * Denis Joseph Barrow (barrow_dj@yahoo.com)
11 * Jochen Roehrig (roehrig@de.ibm.com)
12 * Cornelia Huck <cornelia.huck@de.ibm.com>
14 * Belinda Thompson (belindat@us.ibm.com)
15 * Andy Richter (richtera@us.ibm.com)
17 * Peter Tiedemann (ptiedem@de.ibm.com)
24 #define KMSG_COMPONENT "ctcm"
25 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
27 #include <linux/kernel_stat.h>
28 #include <linux/module.h>
29 #include <linux/init.h>
30 #include <linux/kernel.h>
31 #include <linux/slab.h>
32 #include <linux/errno.h>
33 #include <linux/types.h>
34 #include <linux/interrupt.h>
35 #include <linux/timer.h>
36 #include <linux/bitops.h>
38 #include <linux/signal.h>
39 #include <linux/string.h>
42 #include <linux/if_arp.h>
43 #include <linux/tcp.h>
44 #include <linux/skbuff.h>
45 #include <linux/ctype.h>
49 #include <asm/ccwdev.h>
50 #include <asm/ccwgroup.h>
51 #include <linux/uaccess.h>
53 #include <asm/idals.h>
55 #include "ctcm_fsms.h"
56 #include "ctcm_main.h"
58 /* Some common global variables */
61 * The root device for ctcm group devices
63 static struct device
*ctcm_root_dev
;
66 * Linked list of all detected channels.
68 struct channel
*channels
;
71 * Unpack a just received skb and hand it over to
74 * ch The channel where this skb has been received.
75 * pskb The received skb.
77 void ctcm_unpack_skb(struct channel
*ch
, struct sk_buff
*pskb
)
79 struct net_device
*dev
= ch
->netdev
;
80 struct ctcm_priv
*priv
= dev
->ml_priv
;
81 __u16 len
= *((__u16
*) pskb
->data
);
83 skb_put(pskb
, 2 + LL_HEADER_LENGTH
);
86 pskb
->ip_summed
= CHECKSUM_UNNECESSARY
;
90 struct ll_header
*header
= (struct ll_header
*)pskb
->data
;
92 skb_pull(pskb
, LL_HEADER_LENGTH
);
93 if ((ch
->protocol
== CTCM_PROTO_S390
) &&
94 (header
->type
!= ETH_P_IP
)) {
95 if (!(ch
->logflags
& LOG_FLAG_ILLEGALPKT
)) {
96 ch
->logflags
|= LOG_FLAG_ILLEGALPKT
;
98 * Check packet type only if we stick strictly
99 * to S/390's protocol of OS390. This only
100 * supports IP. Otherwise allow any packet
103 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
104 "%s(%s): Illegal packet type 0x%04x"
106 CTCM_FUNTAIL
, dev
->name
, header
->type
);
108 priv
->stats
.rx_dropped
++;
109 priv
->stats
.rx_frame_errors
++;
112 pskb
->protocol
= ntohs(header
->type
);
113 if ((header
->length
<= LL_HEADER_LENGTH
) ||
114 (len
<= LL_HEADER_LENGTH
)) {
115 if (!(ch
->logflags
& LOG_FLAG_ILLEGALSIZE
)) {
116 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
117 "%s(%s): Illegal packet size %d(%d,%d)"
119 CTCM_FUNTAIL
, dev
->name
,
120 header
->length
, dev
->mtu
, len
);
121 ch
->logflags
|= LOG_FLAG_ILLEGALSIZE
;
124 priv
->stats
.rx_dropped
++;
125 priv
->stats
.rx_length_errors
++;
128 header
->length
-= LL_HEADER_LENGTH
;
129 len
-= LL_HEADER_LENGTH
;
130 if ((header
->length
> skb_tailroom(pskb
)) ||
131 (header
->length
> len
)) {
132 if (!(ch
->logflags
& LOG_FLAG_OVERRUN
)) {
133 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
134 "%s(%s): Packet size %d (overrun)"
135 " - dropping", CTCM_FUNTAIL
,
136 dev
->name
, header
->length
);
137 ch
->logflags
|= LOG_FLAG_OVERRUN
;
140 priv
->stats
.rx_dropped
++;
141 priv
->stats
.rx_length_errors
++;
144 skb_put(pskb
, header
->length
);
145 skb_reset_mac_header(pskb
);
146 len
-= header
->length
;
147 skb
= dev_alloc_skb(pskb
->len
);
149 if (!(ch
->logflags
& LOG_FLAG_NOMEM
)) {
150 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
151 "%s(%s): MEMORY allocation error",
152 CTCM_FUNTAIL
, dev
->name
);
153 ch
->logflags
|= LOG_FLAG_NOMEM
;
155 priv
->stats
.rx_dropped
++;
158 skb_copy_from_linear_data(pskb
, skb_put(skb
, pskb
->len
),
160 skb_reset_mac_header(skb
);
161 skb
->dev
= pskb
->dev
;
162 skb
->protocol
= pskb
->protocol
;
163 pskb
->ip_summed
= CHECKSUM_UNNECESSARY
;
169 priv
->stats
.rx_packets
++;
170 priv
->stats
.rx_bytes
+= skblen
;
173 skb_pull(pskb
, header
->length
);
174 if (skb_tailroom(pskb
) < LL_HEADER_LENGTH
) {
175 CTCM_DBF_DEV_NAME(TRACE
, dev
,
176 "Overrun in ctcm_unpack_skb");
177 ch
->logflags
|= LOG_FLAG_OVERRUN
;
180 skb_put(pskb
, LL_HEADER_LENGTH
);
186 * Release a specific channel in the channel list.
188 * ch Pointer to channel struct to be released.
190 static void channel_free(struct channel
*ch
)
192 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
, "%s(%s)", CTCM_FUNTAIL
, ch
->id
);
193 ch
->flags
&= ~CHANNEL_FLAGS_INUSE
;
194 fsm_newstate(ch
->fsm
, CTC_STATE_IDLE
);
198 * Remove a specific channel in the channel list.
200 * ch Pointer to channel struct to be released.
202 static void channel_remove(struct channel
*ch
)
204 struct channel
**c
= &channels
;
205 char chid
[CTCM_ID_SIZE
+1];
211 strncpy(chid
, ch
->id
, CTCM_ID_SIZE
);
217 fsm_deltimer(&ch
->timer
);
219 fsm_deltimer(&ch
->sweep_timer
);
222 clear_normalized_cda(&ch
->ccw
[4]);
223 if (ch
->trans_skb
!= NULL
) {
224 clear_normalized_cda(&ch
->ccw
[1]);
225 dev_kfree_skb_any(ch
->trans_skb
);
228 tasklet_kill(&ch
->ch_tasklet
);
229 tasklet_kill(&ch
->ch_disc_tasklet
);
230 kfree(ch
->discontact_th
);
241 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
, "%s(%s) %s", CTCM_FUNTAIL
,
242 chid
, ok
? "OK" : "failed");
246 * Get a specific channel from the channel list.
248 * type Type of channel we are interested in.
249 * id Id of channel we are interested in.
250 * direction Direction we want to use this channel for.
252 * returns Pointer to a channel or NULL if no matching channel available.
254 static struct channel
*channel_get(enum ctcm_channel_types type
,
255 char *id
, int direction
)
257 struct channel
*ch
= channels
;
259 while (ch
&& (strncmp(ch
->id
, id
, CTCM_ID_SIZE
) || (ch
->type
!= type
)))
262 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
263 "%s(%d, %s, %d) not found in channel list\n",
264 CTCM_FUNTAIL
, type
, id
, direction
);
266 if (ch
->flags
& CHANNEL_FLAGS_INUSE
)
269 ch
->flags
|= CHANNEL_FLAGS_INUSE
;
270 ch
->flags
&= ~CHANNEL_FLAGS_RWMASK
;
271 ch
->flags
|= (direction
== CTCM_WRITE
)
272 ? CHANNEL_FLAGS_WRITE
: CHANNEL_FLAGS_READ
;
273 fsm_newstate(ch
->fsm
, CTC_STATE_STOPPED
);
279 static long ctcm_check_irb_error(struct ccw_device
*cdev
, struct irb
*irb
)
284 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_WARN
,
285 "irb error %ld on device %s\n",
286 PTR_ERR(irb
), dev_name(&cdev
->dev
));
288 switch (PTR_ERR(irb
)) {
291 "An I/O-error occurred on the CTCM device\n");
295 "An adapter hardware operation timed out\n");
299 "An error occurred on the adapter hardware\n");
306 * Check sense of a unit check.
308 * ch The channel, the sense code belongs to.
309 * sense The sense code to inspect.
311 static inline void ccw_unit_check(struct channel
*ch
, __u8 sense
)
313 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_DEBUG
,
315 CTCM_FUNTAIL
, ch
->id
, sense
);
317 if (sense
& SNS0_INTERVENTION_REQ
) {
319 if (ch
->sense_rc
!= 0x01) {
321 "%s: The communication peer has "
322 "disconnected\n", ch
->id
);
325 fsm_event(ch
->fsm
, CTC_EVENT_UC_RCRESET
, ch
);
327 if (ch
->sense_rc
!= SNS0_INTERVENTION_REQ
) {
329 "%s: The remote operating system is "
330 "not available\n", ch
->id
);
331 ch
->sense_rc
= SNS0_INTERVENTION_REQ
;
333 fsm_event(ch
->fsm
, CTC_EVENT_UC_RSRESET
, ch
);
335 } else if (sense
& SNS0_EQUIPMENT_CHECK
) {
336 if (sense
& SNS0_BUS_OUT_CHECK
) {
337 if (ch
->sense_rc
!= SNS0_BUS_OUT_CHECK
) {
338 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
339 "%s(%s): remote HW error %02x",
340 CTCM_FUNTAIL
, ch
->id
, sense
);
341 ch
->sense_rc
= SNS0_BUS_OUT_CHECK
;
343 fsm_event(ch
->fsm
, CTC_EVENT_UC_HWFAIL
, ch
);
345 if (ch
->sense_rc
!= SNS0_EQUIPMENT_CHECK
) {
346 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
347 "%s(%s): remote read parity error %02x",
348 CTCM_FUNTAIL
, ch
->id
, sense
);
349 ch
->sense_rc
= SNS0_EQUIPMENT_CHECK
;
351 fsm_event(ch
->fsm
, CTC_EVENT_UC_RXPARITY
, ch
);
353 } else if (sense
& SNS0_BUS_OUT_CHECK
) {
354 if (ch
->sense_rc
!= SNS0_BUS_OUT_CHECK
) {
355 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
356 "%s(%s): BUS OUT error %02x",
357 CTCM_FUNTAIL
, ch
->id
, sense
);
358 ch
->sense_rc
= SNS0_BUS_OUT_CHECK
;
360 if (sense
& 0x04) /* data-streaming timeout */
361 fsm_event(ch
->fsm
, CTC_EVENT_UC_TXTIMEOUT
, ch
);
362 else /* Data-transfer parity error */
363 fsm_event(ch
->fsm
, CTC_EVENT_UC_TXPARITY
, ch
);
364 } else if (sense
& SNS0_CMD_REJECT
) {
365 if (ch
->sense_rc
!= SNS0_CMD_REJECT
) {
366 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
367 "%s(%s): Command rejected",
368 CTCM_FUNTAIL
, ch
->id
);
369 ch
->sense_rc
= SNS0_CMD_REJECT
;
371 } else if (sense
== 0) {
372 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
373 "%s(%s): Unit check ZERO",
374 CTCM_FUNTAIL
, ch
->id
);
375 fsm_event(ch
->fsm
, CTC_EVENT_UC_ZERO
, ch
);
377 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
378 "%s(%s): Unit check code %02x unknown",
379 CTCM_FUNTAIL
, ch
->id
, sense
);
380 fsm_event(ch
->fsm
, CTC_EVENT_UC_UNKNOWN
, ch
);
384 int ctcm_ch_alloc_buffer(struct channel
*ch
)
386 clear_normalized_cda(&ch
->ccw
[1]);
387 ch
->trans_skb
= __dev_alloc_skb(ch
->max_bufsize
, GFP_ATOMIC
| GFP_DMA
);
388 if (ch
->trans_skb
== NULL
) {
389 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
390 "%s(%s): %s trans_skb allocation error",
391 CTCM_FUNTAIL
, ch
->id
,
392 (CHANNEL_DIRECTION(ch
->flags
) == CTCM_READ
) ?
397 ch
->ccw
[1].count
= ch
->max_bufsize
;
398 if (set_normalized_cda(&ch
->ccw
[1], ch
->trans_skb
->data
)) {
399 dev_kfree_skb(ch
->trans_skb
);
400 ch
->trans_skb
= NULL
;
401 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
402 "%s(%s): %s set norm_cda failed",
403 CTCM_FUNTAIL
, ch
->id
,
404 (CHANNEL_DIRECTION(ch
->flags
) == CTCM_READ
) ?
409 ch
->ccw
[1].count
= 0;
410 ch
->trans_skb_data
= ch
->trans_skb
->data
;
411 ch
->flags
&= ~CHANNEL_FLAGS_BUFSIZE_CHANGED
;
416 * Interface API for upper network layers
421 * Called from generic network layer when ifconfig up is run.
423 * dev Pointer to interface struct.
425 * returns 0 on success, -ERRNO on failure. (Never fails.)
427 int ctcm_open(struct net_device
*dev
)
429 struct ctcm_priv
*priv
= dev
->ml_priv
;
431 CTCMY_DBF_DEV_NAME(SETUP
, dev
, "");
433 fsm_event(priv
->fsm
, DEV_EVENT_START
, dev
);
438 * Close an interface.
439 * Called from generic network layer when ifconfig down is run.
441 * dev Pointer to interface struct.
443 * returns 0 on success, -ERRNO on failure. (Never fails.)
445 int ctcm_close(struct net_device
*dev
)
447 struct ctcm_priv
*priv
= dev
->ml_priv
;
449 CTCMY_DBF_DEV_NAME(SETUP
, dev
, "");
451 fsm_event(priv
->fsm
, DEV_EVENT_STOP
, dev
);
458 * This is a helper function for ctcm_tx().
460 * ch Channel to be used for sending.
461 * skb Pointer to struct sk_buff of packet to send.
462 * The linklevel header has already been set up
465 * returns 0 on success, -ERRNO on failure. (Never fails.)
467 static int ctcm_transmit_skb(struct channel
*ch
, struct sk_buff
*skb
)
469 unsigned long saveflags
;
470 struct ll_header header
;
474 struct sk_buff
*nskb
;
477 /* we need to acquire the lock for testing the state
478 * otherwise we can have an IRQ changing the state to
479 * TXIDLE after the test but before acquiring the lock.
481 spin_lock_irqsave(&ch
->collect_lock
, saveflags
);
482 if (fsm_getstate(ch
->fsm
) != CTC_STATE_TXIDLE
) {
483 int l
= skb
->len
+ LL_HEADER_LENGTH
;
485 if (ch
->collect_len
+ l
> ch
->max_bufsize
- 2) {
486 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
489 atomic_inc(&skb
->users
);
491 header
.type
= skb
->protocol
;
493 memcpy(skb_push(skb
, LL_HEADER_LENGTH
), &header
,
495 skb_queue_tail(&ch
->collect_queue
, skb
);
496 ch
->collect_len
+= l
;
498 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
501 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
503 * Protect skb against beeing free'd by upper
506 atomic_inc(&skb
->users
);
507 ch
->prof
.txlen
+= skb
->len
;
508 header
.length
= skb
->len
+ LL_HEADER_LENGTH
;
509 header
.type
= skb
->protocol
;
511 memcpy(skb_push(skb
, LL_HEADER_LENGTH
), &header
, LL_HEADER_LENGTH
);
512 block_len
= skb
->len
+ 2;
513 *((__u16
*)skb_push(skb
, 2)) = block_len
;
516 * IDAL support in CTCM is broken, so we have to
517 * care about skb's above 2G ourselves.
519 hi
= ((unsigned long)skb_tail_pointer(skb
) + LL_HEADER_LENGTH
) >> 31;
521 nskb
= alloc_skb(skb
->len
, GFP_ATOMIC
| GFP_DMA
);
523 atomic_dec(&skb
->users
);
524 skb_pull(skb
, LL_HEADER_LENGTH
+ 2);
525 ctcm_clear_busy(ch
->netdev
);
528 memcpy(skb_put(nskb
, skb
->len
), skb
->data
, skb
->len
);
529 atomic_inc(&nskb
->users
);
530 atomic_dec(&skb
->users
);
531 dev_kfree_skb_irq(skb
);
536 ch
->ccw
[4].count
= block_len
;
537 if (set_normalized_cda(&ch
->ccw
[4], skb
->data
)) {
539 * idal allocation failed, try via copying to
540 * trans_skb. trans_skb usually has a pre-allocated
543 if (ctcm_checkalloc_buffer(ch
)) {
545 * Remove our header. It gets added
546 * again on retransmit.
548 atomic_dec(&skb
->users
);
549 skb_pull(skb
, LL_HEADER_LENGTH
+ 2);
550 ctcm_clear_busy(ch
->netdev
);
554 skb_reset_tail_pointer(ch
->trans_skb
);
555 ch
->trans_skb
->len
= 0;
556 ch
->ccw
[1].count
= skb
->len
;
557 skb_copy_from_linear_data(skb
,
558 skb_put(ch
->trans_skb
, skb
->len
), skb
->len
);
559 atomic_dec(&skb
->users
);
560 dev_kfree_skb_irq(skb
);
563 skb_queue_tail(&ch
->io_queue
, skb
);
567 fsm_newstate(ch
->fsm
, CTC_STATE_TX
);
568 fsm_addtimer(&ch
->timer
, CTCM_TIME_5_SEC
, CTC_EVENT_TIMER
, ch
);
569 spin_lock_irqsave(get_ccwdev_lock(ch
->cdev
), saveflags
);
570 ch
->prof
.send_stamp
= current_kernel_time(); /* xtime */
571 rc
= ccw_device_start(ch
->cdev
, &ch
->ccw
[ccw_idx
],
572 (unsigned long)ch
, 0xff, 0);
573 spin_unlock_irqrestore(get_ccwdev_lock(ch
->cdev
), saveflags
);
575 ch
->prof
.doios_single
++;
577 fsm_deltimer(&ch
->timer
);
578 ctcm_ccw_check_rc(ch
, rc
, "single skb TX");
580 skb_dequeue_tail(&ch
->io_queue
);
582 * Remove our header. It gets added
583 * again on retransmit.
585 skb_pull(skb
, LL_HEADER_LENGTH
+ 2);
586 } else if (ccw_idx
== 0) {
587 struct net_device
*dev
= ch
->netdev
;
588 struct ctcm_priv
*priv
= dev
->ml_priv
;
589 priv
->stats
.tx_packets
++;
590 priv
->stats
.tx_bytes
+= skb
->len
- LL_HEADER_LENGTH
;
593 ctcm_clear_busy(ch
->netdev
);
597 static void ctcmpc_send_sweep_req(struct channel
*rch
)
599 struct net_device
*dev
= rch
->netdev
;
600 struct ctcm_priv
*priv
;
601 struct mpc_group
*grp
;
602 struct th_sweep
*header
;
603 struct sk_buff
*sweep_skb
;
609 ch
= priv
->channel
[CTCM_WRITE
];
611 /* sweep processing is not complete until response and request */
612 /* has completed for all read channels in group */
613 if (grp
->in_sweep
== 0) {
615 grp
->sweep_rsp_pend_num
= grp
->active_channels
[CTCM_READ
];
616 grp
->sweep_req_pend_num
= grp
->active_channels
[CTCM_READ
];
619 sweep_skb
= __dev_alloc_skb(MPC_BUFSIZE_DEFAULT
, GFP_ATOMIC
|GFP_DMA
);
621 if (sweep_skb
== NULL
) {
626 header
= kmalloc(TH_SWEEP_LENGTH
, gfp_type());
629 dev_kfree_skb_any(sweep_skb
);
634 header
->th
.th_seg
= 0x00 ;
635 header
->th
.th_ch_flag
= TH_SWEEP_REQ
; /* 0x0f */
636 header
->th
.th_blk_flag
= 0x00;
637 header
->th
.th_is_xid
= 0x00;
638 header
->th
.th_seq_num
= 0x00;
639 header
->sw
.th_last_seq
= ch
->th_seq_num
;
641 memcpy(skb_put(sweep_skb
, TH_SWEEP_LENGTH
), header
, TH_SWEEP_LENGTH
);
645 dev
->trans_start
= jiffies
;
646 skb_queue_tail(&ch
->sweep_queue
, sweep_skb
);
648 fsm_addtimer(&ch
->sweep_timer
, 100, CTC_EVENT_RSWEEP_TIMER
, ch
);
654 ctcm_clear_busy(dev
);
655 fsm_event(grp
->fsm
, MPCG_EVENT_INOP
, dev
);
661 * MPC mode version of transmit_skb
663 static int ctcmpc_transmit_skb(struct channel
*ch
, struct sk_buff
*skb
)
665 struct pdu
*p_header
;
666 struct net_device
*dev
= ch
->netdev
;
667 struct ctcm_priv
*priv
= dev
->ml_priv
;
668 struct mpc_group
*grp
= priv
->mpcg
;
669 struct th_header
*header
;
670 struct sk_buff
*nskb
;
674 unsigned long saveflags
= 0; /* avoids compiler warning */
676 CTCM_PR_DEBUG("Enter %s: %s, cp=%i ch=0x%p id=%s state=%s\n",
677 __func__
, dev
->name
, smp_processor_id(), ch
,
678 ch
->id
, fsm_getstate_str(ch
->fsm
));
680 if ((fsm_getstate(ch
->fsm
) != CTC_STATE_TXIDLE
) || grp
->in_sweep
) {
681 spin_lock_irqsave(&ch
->collect_lock
, saveflags
);
682 atomic_inc(&skb
->users
);
683 p_header
= kmalloc(PDU_HEADER_LENGTH
, gfp_type());
686 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
690 p_header
->pdu_offset
= skb
->len
;
691 p_header
->pdu_proto
= 0x01;
692 p_header
->pdu_flag
= 0x00;
693 if (skb
->protocol
== ntohs(ETH_P_SNAP
)) {
694 p_header
->pdu_flag
|= PDU_FIRST
| PDU_CNTL
;
696 p_header
->pdu_flag
|= PDU_FIRST
;
698 p_header
->pdu_seq
= 0;
699 memcpy(skb_push(skb
, PDU_HEADER_LENGTH
), p_header
,
702 CTCM_PR_DEBUG("%s(%s): Put on collect_q - skb len: %04x \n"
703 "pdu header and data for up to 32 bytes:\n",
704 __func__
, dev
->name
, skb
->len
);
705 CTCM_D3_DUMP((char *)skb
->data
, min_t(int, 32, skb
->len
));
707 skb_queue_tail(&ch
->collect_queue
, skb
);
708 ch
->collect_len
+= skb
->len
;
711 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
716 * Protect skb against beeing free'd by upper
719 atomic_inc(&skb
->users
);
722 * IDAL support in CTCM is broken, so we have to
723 * care about skb's above 2G ourselves.
725 hi
= ((unsigned long)skb
->tail
+ TH_HEADER_LENGTH
) >> 31;
727 nskb
= __dev_alloc_skb(skb
->len
, GFP_ATOMIC
| GFP_DMA
);
731 memcpy(skb_put(nskb
, skb
->len
), skb
->data
, skb
->len
);
732 atomic_inc(&nskb
->users
);
733 atomic_dec(&skb
->users
);
734 dev_kfree_skb_irq(skb
);
739 p_header
= kmalloc(PDU_HEADER_LENGTH
, gfp_type());
744 p_header
->pdu_offset
= skb
->len
;
745 p_header
->pdu_proto
= 0x01;
746 p_header
->pdu_flag
= 0x00;
747 p_header
->pdu_seq
= 0;
748 if (skb
->protocol
== ntohs(ETH_P_SNAP
)) {
749 p_header
->pdu_flag
|= PDU_FIRST
| PDU_CNTL
;
751 p_header
->pdu_flag
|= PDU_FIRST
;
753 memcpy(skb_push(skb
, PDU_HEADER_LENGTH
), p_header
, PDU_HEADER_LENGTH
);
757 if (ch
->collect_len
> 0) {
758 spin_lock_irqsave(&ch
->collect_lock
, saveflags
);
759 skb_queue_tail(&ch
->collect_queue
, skb
);
760 ch
->collect_len
+= skb
->len
;
761 skb
= skb_dequeue(&ch
->collect_queue
);
762 ch
->collect_len
-= skb
->len
;
763 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
766 p_header
= (struct pdu
*)skb
->data
;
767 p_header
->pdu_flag
|= PDU_LAST
;
769 ch
->prof
.txlen
+= skb
->len
- PDU_HEADER_LENGTH
;
771 header
= kmalloc(TH_HEADER_LENGTH
, gfp_type());
775 header
->th_seg
= 0x00;
776 header
->th_ch_flag
= TH_HAS_PDU
; /* Normal data */
777 header
->th_blk_flag
= 0x00;
778 header
->th_is_xid
= 0x00; /* Just data here */
780 header
->th_seq_num
= ch
->th_seq_num
;
782 CTCM_PR_DBGDATA("%s(%s) ToVTAM_th_seq= %08x\n" ,
783 __func__
, dev
->name
, ch
->th_seq_num
);
785 /* put the TH on the packet */
786 memcpy(skb_push(skb
, TH_HEADER_LENGTH
), header
, TH_HEADER_LENGTH
);
790 CTCM_PR_DBGDATA("%s(%s): skb len: %04x\n - pdu header and data for "
791 "up to 32 bytes sent to vtam:\n",
792 __func__
, dev
->name
, skb
->len
);
793 CTCM_D3_DUMP((char *)skb
->data
, min_t(int, 32, skb
->len
));
795 ch
->ccw
[4].count
= skb
->len
;
796 if (set_normalized_cda(&ch
->ccw
[4], skb
->data
)) {
798 * idal allocation failed, try via copying to trans_skb.
799 * trans_skb usually has a pre-allocated idal.
801 if (ctcm_checkalloc_buffer(ch
)) {
804 * It gets added again on retransmit.
809 skb_reset_tail_pointer(ch
->trans_skb
);
810 ch
->trans_skb
->len
= 0;
811 ch
->ccw
[1].count
= skb
->len
;
812 memcpy(skb_put(ch
->trans_skb
, skb
->len
), skb
->data
, skb
->len
);
813 atomic_dec(&skb
->users
);
814 dev_kfree_skb_irq(skb
);
816 CTCM_PR_DBGDATA("%s(%s): trans_skb len: %04x\n"
817 "up to 32 bytes sent to vtam:\n",
818 __func__
, dev
->name
, ch
->trans_skb
->len
);
819 CTCM_D3_DUMP((char *)ch
->trans_skb
->data
,
820 min_t(int, 32, ch
->trans_skb
->len
));
822 skb_queue_tail(&ch
->io_queue
, skb
);
826 fsm_newstate(ch
->fsm
, CTC_STATE_TX
);
827 fsm_addtimer(&ch
->timer
, CTCM_TIME_5_SEC
, CTC_EVENT_TIMER
, ch
);
830 ctcmpc_dumpit((char *)&ch
->ccw
[ccw_idx
],
831 sizeof(struct ccw1
) * 3);
833 spin_lock_irqsave(get_ccwdev_lock(ch
->cdev
), saveflags
);
834 ch
->prof
.send_stamp
= current_kernel_time(); /* xtime */
835 rc
= ccw_device_start(ch
->cdev
, &ch
->ccw
[ccw_idx
],
836 (unsigned long)ch
, 0xff, 0);
837 spin_unlock_irqrestore(get_ccwdev_lock(ch
->cdev
), saveflags
);
839 ch
->prof
.doios_single
++;
841 fsm_deltimer(&ch
->timer
);
842 ctcm_ccw_check_rc(ch
, rc
, "single skb TX");
844 skb_dequeue_tail(&ch
->io_queue
);
845 } else if (ccw_idx
== 0) {
846 priv
->stats
.tx_packets
++;
847 priv
->stats
.tx_bytes
+= skb
->len
- TH_HEADER_LENGTH
;
849 if (ch
->th_seq_num
> 0xf0000000) /* Chose at random. */
850 ctcmpc_send_sweep_req(ch
);
854 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_CRIT
,
855 "%s(%s): MEMORY allocation ERROR\n",
856 CTCM_FUNTAIL
, ch
->id
);
858 atomic_dec(&skb
->users
);
859 dev_kfree_skb_any(skb
);
860 fsm_event(priv
->mpcg
->fsm
, MPCG_EVENT_INOP
, dev
);
862 CTCM_PR_DEBUG("Exit %s(%s)\n", __func__
, dev
->name
);
867 * Start transmission of a packet.
868 * Called from generic network device layer.
870 * skb Pointer to buffer containing the packet.
871 * dev Pointer to interface struct.
873 * returns 0 if packet consumed, !0 if packet rejected.
874 * Note: If we return !0, then the packet is free'd by
875 * the generic network layer.
877 /* first merge version - leaving both functions separated */
878 static int ctcm_tx(struct sk_buff
*skb
, struct net_device
*dev
)
880 struct ctcm_priv
*priv
= dev
->ml_priv
;
883 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
884 "%s(%s): NULL sk_buff passed",
885 CTCM_FUNTAIL
, dev
->name
);
886 priv
->stats
.tx_dropped
++;
889 if (skb_headroom(skb
) < (LL_HEADER_LENGTH
+ 2)) {
890 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
891 "%s(%s): Got sk_buff with head room < %ld bytes",
892 CTCM_FUNTAIL
, dev
->name
, LL_HEADER_LENGTH
+ 2);
894 priv
->stats
.tx_dropped
++;
899 * If channels are not running, try to restart them
900 * and throw away packet.
902 if (fsm_getstate(priv
->fsm
) != DEV_STATE_RUNNING
) {
903 fsm_event(priv
->fsm
, DEV_EVENT_START
, dev
);
905 priv
->stats
.tx_dropped
++;
906 priv
->stats
.tx_errors
++;
907 priv
->stats
.tx_carrier_errors
++;
911 if (ctcm_test_and_set_busy(dev
))
912 return NETDEV_TX_BUSY
;
914 dev
->trans_start
= jiffies
;
915 if (ctcm_transmit_skb(priv
->channel
[CTCM_WRITE
], skb
) != 0)
916 return NETDEV_TX_BUSY
;
920 /* unmerged MPC variant of ctcm_tx */
921 static int ctcmpc_tx(struct sk_buff
*skb
, struct net_device
*dev
)
924 struct ctcm_priv
*priv
= dev
->ml_priv
;
925 struct mpc_group
*grp
= priv
->mpcg
;
926 struct sk_buff
*newskb
= NULL
;
929 * Some sanity checks ...
932 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_ERROR
,
933 "%s(%s): NULL sk_buff passed",
934 CTCM_FUNTAIL
, dev
->name
);
935 priv
->stats
.tx_dropped
++;
938 if (skb_headroom(skb
) < (TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
)) {
939 CTCM_DBF_TEXT_(MPC_TRACE
, CTC_DBF_ERROR
,
940 "%s(%s): Got sk_buff with head room < %ld bytes",
941 CTCM_FUNTAIL
, dev
->name
,
942 TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
);
944 CTCM_D3_DUMP((char *)skb
->data
, min_t(int, 32, skb
->len
));
946 len
= skb
->len
+ TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
;
947 newskb
= __dev_alloc_skb(len
, gfp_type() | GFP_DMA
);
950 CTCM_DBF_TEXT_(MPC_TRACE
, CTC_DBF_ERROR
,
951 "%s: %s: __dev_alloc_skb failed",
952 __func__
, dev
->name
);
954 dev_kfree_skb_any(skb
);
955 priv
->stats
.tx_dropped
++;
956 priv
->stats
.tx_errors
++;
957 priv
->stats
.tx_carrier_errors
++;
958 fsm_event(grp
->fsm
, MPCG_EVENT_INOP
, dev
);
961 newskb
->protocol
= skb
->protocol
;
962 skb_reserve(newskb
, TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
);
963 memcpy(skb_put(newskb
, skb
->len
), skb
->data
, skb
->len
);
964 dev_kfree_skb_any(skb
);
969 * If channels are not running,
970 * notify anybody about a link failure and throw
973 if ((fsm_getstate(priv
->fsm
) != DEV_STATE_RUNNING
) ||
974 (fsm_getstate(grp
->fsm
) < MPCG_STATE_XID2INITW
)) {
975 dev_kfree_skb_any(skb
);
976 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_ERROR
,
977 "%s(%s): inactive MPCGROUP - dropped",
978 CTCM_FUNTAIL
, dev
->name
);
979 priv
->stats
.tx_dropped
++;
980 priv
->stats
.tx_errors
++;
981 priv
->stats
.tx_carrier_errors
++;
985 if (ctcm_test_and_set_busy(dev
)) {
986 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_ERROR
,
987 "%s(%s): device busy - dropped",
988 CTCM_FUNTAIL
, dev
->name
);
989 dev_kfree_skb_any(skb
);
990 priv
->stats
.tx_dropped
++;
991 priv
->stats
.tx_errors
++;
992 priv
->stats
.tx_carrier_errors
++;
993 fsm_event(grp
->fsm
, MPCG_EVENT_INOP
, dev
);
997 dev
->trans_start
= jiffies
;
998 if (ctcmpc_transmit_skb(priv
->channel
[CTCM_WRITE
], skb
) != 0) {
999 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_ERROR
,
1000 "%s(%s): device error - dropped",
1001 CTCM_FUNTAIL
, dev
->name
);
1002 dev_kfree_skb_any(skb
);
1003 priv
->stats
.tx_dropped
++;
1004 priv
->stats
.tx_errors
++;
1005 priv
->stats
.tx_carrier_errors
++;
1006 ctcm_clear_busy(dev
);
1007 fsm_event(grp
->fsm
, MPCG_EVENT_INOP
, dev
);
1010 ctcm_clear_busy(dev
);
1013 MPC_DBF_DEV_NAME(TRACE
, dev
, "exit");
1015 return NETDEV_TX_OK
; /* handle freeing of skb here */
1020 * Sets MTU of an interface.
1022 * dev Pointer to interface struct.
1023 * new_mtu The new MTU to use for this interface.
1025 * returns 0 on success, -EINVAL if MTU is out of valid range.
1026 * (valid range is 576 .. 65527). If VM is on the
1027 * remote side, maximum MTU is 32760, however this is
1030 static int ctcm_change_mtu(struct net_device
*dev
, int new_mtu
)
1032 struct ctcm_priv
*priv
;
1035 if (new_mtu
< 576 || new_mtu
> 65527)
1038 priv
= dev
->ml_priv
;
1039 max_bufsize
= priv
->channel
[CTCM_READ
]->max_bufsize
;
1042 if (new_mtu
> max_bufsize
- TH_HEADER_LENGTH
)
1044 dev
->hard_header_len
= TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
;
1046 if (new_mtu
> max_bufsize
- LL_HEADER_LENGTH
- 2)
1048 dev
->hard_header_len
= LL_HEADER_LENGTH
+ 2;
1055 * Returns interface statistics of a device.
1057 * dev Pointer to interface struct.
1059 * returns Pointer to stats struct of this interface.
1061 static struct net_device_stats
*ctcm_stats(struct net_device
*dev
)
1063 return &((struct ctcm_priv
*)dev
->ml_priv
)->stats
;
1066 static void ctcm_free_netdevice(struct net_device
*dev
)
1068 struct ctcm_priv
*priv
;
1069 struct mpc_group
*grp
;
1071 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1072 "%s(%s)", CTCM_FUNTAIL
, dev
->name
);
1073 priv
= dev
->ml_priv
;
1078 kfree_fsm(grp
->fsm
);
1080 dev_kfree_skb(grp
->xid_skb
);
1081 if (grp
->rcvd_xid_skb
)
1082 dev_kfree_skb(grp
->rcvd_xid_skb
);
1083 tasklet_kill(&grp
->mpc_tasklet2
);
1088 kfree_fsm(priv
->fsm
);
1094 * Note: kfree(priv); is done in "opposite" function of
1095 * allocator function probe_device which is remove_device.
1103 struct mpc_group
*ctcmpc_init_mpc_group(struct ctcm_priv
*priv
);
1105 static const struct net_device_ops ctcm_netdev_ops
= {
1106 .ndo_open
= ctcm_open
,
1107 .ndo_stop
= ctcm_close
,
1108 .ndo_get_stats
= ctcm_stats
,
1109 .ndo_change_mtu
= ctcm_change_mtu
,
1110 .ndo_start_xmit
= ctcm_tx
,
1113 static const struct net_device_ops ctcm_mpc_netdev_ops
= {
1114 .ndo_open
= ctcm_open
,
1115 .ndo_stop
= ctcm_close
,
1116 .ndo_get_stats
= ctcm_stats
,
1117 .ndo_change_mtu
= ctcm_change_mtu
,
1118 .ndo_start_xmit
= ctcmpc_tx
,
1121 void static ctcm_dev_setup(struct net_device
*dev
)
1123 dev
->type
= ARPHRD_SLIP
;
1124 dev
->tx_queue_len
= 100;
1125 dev
->flags
= IFF_POINTOPOINT
| IFF_NOARP
;
1129 * Initialize everything of the net device except the name and the
1132 static struct net_device
*ctcm_init_netdevice(struct ctcm_priv
*priv
)
1134 struct net_device
*dev
;
1135 struct mpc_group
*grp
;
1140 dev
= alloc_netdev(0, MPC_DEVICE_GENE
, ctcm_dev_setup
);
1142 dev
= alloc_netdev(0, CTC_DEVICE_GENE
, ctcm_dev_setup
);
1145 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_CRIT
,
1146 "%s: MEMORY allocation ERROR",
1150 dev
->ml_priv
= priv
;
1151 priv
->fsm
= init_fsm("ctcmdev", dev_state_names
, dev_event_names
,
1152 CTCM_NR_DEV_STATES
, CTCM_NR_DEV_EVENTS
,
1153 dev_fsm
, dev_fsm_len
, GFP_KERNEL
);
1154 if (priv
->fsm
== NULL
) {
1155 CTCMY_DBF_DEV(SETUP
, dev
, "init_fsm error");
1159 fsm_newstate(priv
->fsm
, DEV_STATE_STOPPED
);
1160 fsm_settimer(priv
->fsm
, &priv
->restart_timer
);
1163 /* MPC Group Initializations */
1164 grp
= ctcmpc_init_mpc_group(priv
);
1166 MPC_DBF_DEV(SETUP
, dev
, "init_mpc_group error");
1170 tasklet_init(&grp
->mpc_tasklet2
,
1171 mpc_group_ready
, (unsigned long)dev
);
1172 dev
->mtu
= MPC_BUFSIZE_DEFAULT
-
1173 TH_HEADER_LENGTH
- PDU_HEADER_LENGTH
;
1175 dev
->netdev_ops
= &ctcm_mpc_netdev_ops
;
1176 dev
->hard_header_len
= TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
;
1177 priv
->buffer_size
= MPC_BUFSIZE_DEFAULT
;
1179 dev
->mtu
= CTCM_BUFSIZE_DEFAULT
- LL_HEADER_LENGTH
- 2;
1180 dev
->netdev_ops
= &ctcm_netdev_ops
;
1181 dev
->hard_header_len
= LL_HEADER_LENGTH
+ 2;
1184 CTCMY_DBF_DEV(SETUP
, dev
, "finished");
1192 * cdev The ccw_device the interrupt is for.
1193 * intparm interruption parameter.
1194 * irb interruption response block.
1196 static void ctcm_irq_handler(struct ccw_device
*cdev
,
1197 unsigned long intparm
, struct irb
*irb
)
1200 struct net_device
*dev
;
1201 struct ctcm_priv
*priv
;
1202 struct ccwgroup_device
*cgdev
;
1206 kstat_cpu(smp_processor_id()).irqs
[IOINT_CTC
]++;
1207 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_DEBUG
,
1208 "Enter %s(%s)", CTCM_FUNTAIL
, dev_name(&cdev
->dev
));
1210 if (ctcm_check_irb_error(cdev
, irb
))
1213 cgdev
= dev_get_drvdata(&cdev
->dev
);
1215 cstat
= irb
->scsw
.cmd
.cstat
;
1216 dstat
= irb
->scsw
.cmd
.dstat
;
1218 /* Check for unsolicited interrupts. */
1219 if (cgdev
== NULL
) {
1220 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_ERROR
,
1221 "%s(%s) unsolicited irq: c-%02x d-%02x\n",
1222 CTCM_FUNTAIL
, dev_name(&cdev
->dev
), cstat
, dstat
);
1223 dev_warn(&cdev
->dev
,
1224 "The adapter received a non-specific IRQ\n");
1228 priv
= dev_get_drvdata(&cgdev
->dev
);
1230 /* Try to extract channel from driver data. */
1231 if (priv
->channel
[CTCM_READ
]->cdev
== cdev
)
1232 ch
= priv
->channel
[CTCM_READ
];
1233 else if (priv
->channel
[CTCM_WRITE
]->cdev
== cdev
)
1234 ch
= priv
->channel
[CTCM_WRITE
];
1237 "%s: Internal error: Can't determine channel for "
1238 "interrupt device %s\n",
1239 __func__
, dev_name(&cdev
->dev
));
1240 /* Explain: inconsistent internal structures */
1247 "%s Internal error: net_device is NULL, ch = 0x%p\n",
1249 /* Explain: inconsistent internal structures */
1253 /* Copy interruption response block. */
1254 memcpy(ch
->irb
, irb
, sizeof(struct irb
));
1256 /* Issue error message and return on subchannel error code */
1257 if (irb
->scsw
.cmd
.cstat
) {
1258 fsm_event(ch
->fsm
, CTC_EVENT_SC_UNKNOWN
, ch
);
1259 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
1260 "%s(%s): sub-ch check %s: cs=%02x ds=%02x",
1261 CTCM_FUNTAIL
, dev
->name
, ch
->id
, cstat
, dstat
);
1262 dev_warn(&cdev
->dev
,
1263 "A check occurred on the subchannel\n");
1267 /* Check the reason-code of a unit check */
1268 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_UNIT_CHECK
) {
1269 if ((irb
->ecw
[0] & ch
->sense_rc
) == 0)
1270 /* print it only once */
1271 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
1272 "%s(%s): sense=%02x, ds=%02x",
1273 CTCM_FUNTAIL
, ch
->id
, irb
->ecw
[0], dstat
);
1274 ccw_unit_check(ch
, irb
->ecw
[0]);
1277 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_BUSY
) {
1278 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_ATTENTION
)
1279 fsm_event(ch
->fsm
, CTC_EVENT_ATTNBUSY
, ch
);
1281 fsm_event(ch
->fsm
, CTC_EVENT_BUSY
, ch
);
1284 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_ATTENTION
) {
1285 fsm_event(ch
->fsm
, CTC_EVENT_ATTN
, ch
);
1288 if ((irb
->scsw
.cmd
.stctl
& SCSW_STCTL_SEC_STATUS
) ||
1289 (irb
->scsw
.cmd
.stctl
== SCSW_STCTL_STATUS_PEND
) ||
1290 (irb
->scsw
.cmd
.stctl
==
1291 (SCSW_STCTL_ALERT_STATUS
| SCSW_STCTL_STATUS_PEND
)))
1292 fsm_event(ch
->fsm
, CTC_EVENT_FINSTAT
, ch
);
1294 fsm_event(ch
->fsm
, CTC_EVENT_IRQ
, ch
);
1299 * Add ctcm specific attributes.
1300 * Add ctcm private data.
1302 * cgdev pointer to ccwgroup_device just added
1304 * returns 0 on success, !0 on failure.
1306 static int ctcm_probe_device(struct ccwgroup_device
*cgdev
)
1308 struct ctcm_priv
*priv
;
1311 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1315 if (!get_device(&cgdev
->dev
))
1318 priv
= kzalloc(sizeof(struct ctcm_priv
), GFP_KERNEL
);
1320 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
1321 "%s: memory allocation failure",
1323 put_device(&cgdev
->dev
);
1327 rc
= ctcm_add_files(&cgdev
->dev
);
1330 put_device(&cgdev
->dev
);
1333 priv
->buffer_size
= CTCM_BUFSIZE_DEFAULT
;
1334 cgdev
->cdev
[0]->handler
= ctcm_irq_handler
;
1335 cgdev
->cdev
[1]->handler
= ctcm_irq_handler
;
1336 dev_set_drvdata(&cgdev
->dev
, priv
);
1342 * Add a new channel to the list of channels.
1343 * Keeps the channel list sorted.
1345 * cdev The ccw_device to be added.
1346 * type The type class of the new channel.
1347 * priv Points to the private data of the ccwgroup_device.
1349 * returns 0 on success, !0 on error.
1351 static int add_channel(struct ccw_device
*cdev
, enum ctcm_channel_types type
,
1352 struct ctcm_priv
*priv
)
1354 struct channel
**c
= &channels
;
1359 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1360 "%s(%s), type %d, proto %d",
1361 __func__
, dev_name(&cdev
->dev
), type
, priv
->protocol
);
1363 ch
= kzalloc(sizeof(struct channel
), GFP_KERNEL
);
1367 ch
->protocol
= priv
->protocol
;
1369 ch
->discontact_th
= kzalloc(TH_HEADER_LENGTH
, gfp_type());
1370 if (ch
->discontact_th
== NULL
)
1373 ch
->discontact_th
->th_blk_flag
= TH_DISCONTACT
;
1374 tasklet_init(&ch
->ch_disc_tasklet
,
1375 mpc_action_send_discontact
, (unsigned long)ch
);
1377 tasklet_init(&ch
->ch_tasklet
, ctcmpc_bh
, (unsigned long)ch
);
1378 ch
->max_bufsize
= (MPC_BUFSIZE_DEFAULT
- 35);
1383 ch
->ccw
= kzalloc(ccw_num
* sizeof(struct ccw1
), GFP_KERNEL
| GFP_DMA
);
1384 if (ch
->ccw
== NULL
)
1388 snprintf(ch
->id
, CTCM_ID_SIZE
, "ch-%s", dev_name(&cdev
->dev
));
1392 * "static" ccws are used in the following way:
1394 * ccw[0..2] (Channel program for generic I/O):
1396 * 1: read or write (depending on direction) with fixed
1397 * buffer (idal allocated once when buffer is allocated)
1399 * ccw[3..5] (Channel program for direct write of packets)
1401 * 4: write (idal allocated on every write).
1403 * ccw[6..7] (Channel program for initial channel setup):
1404 * 6: set extended mode
1407 * ch->ccw[0..5] are initialized in ch_action_start because
1408 * the channel's direction is yet unknown here.
1410 * ccws used for xid2 negotiations
1411 * ch-ccw[8-14] need to be used for the XID exchange either
1412 * X side XID2 Processing
1416 * 11: read th from secondary
1417 * 12: read XID from secondary
1418 * 13: read 4 byte ID
1420 * Y side XID Processing
1426 * 13: write 4 byte ID
1429 * ccws used for double noop due to VM timing issues
1430 * which result in unrecoverable Busy on channel
1434 ch
->ccw
[6].cmd_code
= CCW_CMD_SET_EXTENDED
;
1435 ch
->ccw
[6].flags
= CCW_FLAG_SLI
;
1437 ch
->ccw
[7].cmd_code
= CCW_CMD_NOOP
;
1438 ch
->ccw
[7].flags
= CCW_FLAG_SLI
;
1441 ch
->ccw
[15].cmd_code
= CCW_CMD_WRITE
;
1442 ch
->ccw
[15].flags
= CCW_FLAG_SLI
| CCW_FLAG_CC
;
1443 ch
->ccw
[15].count
= TH_HEADER_LENGTH
;
1444 ch
->ccw
[15].cda
= virt_to_phys(ch
->discontact_th
);
1446 ch
->ccw
[16].cmd_code
= CCW_CMD_NOOP
;
1447 ch
->ccw
[16].flags
= CCW_FLAG_SLI
;
1449 ch
->fsm
= init_fsm(ch
->id
, ctc_ch_state_names
,
1450 ctc_ch_event_names
, CTC_MPC_NR_STATES
,
1451 CTC_MPC_NR_EVENTS
, ctcmpc_ch_fsm
,
1452 mpc_ch_fsm_len
, GFP_KERNEL
);
1454 ch
->fsm
= init_fsm(ch
->id
, ctc_ch_state_names
,
1455 ctc_ch_event_names
, CTC_NR_STATES
,
1456 CTC_NR_EVENTS
, ch_fsm
,
1457 ch_fsm_len
, GFP_KERNEL
);
1459 if (ch
->fsm
== NULL
)
1462 fsm_newstate(ch
->fsm
, CTC_STATE_IDLE
);
1464 ch
->irb
= kzalloc(sizeof(struct irb
), GFP_KERNEL
);
1465 if (ch
->irb
== NULL
)
1468 while (*c
&& ctcm_less_than((*c
)->id
, ch
->id
))
1471 if (*c
&& (!strncmp((*c
)->id
, ch
->id
, CTCM_ID_SIZE
))) {
1472 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1473 "%s (%s) already in list, using old entry",
1474 __func__
, (*c
)->id
);
1479 spin_lock_init(&ch
->collect_lock
);
1481 fsm_settimer(ch
->fsm
, &ch
->timer
);
1482 skb_queue_head_init(&ch
->io_queue
);
1483 skb_queue_head_init(&ch
->collect_queue
);
1486 fsm_settimer(ch
->fsm
, &ch
->sweep_timer
);
1487 skb_queue_head_init(&ch
->sweep_queue
);
1496 free_return
: /* note that all channel pointers are 0 or valid */
1498 kfree(ch
->discontact_th
);
1506 * Return type of a detected device.
1508 static enum ctcm_channel_types
get_channel_type(struct ccw_device_id
*id
)
1510 enum ctcm_channel_types type
;
1511 type
= (enum ctcm_channel_types
)id
->driver_info
;
1513 if (type
== ctcm_channel_type_ficon
)
1514 type
= ctcm_channel_type_escon
;
1521 * Setup an interface.
1523 * cgdev Device to be setup.
1525 * returns 0 on success, !0 on failure.
1527 static int ctcm_new_device(struct ccwgroup_device
*cgdev
)
1529 char read_id
[CTCM_ID_SIZE
];
1530 char write_id
[CTCM_ID_SIZE
];
1532 enum ctcm_channel_types type
;
1533 struct ctcm_priv
*priv
;
1534 struct net_device
*dev
;
1535 struct ccw_device
*cdev0
;
1536 struct ccw_device
*cdev1
;
1537 struct channel
*readc
;
1538 struct channel
*writec
;
1542 priv
= dev_get_drvdata(&cgdev
->dev
);
1545 goto out_err_result
;
1548 cdev0
= cgdev
->cdev
[0];
1549 cdev1
= cgdev
->cdev
[1];
1551 type
= get_channel_type(&cdev0
->id
);
1553 snprintf(read_id
, CTCM_ID_SIZE
, "ch-%s", dev_name(&cdev0
->dev
));
1554 snprintf(write_id
, CTCM_ID_SIZE
, "ch-%s", dev_name(&cdev1
->dev
));
1556 ret
= add_channel(cdev0
, type
, priv
);
1559 goto out_err_result
;
1561 ret
= add_channel(cdev1
, type
, priv
);
1564 goto out_remove_channel1
;
1567 ret
= ccw_device_set_online(cdev0
);
1569 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_NOTICE
,
1570 "%s(%s) set_online rc=%d",
1571 CTCM_FUNTAIL
, read_id
, ret
);
1573 goto out_remove_channel2
;
1576 ret
= ccw_device_set_online(cdev1
);
1578 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_NOTICE
,
1579 "%s(%s) set_online rc=%d",
1580 CTCM_FUNTAIL
, write_id
, ret
);
1586 dev
= ctcm_init_netdevice(priv
);
1592 for (direction
= CTCM_READ
; direction
<= CTCM_WRITE
; direction
++) {
1593 priv
->channel
[direction
] =
1594 channel_get(type
, direction
== CTCM_READ
?
1595 read_id
: write_id
, direction
);
1596 if (priv
->channel
[direction
] == NULL
) {
1597 if (direction
== CTCM_WRITE
)
1598 channel_free(priv
->channel
[CTCM_READ
]);
1601 priv
->channel
[direction
]->netdev
= dev
;
1602 priv
->channel
[direction
]->protocol
= priv
->protocol
;
1603 priv
->channel
[direction
]->max_bufsize
= priv
->buffer_size
;
1606 SET_NETDEV_DEV(dev
, &cgdev
->dev
);
1608 if (register_netdev(dev
)) {
1613 if (ctcm_add_attributes(&cgdev
->dev
)) {
1615 goto out_unregister
;
1618 strlcpy(priv
->fsm
->name
, dev
->name
, sizeof(priv
->fsm
->name
));
1621 "setup OK : r/w = %s/%s, protocol : %d\n",
1622 priv
->channel
[CTCM_READ
]->id
,
1623 priv
->channel
[CTCM_WRITE
]->id
, priv
->protocol
);
1625 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1626 "setup(%s) OK : r/w = %s/%s, protocol : %d", dev
->name
,
1627 priv
->channel
[CTCM_READ
]->id
,
1628 priv
->channel
[CTCM_WRITE
]->id
, priv
->protocol
);
1632 unregister_netdev(dev
);
1634 ctcm_free_netdevice(dev
);
1636 ccw_device_set_offline(cgdev
->cdev
[1]);
1638 ccw_device_set_offline(cgdev
->cdev
[0]);
1639 out_remove_channel2
:
1640 readc
= channel_get(type
, read_id
, CTCM_READ
);
1641 channel_remove(readc
);
1642 out_remove_channel1
:
1643 writec
= channel_get(type
, write_id
, CTCM_WRITE
);
1644 channel_remove(writec
);
1650 * Shutdown an interface.
1652 * cgdev Device to be shut down.
1654 * returns 0 on success, !0 on failure.
1656 static int ctcm_shutdown_device(struct ccwgroup_device
*cgdev
)
1658 struct ctcm_priv
*priv
;
1659 struct net_device
*dev
;
1661 priv
= dev_get_drvdata(&cgdev
->dev
);
1665 if (priv
->channel
[CTCM_READ
]) {
1666 dev
= priv
->channel
[CTCM_READ
]->netdev
;
1667 CTCM_DBF_DEV(SETUP
, dev
, "");
1668 /* Close the device */
1670 dev
->flags
&= ~IFF_RUNNING
;
1671 ctcm_remove_attributes(&cgdev
->dev
);
1672 channel_free(priv
->channel
[CTCM_READ
]);
1676 if (priv
->channel
[CTCM_WRITE
])
1677 channel_free(priv
->channel
[CTCM_WRITE
]);
1680 unregister_netdev(dev
);
1681 ctcm_free_netdevice(dev
);
1685 kfree_fsm(priv
->fsm
);
1687 ccw_device_set_offline(cgdev
->cdev
[1]);
1688 ccw_device_set_offline(cgdev
->cdev
[0]);
1690 if (priv
->channel
[CTCM_READ
])
1691 channel_remove(priv
->channel
[CTCM_READ
]);
1692 if (priv
->channel
[CTCM_WRITE
])
1693 channel_remove(priv
->channel
[CTCM_WRITE
]);
1694 priv
->channel
[CTCM_READ
] = priv
->channel
[CTCM_WRITE
] = NULL
;
1701 static void ctcm_remove_device(struct ccwgroup_device
*cgdev
)
1703 struct ctcm_priv
*priv
= dev_get_drvdata(&cgdev
->dev
);
1705 BUG_ON(priv
== NULL
);
1707 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1708 "removing device %p, proto : %d",
1709 cgdev
, priv
->protocol
);
1711 if (cgdev
->state
== CCWGROUP_ONLINE
)
1712 ctcm_shutdown_device(cgdev
);
1713 ctcm_remove_files(&cgdev
->dev
);
1714 dev_set_drvdata(&cgdev
->dev
, NULL
);
1716 put_device(&cgdev
->dev
);
1719 static int ctcm_pm_suspend(struct ccwgroup_device
*gdev
)
1721 struct ctcm_priv
*priv
= dev_get_drvdata(&gdev
->dev
);
1723 if (gdev
->state
== CCWGROUP_OFFLINE
)
1725 netif_device_detach(priv
->channel
[CTCM_READ
]->netdev
);
1726 ctcm_close(priv
->channel
[CTCM_READ
]->netdev
);
1727 if (!wait_event_timeout(priv
->fsm
->wait_q
,
1728 fsm_getstate(priv
->fsm
) == DEV_STATE_STOPPED
, CTCM_TIME_5_SEC
)) {
1729 netif_device_attach(priv
->channel
[CTCM_READ
]->netdev
);
1732 ccw_device_set_offline(gdev
->cdev
[1]);
1733 ccw_device_set_offline(gdev
->cdev
[0]);
1737 static int ctcm_pm_resume(struct ccwgroup_device
*gdev
)
1739 struct ctcm_priv
*priv
= dev_get_drvdata(&gdev
->dev
);
1742 if (gdev
->state
== CCWGROUP_OFFLINE
)
1744 rc
= ccw_device_set_online(gdev
->cdev
[1]);
1747 rc
= ccw_device_set_online(gdev
->cdev
[0]);
1750 ctcm_open(priv
->channel
[CTCM_READ
]->netdev
);
1752 netif_device_attach(priv
->channel
[CTCM_READ
]->netdev
);
1756 static struct ccw_device_id ctcm_ids
[] = {
1757 {CCW_DEVICE(0x3088, 0x08), .driver_info
= ctcm_channel_type_parallel
},
1758 {CCW_DEVICE(0x3088, 0x1e), .driver_info
= ctcm_channel_type_ficon
},
1759 {CCW_DEVICE(0x3088, 0x1f), .driver_info
= ctcm_channel_type_escon
},
1762 MODULE_DEVICE_TABLE(ccw
, ctcm_ids
);
1764 static struct ccw_driver ctcm_ccw_driver
= {
1766 .owner
= THIS_MODULE
,
1770 .probe
= ccwgroup_probe_ccwdev
,
1771 .remove
= ccwgroup_remove_ccwdev
,
1774 static struct ccwgroup_driver ctcm_group_driver
= {
1776 .owner
= THIS_MODULE
,
1777 .name
= CTC_DRIVER_NAME
,
1780 .driver_id
= 0xC3E3C3D4, /* CTCM */
1781 .probe
= ctcm_probe_device
,
1782 .remove
= ctcm_remove_device
,
1783 .set_online
= ctcm_new_device
,
1784 .set_offline
= ctcm_shutdown_device
,
1785 .freeze
= ctcm_pm_suspend
,
1786 .thaw
= ctcm_pm_resume
,
1787 .restore
= ctcm_pm_resume
,
1791 ctcm_driver_group_store(struct device_driver
*ddrv
, const char *buf
,
1796 err
= ccwgroup_create_from_string(ctcm_root_dev
,
1797 ctcm_group_driver
.driver_id
,
1798 &ctcm_ccw_driver
, 2, buf
);
1799 return err
? err
: count
;
1802 static DRIVER_ATTR(group
, 0200, NULL
, ctcm_driver_group_store
);
1804 static struct attribute
*ctcm_group_attrs
[] = {
1805 &driver_attr_group
.attr
,
1809 static struct attribute_group ctcm_group_attr_group
= {
1810 .attrs
= ctcm_group_attrs
,
1813 static const struct attribute_group
*ctcm_group_attr_groups
[] = {
1814 &ctcm_group_attr_group
,
1819 * Module related routines
1823 * Prepare to be unloaded. Free IRQ's and release all resources.
1824 * This is called just before this module is unloaded. It is
1825 * not called, if the usage count is !0, so we don't need to check
1828 static void __exit
ctcm_exit(void)
1830 driver_remove_file(&ctcm_group_driver
.driver
, &driver_attr_group
);
1831 ccwgroup_driver_unregister(&ctcm_group_driver
);
1832 ccw_driver_unregister(&ctcm_ccw_driver
);
1833 root_device_unregister(ctcm_root_dev
);
1834 ctcm_unregister_dbf_views();
1835 pr_info("CTCM driver unloaded\n");
1841 static void print_banner(void)
1843 pr_info("CTCM driver initialized\n");
1847 * Initialize module.
1848 * This is called just after the module is loaded.
1850 * returns 0 on success, !0 on error.
1852 static int __init
ctcm_init(void)
1858 ret
= ctcm_register_dbf_views();
1861 ctcm_root_dev
= root_device_register("ctcm");
1862 ret
= IS_ERR(ctcm_root_dev
) ? PTR_ERR(ctcm_root_dev
) : 0;
1865 ret
= ccw_driver_register(&ctcm_ccw_driver
);
1868 ctcm_group_driver
.driver
.groups
= ctcm_group_attr_groups
;
1869 ret
= ccwgroup_driver_register(&ctcm_group_driver
);
1876 ccw_driver_unregister(&ctcm_ccw_driver
);
1878 root_device_unregister(ctcm_root_dev
);
1880 ctcm_unregister_dbf_views();
1882 pr_err("%s / Initializing the ctcm device driver failed, ret = %d\n",
1887 module_init(ctcm_init
);
1888 module_exit(ctcm_exit
);
1890 MODULE_AUTHOR("Peter Tiedemann <ptiedem@de.ibm.com>");
1891 MODULE_DESCRIPTION("Network driver for S/390 CTC + CTCMPC (SNA)");
1892 MODULE_LICENSE("GPL");