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/module.h>
28 #include <linux/init.h>
29 #include <linux/kernel.h>
30 #include <linux/slab.h>
31 #include <linux/errno.h>
32 #include <linux/types.h>
33 #include <linux/interrupt.h>
34 #include <linux/timer.h>
35 #include <linux/bitops.h>
37 #include <linux/signal.h>
38 #include <linux/string.h>
41 #include <linux/if_arp.h>
42 #include <linux/tcp.h>
43 #include <linux/skbuff.h>
44 #include <linux/ctype.h>
48 #include <asm/ccwdev.h>
49 #include <asm/ccwgroup.h>
50 #include <linux/uaccess.h>
52 #include <asm/idals.h>
54 #include "ctcm_fsms.h"
55 #include "ctcm_main.h"
57 /* Some common global variables */
60 * The root device for ctcm group devices
62 static struct device
*ctcm_root_dev
;
65 * Linked list of all detected channels.
67 struct channel
*channels
;
70 * Unpack a just received skb and hand it over to
73 * ch The channel where this skb has been received.
74 * pskb The received skb.
76 void ctcm_unpack_skb(struct channel
*ch
, struct sk_buff
*pskb
)
78 struct net_device
*dev
= ch
->netdev
;
79 struct ctcm_priv
*priv
= dev
->ml_priv
;
80 __u16 len
= *((__u16
*) pskb
->data
);
82 skb_put(pskb
, 2 + LL_HEADER_LENGTH
);
85 pskb
->ip_summed
= CHECKSUM_UNNECESSARY
;
89 struct ll_header
*header
= (struct ll_header
*)pskb
->data
;
91 skb_pull(pskb
, LL_HEADER_LENGTH
);
92 if ((ch
->protocol
== CTCM_PROTO_S390
) &&
93 (header
->type
!= ETH_P_IP
)) {
94 if (!(ch
->logflags
& LOG_FLAG_ILLEGALPKT
)) {
95 ch
->logflags
|= LOG_FLAG_ILLEGALPKT
;
97 * Check packet type only if we stick strictly
98 * to S/390's protocol of OS390. This only
99 * supports IP. Otherwise allow any packet
102 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
103 "%s(%s): Illegal packet type 0x%04x"
105 CTCM_FUNTAIL
, dev
->name
, header
->type
);
107 priv
->stats
.rx_dropped
++;
108 priv
->stats
.rx_frame_errors
++;
111 pskb
->protocol
= ntohs(header
->type
);
112 if ((header
->length
<= LL_HEADER_LENGTH
) ||
113 (len
<= LL_HEADER_LENGTH
)) {
114 if (!(ch
->logflags
& LOG_FLAG_ILLEGALSIZE
)) {
115 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
116 "%s(%s): Illegal packet size %d(%d,%d)"
118 CTCM_FUNTAIL
, dev
->name
,
119 header
->length
, dev
->mtu
, len
);
120 ch
->logflags
|= LOG_FLAG_ILLEGALSIZE
;
123 priv
->stats
.rx_dropped
++;
124 priv
->stats
.rx_length_errors
++;
127 header
->length
-= LL_HEADER_LENGTH
;
128 len
-= LL_HEADER_LENGTH
;
129 if ((header
->length
> skb_tailroom(pskb
)) ||
130 (header
->length
> len
)) {
131 if (!(ch
->logflags
& LOG_FLAG_OVERRUN
)) {
132 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
133 "%s(%s): Packet size %d (overrun)"
134 " - dropping", CTCM_FUNTAIL
,
135 dev
->name
, header
->length
);
136 ch
->logflags
|= LOG_FLAG_OVERRUN
;
139 priv
->stats
.rx_dropped
++;
140 priv
->stats
.rx_length_errors
++;
143 skb_put(pskb
, header
->length
);
144 skb_reset_mac_header(pskb
);
145 len
-= header
->length
;
146 skb
= dev_alloc_skb(pskb
->len
);
148 if (!(ch
->logflags
& LOG_FLAG_NOMEM
)) {
149 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
150 "%s(%s): MEMORY allocation error",
151 CTCM_FUNTAIL
, dev
->name
);
152 ch
->logflags
|= LOG_FLAG_NOMEM
;
154 priv
->stats
.rx_dropped
++;
157 skb_copy_from_linear_data(pskb
, skb_put(skb
, pskb
->len
),
159 skb_reset_mac_header(skb
);
160 skb
->dev
= pskb
->dev
;
161 skb
->protocol
= pskb
->protocol
;
162 pskb
->ip_summed
= CHECKSUM_UNNECESSARY
;
168 priv
->stats
.rx_packets
++;
169 priv
->stats
.rx_bytes
+= skblen
;
172 skb_pull(pskb
, header
->length
);
173 if (skb_tailroom(pskb
) < LL_HEADER_LENGTH
) {
174 CTCM_DBF_DEV_NAME(TRACE
, dev
,
175 "Overrun in ctcm_unpack_skb");
176 ch
->logflags
|= LOG_FLAG_OVERRUN
;
179 skb_put(pskb
, LL_HEADER_LENGTH
);
185 * Release a specific channel in the channel list.
187 * ch Pointer to channel struct to be released.
189 static void channel_free(struct channel
*ch
)
191 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
, "%s(%s)", CTCM_FUNTAIL
, ch
->id
);
192 ch
->flags
&= ~CHANNEL_FLAGS_INUSE
;
193 fsm_newstate(ch
->fsm
, CTC_STATE_IDLE
);
197 * Remove a specific channel in the channel list.
199 * ch Pointer to channel struct to be released.
201 static void channel_remove(struct channel
*ch
)
203 struct channel
**c
= &channels
;
204 char chid
[CTCM_ID_SIZE
+1];
210 strncpy(chid
, ch
->id
, CTCM_ID_SIZE
);
216 fsm_deltimer(&ch
->timer
);
218 fsm_deltimer(&ch
->sweep_timer
);
221 clear_normalized_cda(&ch
->ccw
[4]);
222 if (ch
->trans_skb
!= NULL
) {
223 clear_normalized_cda(&ch
->ccw
[1]);
224 dev_kfree_skb_any(ch
->trans_skb
);
227 tasklet_kill(&ch
->ch_tasklet
);
228 tasklet_kill(&ch
->ch_disc_tasklet
);
229 kfree(ch
->discontact_th
);
240 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
, "%s(%s) %s", CTCM_FUNTAIL
,
241 chid
, ok
? "OK" : "failed");
245 * Get a specific channel from the channel list.
247 * type Type of channel we are interested in.
248 * id Id of channel we are interested in.
249 * direction Direction we want to use this channel for.
251 * returns Pointer to a channel or NULL if no matching channel available.
253 static struct channel
*channel_get(enum ctcm_channel_types type
,
254 char *id
, int direction
)
256 struct channel
*ch
= channels
;
258 while (ch
&& (strncmp(ch
->id
, id
, CTCM_ID_SIZE
) || (ch
->type
!= type
)))
261 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
262 "%s(%d, %s, %d) not found in channel list\n",
263 CTCM_FUNTAIL
, type
, id
, direction
);
265 if (ch
->flags
& CHANNEL_FLAGS_INUSE
)
268 ch
->flags
|= CHANNEL_FLAGS_INUSE
;
269 ch
->flags
&= ~CHANNEL_FLAGS_RWMASK
;
270 ch
->flags
|= (direction
== CTCM_WRITE
)
271 ? CHANNEL_FLAGS_WRITE
: CHANNEL_FLAGS_READ
;
272 fsm_newstate(ch
->fsm
, CTC_STATE_STOPPED
);
278 static long ctcm_check_irb_error(struct ccw_device
*cdev
, struct irb
*irb
)
283 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_WARN
,
284 "irb error %ld on device %s\n",
285 PTR_ERR(irb
), dev_name(&cdev
->dev
));
287 switch (PTR_ERR(irb
)) {
290 "An I/O-error occurred on the CTCM device\n");
294 "An adapter hardware operation timed out\n");
298 "An error occurred on the adapter hardware\n");
305 * Check sense of a unit check.
307 * ch The channel, the sense code belongs to.
308 * sense The sense code to inspect.
310 static inline void ccw_unit_check(struct channel
*ch
, __u8 sense
)
312 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_DEBUG
,
314 CTCM_FUNTAIL
, ch
->id
, sense
);
316 if (sense
& SNS0_INTERVENTION_REQ
) {
318 if (ch
->sense_rc
!= 0x01) {
320 "%s: The communication peer has "
321 "disconnected\n", ch
->id
);
324 fsm_event(ch
->fsm
, CTC_EVENT_UC_RCRESET
, ch
);
326 if (ch
->sense_rc
!= SNS0_INTERVENTION_REQ
) {
328 "%s: The remote operating system is "
329 "not available\n", ch
->id
);
330 ch
->sense_rc
= SNS0_INTERVENTION_REQ
;
332 fsm_event(ch
->fsm
, CTC_EVENT_UC_RSRESET
, ch
);
334 } else if (sense
& SNS0_EQUIPMENT_CHECK
) {
335 if (sense
& SNS0_BUS_OUT_CHECK
) {
336 if (ch
->sense_rc
!= SNS0_BUS_OUT_CHECK
) {
337 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
338 "%s(%s): remote HW error %02x",
339 CTCM_FUNTAIL
, ch
->id
, sense
);
340 ch
->sense_rc
= SNS0_BUS_OUT_CHECK
;
342 fsm_event(ch
->fsm
, CTC_EVENT_UC_HWFAIL
, ch
);
344 if (ch
->sense_rc
!= SNS0_EQUIPMENT_CHECK
) {
345 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
346 "%s(%s): remote read parity error %02x",
347 CTCM_FUNTAIL
, ch
->id
, sense
);
348 ch
->sense_rc
= SNS0_EQUIPMENT_CHECK
;
350 fsm_event(ch
->fsm
, CTC_EVENT_UC_RXPARITY
, ch
);
352 } else if (sense
& SNS0_BUS_OUT_CHECK
) {
353 if (ch
->sense_rc
!= SNS0_BUS_OUT_CHECK
) {
354 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
355 "%s(%s): BUS OUT error %02x",
356 CTCM_FUNTAIL
, ch
->id
, sense
);
357 ch
->sense_rc
= SNS0_BUS_OUT_CHECK
;
359 if (sense
& 0x04) /* data-streaming timeout */
360 fsm_event(ch
->fsm
, CTC_EVENT_UC_TXTIMEOUT
, ch
);
361 else /* Data-transfer parity error */
362 fsm_event(ch
->fsm
, CTC_EVENT_UC_TXPARITY
, ch
);
363 } else if (sense
& SNS0_CMD_REJECT
) {
364 if (ch
->sense_rc
!= SNS0_CMD_REJECT
) {
365 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
366 "%s(%s): Command rejected",
367 CTCM_FUNTAIL
, ch
->id
);
368 ch
->sense_rc
= SNS0_CMD_REJECT
;
370 } else if (sense
== 0) {
371 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
372 "%s(%s): Unit check ZERO",
373 CTCM_FUNTAIL
, ch
->id
);
374 fsm_event(ch
->fsm
, CTC_EVENT_UC_ZERO
, ch
);
376 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
377 "%s(%s): Unit check code %02x unknown",
378 CTCM_FUNTAIL
, ch
->id
, sense
);
379 fsm_event(ch
->fsm
, CTC_EVENT_UC_UNKNOWN
, ch
);
383 int ctcm_ch_alloc_buffer(struct channel
*ch
)
385 clear_normalized_cda(&ch
->ccw
[1]);
386 ch
->trans_skb
= __dev_alloc_skb(ch
->max_bufsize
, GFP_ATOMIC
| GFP_DMA
);
387 if (ch
->trans_skb
== NULL
) {
388 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
389 "%s(%s): %s trans_skb allocation error",
390 CTCM_FUNTAIL
, ch
->id
,
391 (CHANNEL_DIRECTION(ch
->flags
) == CTCM_READ
) ?
396 ch
->ccw
[1].count
= ch
->max_bufsize
;
397 if (set_normalized_cda(&ch
->ccw
[1], ch
->trans_skb
->data
)) {
398 dev_kfree_skb(ch
->trans_skb
);
399 ch
->trans_skb
= NULL
;
400 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
401 "%s(%s): %s set norm_cda failed",
402 CTCM_FUNTAIL
, ch
->id
,
403 (CHANNEL_DIRECTION(ch
->flags
) == CTCM_READ
) ?
408 ch
->ccw
[1].count
= 0;
409 ch
->trans_skb_data
= ch
->trans_skb
->data
;
410 ch
->flags
&= ~CHANNEL_FLAGS_BUFSIZE_CHANGED
;
415 * Interface API for upper network layers
420 * Called from generic network layer when ifconfig up is run.
422 * dev Pointer to interface struct.
424 * returns 0 on success, -ERRNO on failure. (Never fails.)
426 int ctcm_open(struct net_device
*dev
)
428 struct ctcm_priv
*priv
= dev
->ml_priv
;
430 CTCMY_DBF_DEV_NAME(SETUP
, dev
, "");
432 fsm_event(priv
->fsm
, DEV_EVENT_START
, dev
);
437 * Close an interface.
438 * Called from generic network layer when ifconfig down is run.
440 * dev Pointer to interface struct.
442 * returns 0 on success, -ERRNO on failure. (Never fails.)
444 int ctcm_close(struct net_device
*dev
)
446 struct ctcm_priv
*priv
= dev
->ml_priv
;
448 CTCMY_DBF_DEV_NAME(SETUP
, dev
, "");
450 fsm_event(priv
->fsm
, DEV_EVENT_STOP
, dev
);
457 * This is a helper function for ctcm_tx().
459 * ch Channel to be used for sending.
460 * skb Pointer to struct sk_buff of packet to send.
461 * The linklevel header has already been set up
464 * returns 0 on success, -ERRNO on failure. (Never fails.)
466 static int ctcm_transmit_skb(struct channel
*ch
, struct sk_buff
*skb
)
468 unsigned long saveflags
;
469 struct ll_header header
;
473 struct sk_buff
*nskb
;
476 /* we need to acquire the lock for testing the state
477 * otherwise we can have an IRQ changing the state to
478 * TXIDLE after the test but before acquiring the lock.
480 spin_lock_irqsave(&ch
->collect_lock
, saveflags
);
481 if (fsm_getstate(ch
->fsm
) != CTC_STATE_TXIDLE
) {
482 int l
= skb
->len
+ LL_HEADER_LENGTH
;
484 if (ch
->collect_len
+ l
> ch
->max_bufsize
- 2) {
485 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
488 atomic_inc(&skb
->users
);
490 header
.type
= skb
->protocol
;
492 memcpy(skb_push(skb
, LL_HEADER_LENGTH
), &header
,
494 skb_queue_tail(&ch
->collect_queue
, skb
);
495 ch
->collect_len
+= l
;
497 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
500 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
502 * Protect skb against beeing free'd by upper
505 atomic_inc(&skb
->users
);
506 ch
->prof
.txlen
+= skb
->len
;
507 header
.length
= skb
->len
+ LL_HEADER_LENGTH
;
508 header
.type
= skb
->protocol
;
510 memcpy(skb_push(skb
, LL_HEADER_LENGTH
), &header
, LL_HEADER_LENGTH
);
511 block_len
= skb
->len
+ 2;
512 *((__u16
*)skb_push(skb
, 2)) = block_len
;
515 * IDAL support in CTCM is broken, so we have to
516 * care about skb's above 2G ourselves.
518 hi
= ((unsigned long)skb_tail_pointer(skb
) + LL_HEADER_LENGTH
) >> 31;
520 nskb
= alloc_skb(skb
->len
, GFP_ATOMIC
| GFP_DMA
);
522 atomic_dec(&skb
->users
);
523 skb_pull(skb
, LL_HEADER_LENGTH
+ 2);
524 ctcm_clear_busy(ch
->netdev
);
527 memcpy(skb_put(nskb
, skb
->len
), skb
->data
, skb
->len
);
528 atomic_inc(&nskb
->users
);
529 atomic_dec(&skb
->users
);
530 dev_kfree_skb_irq(skb
);
535 ch
->ccw
[4].count
= block_len
;
536 if (set_normalized_cda(&ch
->ccw
[4], skb
->data
)) {
538 * idal allocation failed, try via copying to
539 * trans_skb. trans_skb usually has a pre-allocated
542 if (ctcm_checkalloc_buffer(ch
)) {
544 * Remove our header. It gets added
545 * again on retransmit.
547 atomic_dec(&skb
->users
);
548 skb_pull(skb
, LL_HEADER_LENGTH
+ 2);
549 ctcm_clear_busy(ch
->netdev
);
553 skb_reset_tail_pointer(ch
->trans_skb
);
554 ch
->trans_skb
->len
= 0;
555 ch
->ccw
[1].count
= skb
->len
;
556 skb_copy_from_linear_data(skb
,
557 skb_put(ch
->trans_skb
, skb
->len
), skb
->len
);
558 atomic_dec(&skb
->users
);
559 dev_kfree_skb_irq(skb
);
562 skb_queue_tail(&ch
->io_queue
, skb
);
566 fsm_newstate(ch
->fsm
, CTC_STATE_TX
);
567 fsm_addtimer(&ch
->timer
, CTCM_TIME_5_SEC
, CTC_EVENT_TIMER
, ch
);
568 spin_lock_irqsave(get_ccwdev_lock(ch
->cdev
), saveflags
);
569 ch
->prof
.send_stamp
= current_kernel_time(); /* xtime */
570 rc
= ccw_device_start(ch
->cdev
, &ch
->ccw
[ccw_idx
],
571 (unsigned long)ch
, 0xff, 0);
572 spin_unlock_irqrestore(get_ccwdev_lock(ch
->cdev
), saveflags
);
574 ch
->prof
.doios_single
++;
576 fsm_deltimer(&ch
->timer
);
577 ctcm_ccw_check_rc(ch
, rc
, "single skb TX");
579 skb_dequeue_tail(&ch
->io_queue
);
581 * Remove our header. It gets added
582 * again on retransmit.
584 skb_pull(skb
, LL_HEADER_LENGTH
+ 2);
585 } else if (ccw_idx
== 0) {
586 struct net_device
*dev
= ch
->netdev
;
587 struct ctcm_priv
*priv
= dev
->ml_priv
;
588 priv
->stats
.tx_packets
++;
589 priv
->stats
.tx_bytes
+= skb
->len
- LL_HEADER_LENGTH
;
592 ctcm_clear_busy(ch
->netdev
);
596 static void ctcmpc_send_sweep_req(struct channel
*rch
)
598 struct net_device
*dev
= rch
->netdev
;
599 struct ctcm_priv
*priv
;
600 struct mpc_group
*grp
;
601 struct th_sweep
*header
;
602 struct sk_buff
*sweep_skb
;
608 ch
= priv
->channel
[CTCM_WRITE
];
610 /* sweep processing is not complete until response and request */
611 /* has completed for all read channels in group */
612 if (grp
->in_sweep
== 0) {
614 grp
->sweep_rsp_pend_num
= grp
->active_channels
[CTCM_READ
];
615 grp
->sweep_req_pend_num
= grp
->active_channels
[CTCM_READ
];
618 sweep_skb
= __dev_alloc_skb(MPC_BUFSIZE_DEFAULT
, GFP_ATOMIC
|GFP_DMA
);
620 if (sweep_skb
== NULL
) {
625 header
= kmalloc(TH_SWEEP_LENGTH
, gfp_type());
628 dev_kfree_skb_any(sweep_skb
);
633 header
->th
.th_seg
= 0x00 ;
634 header
->th
.th_ch_flag
= TH_SWEEP_REQ
; /* 0x0f */
635 header
->th
.th_blk_flag
= 0x00;
636 header
->th
.th_is_xid
= 0x00;
637 header
->th
.th_seq_num
= 0x00;
638 header
->sw
.th_last_seq
= ch
->th_seq_num
;
640 memcpy(skb_put(sweep_skb
, TH_SWEEP_LENGTH
), header
, TH_SWEEP_LENGTH
);
644 dev
->trans_start
= jiffies
;
645 skb_queue_tail(&ch
->sweep_queue
, sweep_skb
);
647 fsm_addtimer(&ch
->sweep_timer
, 100, CTC_EVENT_RSWEEP_TIMER
, ch
);
653 ctcm_clear_busy(dev
);
654 fsm_event(grp
->fsm
, MPCG_EVENT_INOP
, dev
);
660 * MPC mode version of transmit_skb
662 static int ctcmpc_transmit_skb(struct channel
*ch
, struct sk_buff
*skb
)
664 struct pdu
*p_header
;
665 struct net_device
*dev
= ch
->netdev
;
666 struct ctcm_priv
*priv
= dev
->ml_priv
;
667 struct mpc_group
*grp
= priv
->mpcg
;
668 struct th_header
*header
;
669 struct sk_buff
*nskb
;
673 unsigned long saveflags
= 0; /* avoids compiler warning */
675 CTCM_PR_DEBUG("Enter %s: %s, cp=%i ch=0x%p id=%s state=%s\n",
676 __func__
, dev
->name
, smp_processor_id(), ch
,
677 ch
->id
, fsm_getstate_str(ch
->fsm
));
679 if ((fsm_getstate(ch
->fsm
) != CTC_STATE_TXIDLE
) || grp
->in_sweep
) {
680 spin_lock_irqsave(&ch
->collect_lock
, saveflags
);
681 atomic_inc(&skb
->users
);
682 p_header
= kmalloc(PDU_HEADER_LENGTH
, gfp_type());
685 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
689 p_header
->pdu_offset
= skb
->len
;
690 p_header
->pdu_proto
= 0x01;
691 p_header
->pdu_flag
= 0x00;
692 if (skb
->protocol
== ntohs(ETH_P_SNAP
)) {
693 p_header
->pdu_flag
|= PDU_FIRST
| PDU_CNTL
;
695 p_header
->pdu_flag
|= PDU_FIRST
;
697 p_header
->pdu_seq
= 0;
698 memcpy(skb_push(skb
, PDU_HEADER_LENGTH
), p_header
,
701 CTCM_PR_DEBUG("%s(%s): Put on collect_q - skb len: %04x \n"
702 "pdu header and data for up to 32 bytes:\n",
703 __func__
, dev
->name
, skb
->len
);
704 CTCM_D3_DUMP((char *)skb
->data
, min_t(int, 32, skb
->len
));
706 skb_queue_tail(&ch
->collect_queue
, skb
);
707 ch
->collect_len
+= skb
->len
;
710 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
715 * Protect skb against beeing free'd by upper
718 atomic_inc(&skb
->users
);
721 * IDAL support in CTCM is broken, so we have to
722 * care about skb's above 2G ourselves.
724 hi
= ((unsigned long)skb
->tail
+ TH_HEADER_LENGTH
) >> 31;
726 nskb
= __dev_alloc_skb(skb
->len
, GFP_ATOMIC
| GFP_DMA
);
730 memcpy(skb_put(nskb
, skb
->len
), skb
->data
, skb
->len
);
731 atomic_inc(&nskb
->users
);
732 atomic_dec(&skb
->users
);
733 dev_kfree_skb_irq(skb
);
738 p_header
= kmalloc(PDU_HEADER_LENGTH
, gfp_type());
743 p_header
->pdu_offset
= skb
->len
;
744 p_header
->pdu_proto
= 0x01;
745 p_header
->pdu_flag
= 0x00;
746 p_header
->pdu_seq
= 0;
747 if (skb
->protocol
== ntohs(ETH_P_SNAP
)) {
748 p_header
->pdu_flag
|= PDU_FIRST
| PDU_CNTL
;
750 p_header
->pdu_flag
|= PDU_FIRST
;
752 memcpy(skb_push(skb
, PDU_HEADER_LENGTH
), p_header
, PDU_HEADER_LENGTH
);
756 if (ch
->collect_len
> 0) {
757 spin_lock_irqsave(&ch
->collect_lock
, saveflags
);
758 skb_queue_tail(&ch
->collect_queue
, skb
);
759 ch
->collect_len
+= skb
->len
;
760 skb
= skb_dequeue(&ch
->collect_queue
);
761 ch
->collect_len
-= skb
->len
;
762 spin_unlock_irqrestore(&ch
->collect_lock
, saveflags
);
765 p_header
= (struct pdu
*)skb
->data
;
766 p_header
->pdu_flag
|= PDU_LAST
;
768 ch
->prof
.txlen
+= skb
->len
- PDU_HEADER_LENGTH
;
770 header
= kmalloc(TH_HEADER_LENGTH
, gfp_type());
774 header
->th_seg
= 0x00;
775 header
->th_ch_flag
= TH_HAS_PDU
; /* Normal data */
776 header
->th_blk_flag
= 0x00;
777 header
->th_is_xid
= 0x00; /* Just data here */
779 header
->th_seq_num
= ch
->th_seq_num
;
781 CTCM_PR_DBGDATA("%s(%s) ToVTAM_th_seq= %08x\n" ,
782 __func__
, dev
->name
, ch
->th_seq_num
);
784 /* put the TH on the packet */
785 memcpy(skb_push(skb
, TH_HEADER_LENGTH
), header
, TH_HEADER_LENGTH
);
789 CTCM_PR_DBGDATA("%s(%s): skb len: %04x\n - pdu header and data for "
790 "up to 32 bytes sent to vtam:\n",
791 __func__
, dev
->name
, skb
->len
);
792 CTCM_D3_DUMP((char *)skb
->data
, min_t(int, 32, skb
->len
));
794 ch
->ccw
[4].count
= skb
->len
;
795 if (set_normalized_cda(&ch
->ccw
[4], skb
->data
)) {
797 * idal allocation failed, try via copying to trans_skb.
798 * trans_skb usually has a pre-allocated idal.
800 if (ctcm_checkalloc_buffer(ch
)) {
803 * It gets added again on retransmit.
808 skb_reset_tail_pointer(ch
->trans_skb
);
809 ch
->trans_skb
->len
= 0;
810 ch
->ccw
[1].count
= skb
->len
;
811 memcpy(skb_put(ch
->trans_skb
, skb
->len
), skb
->data
, skb
->len
);
812 atomic_dec(&skb
->users
);
813 dev_kfree_skb_irq(skb
);
815 CTCM_PR_DBGDATA("%s(%s): trans_skb len: %04x\n"
816 "up to 32 bytes sent to vtam:\n",
817 __func__
, dev
->name
, ch
->trans_skb
->len
);
818 CTCM_D3_DUMP((char *)ch
->trans_skb
->data
,
819 min_t(int, 32, ch
->trans_skb
->len
));
821 skb_queue_tail(&ch
->io_queue
, skb
);
825 fsm_newstate(ch
->fsm
, CTC_STATE_TX
);
826 fsm_addtimer(&ch
->timer
, CTCM_TIME_5_SEC
, CTC_EVENT_TIMER
, ch
);
829 ctcmpc_dumpit((char *)&ch
->ccw
[ccw_idx
],
830 sizeof(struct ccw1
) * 3);
832 spin_lock_irqsave(get_ccwdev_lock(ch
->cdev
), saveflags
);
833 ch
->prof
.send_stamp
= current_kernel_time(); /* xtime */
834 rc
= ccw_device_start(ch
->cdev
, &ch
->ccw
[ccw_idx
],
835 (unsigned long)ch
, 0xff, 0);
836 spin_unlock_irqrestore(get_ccwdev_lock(ch
->cdev
), saveflags
);
838 ch
->prof
.doios_single
++;
840 fsm_deltimer(&ch
->timer
);
841 ctcm_ccw_check_rc(ch
, rc
, "single skb TX");
843 skb_dequeue_tail(&ch
->io_queue
);
844 } else if (ccw_idx
== 0) {
845 priv
->stats
.tx_packets
++;
846 priv
->stats
.tx_bytes
+= skb
->len
- TH_HEADER_LENGTH
;
848 if (ch
->th_seq_num
> 0xf0000000) /* Chose at random. */
849 ctcmpc_send_sweep_req(ch
);
853 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_CRIT
,
854 "%s(%s): MEMORY allocation ERROR\n",
855 CTCM_FUNTAIL
, ch
->id
);
857 atomic_dec(&skb
->users
);
858 dev_kfree_skb_any(skb
);
859 fsm_event(priv
->mpcg
->fsm
, MPCG_EVENT_INOP
, dev
);
861 CTCM_PR_DEBUG("Exit %s(%s)\n", __func__
, dev
->name
);
866 * Start transmission of a packet.
867 * Called from generic network device layer.
869 * skb Pointer to buffer containing the packet.
870 * dev Pointer to interface struct.
872 * returns 0 if packet consumed, !0 if packet rejected.
873 * Note: If we return !0, then the packet is free'd by
874 * the generic network layer.
876 /* first merge version - leaving both functions separated */
877 static int ctcm_tx(struct sk_buff
*skb
, struct net_device
*dev
)
879 struct ctcm_priv
*priv
= dev
->ml_priv
;
882 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
883 "%s(%s): NULL sk_buff passed",
884 CTCM_FUNTAIL
, dev
->name
);
885 priv
->stats
.tx_dropped
++;
888 if (skb_headroom(skb
) < (LL_HEADER_LENGTH
+ 2)) {
889 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
890 "%s(%s): Got sk_buff with head room < %ld bytes",
891 CTCM_FUNTAIL
, dev
->name
, LL_HEADER_LENGTH
+ 2);
893 priv
->stats
.tx_dropped
++;
898 * If channels are not running, try to restart them
899 * and throw away packet.
901 if (fsm_getstate(priv
->fsm
) != DEV_STATE_RUNNING
) {
902 fsm_event(priv
->fsm
, DEV_EVENT_START
, dev
);
904 priv
->stats
.tx_dropped
++;
905 priv
->stats
.tx_errors
++;
906 priv
->stats
.tx_carrier_errors
++;
910 if (ctcm_test_and_set_busy(dev
))
911 return NETDEV_TX_BUSY
;
913 dev
->trans_start
= jiffies
;
914 if (ctcm_transmit_skb(priv
->channel
[CTCM_WRITE
], skb
) != 0)
915 return NETDEV_TX_BUSY
;
919 /* unmerged MPC variant of ctcm_tx */
920 static int ctcmpc_tx(struct sk_buff
*skb
, struct net_device
*dev
)
923 struct ctcm_priv
*priv
= dev
->ml_priv
;
924 struct mpc_group
*grp
= priv
->mpcg
;
925 struct sk_buff
*newskb
= NULL
;
928 * Some sanity checks ...
931 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_ERROR
,
932 "%s(%s): NULL sk_buff passed",
933 CTCM_FUNTAIL
, dev
->name
);
934 priv
->stats
.tx_dropped
++;
937 if (skb_headroom(skb
) < (TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
)) {
938 CTCM_DBF_TEXT_(MPC_TRACE
, CTC_DBF_ERROR
,
939 "%s(%s): Got sk_buff with head room < %ld bytes",
940 CTCM_FUNTAIL
, dev
->name
,
941 TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
);
943 CTCM_D3_DUMP((char *)skb
->data
, min_t(int, 32, skb
->len
));
945 len
= skb
->len
+ TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
;
946 newskb
= __dev_alloc_skb(len
, gfp_type() | GFP_DMA
);
949 CTCM_DBF_TEXT_(MPC_TRACE
, CTC_DBF_ERROR
,
950 "%s: %s: __dev_alloc_skb failed",
951 __func__
, dev
->name
);
953 dev_kfree_skb_any(skb
);
954 priv
->stats
.tx_dropped
++;
955 priv
->stats
.tx_errors
++;
956 priv
->stats
.tx_carrier_errors
++;
957 fsm_event(grp
->fsm
, MPCG_EVENT_INOP
, dev
);
960 newskb
->protocol
= skb
->protocol
;
961 skb_reserve(newskb
, TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
);
962 memcpy(skb_put(newskb
, skb
->len
), skb
->data
, skb
->len
);
963 dev_kfree_skb_any(skb
);
968 * If channels are not running,
969 * notify anybody about a link failure and throw
972 if ((fsm_getstate(priv
->fsm
) != DEV_STATE_RUNNING
) ||
973 (fsm_getstate(grp
->fsm
) < MPCG_STATE_XID2INITW
)) {
974 dev_kfree_skb_any(skb
);
975 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_ERROR
,
976 "%s(%s): inactive MPCGROUP - dropped",
977 CTCM_FUNTAIL
, dev
->name
);
978 priv
->stats
.tx_dropped
++;
979 priv
->stats
.tx_errors
++;
980 priv
->stats
.tx_carrier_errors
++;
984 if (ctcm_test_and_set_busy(dev
)) {
985 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_ERROR
,
986 "%s(%s): device busy - dropped",
987 CTCM_FUNTAIL
, dev
->name
);
988 dev_kfree_skb_any(skb
);
989 priv
->stats
.tx_dropped
++;
990 priv
->stats
.tx_errors
++;
991 priv
->stats
.tx_carrier_errors
++;
992 fsm_event(grp
->fsm
, MPCG_EVENT_INOP
, dev
);
996 dev
->trans_start
= jiffies
;
997 if (ctcmpc_transmit_skb(priv
->channel
[CTCM_WRITE
], skb
) != 0) {
998 CTCM_DBF_TEXT_(MPC_ERROR
, CTC_DBF_ERROR
,
999 "%s(%s): device error - dropped",
1000 CTCM_FUNTAIL
, dev
->name
);
1001 dev_kfree_skb_any(skb
);
1002 priv
->stats
.tx_dropped
++;
1003 priv
->stats
.tx_errors
++;
1004 priv
->stats
.tx_carrier_errors
++;
1005 ctcm_clear_busy(dev
);
1006 fsm_event(grp
->fsm
, MPCG_EVENT_INOP
, dev
);
1009 ctcm_clear_busy(dev
);
1012 MPC_DBF_DEV_NAME(TRACE
, dev
, "exit");
1014 return NETDEV_TX_OK
; /* handle freeing of skb here */
1019 * Sets MTU of an interface.
1021 * dev Pointer to interface struct.
1022 * new_mtu The new MTU to use for this interface.
1024 * returns 0 on success, -EINVAL if MTU is out of valid range.
1025 * (valid range is 576 .. 65527). If VM is on the
1026 * remote side, maximum MTU is 32760, however this is
1029 static int ctcm_change_mtu(struct net_device
*dev
, int new_mtu
)
1031 struct ctcm_priv
*priv
;
1034 if (new_mtu
< 576 || new_mtu
> 65527)
1037 priv
= dev
->ml_priv
;
1038 max_bufsize
= priv
->channel
[CTCM_READ
]->max_bufsize
;
1041 if (new_mtu
> max_bufsize
- TH_HEADER_LENGTH
)
1043 dev
->hard_header_len
= TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
;
1045 if (new_mtu
> max_bufsize
- LL_HEADER_LENGTH
- 2)
1047 dev
->hard_header_len
= LL_HEADER_LENGTH
+ 2;
1054 * Returns interface statistics of a device.
1056 * dev Pointer to interface struct.
1058 * returns Pointer to stats struct of this interface.
1060 static struct net_device_stats
*ctcm_stats(struct net_device
*dev
)
1062 return &((struct ctcm_priv
*)dev
->ml_priv
)->stats
;
1065 static void ctcm_free_netdevice(struct net_device
*dev
)
1067 struct ctcm_priv
*priv
;
1068 struct mpc_group
*grp
;
1070 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1071 "%s(%s)", CTCM_FUNTAIL
, dev
->name
);
1072 priv
= dev
->ml_priv
;
1077 kfree_fsm(grp
->fsm
);
1079 dev_kfree_skb(grp
->xid_skb
);
1080 if (grp
->rcvd_xid_skb
)
1081 dev_kfree_skb(grp
->rcvd_xid_skb
);
1082 tasklet_kill(&grp
->mpc_tasklet2
);
1087 kfree_fsm(priv
->fsm
);
1093 * Note: kfree(priv); is done in "opposite" function of
1094 * allocator function probe_device which is remove_device.
1102 struct mpc_group
*ctcmpc_init_mpc_group(struct ctcm_priv
*priv
);
1104 static const struct net_device_ops ctcm_netdev_ops
= {
1105 .ndo_open
= ctcm_open
,
1106 .ndo_stop
= ctcm_close
,
1107 .ndo_get_stats
= ctcm_stats
,
1108 .ndo_change_mtu
= ctcm_change_mtu
,
1109 .ndo_start_xmit
= ctcm_tx
,
1112 static const struct net_device_ops ctcm_mpc_netdev_ops
= {
1113 .ndo_open
= ctcm_open
,
1114 .ndo_stop
= ctcm_close
,
1115 .ndo_get_stats
= ctcm_stats
,
1116 .ndo_change_mtu
= ctcm_change_mtu
,
1117 .ndo_start_xmit
= ctcmpc_tx
,
1120 void static ctcm_dev_setup(struct net_device
*dev
)
1122 dev
->type
= ARPHRD_SLIP
;
1123 dev
->tx_queue_len
= 100;
1124 dev
->flags
= IFF_POINTOPOINT
| IFF_NOARP
;
1128 * Initialize everything of the net device except the name and the
1131 static struct net_device
*ctcm_init_netdevice(struct ctcm_priv
*priv
)
1133 struct net_device
*dev
;
1134 struct mpc_group
*grp
;
1139 dev
= alloc_netdev(0, MPC_DEVICE_GENE
, ctcm_dev_setup
);
1141 dev
= alloc_netdev(0, CTC_DEVICE_GENE
, ctcm_dev_setup
);
1144 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_CRIT
,
1145 "%s: MEMORY allocation ERROR",
1149 dev
->ml_priv
= priv
;
1150 priv
->fsm
= init_fsm("ctcmdev", dev_state_names
, dev_event_names
,
1151 CTCM_NR_DEV_STATES
, CTCM_NR_DEV_EVENTS
,
1152 dev_fsm
, dev_fsm_len
, GFP_KERNEL
);
1153 if (priv
->fsm
== NULL
) {
1154 CTCMY_DBF_DEV(SETUP
, dev
, "init_fsm error");
1158 fsm_newstate(priv
->fsm
, DEV_STATE_STOPPED
);
1159 fsm_settimer(priv
->fsm
, &priv
->restart_timer
);
1162 /* MPC Group Initializations */
1163 grp
= ctcmpc_init_mpc_group(priv
);
1165 MPC_DBF_DEV(SETUP
, dev
, "init_mpc_group error");
1169 tasklet_init(&grp
->mpc_tasklet2
,
1170 mpc_group_ready
, (unsigned long)dev
);
1171 dev
->mtu
= MPC_BUFSIZE_DEFAULT
-
1172 TH_HEADER_LENGTH
- PDU_HEADER_LENGTH
;
1174 dev
->netdev_ops
= &ctcm_mpc_netdev_ops
;
1175 dev
->hard_header_len
= TH_HEADER_LENGTH
+ PDU_HEADER_LENGTH
;
1176 priv
->buffer_size
= MPC_BUFSIZE_DEFAULT
;
1178 dev
->mtu
= CTCM_BUFSIZE_DEFAULT
- LL_HEADER_LENGTH
- 2;
1179 dev
->netdev_ops
= &ctcm_netdev_ops
;
1180 dev
->hard_header_len
= LL_HEADER_LENGTH
+ 2;
1183 CTCMY_DBF_DEV(SETUP
, dev
, "finished");
1191 * cdev The ccw_device the interrupt is for.
1192 * intparm interruption parameter.
1193 * irb interruption response block.
1195 static void ctcm_irq_handler(struct ccw_device
*cdev
,
1196 unsigned long intparm
, struct irb
*irb
)
1199 struct net_device
*dev
;
1200 struct ctcm_priv
*priv
;
1201 struct ccwgroup_device
*cgdev
;
1205 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_DEBUG
,
1206 "Enter %s(%s)", CTCM_FUNTAIL
, dev_name(&cdev
->dev
));
1208 if (ctcm_check_irb_error(cdev
, irb
))
1211 cgdev
= dev_get_drvdata(&cdev
->dev
);
1213 cstat
= irb
->scsw
.cmd
.cstat
;
1214 dstat
= irb
->scsw
.cmd
.dstat
;
1216 /* Check for unsolicited interrupts. */
1217 if (cgdev
== NULL
) {
1218 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_ERROR
,
1219 "%s(%s) unsolicited irq: c-%02x d-%02x\n",
1220 CTCM_FUNTAIL
, dev_name(&cdev
->dev
), cstat
, dstat
);
1221 dev_warn(&cdev
->dev
,
1222 "The adapter received a non-specific IRQ\n");
1226 priv
= dev_get_drvdata(&cgdev
->dev
);
1228 /* Try to extract channel from driver data. */
1229 if (priv
->channel
[CTCM_READ
]->cdev
== cdev
)
1230 ch
= priv
->channel
[CTCM_READ
];
1231 else if (priv
->channel
[CTCM_WRITE
]->cdev
== cdev
)
1232 ch
= priv
->channel
[CTCM_WRITE
];
1235 "%s: Internal error: Can't determine channel for "
1236 "interrupt device %s\n",
1237 __func__
, dev_name(&cdev
->dev
));
1238 /* Explain: inconsistent internal structures */
1245 "%s Internal error: net_device is NULL, ch = 0x%p\n",
1247 /* Explain: inconsistent internal structures */
1251 /* Copy interruption response block. */
1252 memcpy(ch
->irb
, irb
, sizeof(struct irb
));
1254 /* Issue error message and return on subchannel error code */
1255 if (irb
->scsw
.cmd
.cstat
) {
1256 fsm_event(ch
->fsm
, CTC_EVENT_SC_UNKNOWN
, ch
);
1257 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
1258 "%s(%s): sub-ch check %s: cs=%02x ds=%02x",
1259 CTCM_FUNTAIL
, dev
->name
, ch
->id
, cstat
, dstat
);
1260 dev_warn(&cdev
->dev
,
1261 "A check occurred on the subchannel\n");
1265 /* Check the reason-code of a unit check */
1266 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_UNIT_CHECK
) {
1267 if ((irb
->ecw
[0] & ch
->sense_rc
) == 0)
1268 /* print it only once */
1269 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_WARN
,
1270 "%s(%s): sense=%02x, ds=%02x",
1271 CTCM_FUNTAIL
, ch
->id
, irb
->ecw
[0], dstat
);
1272 ccw_unit_check(ch
, irb
->ecw
[0]);
1275 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_BUSY
) {
1276 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_ATTENTION
)
1277 fsm_event(ch
->fsm
, CTC_EVENT_ATTNBUSY
, ch
);
1279 fsm_event(ch
->fsm
, CTC_EVENT_BUSY
, ch
);
1282 if (irb
->scsw
.cmd
.dstat
& DEV_STAT_ATTENTION
) {
1283 fsm_event(ch
->fsm
, CTC_EVENT_ATTN
, ch
);
1286 if ((irb
->scsw
.cmd
.stctl
& SCSW_STCTL_SEC_STATUS
) ||
1287 (irb
->scsw
.cmd
.stctl
== SCSW_STCTL_STATUS_PEND
) ||
1288 (irb
->scsw
.cmd
.stctl
==
1289 (SCSW_STCTL_ALERT_STATUS
| SCSW_STCTL_STATUS_PEND
)))
1290 fsm_event(ch
->fsm
, CTC_EVENT_FINSTAT
, ch
);
1292 fsm_event(ch
->fsm
, CTC_EVENT_IRQ
, ch
);
1297 * Add ctcm specific attributes.
1298 * Add ctcm private data.
1300 * cgdev pointer to ccwgroup_device just added
1302 * returns 0 on success, !0 on failure.
1304 static int ctcm_probe_device(struct ccwgroup_device
*cgdev
)
1306 struct ctcm_priv
*priv
;
1309 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1313 if (!get_device(&cgdev
->dev
))
1316 priv
= kzalloc(sizeof(struct ctcm_priv
), GFP_KERNEL
);
1318 CTCM_DBF_TEXT_(ERROR
, CTC_DBF_ERROR
,
1319 "%s: memory allocation failure",
1321 put_device(&cgdev
->dev
);
1325 rc
= ctcm_add_files(&cgdev
->dev
);
1328 put_device(&cgdev
->dev
);
1331 priv
->buffer_size
= CTCM_BUFSIZE_DEFAULT
;
1332 cgdev
->cdev
[0]->handler
= ctcm_irq_handler
;
1333 cgdev
->cdev
[1]->handler
= ctcm_irq_handler
;
1334 dev_set_drvdata(&cgdev
->dev
, priv
);
1340 * Add a new channel to the list of channels.
1341 * Keeps the channel list sorted.
1343 * cdev The ccw_device to be added.
1344 * type The type class of the new channel.
1345 * priv Points to the private data of the ccwgroup_device.
1347 * returns 0 on success, !0 on error.
1349 static int add_channel(struct ccw_device
*cdev
, enum ctcm_channel_types type
,
1350 struct ctcm_priv
*priv
)
1352 struct channel
**c
= &channels
;
1357 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1358 "%s(%s), type %d, proto %d",
1359 __func__
, dev_name(&cdev
->dev
), type
, priv
->protocol
);
1361 ch
= kzalloc(sizeof(struct channel
), GFP_KERNEL
);
1365 ch
->protocol
= priv
->protocol
;
1367 ch
->discontact_th
= kzalloc(TH_HEADER_LENGTH
, gfp_type());
1368 if (ch
->discontact_th
== NULL
)
1371 ch
->discontact_th
->th_blk_flag
= TH_DISCONTACT
;
1372 tasklet_init(&ch
->ch_disc_tasklet
,
1373 mpc_action_send_discontact
, (unsigned long)ch
);
1375 tasklet_init(&ch
->ch_tasklet
, ctcmpc_bh
, (unsigned long)ch
);
1376 ch
->max_bufsize
= (MPC_BUFSIZE_DEFAULT
- 35);
1381 ch
->ccw
= kzalloc(ccw_num
* sizeof(struct ccw1
), GFP_KERNEL
| GFP_DMA
);
1382 if (ch
->ccw
== NULL
)
1386 snprintf(ch
->id
, CTCM_ID_SIZE
, "ch-%s", dev_name(&cdev
->dev
));
1390 * "static" ccws are used in the following way:
1392 * ccw[0..2] (Channel program for generic I/O):
1394 * 1: read or write (depending on direction) with fixed
1395 * buffer (idal allocated once when buffer is allocated)
1397 * ccw[3..5] (Channel program for direct write of packets)
1399 * 4: write (idal allocated on every write).
1401 * ccw[6..7] (Channel program for initial channel setup):
1402 * 6: set extended mode
1405 * ch->ccw[0..5] are initialized in ch_action_start because
1406 * the channel's direction is yet unknown here.
1408 * ccws used for xid2 negotiations
1409 * ch-ccw[8-14] need to be used for the XID exchange either
1410 * X side XID2 Processing
1414 * 11: read th from secondary
1415 * 12: read XID from secondary
1416 * 13: read 4 byte ID
1418 * Y side XID Processing
1424 * 13: write 4 byte ID
1427 * ccws used for double noop due to VM timing issues
1428 * which result in unrecoverable Busy on channel
1432 ch
->ccw
[6].cmd_code
= CCW_CMD_SET_EXTENDED
;
1433 ch
->ccw
[6].flags
= CCW_FLAG_SLI
;
1435 ch
->ccw
[7].cmd_code
= CCW_CMD_NOOP
;
1436 ch
->ccw
[7].flags
= CCW_FLAG_SLI
;
1439 ch
->ccw
[15].cmd_code
= CCW_CMD_WRITE
;
1440 ch
->ccw
[15].flags
= CCW_FLAG_SLI
| CCW_FLAG_CC
;
1441 ch
->ccw
[15].count
= TH_HEADER_LENGTH
;
1442 ch
->ccw
[15].cda
= virt_to_phys(ch
->discontact_th
);
1444 ch
->ccw
[16].cmd_code
= CCW_CMD_NOOP
;
1445 ch
->ccw
[16].flags
= CCW_FLAG_SLI
;
1447 ch
->fsm
= init_fsm(ch
->id
, ctc_ch_state_names
,
1448 ctc_ch_event_names
, CTC_MPC_NR_STATES
,
1449 CTC_MPC_NR_EVENTS
, ctcmpc_ch_fsm
,
1450 mpc_ch_fsm_len
, GFP_KERNEL
);
1452 ch
->fsm
= init_fsm(ch
->id
, ctc_ch_state_names
,
1453 ctc_ch_event_names
, CTC_NR_STATES
,
1454 CTC_NR_EVENTS
, ch_fsm
,
1455 ch_fsm_len
, GFP_KERNEL
);
1457 if (ch
->fsm
== NULL
)
1460 fsm_newstate(ch
->fsm
, CTC_STATE_IDLE
);
1462 ch
->irb
= kzalloc(sizeof(struct irb
), GFP_KERNEL
);
1463 if (ch
->irb
== NULL
)
1466 while (*c
&& ctcm_less_than((*c
)->id
, ch
->id
))
1469 if (*c
&& (!strncmp((*c
)->id
, ch
->id
, CTCM_ID_SIZE
))) {
1470 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1471 "%s (%s) already in list, using old entry",
1472 __func__
, (*c
)->id
);
1477 spin_lock_init(&ch
->collect_lock
);
1479 fsm_settimer(ch
->fsm
, &ch
->timer
);
1480 skb_queue_head_init(&ch
->io_queue
);
1481 skb_queue_head_init(&ch
->collect_queue
);
1484 fsm_settimer(ch
->fsm
, &ch
->sweep_timer
);
1485 skb_queue_head_init(&ch
->sweep_queue
);
1494 free_return
: /* note that all channel pointers are 0 or valid */
1496 kfree(ch
->discontact_th
);
1504 * Return type of a detected device.
1506 static enum ctcm_channel_types
get_channel_type(struct ccw_device_id
*id
)
1508 enum ctcm_channel_types type
;
1509 type
= (enum ctcm_channel_types
)id
->driver_info
;
1511 if (type
== ctcm_channel_type_ficon
)
1512 type
= ctcm_channel_type_escon
;
1519 * Setup an interface.
1521 * cgdev Device to be setup.
1523 * returns 0 on success, !0 on failure.
1525 static int ctcm_new_device(struct ccwgroup_device
*cgdev
)
1527 char read_id
[CTCM_ID_SIZE
];
1528 char write_id
[CTCM_ID_SIZE
];
1530 enum ctcm_channel_types type
;
1531 struct ctcm_priv
*priv
;
1532 struct net_device
*dev
;
1533 struct ccw_device
*cdev0
;
1534 struct ccw_device
*cdev1
;
1535 struct channel
*readc
;
1536 struct channel
*writec
;
1540 priv
= dev_get_drvdata(&cgdev
->dev
);
1543 goto out_err_result
;
1546 cdev0
= cgdev
->cdev
[0];
1547 cdev1
= cgdev
->cdev
[1];
1549 type
= get_channel_type(&cdev0
->id
);
1551 snprintf(read_id
, CTCM_ID_SIZE
, "ch-%s", dev_name(&cdev0
->dev
));
1552 snprintf(write_id
, CTCM_ID_SIZE
, "ch-%s", dev_name(&cdev1
->dev
));
1554 ret
= add_channel(cdev0
, type
, priv
);
1557 goto out_err_result
;
1559 ret
= add_channel(cdev1
, type
, priv
);
1562 goto out_remove_channel1
;
1565 ret
= ccw_device_set_online(cdev0
);
1567 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_NOTICE
,
1568 "%s(%s) set_online rc=%d",
1569 CTCM_FUNTAIL
, read_id
, ret
);
1571 goto out_remove_channel2
;
1574 ret
= ccw_device_set_online(cdev1
);
1576 CTCM_DBF_TEXT_(TRACE
, CTC_DBF_NOTICE
,
1577 "%s(%s) set_online rc=%d",
1578 CTCM_FUNTAIL
, write_id
, ret
);
1584 dev
= ctcm_init_netdevice(priv
);
1590 for (direction
= CTCM_READ
; direction
<= CTCM_WRITE
; direction
++) {
1591 priv
->channel
[direction
] =
1592 channel_get(type
, direction
== CTCM_READ
?
1593 read_id
: write_id
, direction
);
1594 if (priv
->channel
[direction
] == NULL
) {
1595 if (direction
== CTCM_WRITE
)
1596 channel_free(priv
->channel
[CTCM_READ
]);
1599 priv
->channel
[direction
]->netdev
= dev
;
1600 priv
->channel
[direction
]->protocol
= priv
->protocol
;
1601 priv
->channel
[direction
]->max_bufsize
= priv
->buffer_size
;
1604 SET_NETDEV_DEV(dev
, &cgdev
->dev
);
1606 if (register_netdev(dev
)) {
1611 if (ctcm_add_attributes(&cgdev
->dev
)) {
1613 goto out_unregister
;
1616 strlcpy(priv
->fsm
->name
, dev
->name
, sizeof(priv
->fsm
->name
));
1619 "setup OK : r/w = %s/%s, protocol : %d\n",
1620 priv
->channel
[CTCM_READ
]->id
,
1621 priv
->channel
[CTCM_WRITE
]->id
, priv
->protocol
);
1623 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1624 "setup(%s) OK : r/w = %s/%s, protocol : %d", dev
->name
,
1625 priv
->channel
[CTCM_READ
]->id
,
1626 priv
->channel
[CTCM_WRITE
]->id
, priv
->protocol
);
1630 unregister_netdev(dev
);
1632 ctcm_free_netdevice(dev
);
1634 ccw_device_set_offline(cgdev
->cdev
[1]);
1636 ccw_device_set_offline(cgdev
->cdev
[0]);
1637 out_remove_channel2
:
1638 readc
= channel_get(type
, read_id
, CTCM_READ
);
1639 channel_remove(readc
);
1640 out_remove_channel1
:
1641 writec
= channel_get(type
, write_id
, CTCM_WRITE
);
1642 channel_remove(writec
);
1648 * Shutdown an interface.
1650 * cgdev Device to be shut down.
1652 * returns 0 on success, !0 on failure.
1654 static int ctcm_shutdown_device(struct ccwgroup_device
*cgdev
)
1656 struct ctcm_priv
*priv
;
1657 struct net_device
*dev
;
1659 priv
= dev_get_drvdata(&cgdev
->dev
);
1663 if (priv
->channel
[CTCM_READ
]) {
1664 dev
= priv
->channel
[CTCM_READ
]->netdev
;
1665 CTCM_DBF_DEV(SETUP
, dev
, "");
1666 /* Close the device */
1668 dev
->flags
&= ~IFF_RUNNING
;
1669 ctcm_remove_attributes(&cgdev
->dev
);
1670 channel_free(priv
->channel
[CTCM_READ
]);
1674 if (priv
->channel
[CTCM_WRITE
])
1675 channel_free(priv
->channel
[CTCM_WRITE
]);
1678 unregister_netdev(dev
);
1679 ctcm_free_netdevice(dev
);
1683 kfree_fsm(priv
->fsm
);
1685 ccw_device_set_offline(cgdev
->cdev
[1]);
1686 ccw_device_set_offline(cgdev
->cdev
[0]);
1688 if (priv
->channel
[CTCM_READ
])
1689 channel_remove(priv
->channel
[CTCM_READ
]);
1690 if (priv
->channel
[CTCM_WRITE
])
1691 channel_remove(priv
->channel
[CTCM_WRITE
]);
1692 priv
->channel
[CTCM_READ
] = priv
->channel
[CTCM_WRITE
] = NULL
;
1699 static void ctcm_remove_device(struct ccwgroup_device
*cgdev
)
1701 struct ctcm_priv
*priv
= dev_get_drvdata(&cgdev
->dev
);
1703 BUG_ON(priv
== NULL
);
1705 CTCM_DBF_TEXT_(SETUP
, CTC_DBF_INFO
,
1706 "removing device %p, proto : %d",
1707 cgdev
, priv
->protocol
);
1709 if (cgdev
->state
== CCWGROUP_ONLINE
)
1710 ctcm_shutdown_device(cgdev
);
1711 ctcm_remove_files(&cgdev
->dev
);
1712 dev_set_drvdata(&cgdev
->dev
, NULL
);
1714 put_device(&cgdev
->dev
);
1717 static int ctcm_pm_suspend(struct ccwgroup_device
*gdev
)
1719 struct ctcm_priv
*priv
= dev_get_drvdata(&gdev
->dev
);
1721 if (gdev
->state
== CCWGROUP_OFFLINE
)
1723 netif_device_detach(priv
->channel
[CTCM_READ
]->netdev
);
1724 ctcm_close(priv
->channel
[CTCM_READ
]->netdev
);
1725 if (!wait_event_timeout(priv
->fsm
->wait_q
,
1726 fsm_getstate(priv
->fsm
) == DEV_STATE_STOPPED
, CTCM_TIME_5_SEC
)) {
1727 netif_device_attach(priv
->channel
[CTCM_READ
]->netdev
);
1730 ccw_device_set_offline(gdev
->cdev
[1]);
1731 ccw_device_set_offline(gdev
->cdev
[0]);
1735 static int ctcm_pm_resume(struct ccwgroup_device
*gdev
)
1737 struct ctcm_priv
*priv
= dev_get_drvdata(&gdev
->dev
);
1740 if (gdev
->state
== CCWGROUP_OFFLINE
)
1742 rc
= ccw_device_set_online(gdev
->cdev
[1]);
1745 rc
= ccw_device_set_online(gdev
->cdev
[0]);
1748 ctcm_open(priv
->channel
[CTCM_READ
]->netdev
);
1750 netif_device_attach(priv
->channel
[CTCM_READ
]->netdev
);
1754 static struct ccw_device_id ctcm_ids
[] = {
1755 {CCW_DEVICE(0x3088, 0x08), .driver_info
= ctcm_channel_type_parallel
},
1756 {CCW_DEVICE(0x3088, 0x1e), .driver_info
= ctcm_channel_type_ficon
},
1757 {CCW_DEVICE(0x3088, 0x1f), .driver_info
= ctcm_channel_type_escon
},
1760 MODULE_DEVICE_TABLE(ccw
, ctcm_ids
);
1762 static struct ccw_driver ctcm_ccw_driver
= {
1764 .owner
= THIS_MODULE
,
1768 .probe
= ccwgroup_probe_ccwdev
,
1769 .remove
= ccwgroup_remove_ccwdev
,
1770 .int_class
= IOINT_CTC
,
1773 static struct ccwgroup_driver ctcm_group_driver
= {
1775 .owner
= THIS_MODULE
,
1776 .name
= CTC_DRIVER_NAME
,
1779 .driver_id
= 0xC3E3C3D4, /* CTCM */
1780 .probe
= ctcm_probe_device
,
1781 .remove
= ctcm_remove_device
,
1782 .set_online
= ctcm_new_device
,
1783 .set_offline
= ctcm_shutdown_device
,
1784 .freeze
= ctcm_pm_suspend
,
1785 .thaw
= ctcm_pm_resume
,
1786 .restore
= ctcm_pm_resume
,
1790 ctcm_driver_group_store(struct device_driver
*ddrv
, const char *buf
,
1795 err
= ccwgroup_create_from_string(ctcm_root_dev
,
1796 ctcm_group_driver
.driver_id
,
1797 &ctcm_ccw_driver
, 2, buf
);
1798 return err
? err
: count
;
1801 static DRIVER_ATTR(group
, 0200, NULL
, ctcm_driver_group_store
);
1803 static struct attribute
*ctcm_group_attrs
[] = {
1804 &driver_attr_group
.attr
,
1808 static struct attribute_group ctcm_group_attr_group
= {
1809 .attrs
= ctcm_group_attrs
,
1812 static const struct attribute_group
*ctcm_group_attr_groups
[] = {
1813 &ctcm_group_attr_group
,
1818 * Module related routines
1822 * Prepare to be unloaded. Free IRQ's and release all resources.
1823 * This is called just before this module is unloaded. It is
1824 * not called, if the usage count is !0, so we don't need to check
1827 static void __exit
ctcm_exit(void)
1829 driver_remove_file(&ctcm_group_driver
.driver
, &driver_attr_group
);
1830 ccwgroup_driver_unregister(&ctcm_group_driver
);
1831 ccw_driver_unregister(&ctcm_ccw_driver
);
1832 root_device_unregister(ctcm_root_dev
);
1833 ctcm_unregister_dbf_views();
1834 pr_info("CTCM driver unloaded\n");
1840 static void print_banner(void)
1842 pr_info("CTCM driver initialized\n");
1846 * Initialize module.
1847 * This is called just after the module is loaded.
1849 * returns 0 on success, !0 on error.
1851 static int __init
ctcm_init(void)
1857 ret
= ctcm_register_dbf_views();
1860 ctcm_root_dev
= root_device_register("ctcm");
1861 ret
= IS_ERR(ctcm_root_dev
) ? PTR_ERR(ctcm_root_dev
) : 0;
1864 ret
= ccw_driver_register(&ctcm_ccw_driver
);
1867 ctcm_group_driver
.driver
.groups
= ctcm_group_attr_groups
;
1868 ret
= ccwgroup_driver_register(&ctcm_group_driver
);
1875 ccw_driver_unregister(&ctcm_ccw_driver
);
1877 root_device_unregister(ctcm_root_dev
);
1879 ctcm_unregister_dbf_views();
1881 pr_err("%s / Initializing the ctcm device driver failed, ret = %d\n",
1886 module_init(ctcm_init
);
1887 module_exit(ctcm_exit
);
1889 MODULE_AUTHOR("Peter Tiedemann <ptiedem@de.ibm.com>");
1890 MODULE_DESCRIPTION("Network driver for S/390 CTC + CTCMPC (SNA)");
1891 MODULE_LICENSE("GPL");