2 * Copyright IBM Corp. 2001, 2009
4 * Original CTC driver(s):
5 * Fritz Elfert (felfert@millenux.com)
6 * Dieter Wellerdiek (wel@de.ibm.com)
7 * Martin Schwidefsky (schwidefsky@de.ibm.com)
8 * Denis Joseph Barrow (barrow_dj@yahoo.com)
9 * Jochen Roehrig (roehrig@de.ibm.com)
10 * Cornelia Huck <cornelia.huck@de.ibm.com>
12 * Belinda Thompson (belindat@us.ibm.com)
13 * Andy Richter (richtera@us.ibm.com)
15 * Peter Tiedemann (ptiedem@de.ibm.com)
22 #define KMSG_COMPONENT "ctcm"
23 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
25 #include <linux/module.h>
26 #include <linux/init.h>
27 #include <linux/kernel.h>
28 #include <linux/slab.h>
29 #include <linux/errno.h>
30 #include <linux/types.h>
31 #include <linux/interrupt.h>
32 #include <linux/timer.h>
33 #include <linux/bitops.h>
35 #include <linux/signal.h>
36 #include <linux/string.h>
39 #include <linux/if_arp.h>
40 #include <linux/tcp.h>
41 #include <linux/skbuff.h>
42 #include <linux/ctype.h>
46 #include <asm/ccwdev.h>
47 #include <asm/ccwgroup.h>
48 #include <linux/uaccess.h>
50 #include <asm/idals.h>
52 #include "ctcm_fsms.h"
53 #include "ctcm_main.h"
55 /* Some common global variables */
58 * The root device for ctcm group devices
60 static struct device
*ctcm_root_dev
;
63 * Linked list of all detected channels.
65 struct channel
*channels
;
68 * Unpack a just received skb and hand it over to
71 * ch The channel where this skb has been received.
72 * pskb The received skb.
74 void ctcm_unpack_skb(struct channel
*ch
, struct sk_buff
*pskb
)
76 struct net_device
*dev
= ch
->netdev
;
77 struct ctcm_priv
*priv
= dev
->ml_priv
;
78 __u16 len
= *((__u16
*) pskb
->data
);
80 skb_put(pskb
, 2 + LL_HEADER_LENGTH
);
83 pskb
->ip_summed
= CHECKSUM_UNNECESSARY
;
87 struct ll_header
*header
= (struct ll_header
*)pskb
->data
;
89 skb_pull(pskb
, LL_HEADER_LENGTH
);
90 if ((ch
->protocol
== CTCM_PROTO_S390
) &&
91 (header
->type
!= ETH_P_IP
)) {
92 if (!(ch
->logflags
& LOG_FLAG_ILLEGALPKT
)) {
93 ch
->logflags
|= LOG_FLAG_ILLEGALPKT
;
95 * Check packet type only if we stick strictly
96 * to S/390's protocol of OS390. This only
97 * supports IP. Otherwise allow any packet
100 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
101 "%s(%s): Illegal packet type 0x%04x"
103 CTCM_FUNTAIL
, dev
->name
, header
->type
);
105 priv
->stats
.rx_dropped
++;
106 priv
->stats
.rx_frame_errors
++;
109 pskb
->protocol
= ntohs(header
->type
);
110 if ((header
->length
<= LL_HEADER_LENGTH
) ||
111 (len
<= LL_HEADER_LENGTH
)) {
112 if (!(ch
->logflags
& LOG_FLAG_ILLEGALSIZE
)) {
113 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
114 "%s(%s): Illegal packet size %d(%d,%d)"
116 CTCM_FUNTAIL
, dev
->name
,
117 header
->length
, dev
->mtu
, len
);
118 ch
->logflags
|= LOG_FLAG_ILLEGALSIZE
;
121 priv
->stats
.rx_dropped
++;
122 priv
->stats
.rx_length_errors
++;
125 header
->length
-= LL_HEADER_LENGTH
;
126 len
-= LL_HEADER_LENGTH
;
127 if ((header
->length
> skb_tailroom(pskb
)) ||
128 (header
->length
> len
)) {
129 if (!(ch
->logflags
& LOG_FLAG_OVERRUN
)) {
130 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
131 "%s(%s): Packet size %d (overrun)"
132 " - dropping", CTCM_FUNTAIL
,
133 dev
->name
, header
->length
);
134 ch
->logflags
|= LOG_FLAG_OVERRUN
;
137 priv
->stats
.rx_dropped
++;
138 priv
->stats
.rx_length_errors
++;
141 skb_put(pskb
, header
->length
);
142 skb_reset_mac_header(pskb
);
143 len
-= header
->length
;
144 skb
= dev_alloc_skb(pskb
->len
);
146 if (!(ch
->logflags
& LOG_FLAG_NOMEM
)) {
147 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
148 "%s(%s): MEMORY allocation error",
149 CTCM_FUNTAIL
, dev
->name
);
150 ch
->logflags
|= LOG_FLAG_NOMEM
;
152 priv
->stats
.rx_dropped
++;
155 skb_copy_from_linear_data(pskb
, skb_put(skb
, pskb
->len
),
157 skb_reset_mac_header(skb
);
158 skb
->dev
= pskb
->dev
;
159 skb
->protocol
= pskb
->protocol
;
160 pskb
->ip_summed
= CHECKSUM_UNNECESSARY
;
166 priv
->stats
.rx_packets
++;
167 priv
->stats
.rx_bytes
+= skblen
;
170 skb_pull(pskb
, header
->length
);
171 if (skb_tailroom(pskb
) < LL_HEADER_LENGTH
) {
172 CTCM_DBF_DEV_NAME(TRACE
, dev
,
173 "Overrun in ctcm_unpack_skb");
174 ch
->logflags
|= LOG_FLAG_OVERRUN
;
177 skb_put(pskb
, LL_HEADER_LENGTH
);
183 * Release a specific channel in the channel list.
185 * ch Pointer to channel struct to be released.
187 static void channel_free(struct channel
*ch
)
189 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
, "%s(%s)", CTCM_FUNTAIL
, ch
->id
);
190 ch
->flags
&= ~CHANNEL_FLAGS_INUSE
;
191 fsm_newstate(ch
->fsm
, CTC_STATE_IDLE
);
195 * Remove a specific channel in the channel list.
197 * ch Pointer to channel struct to be released.
199 static void channel_remove(struct channel
*ch
)
201 struct channel
**c
= &channels
;
202 char chid
[CTCM_ID_SIZE
+1];
208 strncpy(chid
, ch
->id
, CTCM_ID_SIZE
);
214 fsm_deltimer(&ch
->timer
);
216 fsm_deltimer(&ch
->sweep_timer
);
219 clear_normalized_cda(&ch
->ccw
[4]);
220 if (ch
->trans_skb
!= NULL
) {
221 clear_normalized_cda(&ch
->ccw
[1]);
222 dev_kfree_skb_any(ch
->trans_skb
);
225 tasklet_kill(&ch
->ch_tasklet
);
226 tasklet_kill(&ch
->ch_disc_tasklet
);
227 kfree(ch
->discontact_th
);
238 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
, "%s(%s) %s", CTCM_FUNTAIL
,
239 chid
, ok
? "OK" : "failed");
243 * Get a specific channel from the channel list.
245 * type Type of channel we are interested in.
246 * id Id of channel we are interested in.
247 * direction Direction we want to use this channel for.
249 * returns Pointer to a channel or NULL if no matching channel available.
251 static struct channel
*channel_get(enum ctcm_channel_types type
,
252 char *id
, int direction
)
254 struct channel
*ch
= channels
;
256 while (ch
&& (strncmp(ch
->id
, id
, CTCM_ID_SIZE
) || (ch
->type
!= type
)))
259 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
260 "%s(%d, %s, %d) not found in channel list\n",
261 CTCM_FUNTAIL
, type
, id
, direction
);
263 if (ch
->flags
& CHANNEL_FLAGS_INUSE
)
266 ch
->flags
|= CHANNEL_FLAGS_INUSE
;
267 ch
->flags
&= ~CHANNEL_FLAGS_RWMASK
;
268 ch
->flags
|= (direction
== CTCM_WRITE
)
269 ? CHANNEL_FLAGS_WRITE
: CHANNEL_FLAGS_READ
;
270 fsm_newstate(ch
->fsm
, CTC_STATE_STOPPED
);
276 static long ctcm_check_irb_error(struct ccw_device
*cdev
, struct irb
*irb
)
281 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_WARN
,
282 "irb error %ld on device %s\n",
283 PTR_ERR(irb
), dev_name(&cdev
->dev
));
285 switch (PTR_ERR(irb
)) {
288 "An I/O-error occurred on the CTCM device\n");
292 "An adapter hardware operation timed out\n");
296 "An error occurred on the adapter hardware\n");
303 * Check sense of a unit check.
305 * ch The channel, the sense code belongs to.
306 * sense The sense code to inspect.
308 static inline void ccw_unit_check(struct channel
*ch
, __u8 sense
)
310 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_DEBUG
,
312 CTCM_FUNTAIL
, ch
->id
, sense
);
314 if (sense
& SNS0_INTERVENTION_REQ
) {
316 if (ch
->sense_rc
!= 0x01) {
318 "%s: The communication peer has "
319 "disconnected\n", ch
->id
);
322 fsm_event(ch
->fsm
, CTC_EVENT_UC_RCRESET
, ch
);
324 if (ch
->sense_rc
!= SNS0_INTERVENTION_REQ
) {
326 "%s: The remote operating system is "
327 "not available\n", ch
->id
);
328 ch
->sense_rc
= SNS0_INTERVENTION_REQ
;
330 fsm_event(ch
->fsm
, CTC_EVENT_UC_RSRESET
, ch
);
332 } else if (sense
& SNS0_EQUIPMENT_CHECK
) {
333 if (sense
& SNS0_BUS_OUT_CHECK
) {
334 if (ch
->sense_rc
!= SNS0_BUS_OUT_CHECK
) {
335 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
336 "%s(%s): remote HW error %02x",
337 CTCM_FUNTAIL
, ch
->id
, sense
);
338 ch
->sense_rc
= SNS0_BUS_OUT_CHECK
;
340 fsm_event(ch
->fsm
, CTC_EVENT_UC_HWFAIL
, ch
);
342 if (ch
->sense_rc
!= SNS0_EQUIPMENT_CHECK
) {
343 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
344 "%s(%s): remote read parity error %02x",
345 CTCM_FUNTAIL
, ch
->id
, sense
);
346 ch
->sense_rc
= SNS0_EQUIPMENT_CHECK
;
348 fsm_event(ch
->fsm
, CTC_EVENT_UC_RXPARITY
, ch
);
350 } else if (sense
& SNS0_BUS_OUT_CHECK
) {
351 if (ch
->sense_rc
!= SNS0_BUS_OUT_CHECK
) {
352 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
353 "%s(%s): BUS OUT error %02x",
354 CTCM_FUNTAIL
, ch
->id
, sense
);
355 ch
->sense_rc
= SNS0_BUS_OUT_CHECK
;
357 if (sense
& 0x04) /* data-streaming timeout */
358 fsm_event(ch
->fsm
, CTC_EVENT_UC_TXTIMEOUT
, ch
);
359 else /* Data-transfer parity error */
360 fsm_event(ch
->fsm
, CTC_EVENT_UC_TXPARITY
, ch
);
361 } else if (sense
& SNS0_CMD_REJECT
) {
362 if (ch
->sense_rc
!= SNS0_CMD_REJECT
) {
363 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
364 "%s(%s): Command rejected",
365 CTCM_FUNTAIL
, ch
->id
);
366 ch
->sense_rc
= SNS0_CMD_REJECT
;
368 } else if (sense
== 0) {
369 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
370 "%s(%s): Unit check ZERO",
371 CTCM_FUNTAIL
, ch
->id
);
372 fsm_event(ch
->fsm
, CTC_EVENT_UC_ZERO
, ch
);
374 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
375 "%s(%s): Unit check code %02x unknown",
376 CTCM_FUNTAIL
, ch
->id
, sense
);
377 fsm_event(ch
->fsm
, CTC_EVENT_UC_UNKNOWN
, ch
);
381 int ctcm_ch_alloc_buffer(struct channel
*ch
)
383 clear_normalized_cda(&ch
->ccw
[1]);
384 ch
->trans_skb
= __dev_alloc_skb(ch
->max_bufsize
, GFP_ATOMIC
| GFP_DMA
);
385 if (ch
->trans_skb
== NULL
) {
386 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
387 "%s(%s): %s trans_skb allocation error",
388 CTCM_FUNTAIL
, ch
->id
,
389 (CHANNEL_DIRECTION(ch
->flags
) == CTCM_READ
) ?
394 ch
->ccw
[1].count
= ch
->max_bufsize
;
395 if (set_normalized_cda(&ch
->ccw
[1], ch
->trans_skb
->data
)) {
396 dev_kfree_skb(ch
->trans_skb
);
397 ch
->trans_skb
= NULL
;
398 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
399 "%s(%s): %s set norm_cda failed",
400 CTCM_FUNTAIL
, ch
->id
,
401 (CHANNEL_DIRECTION(ch
->flags
) == CTCM_READ
) ?
406 ch
->ccw
[1].count
= 0;
407 ch
->trans_skb_data
= ch
->trans_skb
->data
;
408 ch
->flags
&= ~CHANNEL_FLAGS_BUFSIZE_CHANGED
;
413 * Interface API for upper network layers
418 * Called from generic network layer when ifconfig up is run.
420 * dev Pointer to interface struct.
422 * returns 0 on success, -ERRNO on failure. (Never fails.)
424 int ctcm_open(struct net_device
*dev
)
426 struct ctcm_priv
*priv
= dev
->ml_priv
;
428 CTCMY_DBF_DEV_NAME(SETUP
, dev
, "");
430 fsm_event(priv
->fsm
, DEV_EVENT_START
, dev
);
435 * Close an interface.
436 * Called from generic network layer when ifconfig down is run.
438 * dev Pointer to interface struct.
440 * returns 0 on success, -ERRNO on failure. (Never fails.)
442 int ctcm_close(struct net_device
*dev
)
444 struct ctcm_priv
*priv
= dev
->ml_priv
;
446 CTCMY_DBF_DEV_NAME(SETUP
, dev
, "");
448 fsm_event(priv
->fsm
, DEV_EVENT_STOP
, dev
);
455 * This is a helper function for ctcm_tx().
457 * ch Channel to be used for sending.
458 * skb Pointer to struct sk_buff of packet to send.
459 * The linklevel header has already been set up
462 * returns 0 on success, -ERRNO on failure. (Never fails.)
464 static int ctcm_transmit_skb(struct channel
*ch
, struct sk_buff
*skb
)
466 unsigned long saveflags
;
467 struct ll_header header
;
471 struct sk_buff
*nskb
;
474 /* we need to acquire the lock for testing the state
475 * otherwise we can have an IRQ changing the state to
476 * TXIDLE after the test but before acquiring the lock.
478 spin_lock_irqsave(&ch
->collect_lock
, saveflags
);
479 if (fsm_getstate(ch
->fsm
) != CTC_STATE_TXIDLE
) {
480 int l
= skb
->len
+ LL_HEADER_LENGTH
;
482 if (ch
->collect_len
+ l
> ch
->max_bufsize
- 2) {
483 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
486 atomic_inc(&skb
->users
);
488 header
.type
= skb
->protocol
;
490 memcpy(skb_push(skb
, LL_HEADER_LENGTH
), &header
,
492 skb_queue_tail(&ch
->collect_queue
, skb
);
493 ch
->collect_len
+= l
;
495 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
498 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
500 * Protect skb against beeing free'd by upper
503 atomic_inc(&skb
->users
);
504 ch
->prof
.txlen
+= skb
->len
;
505 header
.length
= skb
->len
+ LL_HEADER_LENGTH
;
506 header
.type
= skb
->protocol
;
508 memcpy(skb_push(skb
, LL_HEADER_LENGTH
), &header
, LL_HEADER_LENGTH
);
509 block_len
= skb
->len
+ 2;
510 *((__u16
*)skb_push(skb
, 2)) = block_len
;
513 * IDAL support in CTCM is broken, so we have to
514 * care about skb's above 2G ourselves.
516 hi
= ((unsigned long)skb_tail_pointer(skb
) + LL_HEADER_LENGTH
) >> 31;
518 nskb
= alloc_skb(skb
->len
, GFP_ATOMIC
| GFP_DMA
);
520 atomic_dec(&skb
->users
);
521 skb_pull(skb
, LL_HEADER_LENGTH
+ 2);
522 ctcm_clear_busy(ch
->netdev
);
525 memcpy(skb_put(nskb
, skb
->len
), skb
->data
, skb
->len
);
526 atomic_inc(&nskb
->users
);
527 atomic_dec(&skb
->users
);
528 dev_kfree_skb_irq(skb
);
533 ch
->ccw
[4].count
= block_len
;
534 if (set_normalized_cda(&ch
->ccw
[4], skb
->data
)) {
536 * idal allocation failed, try via copying to
537 * trans_skb. trans_skb usually has a pre-allocated
540 if (ctcm_checkalloc_buffer(ch
)) {
542 * Remove our header. It gets added
543 * again on retransmit.
545 atomic_dec(&skb
->users
);
546 skb_pull(skb
, LL_HEADER_LENGTH
+ 2);
547 ctcm_clear_busy(ch
->netdev
);
551 skb_reset_tail_pointer(ch
->trans_skb
);
552 ch
->trans_skb
->len
= 0;
553 ch
->ccw
[1].count
= skb
->len
;
554 skb_copy_from_linear_data(skb
,
555 skb_put(ch
->trans_skb
, skb
->len
), skb
->len
);
556 atomic_dec(&skb
->users
);
557 dev_kfree_skb_irq(skb
);
560 skb_queue_tail(&ch
->io_queue
, skb
);
564 ctcmpc_dumpit((char *)&ch
->ccw
[ccw_idx
],
565 sizeof(struct ccw1
) * 3);
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 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_DEBUG
,
1207 "Enter %s(%s)", CTCM_FUNTAIL
, dev_name(&cdev
->dev
));
1209 if (ctcm_check_irb_error(cdev
, irb
))
1212 cgdev
= dev_get_drvdata(&cdev
->dev
);
1214 cstat
= irb
->scsw
.cmd
.cstat
;
1215 dstat
= irb
->scsw
.cmd
.dstat
;
1217 /* Check for unsolicited interrupts. */
1218 if (cgdev
== NULL
) {
1219 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_ERROR
,
1220 "%s(%s) unsolicited irq: c-%02x d-%02x\n",
1221 CTCM_FUNTAIL
, dev_name(&cdev
->dev
), cstat
, dstat
);
1222 dev_warn(&cdev
->dev
,
1223 "The adapter received a non-specific IRQ\n");
1227 priv
= dev_get_drvdata(&cgdev
->dev
);
1229 /* Try to extract channel from driver data. */
1230 if (priv
->channel
[CTCM_READ
]->cdev
== cdev
)
1231 ch
= priv
->channel
[CTCM_READ
];
1232 else if (priv
->channel
[CTCM_WRITE
]->cdev
== cdev
)
1233 ch
= priv
->channel
[CTCM_WRITE
];
1236 "%s: Internal error: Can't determine channel for "
1237 "interrupt device %s\n",
1238 __func__
, dev_name(&cdev
->dev
));
1239 /* Explain: inconsistent internal structures */
1246 "%s Internal error: net_device is NULL, ch = 0x%p\n",
1248 /* Explain: inconsistent internal structures */
1252 /* Copy interruption response block. */
1253 memcpy(ch
->irb
, irb
, sizeof(struct irb
));
1255 /* Issue error message and return on subchannel error code */
1256 if (irb
->scsw
.cmd
.cstat
) {
1257 fsm_event(ch
->fsm
, CTC_EVENT_SC_UNKNOWN
, ch
);
1258 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
1259 "%s(%s): sub-ch check %s: cs=%02x ds=%02x",
1260 CTCM_FUNTAIL
, dev
->name
, ch
->id
, cstat
, dstat
);
1261 dev_warn(&cdev
->dev
,
1262 "A check occurred on the subchannel\n");
1266 /* Check the reason-code of a unit check */
1267 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_UNIT_CHECK
) {
1268 if ((irb
->ecw
[0] & ch
->sense_rc
) == 0)
1269 /* print it only once */
1270 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
1271 "%s(%s): sense=%02x, ds=%02x",
1272 CTCM_FUNTAIL
, ch
->id
, irb
->ecw
[0], dstat
);
1273 ccw_unit_check(ch
, irb
->ecw
[0]);
1276 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_BUSY
) {
1277 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_ATTENTION
)
1278 fsm_event(ch
->fsm
, CTC_EVENT_ATTNBUSY
, ch
);
1280 fsm_event(ch
->fsm
, CTC_EVENT_BUSY
, ch
);
1283 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_ATTENTION
) {
1284 fsm_event(ch
->fsm
, CTC_EVENT_ATTN
, ch
);
1287 if ((irb
->scsw
.cmd
.stctl
& SCSW_STCTL_SEC_STATUS
) ||
1288 (irb
->scsw
.cmd
.stctl
== SCSW_STCTL_STATUS_PEND
) ||
1289 (irb
->scsw
.cmd
.stctl
==
1290 (SCSW_STCTL_ALERT_STATUS
| SCSW_STCTL_STATUS_PEND
)))
1291 fsm_event(ch
->fsm
, CTC_EVENT_FINSTAT
, ch
);
1293 fsm_event(ch
->fsm
, CTC_EVENT_IRQ
, ch
);
1297 static const struct device_type ctcm_devtype
= {
1299 .groups
= ctcm_attr_groups
,
1303 * Add ctcm specific attributes.
1304 * Add ctcm private data.
1306 * cgdev pointer to ccwgroup_device just added
1308 * returns 0 on success, !0 on failure.
1310 static int ctcm_probe_device(struct ccwgroup_device
*cgdev
)
1312 struct ctcm_priv
*priv
;
1314 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1318 if (!get_device(&cgdev
->dev
))
1321 priv
= kzalloc(sizeof(struct ctcm_priv
), GFP_KERNEL
);
1323 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
1324 "%s: memory allocation failure",
1326 put_device(&cgdev
->dev
);
1329 priv
->buffer_size
= CTCM_BUFSIZE_DEFAULT
;
1330 cgdev
->cdev
[0]->handler
= ctcm_irq_handler
;
1331 cgdev
->cdev
[1]->handler
= ctcm_irq_handler
;
1332 dev_set_drvdata(&cgdev
->dev
, priv
);
1333 cgdev
->dev
.type
= &ctcm_devtype
;
1339 * Add a new channel to the list of channels.
1340 * Keeps the channel list sorted.
1342 * cdev The ccw_device to be added.
1343 * type The type class of the new channel.
1344 * priv Points to the private data of the ccwgroup_device.
1346 * returns 0 on success, !0 on error.
1348 static int add_channel(struct ccw_device
*cdev
, enum ctcm_channel_types type
,
1349 struct ctcm_priv
*priv
)
1351 struct channel
**c
= &channels
;
1356 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1357 "%s(%s), type %d, proto %d",
1358 __func__
, dev_name(&cdev
->dev
), type
, priv
->protocol
);
1360 ch
= kzalloc(sizeof(struct channel
), GFP_KERNEL
);
1364 ch
->protocol
= priv
->protocol
;
1366 ch
->discontact_th
= kzalloc(TH_HEADER_LENGTH
, gfp_type());
1367 if (ch
->discontact_th
== NULL
)
1370 ch
->discontact_th
->th_blk_flag
= TH_DISCONTACT
;
1371 tasklet_init(&ch
->ch_disc_tasklet
,
1372 mpc_action_send_discontact
, (unsigned long)ch
);
1374 tasklet_init(&ch
->ch_tasklet
, ctcmpc_bh
, (unsigned long)ch
);
1375 ch
->max_bufsize
= (MPC_BUFSIZE_DEFAULT
- 35);
1380 ch
->ccw
= kzalloc(ccw_num
* sizeof(struct ccw1
), GFP_KERNEL
| GFP_DMA
);
1381 if (ch
->ccw
== NULL
)
1385 snprintf(ch
->id
, CTCM_ID_SIZE
, "ch-%s", dev_name(&cdev
->dev
));
1389 * "static" ccws are used in the following way:
1391 * ccw[0..2] (Channel program for generic I/O):
1393 * 1: read or write (depending on direction) with fixed
1394 * buffer (idal allocated once when buffer is allocated)
1396 * ccw[3..5] (Channel program for direct write of packets)
1398 * 4: write (idal allocated on every write).
1400 * ccw[6..7] (Channel program for initial channel setup):
1401 * 6: set extended mode
1404 * ch->ccw[0..5] are initialized in ch_action_start because
1405 * the channel's direction is yet unknown here.
1407 * ccws used for xid2 negotiations
1408 * ch-ccw[8-14] need to be used for the XID exchange either
1409 * X side XID2 Processing
1413 * 11: read th from secondary
1414 * 12: read XID from secondary
1415 * 13: read 4 byte ID
1417 * Y side XID Processing
1423 * 13: write 4 byte ID
1426 * ccws used for double noop due to VM timing issues
1427 * which result in unrecoverable Busy on channel
1431 ch
->ccw
[6].cmd_code
= CCW_CMD_SET_EXTENDED
;
1432 ch
->ccw
[6].flags
= CCW_FLAG_SLI
;
1434 ch
->ccw
[7].cmd_code
= CCW_CMD_NOOP
;
1435 ch
->ccw
[7].flags
= CCW_FLAG_SLI
;
1438 ch
->ccw
[15].cmd_code
= CCW_CMD_WRITE
;
1439 ch
->ccw
[15].flags
= CCW_FLAG_SLI
| CCW_FLAG_CC
;
1440 ch
->ccw
[15].count
= TH_HEADER_LENGTH
;
1441 ch
->ccw
[15].cda
= virt_to_phys(ch
->discontact_th
);
1443 ch
->ccw
[16].cmd_code
= CCW_CMD_NOOP
;
1444 ch
->ccw
[16].flags
= CCW_FLAG_SLI
;
1446 ch
->fsm
= init_fsm(ch
->id
, ctc_ch_state_names
,
1447 ctc_ch_event_names
, CTC_MPC_NR_STATES
,
1448 CTC_MPC_NR_EVENTS
, ctcmpc_ch_fsm
,
1449 mpc_ch_fsm_len
, GFP_KERNEL
);
1451 ch
->fsm
= init_fsm(ch
->id
, ctc_ch_state_names
,
1452 ctc_ch_event_names
, CTC_NR_STATES
,
1453 CTC_NR_EVENTS
, ch_fsm
,
1454 ch_fsm_len
, GFP_KERNEL
);
1456 if (ch
->fsm
== NULL
)
1459 fsm_newstate(ch
->fsm
, CTC_STATE_IDLE
);
1461 ch
->irb
= kzalloc(sizeof(struct irb
), GFP_KERNEL
);
1462 if (ch
->irb
== NULL
)
1465 while (*c
&& ctcm_less_than((*c
)->id
, ch
->id
))
1468 if (*c
&& (!strncmp((*c
)->id
, ch
->id
, CTCM_ID_SIZE
))) {
1469 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1470 "%s (%s) already in list, using old entry",
1471 __func__
, (*c
)->id
);
1476 spin_lock_init(&ch
->collect_lock
);
1478 fsm_settimer(ch
->fsm
, &ch
->timer
);
1479 skb_queue_head_init(&ch
->io_queue
);
1480 skb_queue_head_init(&ch
->collect_queue
);
1483 fsm_settimer(ch
->fsm
, &ch
->sweep_timer
);
1484 skb_queue_head_init(&ch
->sweep_queue
);
1493 free_return
: /* note that all channel pointers are 0 or valid */
1495 kfree(ch
->discontact_th
);
1503 * Return type of a detected device.
1505 static enum ctcm_channel_types
get_channel_type(struct ccw_device_id
*id
)
1507 enum ctcm_channel_types type
;
1508 type
= (enum ctcm_channel_types
)id
->driver_info
;
1510 if (type
== ctcm_channel_type_ficon
)
1511 type
= ctcm_channel_type_escon
;
1518 * Setup an interface.
1520 * cgdev Device to be setup.
1522 * returns 0 on success, !0 on failure.
1524 static int ctcm_new_device(struct ccwgroup_device
*cgdev
)
1526 char read_id
[CTCM_ID_SIZE
];
1527 char write_id
[CTCM_ID_SIZE
];
1529 enum ctcm_channel_types type
;
1530 struct ctcm_priv
*priv
;
1531 struct net_device
*dev
;
1532 struct ccw_device
*cdev0
;
1533 struct ccw_device
*cdev1
;
1534 struct channel
*readc
;
1535 struct channel
*writec
;
1539 priv
= dev_get_drvdata(&cgdev
->dev
);
1542 goto out_err_result
;
1545 cdev0
= cgdev
->cdev
[0];
1546 cdev1
= cgdev
->cdev
[1];
1548 type
= get_channel_type(&cdev0
->id
);
1550 snprintf(read_id
, CTCM_ID_SIZE
, "ch-%s", dev_name(&cdev0
->dev
));
1551 snprintf(write_id
, CTCM_ID_SIZE
, "ch-%s", dev_name(&cdev1
->dev
));
1553 ret
= add_channel(cdev0
, type
, priv
);
1556 goto out_err_result
;
1558 ret
= add_channel(cdev1
, type
, priv
);
1561 goto out_remove_channel1
;
1564 ret
= ccw_device_set_online(cdev0
);
1566 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_NOTICE
,
1567 "%s(%s) set_online rc=%d",
1568 CTCM_FUNTAIL
, read_id
, ret
);
1570 goto out_remove_channel2
;
1573 ret
= ccw_device_set_online(cdev1
);
1575 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_NOTICE
,
1576 "%s(%s) set_online rc=%d",
1577 CTCM_FUNTAIL
, write_id
, ret
);
1583 dev
= ctcm_init_netdevice(priv
);
1589 for (direction
= CTCM_READ
; direction
<= CTCM_WRITE
; direction
++) {
1590 priv
->channel
[direction
] =
1591 channel_get(type
, direction
== CTCM_READ
?
1592 read_id
: write_id
, direction
);
1593 if (priv
->channel
[direction
] == NULL
) {
1594 if (direction
== CTCM_WRITE
)
1595 channel_free(priv
->channel
[CTCM_READ
]);
1598 priv
->channel
[direction
]->netdev
= dev
;
1599 priv
->channel
[direction
]->protocol
= priv
->protocol
;
1600 priv
->channel
[direction
]->max_bufsize
= priv
->buffer_size
;
1603 SET_NETDEV_DEV(dev
, &cgdev
->dev
);
1605 if (register_netdev(dev
)) {
1610 strlcpy(priv
->fsm
->name
, dev
->name
, sizeof(priv
->fsm
->name
));
1613 "setup OK : r/w = %s/%s, protocol : %d\n",
1614 priv
->channel
[CTCM_READ
]->id
,
1615 priv
->channel
[CTCM_WRITE
]->id
, priv
->protocol
);
1617 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1618 "setup(%s) OK : r/w = %s/%s, protocol : %d", dev
->name
,
1619 priv
->channel
[CTCM_READ
]->id
,
1620 priv
->channel
[CTCM_WRITE
]->id
, priv
->protocol
);
1624 ctcm_free_netdevice(dev
);
1626 ccw_device_set_offline(cgdev
->cdev
[1]);
1628 ccw_device_set_offline(cgdev
->cdev
[0]);
1629 out_remove_channel2
:
1630 readc
= channel_get(type
, read_id
, CTCM_READ
);
1631 channel_remove(readc
);
1632 out_remove_channel1
:
1633 writec
= channel_get(type
, write_id
, CTCM_WRITE
);
1634 channel_remove(writec
);
1640 * Shutdown an interface.
1642 * cgdev Device to be shut down.
1644 * returns 0 on success, !0 on failure.
1646 static int ctcm_shutdown_device(struct ccwgroup_device
*cgdev
)
1648 struct ctcm_priv
*priv
;
1649 struct net_device
*dev
;
1651 priv
= dev_get_drvdata(&cgdev
->dev
);
1655 if (priv
->channel
[CTCM_READ
]) {
1656 dev
= priv
->channel
[CTCM_READ
]->netdev
;
1657 CTCM_DBF_DEV(SETUP
, dev
, "");
1658 /* Close the device */
1660 dev
->flags
&= ~IFF_RUNNING
;
1661 channel_free(priv
->channel
[CTCM_READ
]);
1665 if (priv
->channel
[CTCM_WRITE
])
1666 channel_free(priv
->channel
[CTCM_WRITE
]);
1669 unregister_netdev(dev
);
1670 ctcm_free_netdevice(dev
);
1674 kfree_fsm(priv
->fsm
);
1676 ccw_device_set_offline(cgdev
->cdev
[1]);
1677 ccw_device_set_offline(cgdev
->cdev
[0]);
1679 if (priv
->channel
[CTCM_READ
])
1680 channel_remove(priv
->channel
[CTCM_READ
]);
1681 if (priv
->channel
[CTCM_WRITE
])
1682 channel_remove(priv
->channel
[CTCM_WRITE
]);
1683 priv
->channel
[CTCM_READ
] = priv
->channel
[CTCM_WRITE
] = NULL
;
1690 static void ctcm_remove_device(struct ccwgroup_device
*cgdev
)
1692 struct ctcm_priv
*priv
= dev_get_drvdata(&cgdev
->dev
);
1694 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1695 "removing device %p, proto : %d",
1696 cgdev
, priv
->protocol
);
1698 if (cgdev
->state
== CCWGROUP_ONLINE
)
1699 ctcm_shutdown_device(cgdev
);
1700 dev_set_drvdata(&cgdev
->dev
, NULL
);
1702 put_device(&cgdev
->dev
);
1705 static int ctcm_pm_suspend(struct ccwgroup_device
*gdev
)
1707 struct ctcm_priv
*priv
= dev_get_drvdata(&gdev
->dev
);
1709 if (gdev
->state
== CCWGROUP_OFFLINE
)
1711 netif_device_detach(priv
->channel
[CTCM_READ
]->netdev
);
1712 ctcm_close(priv
->channel
[CTCM_READ
]->netdev
);
1713 if (!wait_event_timeout(priv
->fsm
->wait_q
,
1714 fsm_getstate(priv
->fsm
) == DEV_STATE_STOPPED
, CTCM_TIME_5_SEC
)) {
1715 netif_device_attach(priv
->channel
[CTCM_READ
]->netdev
);
1718 ccw_device_set_offline(gdev
->cdev
[1]);
1719 ccw_device_set_offline(gdev
->cdev
[0]);
1723 static int ctcm_pm_resume(struct ccwgroup_device
*gdev
)
1725 struct ctcm_priv
*priv
= dev_get_drvdata(&gdev
->dev
);
1728 if (gdev
->state
== CCWGROUP_OFFLINE
)
1730 rc
= ccw_device_set_online(gdev
->cdev
[1]);
1733 rc
= ccw_device_set_online(gdev
->cdev
[0]);
1736 ctcm_open(priv
->channel
[CTCM_READ
]->netdev
);
1738 netif_device_attach(priv
->channel
[CTCM_READ
]->netdev
);
1742 static struct ccw_device_id ctcm_ids
[] = {
1743 {CCW_DEVICE(0x3088, 0x08), .driver_info
= ctcm_channel_type_parallel
},
1744 {CCW_DEVICE(0x3088, 0x1e), .driver_info
= ctcm_channel_type_ficon
},
1745 {CCW_DEVICE(0x3088, 0x1f), .driver_info
= ctcm_channel_type_escon
},
1748 MODULE_DEVICE_TABLE(ccw
, ctcm_ids
);
1750 static struct ccw_driver ctcm_ccw_driver
= {
1752 .owner
= THIS_MODULE
,
1756 .probe
= ccwgroup_probe_ccwdev
,
1757 .remove
= ccwgroup_remove_ccwdev
,
1758 .int_class
= IRQIO_CTC
,
1761 static struct ccwgroup_driver ctcm_group_driver
= {
1763 .owner
= THIS_MODULE
,
1764 .name
= CTC_DRIVER_NAME
,
1766 .setup
= ctcm_probe_device
,
1767 .remove
= ctcm_remove_device
,
1768 .set_online
= ctcm_new_device
,
1769 .set_offline
= ctcm_shutdown_device
,
1770 .freeze
= ctcm_pm_suspend
,
1771 .thaw
= ctcm_pm_resume
,
1772 .restore
= ctcm_pm_resume
,
1775 static ssize_t
ctcm_driver_group_store(struct device_driver
*ddrv
,
1776 const char *buf
, size_t count
)
1780 err
= ccwgroup_create_dev(ctcm_root_dev
, &ctcm_group_driver
, 2, buf
);
1781 return err
? err
: count
;
1783 static DRIVER_ATTR(group
, 0200, NULL
, ctcm_driver_group_store
);
1785 static struct attribute
*ctcm_drv_attrs
[] = {
1786 &driver_attr_group
.attr
,
1789 static struct attribute_group ctcm_drv_attr_group
= {
1790 .attrs
= ctcm_drv_attrs
,
1792 static const struct attribute_group
*ctcm_drv_attr_groups
[] = {
1793 &ctcm_drv_attr_group
,
1798 * Module related routines
1802 * Prepare to be unloaded. Free IRQ's and release all resources.
1803 * This is called just before this module is unloaded. It is
1804 * not called, if the usage count is !0, so we don't need to check
1807 static void __exit
ctcm_exit(void)
1809 ccwgroup_driver_unregister(&ctcm_group_driver
);
1810 ccw_driver_unregister(&ctcm_ccw_driver
);
1811 root_device_unregister(ctcm_root_dev
);
1812 ctcm_unregister_dbf_views();
1813 pr_info("CTCM driver unloaded\n");
1819 static void print_banner(void)
1821 pr_info("CTCM driver initialized\n");
1825 * Initialize module.
1826 * This is called just after the module is loaded.
1828 * returns 0 on success, !0 on error.
1830 static int __init
ctcm_init(void)
1836 ret
= ctcm_register_dbf_views();
1839 ctcm_root_dev
= root_device_register("ctcm");
1840 ret
= PTR_RET(ctcm_root_dev
);
1843 ret
= ccw_driver_register(&ctcm_ccw_driver
);
1846 ctcm_group_driver
.driver
.groups
= ctcm_drv_attr_groups
;
1847 ret
= ccwgroup_driver_register(&ctcm_group_driver
);
1854 ccw_driver_unregister(&ctcm_ccw_driver
);
1856 root_device_unregister(ctcm_root_dev
);
1858 ctcm_unregister_dbf_views();
1860 pr_err("%s / Initializing the ctcm device driver failed, ret = %d\n",
1865 module_init(ctcm_init
);
1866 module_exit(ctcm_exit
);
1868 MODULE_AUTHOR("Peter Tiedemann <ptiedem@de.ibm.com>");
1869 MODULE_DESCRIPTION("Network driver for S/390 CTC + CTCMPC (SNA)");
1870 MODULE_LICENSE("GPL");