Blame view

net/iucv/af_iucv.c 56.7 KB
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1
  /*
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2
3
   *  IUCV protocol stack for Linux on zSeries
   *
c23cad923   Ursula Braun   [S390] PM: af_iuc...
4
   *  Copyright IBM Corp. 2006, 2009
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
5
6
   *
   *  Author(s):	Jennifer Hunt <jenhunt@us.ibm.com>
c23cad923   Ursula Braun   [S390] PM: af_iuc...
7
8
9
   *		Hendrik Brueckner <brueckner@linux.vnet.ibm.com>
   *  PM functions:
   *		Ursula Braun <ursula.braun@de.ibm.com>
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
10
   */
8f7c502c2   Ursula Braun   [S390] convert iu...
11
12
  #define KMSG_COMPONENT "af_iucv"
  #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
13
14
15
16
17
18
19
20
21
22
23
24
25
26
  #include <linux/module.h>
  #include <linux/types.h>
  #include <linux/list.h>
  #include <linux/errno.h>
  #include <linux/kernel.h>
  #include <linux/sched.h>
  #include <linux/slab.h>
  #include <linux/skbuff.h>
  #include <linux/init.h>
  #include <linux/poll.h>
  #include <net/sock.h>
  #include <asm/ebcdic.h>
  #include <asm/cpcmd.h>
  #include <linux/kmod.h>
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
27
  #include <net/iucv/af_iucv.h>
3881ac441   Ursula Braun   af_iucv: add Hipe...
28
  #define VERSION "1.2"
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
29
30
  
  static char iucv_userid[80];
5708e868d   Alexey Dobriyan   net: constify rem...
31
  static const struct proto_ops iucv_sock_ops;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
32
33
34
35
36
37
  
  static struct proto iucv_proto = {
  	.name		= "AF_IUCV",
  	.owner		= THIS_MODULE,
  	.obj_size	= sizeof(struct iucv_sock),
  };
6fcd61f7b   Frank Blaschka   af_iucv: use load...
38
  static struct iucv_interface *pr_iucv;
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
39
40
41
  /* special AF_IUCV IPRM messages */
  static const u8 iprm_shutdown[8] =
  	{0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01};
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
42
43
44
45
46
47
48
  #define TRGCLS_SIZE	(sizeof(((struct iucv_message *)0)->class))
  
  /* macros to set/get socket control buffer at correct offset */
  #define CB_TAG(skb)	((skb)->cb)		/* iucv message tag */
  #define CB_TAG_LEN	(sizeof(((struct iucv_message *) 0)->tag))
  #define CB_TRGCLS(skb)	((skb)->cb + CB_TAG_LEN) /* iucv msg target class */
  #define CB_TRGCLS_LEN	(TRGCLS_SIZE)
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
49
50
51
52
53
  #define __iucv_sock_wait(sk, condition, timeo, ret)			\
  do {									\
  	DEFINE_WAIT(__wait);						\
  	long __timeo = timeo;						\
  	ret = 0;							\
aa3951451   Eric Dumazet   net: sk_sleep() h...
54
  	prepare_to_wait(sk_sleep(sk), &__wait, TASK_INTERRUPTIBLE);	\
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
55
  	while (!(condition)) {						\
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
  		if (!__timeo) {						\
  			ret = -EAGAIN;					\
  			break;						\
  		}							\
  		if (signal_pending(current)) {				\
  			ret = sock_intr_errno(__timeo);			\
  			break;						\
  		}							\
  		release_sock(sk);					\
  		__timeo = schedule_timeout(__timeo);			\
  		lock_sock(sk);						\
  		ret = sock_error(sk);					\
  		if (ret)						\
  			break;						\
  	}								\
aa3951451   Eric Dumazet   net: sk_sleep() h...
71
  	finish_wait(sk_sleep(sk), &__wait);				\
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
72
73
74
75
76
77
78
79
80
  } while (0)
  
  #define iucv_sock_wait(sk, condition, timeo)				\
  ({									\
  	int __ret = 0;							\
  	if (!(condition))						\
  		__iucv_sock_wait(sk, condition, timeo, __ret);		\
  	__ret;								\
  })
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
81

57f204480   Heiko Carstens   [AF_IUCV]: remove...
82
83
  static void iucv_sock_kill(struct sock *sk);
  static void iucv_sock_close(struct sock *sk);
3881ac441   Ursula Braun   af_iucv: add Hipe...
84
85
86
87
88
  static int afiucv_hs_rcv(struct sk_buff *skb, struct net_device *dev,
  	struct packet_type *pt, struct net_device *orig_dev);
  static int afiucv_hs_send(struct iucv_message *imsg, struct sock *sock,
  		   struct sk_buff *skb, u8 flags);
  static void afiucv_hs_callback_txnotify(struct sk_buff *, enum iucv_tx_notify);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
89
90
91
92
  /* Call Back functions */
  static void iucv_callback_rx(struct iucv_path *, struct iucv_message *);
  static void iucv_callback_txdone(struct iucv_path *, struct iucv_message *);
  static void iucv_callback_connack(struct iucv_path *, u8 ipuser[16]);
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
93
94
  static int iucv_callback_connreq(struct iucv_path *, u8 ipvmid[8],
  				 u8 ipuser[16]);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
95
  static void iucv_callback_connrej(struct iucv_path *, u8 ipuser[16]);
af88b52de   Hendrik Brueckner   af_iucv: sync sk ...
96
  static void iucv_callback_shutdown(struct iucv_path *, u8 ipuser[16]);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
97
98
  
  static struct iucv_sock_list iucv_sk_list = {
3db8ce35c   Robert P. J. Day   af_iucv: Use non-...
99
  	.lock = __RW_LOCK_UNLOCKED(iucv_sk_list.lock),
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
100
101
102
103
104
105
106
107
  	.autobind_name = ATOMIC_INIT(0)
  };
  
  static struct iucv_handler af_iucv_handler = {
  	.path_pending	  = iucv_callback_connreq,
  	.path_complete	  = iucv_callback_connack,
  	.path_severed	  = iucv_callback_connrej,
  	.message_pending  = iucv_callback_rx,
af88b52de   Hendrik Brueckner   af_iucv: sync sk ...
108
109
  	.message_complete = iucv_callback_txdone,
  	.path_quiesced	  = iucv_callback_shutdown,
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
110
111
112
113
114
115
116
117
118
119
120
  };
  
  static inline void high_nmcpy(unsigned char *dst, char *src)
  {
         memcpy(dst, src, 8);
  }
  
  static inline void low_nmcpy(unsigned char *dst, char *src)
  {
         memcpy(&dst[8], src, 8);
  }
816abbadf   Ursula Braun   af_iucv: release ...
121
122
123
124
125
126
127
128
129
130
  static void iucv_skb_queue_purge(struct sk_buff_head *list)
  {
  	struct sk_buff *skb;
  
  	while ((skb = skb_dequeue(list)) != NULL) {
  		if (skb->dev)
  			dev_put(skb->dev);
  		kfree_skb(skb);
  	}
  }
c23cad923   Ursula Braun   [S390] PM: af_iuc...
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
  static int afiucv_pm_prepare(struct device *dev)
  {
  #ifdef CONFIG_PM_DEBUG
  	printk(KERN_WARNING "afiucv_pm_prepare
  ");
  #endif
  	return 0;
  }
  
  static void afiucv_pm_complete(struct device *dev)
  {
  #ifdef CONFIG_PM_DEBUG
  	printk(KERN_WARNING "afiucv_pm_complete
  ");
  #endif
c23cad923   Ursula Braun   [S390] PM: af_iuc...
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
  }
  
  /**
   * afiucv_pm_freeze() - Freeze PM callback
   * @dev:	AFIUCV dummy device
   *
   * Sever all established IUCV communication pathes
   */
  static int afiucv_pm_freeze(struct device *dev)
  {
  	struct iucv_sock *iucv;
  	struct sock *sk;
  	struct hlist_node *node;
  	int err = 0;
  
  #ifdef CONFIG_PM_DEBUG
  	printk(KERN_WARNING "afiucv_pm_freeze
  ");
  #endif
  	read_lock(&iucv_sk_list.lock);
  	sk_for_each(sk, node, &iucv_sk_list.head) {
  		iucv = iucv_sk(sk);
816abbadf   Ursula Braun   af_iucv: release ...
168
  		iucv_skb_queue_purge(&iucv->send_skb_q);
c23cad923   Ursula Braun   [S390] PM: af_iuc...
169
170
  		skb_queue_purge(&iucv->backlog_skb_q);
  		switch (sk->sk_state) {
c23cad923   Ursula Braun   [S390] PM: af_iuc...
171
172
173
174
  		case IUCV_DISCONN:
  		case IUCV_CLOSING:
  		case IUCV_CONNECTED:
  			if (iucv->path) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
175
  				err = pr_iucv->path_sever(iucv->path, NULL);
c23cad923   Ursula Braun   [S390] PM: af_iuc...
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
  				iucv_path_free(iucv->path);
  				iucv->path = NULL;
  			}
  			break;
  		case IUCV_OPEN:
  		case IUCV_BOUND:
  		case IUCV_LISTEN:
  		case IUCV_CLOSED:
  		default:
  			break;
  		}
  	}
  	read_unlock(&iucv_sk_list.lock);
  	return err;
  }
  
  /**
   * afiucv_pm_restore_thaw() - Thaw and restore PM callback
   * @dev:	AFIUCV dummy device
   *
   * socket clean up after freeze
   */
  static int afiucv_pm_restore_thaw(struct device *dev)
  {
c23cad923   Ursula Braun   [S390] PM: af_iuc...
200
201
202
203
204
205
206
207
208
  	struct sock *sk;
  	struct hlist_node *node;
  
  #ifdef CONFIG_PM_DEBUG
  	printk(KERN_WARNING "afiucv_pm_restore_thaw
  ");
  #endif
  	read_lock(&iucv_sk_list.lock);
  	sk_for_each(sk, node, &iucv_sk_list.head) {
c23cad923   Ursula Braun   [S390] PM: af_iuc...
209
210
211
212
213
214
215
  		switch (sk->sk_state) {
  		case IUCV_CONNECTED:
  			sk->sk_err = EPIPE;
  			sk->sk_state = IUCV_DISCONN;
  			sk->sk_state_change(sk);
  			break;
  		case IUCV_DISCONN:
c23cad923   Ursula Braun   [S390] PM: af_iuc...
216
217
218
219
220
221
222
223
224
225
226
  		case IUCV_CLOSING:
  		case IUCV_LISTEN:
  		case IUCV_BOUND:
  		case IUCV_OPEN:
  		default:
  			break;
  		}
  	}
  	read_unlock(&iucv_sk_list.lock);
  	return 0;
  }
471452104   Alexey Dobriyan   const: constify r...
227
  static const struct dev_pm_ops afiucv_pm_ops = {
c23cad923   Ursula Braun   [S390] PM: af_iuc...
228
229
230
231
232
233
234
235
236
237
  	.prepare = afiucv_pm_prepare,
  	.complete = afiucv_pm_complete,
  	.freeze = afiucv_pm_freeze,
  	.thaw = afiucv_pm_restore_thaw,
  	.restore = afiucv_pm_restore_thaw,
  };
  
  static struct device_driver af_iucv_driver = {
  	.owner = THIS_MODULE,
  	.name = "afiucv",
6fcd61f7b   Frank Blaschka   af_iucv: use load...
238
  	.bus  = NULL,
c23cad923   Ursula Braun   [S390] PM: af_iuc...
239
240
241
242
243
  	.pm   = &afiucv_pm_ops,
  };
  
  /* dummy device used as trigger for PM functions */
  static struct device *af_iucv_dev;
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
244
245
246
247
248
249
250
251
252
253
254
255
  /**
   * iucv_msg_length() - Returns the length of an iucv message.
   * @msg:	Pointer to struct iucv_message, MUST NOT be NULL
   *
   * The function returns the length of the specified iucv message @msg of data
   * stored in a buffer and of data stored in the parameter list (PRMDATA).
   *
   * For IUCV_IPRMDATA, AF_IUCV uses the following convention to transport socket
   * data:
   *	PRMDATA[0..6]	socket data (max 7 bytes);
   *	PRMDATA[7]	socket data length value (len is 0xff - PRMDATA[7])
   *
25985edce   Lucas De Marchi   Fix common misspe...
256
   * The socket data length is computed by subtracting the socket data length
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
   * value from 0xFF.
   * If the socket data len is greater 7, then PRMDATA can be used for special
   * notifications (see iucv_sock_shutdown); and further,
   * if the socket data len is > 7, the function returns 8.
   *
   * Use this function to allocate socket buffers to store iucv message data.
   */
  static inline size_t iucv_msg_length(struct iucv_message *msg)
  {
  	size_t datalen;
  
  	if (msg->flags & IUCV_IPRMDATA) {
  		datalen = 0xff - msg->rmmsg[7];
  		return (datalen < 8) ? datalen : 8;
  	}
  	return msg->length;
  }
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
  /**
   * iucv_sock_in_state() - check for specific states
   * @sk:		sock structure
   * @state:	first iucv sk state
   * @state:	second iucv sk state
   *
   * Returns true if the socket in either in the first or second state.
   */
  static int iucv_sock_in_state(struct sock *sk, int state, int state2)
  {
  	return (sk->sk_state == state || sk->sk_state == state2);
  }
  
  /**
   * iucv_below_msglim() - function to check if messages can be sent
   * @sk:		sock structure
   *
   * Returns true if the send queue length is lower than the message limit.
   * Always returns true if the socket is not connected (no iucv path for
   * checking the message limit).
   */
  static inline int iucv_below_msglim(struct sock *sk)
  {
  	struct iucv_sock *iucv = iucv_sk(sk);
  
  	if (sk->sk_state != IUCV_CONNECTED)
  		return 1;
3881ac441   Ursula Braun   af_iucv: add Hipe...
301
302
303
304
305
  	if (iucv->transport == AF_IUCV_TRANS_IUCV)
  		return (skb_queue_len(&iucv->send_skb_q) < iucv->path->msglim);
  	else
  		return ((atomic_read(&iucv->msg_sent) < iucv->msglimit_peer) &&
  			(atomic_read(&iucv->pendings) <= 0));
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
306
307
308
309
310
311
312
  }
  
  /**
   * iucv_sock_wake_msglim() - Wake up thread waiting on msg limit
   */
  static void iucv_sock_wake_msglim(struct sock *sk)
  {
438154823   Eric Dumazet   net: sock_def_rea...
313
314
315
316
317
318
  	struct socket_wq *wq;
  
  	rcu_read_lock();
  	wq = rcu_dereference(sk->sk_wq);
  	if (wq_has_sleeper(wq))
  		wake_up_interruptible_all(&wq->wait);
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
319
  	sk_wake_async(sk, SOCK_WAKE_SPACE, POLL_OUT);
438154823   Eric Dumazet   net: sock_def_rea...
320
  	rcu_read_unlock();
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
321
  }
3881ac441   Ursula Braun   af_iucv: add Hipe...
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
  /**
   * afiucv_hs_send() - send a message through HiperSockets transport
   */
  static int afiucv_hs_send(struct iucv_message *imsg, struct sock *sock,
  		   struct sk_buff *skb, u8 flags)
  {
  	struct net *net = sock_net(sock);
  	struct iucv_sock *iucv = iucv_sk(sock);
  	struct af_iucv_trans_hdr *phs_hdr;
  	struct sk_buff *nskb;
  	int err, confirm_recv = 0;
  
  	memset(skb->head, 0, ETH_HLEN);
  	phs_hdr = (struct af_iucv_trans_hdr *)skb_push(skb,
  					sizeof(struct af_iucv_trans_hdr));
  	skb_reset_mac_header(skb);
  	skb_reset_network_header(skb);
  	skb_push(skb, ETH_HLEN);
  	skb_reset_mac_header(skb);
  	memset(phs_hdr, 0, sizeof(struct af_iucv_trans_hdr));
  
  	phs_hdr->magic = ETH_P_AF_IUCV;
  	phs_hdr->version = 1;
  	phs_hdr->flags = flags;
  	if (flags == AF_IUCV_FLAG_SYN)
  		phs_hdr->window = iucv->msglimit;
  	else if ((flags == AF_IUCV_FLAG_WIN) || !flags) {
  		confirm_recv = atomic_read(&iucv->msg_recv);
  		phs_hdr->window = confirm_recv;
  		if (confirm_recv)
  			phs_hdr->flags = phs_hdr->flags | AF_IUCV_FLAG_WIN;
  	}
  	memcpy(phs_hdr->destUserID, iucv->dst_user_id, 8);
  	memcpy(phs_hdr->destAppName, iucv->dst_name, 8);
  	memcpy(phs_hdr->srcUserID, iucv->src_user_id, 8);
  	memcpy(phs_hdr->srcAppName, iucv->src_name, 8);
  	ASCEBC(phs_hdr->destUserID, sizeof(phs_hdr->destUserID));
  	ASCEBC(phs_hdr->destAppName, sizeof(phs_hdr->destAppName));
  	ASCEBC(phs_hdr->srcUserID, sizeof(phs_hdr->srcUserID));
  	ASCEBC(phs_hdr->srcAppName, sizeof(phs_hdr->srcAppName));
  	if (imsg)
  		memcpy(&phs_hdr->iucv_hdr, imsg, sizeof(struct iucv_message));
816abbadf   Ursula Braun   af_iucv: release ...
364
  	skb->dev = dev_get_by_index(net, sock->sk_bound_dev_if);
3881ac441   Ursula Braun   af_iucv: add Hipe...
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
  	if (!skb->dev)
  		return -ENODEV;
  	if (!(skb->dev->flags & IFF_UP))
  		return -ENETDOWN;
  	if (skb->len > skb->dev->mtu) {
  		if (sock->sk_type == SOCK_SEQPACKET)
  			return -EMSGSIZE;
  		else
  			skb_trim(skb, skb->dev->mtu);
  	}
  	skb->protocol = ETH_P_AF_IUCV;
  	skb_shinfo(skb)->tx_flags |= SKBTX_DRV_NEEDS_SK_REF;
  	nskb = skb_clone(skb, GFP_ATOMIC);
  	if (!nskb)
  		return -ENOMEM;
  	skb_queue_tail(&iucv->send_skb_q, nskb);
  	err = dev_queue_xmit(skb);
  	if (err) {
  		skb_unlink(nskb, &iucv->send_skb_q);
816abbadf   Ursula Braun   af_iucv: release ...
384
  		dev_put(nskb->dev);
3881ac441   Ursula Braun   af_iucv: add Hipe...
385
386
387
388
389
390
391
  		kfree_skb(nskb);
  	} else {
  		atomic_sub(confirm_recv, &iucv->msg_recv);
  		WARN_ON(atomic_read(&iucv->msg_recv) < 0);
  	}
  	return err;
  }
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
  static struct sock *__iucv_get_sock_by_name(char *nm)
  {
  	struct sock *sk;
  	struct hlist_node *node;
  
  	sk_for_each(sk, node, &iucv_sk_list.head)
  		if (!memcmp(&iucv_sk(sk)->src_name, nm, 8))
  			return sk;
  
  	return NULL;
  }
  
  static void iucv_sock_destruct(struct sock *sk)
  {
  	skb_queue_purge(&sk->sk_receive_queue);
  	skb_queue_purge(&sk->sk_write_queue);
  }
  
  /* Cleanup Listen */
  static void iucv_sock_cleanup_listen(struct sock *parent)
  {
  	struct sock *sk;
  
  	/* Close non-accepted connections */
  	while ((sk = iucv_accept_dequeue(parent, NULL))) {
  		iucv_sock_close(sk);
  		iucv_sock_kill(sk);
  	}
  
  	parent->sk_state = IUCV_CLOSED;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
422
  }
7514bab04   Hendrik Brueckner   af_iucv: do not c...
423
  /* Kill socket (only if zapped and orphaned) */
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
  static void iucv_sock_kill(struct sock *sk)
  {
  	if (!sock_flag(sk, SOCK_ZAPPED) || sk->sk_socket)
  		return;
  
  	iucv_sock_unlink(&iucv_sk_list, sk);
  	sock_set_flag(sk, SOCK_DEAD);
  	sock_put(sk);
  }
  
  /* Close an IUCV socket */
  static void iucv_sock_close(struct sock *sk)
  {
  	unsigned char user_data[16];
  	struct iucv_sock *iucv = iucv_sk(sk);
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
439
  	unsigned long timeo;
3881ac441   Ursula Braun   af_iucv: add Hipe...
440
441
  	int err, blen;
  	struct sk_buff *skb;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
442

eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
443
  	lock_sock(sk);
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
444
  	switch (sk->sk_state) {
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
445
446
447
448
449
  	case IUCV_LISTEN:
  		iucv_sock_cleanup_listen(sk);
  		break;
  
  	case IUCV_CONNECTED:
3881ac441   Ursula Braun   af_iucv: add Hipe...
450
451
452
453
454
  		if (iucv->transport == AF_IUCV_TRANS_HIPER) {
  			/* send fin */
  			blen = sizeof(struct af_iucv_trans_hdr) + ETH_HLEN;
  			skb = sock_alloc_send_skb(sk, blen, 1, &err);
  			if (skb) {
816abbadf   Ursula Braun   af_iucv: release ...
455
  				skb_reserve(skb, blen);
3881ac441   Ursula Braun   af_iucv: add Hipe...
456
457
458
459
460
461
  				err = afiucv_hs_send(NULL, sk, skb,
  						     AF_IUCV_FLAG_FIN);
  			}
  			sk->sk_state = IUCV_DISCONN;
  			sk->sk_state_change(sk);
  		}
816abbadf   Ursula Braun   af_iucv: release ...
462
  	case IUCV_DISCONN:   /* fall through */
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
463
464
  		sk->sk_state = IUCV_CLOSING;
  		sk->sk_state_change(sk);
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
465
  		if (!skb_queue_empty(&iucv->send_skb_q)) {
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
466
467
468
469
  			if (sock_flag(sk, SOCK_LINGER) && sk->sk_lingertime)
  				timeo = sk->sk_lingertime;
  			else
  				timeo = IUCV_DISCONN_TIMEOUT;
9f6298a6c   Ursula Braun   af_iucv: get rid ...
470
  			iucv_sock_wait(sk,
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
471
472
  					iucv_sock_in_state(sk, IUCV_CLOSED, 0),
  					timeo);
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
473
  		}
bbe188c8f   Ursula Braun   af_iucv: consider...
474
  	case IUCV_CLOSING:   /* fall through */
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
475
476
  		sk->sk_state = IUCV_CLOSED;
  		sk->sk_state_change(sk);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
477
478
479
480
  		if (iucv->path) {
  			low_nmcpy(user_data, iucv->src_name);
  			high_nmcpy(user_data, iucv->dst_name);
  			ASCEBC(user_data, sizeof(user_data));
6fcd61f7b   Frank Blaschka   af_iucv: use load...
481
  			pr_iucv->path_sever(iucv->path, user_data);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
482
483
484
  			iucv_path_free(iucv->path);
  			iucv->path = NULL;
  		}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
485
486
  		sk->sk_err = ECONNRESET;
  		sk->sk_state_change(sk);
816abbadf   Ursula Braun   af_iucv: release ...
487
  		iucv_skb_queue_purge(&iucv->send_skb_q);
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
488
  		skb_queue_purge(&iucv->backlog_skb_q);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
489
490
491
  		break;
  
  	default:
7514bab04   Hendrik Brueckner   af_iucv: do not c...
492
  		/* nothing to do here */
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
493
  		break;
3ff50b799   Stephen Hemminger   [NET]: cleanup ex...
494
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
495

7514bab04   Hendrik Brueckner   af_iucv: do not c...
496
497
  	/* mark socket for deletion by iucv_sock_kill() */
  	sock_set_flag(sk, SOCK_ZAPPED);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
498
  	release_sock(sk);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
499
500
501
502
503
504
505
506
507
508
509
  }
  
  static void iucv_sock_init(struct sock *sk, struct sock *parent)
  {
  	if (parent)
  		sk->sk_type = parent->sk_type;
  }
  
  static struct sock *iucv_sock_alloc(struct socket *sock, int proto, gfp_t prio)
  {
  	struct sock *sk;
493d3971a   Ursula Braun   af_iucv: cleanup ...
510
  	struct iucv_sock *iucv;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
511

6257ff217   Pavel Emelyanov   [NET]: Forget the...
512
  	sk = sk_alloc(&init_net, PF_IUCV, prio, &iucv_proto);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
513
514
  	if (!sk)
  		return NULL;
493d3971a   Ursula Braun   af_iucv: cleanup ...
515
  	iucv = iucv_sk(sk);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
516
517
  
  	sock_init_data(sock, sk);
493d3971a   Ursula Braun   af_iucv: cleanup ...
518
519
520
521
522
523
524
  	INIT_LIST_HEAD(&iucv->accept_q);
  	spin_lock_init(&iucv->accept_q_lock);
  	skb_queue_head_init(&iucv->send_skb_q);
  	INIT_LIST_HEAD(&iucv->message_q.list);
  	spin_lock_init(&iucv->message_q.lock);
  	skb_queue_head_init(&iucv->backlog_skb_q);
  	iucv->send_tag = 0;
3881ac441   Ursula Braun   af_iucv: add Hipe...
525
  	atomic_set(&iucv->pendings, 0);
493d3971a   Ursula Braun   af_iucv: cleanup ...
526
  	iucv->flags = 0;
3881ac441   Ursula Braun   af_iucv: add Hipe...
527
528
529
  	iucv->msglimit = 0;
  	atomic_set(&iucv->msg_sent, 0);
  	atomic_set(&iucv->msg_recv, 0);
493d3971a   Ursula Braun   af_iucv: cleanup ...
530
  	iucv->path = NULL;
3881ac441   Ursula Braun   af_iucv: add Hipe...
531
  	iucv->sk_txnotify = afiucv_hs_callback_txnotify;
493d3971a   Ursula Braun   af_iucv: cleanup ...
532
  	memset(&iucv->src_user_id , 0, 32);
3881ac441   Ursula Braun   af_iucv: add Hipe...
533
534
535
536
  	if (pr_iucv)
  		iucv->transport = AF_IUCV_TRANS_IUCV;
  	else
  		iucv->transport = AF_IUCV_TRANS_HIPER;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
537
538
539
540
541
542
543
544
545
  
  	sk->sk_destruct = iucv_sock_destruct;
  	sk->sk_sndtimeo = IUCV_CONN_TIMEOUT;
  	sk->sk_allocation = GFP_DMA;
  
  	sock_reset_flag(sk, SOCK_ZAPPED);
  
  	sk->sk_protocol = proto;
  	sk->sk_state	= IUCV_OPEN;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
546
547
548
549
550
  	iucv_sock_link(&iucv_sk_list, sk);
  	return sk;
  }
  
  /* Create an IUCV socket */
3f378b684   Eric Paris   net: pass kern to...
551
552
  static int iucv_sock_create(struct net *net, struct socket *sock, int protocol,
  			    int kern)
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
553
554
  {
  	struct sock *sk;
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
555
556
  	if (protocol && protocol != PF_IUCV)
  		return -EPROTONOSUPPORT;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
557
558
  
  	sock->state = SS_UNCONNECTED;
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
559
560
561
562
563
564
565
566
567
568
569
570
  
  	switch (sock->type) {
  	case SOCK_STREAM:
  		sock->ops = &iucv_sock_ops;
  		break;
  	case SOCK_SEQPACKET:
  		/* currently, proto ops can handle both sk types */
  		sock->ops = &iucv_sock_ops;
  		break;
  	default:
  		return -ESOCKTNOSUPPORT;
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
  
  	sk = iucv_sock_alloc(sock, protocol, GFP_KERNEL);
  	if (!sk)
  		return -ENOMEM;
  
  	iucv_sock_init(sk, NULL);
  
  	return 0;
  }
  
  void iucv_sock_link(struct iucv_sock_list *l, struct sock *sk)
  {
  	write_lock_bh(&l->lock);
  	sk_add_node(sk, &l->head);
  	write_unlock_bh(&l->lock);
  }
  
  void iucv_sock_unlink(struct iucv_sock_list *l, struct sock *sk)
  {
  	write_lock_bh(&l->lock);
  	sk_del_node_init(sk);
  	write_unlock_bh(&l->lock);
  }
  
  void iucv_accept_enqueue(struct sock *parent, struct sock *sk)
  {
febca281f   Ursula Braun   [AF_IUCV]: Add lo...
597
598
  	unsigned long flags;
  	struct iucv_sock *par = iucv_sk(parent);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
599
  	sock_hold(sk);
febca281f   Ursula Braun   [AF_IUCV]: Add lo...
600
601
602
  	spin_lock_irqsave(&par->accept_q_lock, flags);
  	list_add_tail(&iucv_sk(sk)->accept_q, &par->accept_q);
  	spin_unlock_irqrestore(&par->accept_q_lock, flags);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
603
  	iucv_sk(sk)->parent = parent;
49f5eba75   Hendrik Brueckner   af_iucv: use sk f...
604
  	sk_acceptq_added(parent);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
605
606
607
608
  }
  
  void iucv_accept_unlink(struct sock *sk)
  {
febca281f   Ursula Braun   [AF_IUCV]: Add lo...
609
610
611
612
  	unsigned long flags;
  	struct iucv_sock *par = iucv_sk(iucv_sk(sk)->parent);
  
  	spin_lock_irqsave(&par->accept_q_lock, flags);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
613
  	list_del_init(&iucv_sk(sk)->accept_q);
febca281f   Ursula Braun   [AF_IUCV]: Add lo...
614
  	spin_unlock_irqrestore(&par->accept_q_lock, flags);
49f5eba75   Hendrik Brueckner   af_iucv: use sk f...
615
  	sk_acceptq_removed(iucv_sk(sk)->parent);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
616
617
618
619
620
621
622
623
  	iucv_sk(sk)->parent = NULL;
  	sock_put(sk);
  }
  
  struct sock *iucv_accept_dequeue(struct sock *parent, struct socket *newsock)
  {
  	struct iucv_sock *isk, *n;
  	struct sock *sk;
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
624
  	list_for_each_entry_safe(isk, n, &iucv_sk(parent)->accept_q, accept_q) {
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
625
626
627
628
  		sk = (struct sock *) isk;
  		lock_sock(sk);
  
  		if (sk->sk_state == IUCV_CLOSED) {
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
629
  			iucv_accept_unlink(sk);
febca281f   Ursula Braun   [AF_IUCV]: Add lo...
630
  			release_sock(sk);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
631
632
633
634
  			continue;
  		}
  
  		if (sk->sk_state == IUCV_CONNECTED ||
aac6399c6   Ursula Braun   af_iucv: get rid ...
635
  		    sk->sk_state == IUCV_DISCONN ||
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
636
637
638
639
  		    !newsock) {
  			iucv_accept_unlink(sk);
  			if (newsock)
  				sock_graft(sk, newsock);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
640
641
642
643
644
645
646
647
  			release_sock(sk);
  			return sk;
  		}
  
  		release_sock(sk);
  	}
  	return NULL;
  }
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
648
649
650
651
652
653
654
  /* Bind an unbound socket */
  static int iucv_sock_bind(struct socket *sock, struct sockaddr *addr,
  			  int addr_len)
  {
  	struct sockaddr_iucv *sa = (struct sockaddr_iucv *) addr;
  	struct sock *sk = sock->sk;
  	struct iucv_sock *iucv;
3881ac441   Ursula Braun   af_iucv: add Hipe...
655
656
657
  	int err = 0;
  	struct net_device *dev;
  	char uid[9];
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
  
  	/* Verify the input sockaddr */
  	if (!addr || addr->sa_family != AF_IUCV)
  		return -EINVAL;
  
  	lock_sock(sk);
  	if (sk->sk_state != IUCV_OPEN) {
  		err = -EBADFD;
  		goto done;
  	}
  
  	write_lock_bh(&iucv_sk_list.lock);
  
  	iucv = iucv_sk(sk);
  	if (__iucv_get_sock_by_name(sa->siucv_name)) {
  		err = -EADDRINUSE;
  		goto done_unlock;
  	}
3881ac441   Ursula Braun   af_iucv: add Hipe...
676
  	if (iucv->path)
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
677
  		goto done_unlock;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
678
679
  
  	/* Bind the socket */
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
680

3881ac441   Ursula Braun   af_iucv: add Hipe...
681
682
683
  	if (pr_iucv)
  		if (!memcmp(sa->siucv_user_id, iucv_userid, 8))
  			goto vm_bind; /* VM IUCV transport */
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
684

3881ac441   Ursula Braun   af_iucv: add Hipe...
685
686
687
688
689
690
691
692
  	/* try hiper transport */
  	memcpy(uid, sa->siucv_user_id, sizeof(uid));
  	ASCEBC(uid, 8);
  	rcu_read_lock();
  	for_each_netdev_rcu(&init_net, dev) {
  		if (!memcmp(dev->perm_addr, uid, 8)) {
  			memcpy(iucv->src_name, sa->siucv_name, 8);
  			memcpy(iucv->src_user_id, sa->siucv_user_id, 8);
816abbadf   Ursula Braun   af_iucv: release ...
693
  			sk->sk_bound_dev_if = dev->ifindex;
3881ac441   Ursula Braun   af_iucv: add Hipe...
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
  			sk->sk_state = IUCV_BOUND;
  			iucv->transport = AF_IUCV_TRANS_HIPER;
  			if (!iucv->msglimit)
  				iucv->msglimit = IUCV_HIPER_MSGLIM_DEFAULT;
  			rcu_read_unlock();
  			goto done_unlock;
  		}
  	}
  	rcu_read_unlock();
  vm_bind:
  	if (pr_iucv) {
  		/* use local userid for backward compat */
  		memcpy(iucv->src_name, sa->siucv_name, 8);
  		memcpy(iucv->src_user_id, iucv_userid, 8);
  		sk->sk_state = IUCV_BOUND;
  		iucv->transport = AF_IUCV_TRANS_IUCV;
  		if (!iucv->msglimit)
  			iucv->msglimit = IUCV_QUEUELEN_DEFAULT;
  		goto done_unlock;
  	}
  	/* found no dev to bind */
  	err = -ENODEV;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
716
717
718
719
720
721
722
723
724
725
726
727
  done_unlock:
  	/* Release the socket list lock */
  	write_unlock_bh(&iucv_sk_list.lock);
  done:
  	release_sock(sk);
  	return err;
  }
  
  /* Automatically bind an unbound socket */
  static int iucv_sock_autobind(struct sock *sk)
  {
  	struct iucv_sock *iucv = iucv_sk(sk);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
728
729
  	char name[12];
  	int err = 0;
aac6399c6   Ursula Braun   af_iucv: get rid ...
730
  	if (unlikely(!pr_iucv))
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
731
  		return -EPROTO;
aac6399c6   Ursula Braun   af_iucv: get rid ...
732
  	memcpy(iucv->src_user_id, iucv_userid, 8);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
733
734
735
736
737
738
739
740
741
742
743
744
  
  	write_lock_bh(&iucv_sk_list.lock);
  
  	sprintf(name, "%08x", atomic_inc_return(&iucv_sk_list.autobind_name));
  	while (__iucv_get_sock_by_name(name)) {
  		sprintf(name, "%08x",
  			atomic_inc_return(&iucv_sk_list.autobind_name));
  	}
  
  	write_unlock_bh(&iucv_sk_list.lock);
  
  	memcpy(&iucv->src_name, name, 8);
3881ac441   Ursula Braun   af_iucv: add Hipe...
745
746
  	if (!iucv->msglimit)
  		iucv->msglimit = IUCV_QUEUELEN_DEFAULT;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
747
748
  	return err;
  }
3881ac441   Ursula Braun   af_iucv: add Hipe...
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
  static int afiucv_hs_connect(struct socket *sock)
  {
  	struct sock *sk = sock->sk;
  	struct sk_buff *skb;
  	int blen = sizeof(struct af_iucv_trans_hdr) + ETH_HLEN;
  	int err = 0;
  
  	/* send syn */
  	skb = sock_alloc_send_skb(sk, blen, 1, &err);
  	if (!skb) {
  		err = -ENOMEM;
  		goto done;
  	}
  	skb->dev = NULL;
  	skb_reserve(skb, blen);
  	err = afiucv_hs_send(NULL, sk, skb, AF_IUCV_FLAG_SYN);
  done:
  	return err;
  }
  
  static int afiucv_path_connect(struct socket *sock, struct sockaddr *addr)
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
770
771
772
  {
  	struct sockaddr_iucv *sa = (struct sockaddr_iucv *) addr;
  	struct sock *sk = sock->sk;
493d3971a   Ursula Braun   af_iucv: cleanup ...
773
  	struct iucv_sock *iucv = iucv_sk(sk);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
774
775
  	unsigned char user_data[16];
  	int err;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
776
  	high_nmcpy(user_data, sa->siucv_name);
493d3971a   Ursula Braun   af_iucv: cleanup ...
777
  	low_nmcpy(user_data, iucv->src_name);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
778
  	ASCEBC(user_data, sizeof(user_data));
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
779
  	/* Create path. */
09488e2e0   Hendrik Brueckner   af_iucv: New sock...
780
  	iucv->path = iucv_path_alloc(iucv->msglimit,
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
781
  				     IUCV_IPRMDATA, GFP_KERNEL);
d44447229   Ursula Braun   [AF_IUCV]: broken...
782
783
784
785
  	if (!iucv->path) {
  		err = -ENOMEM;
  		goto done;
  	}
6fcd61f7b   Frank Blaschka   af_iucv: use load...
786
787
788
  	err = pr_iucv->path_connect(iucv->path, &af_iucv_handler,
  				    sa->siucv_user_id, NULL, user_data,
  				    sk);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
789
790
791
  	if (err) {
  		iucv_path_free(iucv->path);
  		iucv->path = NULL;
55cdea9ed   Hendrik Brueckner   af_iucv: New erro...
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
  		switch (err) {
  		case 0x0b:	/* Target communicator is not logged on */
  			err = -ENETUNREACH;
  			break;
  		case 0x0d:	/* Max connections for this guest exceeded */
  		case 0x0e:	/* Max connections for target guest exceeded */
  			err = -EAGAIN;
  			break;
  		case 0x0f:	/* Missing IUCV authorization */
  			err = -EACCES;
  			break;
  		default:
  			err = -ECONNREFUSED;
  			break;
  		}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
807
  	}
3881ac441   Ursula Braun   af_iucv: add Hipe...
808
809
810
  done:
  	return err;
  }
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
811

3881ac441   Ursula Braun   af_iucv: add Hipe...
812
813
814
815
816
817
818
819
820
821
822
823
824
825
826
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
847
848
849
850
851
852
853
  /* Connect an unconnected socket */
  static int iucv_sock_connect(struct socket *sock, struct sockaddr *addr,
  			     int alen, int flags)
  {
  	struct sockaddr_iucv *sa = (struct sockaddr_iucv *) addr;
  	struct sock *sk = sock->sk;
  	struct iucv_sock *iucv = iucv_sk(sk);
  	int err;
  
  	if (addr->sa_family != AF_IUCV || alen < sizeof(struct sockaddr_iucv))
  		return -EINVAL;
  
  	if (sk->sk_state != IUCV_OPEN && sk->sk_state != IUCV_BOUND)
  		return -EBADFD;
  
  	if (sk->sk_state == IUCV_OPEN &&
  	    iucv->transport == AF_IUCV_TRANS_HIPER)
  		return -EBADFD; /* explicit bind required */
  
  	if (sk->sk_type != SOCK_STREAM && sk->sk_type != SOCK_SEQPACKET)
  		return -EINVAL;
  
  	if (sk->sk_state == IUCV_OPEN) {
  		err = iucv_sock_autobind(sk);
  		if (unlikely(err))
  			return err;
  	}
  
  	lock_sock(sk);
  
  	/* Set the destination information */
  	memcpy(iucv->dst_user_id, sa->siucv_user_id, 8);
  	memcpy(iucv->dst_name, sa->siucv_name, 8);
  
  	if (iucv->transport == AF_IUCV_TRANS_HIPER)
  		err = afiucv_hs_connect(sock);
  	else
  		err = afiucv_path_connect(sock, addr);
  	if (err)
  		goto done;
  
  	if (sk->sk_state != IUCV_CONNECTED)
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
854
855
856
  		err = iucv_sock_wait(sk, iucv_sock_in_state(sk, IUCV_CONNECTED,
  							    IUCV_DISCONN),
  				     sock_sndtimeo(sk, flags & O_NONBLOCK));
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
857

3881ac441   Ursula Braun   af_iucv: add Hipe...
858
  	if (sk->sk_state == IUCV_DISCONN || sk->sk_state == IUCV_CLOSED)
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
859
  		err = -ECONNREFUSED;
18becbc54   Ursula Braun   af_iucv: avoid le...
860

3881ac441   Ursula Braun   af_iucv: add Hipe...
861
  	if (err && iucv->transport == AF_IUCV_TRANS_IUCV) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
862
  		pr_iucv->path_sever(iucv->path, NULL);
18becbc54   Ursula Braun   af_iucv: avoid le...
863
864
865
  		iucv_path_free(iucv->path);
  		iucv->path = NULL;
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
866
867
868
869
870
871
872
873
874
875
876
877
878
879
  done:
  	release_sock(sk);
  	return err;
  }
  
  /* Move a socket into listening state. */
  static int iucv_sock_listen(struct socket *sock, int backlog)
  {
  	struct sock *sk = sock->sk;
  	int err;
  
  	lock_sock(sk);
  
  	err = -EINVAL;
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
880
881
882
883
  	if (sk->sk_state != IUCV_BOUND)
  		goto done;
  
  	if (sock->type != SOCK_STREAM && sock->type != SOCK_SEQPACKET)
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
884
885
886
887
888
889
890
891
892
893
894
895
896
897
898
899
900
901
902
903
  		goto done;
  
  	sk->sk_max_ack_backlog = backlog;
  	sk->sk_ack_backlog = 0;
  	sk->sk_state = IUCV_LISTEN;
  	err = 0;
  
  done:
  	release_sock(sk);
  	return err;
  }
  
  /* Accept a pending connection */
  static int iucv_sock_accept(struct socket *sock, struct socket *newsock,
  			    int flags)
  {
  	DECLARE_WAITQUEUE(wait, current);
  	struct sock *sk = sock->sk, *nsk;
  	long timeo;
  	int err = 0;
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
904
  	lock_sock_nested(sk, SINGLE_DEPTH_NESTING);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
905
906
907
908
909
910
911
912
913
  
  	if (sk->sk_state != IUCV_LISTEN) {
  		err = -EBADFD;
  		goto done;
  	}
  
  	timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
  
  	/* Wait for an incoming connection */
aa3951451   Eric Dumazet   net: sk_sleep() h...
914
  	add_wait_queue_exclusive(sk_sleep(sk), &wait);
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
915
  	while (!(nsk = iucv_accept_dequeue(sk, newsock))) {
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
916
917
918
919
920
921
922
923
  		set_current_state(TASK_INTERRUPTIBLE);
  		if (!timeo) {
  			err = -EAGAIN;
  			break;
  		}
  
  		release_sock(sk);
  		timeo = schedule_timeout(timeo);
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
924
  		lock_sock_nested(sk, SINGLE_DEPTH_NESTING);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
925
926
927
928
929
930
931
932
933
934
935
936
937
  
  		if (sk->sk_state != IUCV_LISTEN) {
  			err = -EBADFD;
  			break;
  		}
  
  		if (signal_pending(current)) {
  			err = sock_intr_errno(timeo);
  			break;
  		}
  	}
  
  	set_current_state(TASK_RUNNING);
aa3951451   Eric Dumazet   net: sk_sleep() h...
938
  	remove_wait_queue(sk_sleep(sk), &wait);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
  
  	if (err)
  		goto done;
  
  	newsock->state = SS_CONNECTED;
  
  done:
  	release_sock(sk);
  	return err;
  }
  
  static int iucv_sock_getname(struct socket *sock, struct sockaddr *addr,
  			     int *len, int peer)
  {
  	struct sockaddr_iucv *siucv = (struct sockaddr_iucv *) addr;
  	struct sock *sk = sock->sk;
493d3971a   Ursula Braun   af_iucv: cleanup ...
955
  	struct iucv_sock *iucv = iucv_sk(sk);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
956
957
958
959
960
  
  	addr->sa_family = AF_IUCV;
  	*len = sizeof(struct sockaddr_iucv);
  
  	if (peer) {
493d3971a   Ursula Braun   af_iucv: cleanup ...
961
962
  		memcpy(siucv->siucv_user_id, iucv->dst_user_id, 8);
  		memcpy(siucv->siucv_name, iucv->dst_name, 8);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
963
  	} else {
493d3971a   Ursula Braun   af_iucv: cleanup ...
964
965
  		memcpy(siucv->siucv_user_id, iucv->src_user_id, 8);
  		memcpy(siucv->siucv_name, iucv->src_name, 8);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
966
967
968
  	}
  	memset(&siucv->siucv_port, 0, sizeof(siucv->siucv_port));
  	memset(&siucv->siucv_addr, 0, sizeof(siucv->siucv_addr));
493d3971a   Ursula Braun   af_iucv: cleanup ...
969
  	memset(&siucv->siucv_nodeid, 0, sizeof(siucv->siucv_nodeid));
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
970
971
972
  
  	return 0;
  }
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
973
974
975
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991
992
  /**
   * iucv_send_iprm() - Send socket data in parameter list of an iucv message.
   * @path:	IUCV path
   * @msg:	Pointer to a struct iucv_message
   * @skb:	The socket data to send, skb->len MUST BE <= 7
   *
   * Send the socket data in the parameter list in the iucv message
   * (IUCV_IPRMDATA). The socket data is stored at index 0 to 6 in the parameter
   * list and the socket data len at index 7 (last byte).
   * See also iucv_msg_length().
   *
   * Returns the error code from the iucv_message_send() call.
   */
  static int iucv_send_iprm(struct iucv_path *path, struct iucv_message *msg,
  			  struct sk_buff *skb)
  {
  	u8 prmdata[8];
  
  	memcpy(prmdata, (void *) skb->data, skb->len);
  	prmdata[7] = 0xff - (u8) skb->len;
6fcd61f7b   Frank Blaschka   af_iucv: use load...
993
  	return pr_iucv->message_send(path, msg, IUCV_IPRMDATA, 0,
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
994
995
  				 (void *) prmdata, 8);
  }
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
996
997
998
999
1000
1001
1002
  static int iucv_sock_sendmsg(struct kiocb *iocb, struct socket *sock,
  			     struct msghdr *msg, size_t len)
  {
  	struct sock *sk = sock->sk;
  	struct iucv_sock *iucv = iucv_sk(sk);
  	struct sk_buff *skb;
  	struct iucv_message txmsg;
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1003
1004
  	struct cmsghdr *cmsg;
  	int cmsg_done;
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
1005
  	long timeo;
8f7c502c2   Ursula Braun   [S390] convert iu...
1006
1007
  	char user_id[9];
  	char appl_id[9];
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1008
  	int err;
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
1009
  	int noblock = msg->msg_flags & MSG_DONTWAIT;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1010
1011
1012
1013
1014
1015
1016
  
  	err = sock_error(sk);
  	if (err)
  		return err;
  
  	if (msg->msg_flags & MSG_OOB)
  		return -EOPNOTSUPP;
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
1017
1018
1019
  	/* SOCK_SEQPACKET: we do not support segmented records */
  	if (sk->sk_type == SOCK_SEQPACKET && !(msg->msg_flags & MSG_EOR))
  		return -EOPNOTSUPP;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1020
1021
1022
1023
1024
1025
  	lock_sock(sk);
  
  	if (sk->sk_shutdown & SEND_SHUTDOWN) {
  		err = -EPIPE;
  		goto out;
  	}
bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1026
1027
1028
1029
1030
  	/* Return if the socket is not in connected state */
  	if (sk->sk_state != IUCV_CONNECTED) {
  		err = -ENOTCONN;
  		goto out;
  	}
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1031

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1032
1033
1034
  	/* initialize defaults */
  	cmsg_done   = 0;	/* check for duplicate headers */
  	txmsg.class = 0;
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1035

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1036
1037
1038
  	/* iterate over control messages */
  	for (cmsg = CMSG_FIRSTHDR(msg); cmsg;
  		cmsg = CMSG_NXTHDR(msg, cmsg)) {
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1039

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1040
1041
1042
1043
  		if (!CMSG_OK(msg, cmsg)) {
  			err = -EINVAL;
  			goto out;
  		}
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1044

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1045
1046
  		if (cmsg->cmsg_level != SOL_IUCV)
  			continue;
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1047

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1048
1049
1050
1051
1052
  		if (cmsg->cmsg_type & cmsg_done) {
  			err = -EINVAL;
  			goto out;
  		}
  		cmsg_done |= cmsg->cmsg_type;
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1053

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1054
1055
1056
  		switch (cmsg->cmsg_type) {
  		case SCM_IUCV_TRGCLS:
  			if (cmsg->cmsg_len != CMSG_LEN(TRGCLS_SIZE)) {
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1057
1058
1059
  				err = -EINVAL;
  				goto out;
  			}
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1060

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1061
1062
1063
  			/* set iucv message target class */
  			memcpy(&txmsg.class,
  				(void *) CMSG_DATA(cmsg), TRGCLS_SIZE);
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1064

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1065
  			break;
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1066

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1067
1068
1069
1070
  		default:
  			err = -EINVAL;
  			goto out;
  			break;
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1071
  		}
bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1072
  	}
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1073

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1074
1075
1076
1077
  	/* allocate one skb for each iucv message:
  	 * this is fine for SOCK_SEQPACKET (unless we want to support
  	 * segmented records using the MSG_EOR flag), but
  	 * for SOCK_STREAM we might want to improve it in future */
3881ac441   Ursula Braun   af_iucv: add Hipe...
1078
1079
1080
1081
1082
1083
  	if (iucv->transport == AF_IUCV_TRANS_HIPER)
  		skb = sock_alloc_send_skb(sk,
  			len + sizeof(struct af_iucv_trans_hdr) + ETH_HLEN,
  			noblock, &err);
  	else
  		skb = sock_alloc_send_skb(sk, len, noblock, &err);
bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1084
1085
  	if (!skb)
  		goto out;
3881ac441   Ursula Braun   af_iucv: add Hipe...
1086
1087
  	if (iucv->transport == AF_IUCV_TRANS_HIPER)
  		skb_reserve(skb, sizeof(struct af_iucv_trans_hdr) + ETH_HLEN);
bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1088
1089
1090
1091
  	if (memcpy_fromiovec(skb_put(skb, len), msg->msg_iov, len)) {
  		err = -EFAULT;
  		goto fail;
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1092

0ea920d21   Hendrik Brueckner   af_iucv: Return -...
1093
1094
1095
1096
1097
  	/* wait if outstanding messages for iucv path has reached */
  	timeo = sock_sndtimeo(sk, noblock);
  	err = iucv_sock_wait(sk, iucv_below_msglim(sk), timeo);
  	if (err)
  		goto fail;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1098

0ea920d21   Hendrik Brueckner   af_iucv: Return -...
1099
1100
1101
1102
1103
  	/* return -ECONNRESET if the socket is no longer connected */
  	if (sk->sk_state != IUCV_CONNECTED) {
  		err = -ECONNRESET;
  		goto fail;
  	}
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
1104

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1105
1106
1107
  	/* increment and save iucv message tag for msg_completion cbk */
  	txmsg.tag = iucv->send_tag++;
  	memcpy(CB_TAG(skb), &txmsg.tag, CB_TAG_LEN);
3881ac441   Ursula Braun   af_iucv: add Hipe...
1108
1109
1110
1111
1112
1113
1114
1115
1116
  	if (iucv->transport == AF_IUCV_TRANS_HIPER) {
  		atomic_inc(&iucv->msg_sent);
  		err = afiucv_hs_send(&txmsg, sk, skb, 0);
  		if (err) {
  			atomic_dec(&iucv->msg_sent);
  			goto fail;
  		}
  		goto release;
  	}
bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1117
  	skb_queue_tail(&iucv->send_skb_q, skb);
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
1118

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1119
1120
1121
  	if (((iucv->path->flags & IUCV_IPRMDATA) & iucv->flags)
  	      && skb->len <= 7) {
  		err = iucv_send_iprm(iucv->path, &txmsg, skb);
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
1122

bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132
  		/* on success: there is no message_complete callback
  		 * for an IPRMDATA msg; remove skb from send queue */
  		if (err == 0) {
  			skb_unlink(skb, &iucv->send_skb_q);
  			kfree_skb(skb);
  		}
  
  		/* this error should never happen since the
  		 * IUCV_IPRMDATA path flag is set... sever path */
  		if (err == 0x15) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1133
  			pr_iucv->path_sever(iucv->path, NULL);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1134
1135
1136
1137
  			skb_unlink(skb, &iucv->send_skb_q);
  			err = -EPIPE;
  			goto fail;
  		}
bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1138
  	} else
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1139
  		err = pr_iucv->message_send(iucv->path, &txmsg, 0, 0,
bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150
  					(void *) skb->data, skb->len);
  	if (err) {
  		if (err == 3) {
  			user_id[8] = 0;
  			memcpy(user_id, iucv->dst_user_id, 8);
  			appl_id[8] = 0;
  			memcpy(appl_id, iucv->dst_name, 8);
  			pr_err("Application %s on z/VM guest %s"
  				" exceeds message limit
  ",
  				appl_id, user_id);
0ea920d21   Hendrik Brueckner   af_iucv: Return -...
1151
1152
1153
  			err = -EAGAIN;
  		} else
  			err = -EPIPE;
bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1154
  		skb_unlink(skb, &iucv->send_skb_q);
bb664f49f   Hendrik Brueckner   af_iucv: Change i...
1155
  		goto fail;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1156
  	}
3881ac441   Ursula Braun   af_iucv: add Hipe...
1157
  release:
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1158
1159
1160
1161
  	release_sock(sk);
  	return len;
  
  fail:
816abbadf   Ursula Braun   af_iucv: release ...
1162
1163
  	if (skb->dev)
  		dev_put(skb->dev);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1164
1165
1166
1167
1168
  	kfree_skb(skb);
  out:
  	release_sock(sk);
  	return err;
  }
bf95d20fd   Hendrik Brueckner   af_iucv: fix race...
1169
1170
1171
1172
  /* iucv_fragment_skb() - Fragment a single IUCV message into multiple skb's
   *
   * Locking: must be called with message_q.lock held
   */
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
  static int iucv_fragment_skb(struct sock *sk, struct sk_buff *skb, int len)
  {
  	int dataleft, size, copied = 0;
  	struct sk_buff *nskb;
  
  	dataleft = len;
  	while (dataleft) {
  		if (dataleft >= sk->sk_rcvbuf / 4)
  			size = sk->sk_rcvbuf / 4;
  		else
  			size = dataleft;
  
  		nskb = alloc_skb(size, GFP_ATOMIC | GFP_DMA);
  		if (!nskb)
  			return -ENOMEM;
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1188
1189
1190
1191
  		/* copy target class to control buffer of new skb */
  		memcpy(CB_TRGCLS(nskb), CB_TRGCLS(skb), CB_TRGCLS_LEN);
  
  		/* copy data fragment */
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1192
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
  		memcpy(nskb->data, skb->data + copied, size);
  		copied += size;
  		dataleft -= size;
  
  		skb_reset_transport_header(nskb);
  		skb_reset_network_header(nskb);
  		nskb->len = size;
  
  		skb_queue_tail(&iucv_sk(sk)->backlog_skb_q, nskb);
  	}
  
  	return 0;
  }
bf95d20fd   Hendrik Brueckner   af_iucv: fix race...
1205
1206
1207
1208
  /* iucv_process_message() - Receive a single outstanding IUCV message
   *
   * Locking: must be called with message_q.lock held
   */
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1209
1210
1211
1212
1213
  static void iucv_process_message(struct sock *sk, struct sk_buff *skb,
  				 struct iucv_path *path,
  				 struct iucv_message *msg)
  {
  	int rc;
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
1214
1215
1216
  	unsigned int len;
  
  	len = iucv_msg_length(msg);
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1217

44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1218
1219
1220
  	/* store msg target class in the second 4 bytes of skb ctrl buffer */
  	/* Note: the first 4 bytes are reserved for msg tag */
  	memcpy(CB_TRGCLS(skb), &msg->class, CB_TRGCLS_LEN);
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
1221
1222
1223
1224
1225
1226
  	/* check for special IPRM messages (e.g. iucv_sock_shutdown) */
  	if ((msg->flags & IUCV_IPRMDATA) && len > 7) {
  		if (memcmp(msg->rmmsg, iprm_shutdown, 8) == 0) {
  			skb->data = NULL;
  			skb->len = 0;
  		}
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1227
  	} else {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1228
1229
1230
  		rc = pr_iucv->message_receive(path, msg,
  					      msg->flags & IUCV_IPRMDATA,
  					      skb->data, len, NULL);
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1231
1232
1233
1234
  		if (rc) {
  			kfree_skb(skb);
  			return;
  		}
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
1235
1236
1237
1238
1239
  		/* we need to fragment iucv messages for SOCK_STREAM only;
  		 * for SOCK_SEQPACKET, it is only relevant if we support
  		 * record segmentation using MSG_EOR (see also recvmsg()) */
  		if (sk->sk_type == SOCK_STREAM &&
  		    skb->truesize >= sk->sk_rcvbuf / 4) {
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
1240
  			rc = iucv_fragment_skb(sk, skb, len);
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1241
1242
1243
  			kfree_skb(skb);
  			skb = NULL;
  			if (rc) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1244
  				pr_iucv->path_sever(path, NULL);
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1245
1246
1247
1248
1249
1250
  				return;
  			}
  			skb = skb_dequeue(&iucv_sk(sk)->backlog_skb_q);
  		} else {
  			skb_reset_transport_header(skb);
  			skb_reset_network_header(skb);
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
1251
  			skb->len = len;
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1252
1253
1254
1255
1256
1257
  		}
  	}
  
  	if (sock_queue_rcv_skb(sk, skb))
  		skb_queue_head(&iucv_sk(sk)->backlog_skb_q, skb);
  }
bf95d20fd   Hendrik Brueckner   af_iucv: fix race...
1258
1259
1260
1261
  /* iucv_process_message_q() - Process outstanding IUCV messages
   *
   * Locking: must be called with message_q.lock held
   */
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1262
1263
1264
1265
1266
1267
1268
  static void iucv_process_message_q(struct sock *sk)
  {
  	struct iucv_sock *iucv = iucv_sk(sk);
  	struct sk_buff *skb;
  	struct sock_msg_q *p, *n;
  
  	list_for_each_entry_safe(p, n, &iucv->message_q.list, list) {
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
1269
  		skb = alloc_skb(iucv_msg_length(&p->msg), GFP_ATOMIC | GFP_DMA);
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1270
1271
1272
1273
1274
1275
1276
1277
1278
  		if (!skb)
  			break;
  		iucv_process_message(sk, skb, p->path, &p->msg);
  		list_del(&p->list);
  		kfree(p);
  		if (!skb_queue_empty(&iucv->backlog_skb_q))
  			break;
  	}
  }
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1279
1280
1281
1282
1283
  static int iucv_sock_recvmsg(struct kiocb *iocb, struct socket *sock,
  			     struct msghdr *msg, size_t len, int flags)
  {
  	int noblock = flags & MSG_DONTWAIT;
  	struct sock *sk = sock->sk;
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1284
  	struct iucv_sock *iucv = iucv_sk(sk);
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
1285
  	unsigned int copied, rlen;
3881ac441   Ursula Braun   af_iucv: add Hipe...
1286
1287
  	struct sk_buff *skb, *rskb, *cskb, *sskb;
  	int blen;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1288
  	int err = 0;
aac6399c6   Ursula Braun   af_iucv: get rid ...
1289
  	if ((sk->sk_state == IUCV_DISCONN) &&
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1290
1291
1292
  	    skb_queue_empty(&iucv->backlog_skb_q) &&
  	    skb_queue_empty(&sk->sk_receive_queue) &&
  	    list_empty(&iucv->message_q.list))
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1293
  		return 0;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1294
1295
  	if (flags & (MSG_OOB))
  		return -EOPNOTSUPP;
60d3705fc   Hendrik Brueckner   af_iucv: fix oops...
1296
1297
  	/* receive/dequeue next skb:
  	 * the function understands MSG_PEEK and, thus, does not dequeue skb */
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1298
1299
1300
1301
1302
1303
  	skb = skb_recv_datagram(sk, flags, noblock, &err);
  	if (!skb) {
  		if (sk->sk_shutdown & RCV_SHUTDOWN)
  			return 0;
  		return err;
  	}
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
1304
1305
  	rlen   = skb->len;		/* real length of skb */
  	copied = min_t(unsigned int, rlen, len);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1306

561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1307
  	cskb = skb;
3881ac441   Ursula Braun   af_iucv: add Hipe...
1308
  	if (skb_copy_datagram_iovec(cskb, 0, msg->msg_iov, copied)) {
802788bf9   Hendrik Brueckner   af_iucv: cleanup ...
1309
1310
1311
  		if (!(flags & MSG_PEEK))
  			skb_queue_head(&sk->sk_receive_queue, skb);
  		return -EFAULT;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1312
  	}
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
1313
1314
1315
1316
1317
1318
1319
  	/* SOCK_SEQPACKET: set MSG_TRUNC if recv buf size is too small */
  	if (sk->sk_type == SOCK_SEQPACKET) {
  		if (copied < rlen)
  			msg->msg_flags |= MSG_TRUNC;
  		/* each iucv message contains a complete record */
  		msg->msg_flags |= MSG_EOR;
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1320

44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1321
1322
1323
1324
1325
1326
1327
1328
1329
1330
  	/* create control message to store iucv msg target class:
  	 * get the trgcls from the control buffer of the skb due to
  	 * fragmentation of original iucv message. */
  	err = put_cmsg(msg, SOL_IUCV, SCM_IUCV_TRGCLS,
  			CB_TRGCLS_LEN, CB_TRGCLS(skb));
  	if (err) {
  		if (!(flags & MSG_PEEK))
  			skb_queue_head(&sk->sk_receive_queue, skb);
  		return err;
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1331
1332
  	/* Mark read part of skb as used */
  	if (!(flags & MSG_PEEK)) {
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1333

aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
1334
1335
1336
1337
1338
1339
1340
  		/* SOCK_STREAM: re-queue skb if it contains unreceived data */
  		if (sk->sk_type == SOCK_STREAM) {
  			skb_pull(skb, copied);
  			if (skb->len) {
  				skb_queue_head(&sk->sk_receive_queue, skb);
  				goto done;
  			}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1341
1342
1343
  		}
  
  		kfree_skb(skb);
3881ac441   Ursula Braun   af_iucv: add Hipe...
1344
  		atomic_inc(&iucv->msg_recv);
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1345
1346
  
  		/* Queue backlog skbs */
bf95d20fd   Hendrik Brueckner   af_iucv: fix race...
1347
  		spin_lock_bh(&iucv->message_q.lock);
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1348
  		rskb = skb_dequeue(&iucv->backlog_skb_q);
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
1349
  		while (rskb) {
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1350
  			if (sock_queue_rcv_skb(sk, rskb)) {
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1351
  				skb_queue_head(&iucv->backlog_skb_q,
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1352
1353
1354
  						rskb);
  				break;
  			} else {
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1355
  				rskb = skb_dequeue(&iucv->backlog_skb_q);
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1356
1357
  			}
  		}
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1358
  		if (skb_queue_empty(&iucv->backlog_skb_q)) {
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1359
1360
  			if (!list_empty(&iucv->message_q.list))
  				iucv_process_message_q(sk);
3881ac441   Ursula Braun   af_iucv: add Hipe...
1361
1362
1363
1364
1365
1366
1367
  			if (atomic_read(&iucv->msg_recv) >=
  							iucv->msglimit / 2) {
  				/* send WIN to peer */
  				blen = sizeof(struct af_iucv_trans_hdr) +
  					ETH_HLEN;
  				sskb = sock_alloc_send_skb(sk, blen, 1, &err);
  				if (sskb) {
816abbadf   Ursula Braun   af_iucv: release ...
1368
  					skb_reserve(sskb, blen);
3881ac441   Ursula Braun   af_iucv: add Hipe...
1369
1370
1371
1372
1373
1374
1375
1376
  					err = afiucv_hs_send(NULL, sk, sskb,
  							     AF_IUCV_FLAG_WIN);
  				}
  				if (err) {
  					sk->sk_state = IUCV_DISCONN;
  					sk->sk_state_change(sk);
  				}
  			}
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1377
  		}
bf95d20fd   Hendrik Brueckner   af_iucv: fix race...
1378
  		spin_unlock_bh(&iucv->message_q.lock);
60d3705fc   Hendrik Brueckner   af_iucv: fix oops...
1379
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1380
1381
  
  done:
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
1382
1383
1384
1385
1386
  	/* SOCK_SEQPACKET: return real length if MSG_TRUNC is set */
  	if (sk->sk_type == SOCK_SEQPACKET && (flags & MSG_TRUNC))
  		copied = rlen;
  
  	return copied;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1387
1388
1389
1390
1391
1392
  }
  
  static inline unsigned int iucv_accept_poll(struct sock *parent)
  {
  	struct iucv_sock *isk, *n;
  	struct sock *sk;
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
1393
  	list_for_each_entry_safe(isk, n, &iucv_sk(parent)->accept_q, accept_q) {
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1394
1395
1396
1397
1398
1399
1400
1401
1402
1403
1404
1405
1406
1407
  		sk = (struct sock *) isk;
  
  		if (sk->sk_state == IUCV_CONNECTED)
  			return POLLIN | POLLRDNORM;
  	}
  
  	return 0;
  }
  
  unsigned int iucv_sock_poll(struct file *file, struct socket *sock,
  			    poll_table *wait)
  {
  	struct sock *sk = sock->sk;
  	unsigned int mask = 0;
aa3951451   Eric Dumazet   net: sk_sleep() h...
1408
  	sock_poll_wait(file, sk_sleep(sk), wait);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1409
1410
1411
1412
1413
1414
1415
1416
1417
1418
1419
1420
1421
1422
  
  	if (sk->sk_state == IUCV_LISTEN)
  		return iucv_accept_poll(sk);
  
  	if (sk->sk_err || !skb_queue_empty(&sk->sk_error_queue))
  		mask |= POLLERR;
  
  	if (sk->sk_shutdown & RCV_SHUTDOWN)
  		mask |= POLLRDHUP;
  
  	if (sk->sk_shutdown == SHUTDOWN_MASK)
  		mask |= POLLHUP;
  
  	if (!skb_queue_empty(&sk->sk_receive_queue) ||
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
1423
  	    (sk->sk_shutdown & RCV_SHUTDOWN))
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1424
1425
1426
1427
  		mask |= POLLIN | POLLRDNORM;
  
  	if (sk->sk_state == IUCV_CLOSED)
  		mask |= POLLHUP;
aac6399c6   Ursula Braun   af_iucv: get rid ...
1428
  	if (sk->sk_state == IUCV_DISCONN)
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1429
  		mask |= POLLIN;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1430
1431
1432
1433
1434
1435
1436
1437
1438
1439
1440
1441
1442
1443
  	if (sock_writeable(sk))
  		mask |= POLLOUT | POLLWRNORM | POLLWRBAND;
  	else
  		set_bit(SOCK_ASYNC_NOSPACE, &sk->sk_socket->flags);
  
  	return mask;
  }
  
  static int iucv_sock_shutdown(struct socket *sock, int how)
  {
  	struct sock *sk = sock->sk;
  	struct iucv_sock *iucv = iucv_sk(sk);
  	struct iucv_message txmsg;
  	int err = 0;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1444
1445
1446
1447
1448
1449
1450
  
  	how++;
  
  	if ((how & ~SHUTDOWN_MASK) || !how)
  		return -EINVAL;
  
  	lock_sock(sk);
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
1451
  	switch (sk->sk_state) {
e14ad5fa8   Hendrik Brueckner   af_iucv: Test add...
1452
1453
  	case IUCV_DISCONN:
  	case IUCV_CLOSING:
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1454
1455
1456
1457
1458
1459
1460
1461
1462
1463
1464
1465
  	case IUCV_CLOSED:
  		err = -ENOTCONN;
  		goto fail;
  
  	default:
  		sk->sk_shutdown |= how;
  		break;
  	}
  
  	if (how == SEND_SHUTDOWN || how == SHUTDOWN_MASK) {
  		txmsg.class = 0;
  		txmsg.tag = 0;
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1466
1467
  		err = pr_iucv->message_send(iucv->path, &txmsg, IUCV_IPRMDATA,
  					0, (void *) iprm_shutdown, 8);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1468
  		if (err) {
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
1469
  			switch (err) {
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1470
1471
1472
1473
1474
1475
1476
1477
1478
1479
1480
1481
1482
1483
  			case 1:
  				err = -ENOTCONN;
  				break;
  			case 2:
  				err = -ECONNRESET;
  				break;
  			default:
  				err = -ENOTCONN;
  				break;
  			}
  		}
  	}
  
  	if (how == RCV_SHUTDOWN || how == SHUTDOWN_MASK) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1484
  		err = pr_iucv->path_quiesce(iucv->path, NULL);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1485
1486
1487
1488
1489
1490
1491
1492
1493
1494
1495
1496
1497
1498
1499
1500
1501
1502
1503
1504
1505
1506
1507
1508
1509
1510
  		if (err)
  			err = -ENOTCONN;
  
  		skb_queue_purge(&sk->sk_receive_queue);
  	}
  
  	/* Wake up anyone sleeping in poll */
  	sk->sk_state_change(sk);
  
  fail:
  	release_sock(sk);
  	return err;
  }
  
  static int iucv_sock_release(struct socket *sock)
  {
  	struct sock *sk = sock->sk;
  	int err = 0;
  
  	if (!sk)
  		return 0;
  
  	iucv_sock_close(sk);
  
  	/* Unregister with IUCV base support */
  	if (iucv_sk(sk)->path) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1511
  		pr_iucv->path_sever(iucv_sk(sk)->path, NULL);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1512
1513
1514
  		iucv_path_free(iucv_sk(sk)->path);
  		iucv_sk(sk)->path = NULL;
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1515
1516
1517
1518
  	sock_orphan(sk);
  	iucv_sock_kill(sk);
  	return err;
  }
9d5c5d8f4   Hendrik Brueckner   af_iucv: add sock...
1519
1520
  /* getsockopt and setsockopt */
  static int iucv_sock_setsockopt(struct socket *sock, int level, int optname,
b7058842c   David S. Miller   net: Make setsock...
1521
  				char __user *optval, unsigned int optlen)
9d5c5d8f4   Hendrik Brueckner   af_iucv: add sock...
1522
1523
1524
1525
1526
1527
1528
1529
1530
1531
1532
1533
1534
1535
1536
1537
1538
1539
1540
1541
1542
1543
1544
1545
1546
  {
  	struct sock *sk = sock->sk;
  	struct iucv_sock *iucv = iucv_sk(sk);
  	int val;
  	int rc;
  
  	if (level != SOL_IUCV)
  		return -ENOPROTOOPT;
  
  	if (optlen < sizeof(int))
  		return -EINVAL;
  
  	if (get_user(val, (int __user *) optval))
  		return -EFAULT;
  
  	rc = 0;
  
  	lock_sock(sk);
  	switch (optname) {
  	case SO_IPRMDATA_MSG:
  		if (val)
  			iucv->flags |= IUCV_IPRMDATA;
  		else
  			iucv->flags &= ~IUCV_IPRMDATA;
  		break;
09488e2e0   Hendrik Brueckner   af_iucv: New sock...
1547
1548
1549
1550
1551
1552
1553
1554
1555
1556
1557
1558
1559
1560
  	case SO_MSGLIMIT:
  		switch (sk->sk_state) {
  		case IUCV_OPEN:
  		case IUCV_BOUND:
  			if (val < 1 || val > (u16)(~0))
  				rc = -EINVAL;
  			else
  				iucv->msglimit = val;
  			break;
  		default:
  			rc = -EINVAL;
  			break;
  		}
  		break;
9d5c5d8f4   Hendrik Brueckner   af_iucv: add sock...
1561
1562
1563
1564
1565
1566
1567
1568
1569
1570
1571
1572
1573
1574
1575
1576
1577
1578
1579
1580
1581
1582
1583
1584
1585
1586
1587
1588
1589
1590
1591
  	default:
  		rc = -ENOPROTOOPT;
  		break;
  	}
  	release_sock(sk);
  
  	return rc;
  }
  
  static int iucv_sock_getsockopt(struct socket *sock, int level, int optname,
  				char __user *optval, int __user *optlen)
  {
  	struct sock *sk = sock->sk;
  	struct iucv_sock *iucv = iucv_sk(sk);
  	int val, len;
  
  	if (level != SOL_IUCV)
  		return -ENOPROTOOPT;
  
  	if (get_user(len, optlen))
  		return -EFAULT;
  
  	if (len < 0)
  		return -EINVAL;
  
  	len = min_t(unsigned int, len, sizeof(int));
  
  	switch (optname) {
  	case SO_IPRMDATA_MSG:
  		val = (iucv->flags & IUCV_IPRMDATA) ? 1 : 0;
  		break;
09488e2e0   Hendrik Brueckner   af_iucv: New sock...
1592
1593
1594
1595
1596
1597
  	case SO_MSGLIMIT:
  		lock_sock(sk);
  		val = (iucv->path != NULL) ? iucv->path->msglim	/* connected */
  					   : iucv->msglimit;	/* default */
  		release_sock(sk);
  		break;
9d5c5d8f4   Hendrik Brueckner   af_iucv: add sock...
1598
1599
1600
1601
1602
1603
1604
1605
1606
1607
1608
  	default:
  		return -ENOPROTOOPT;
  	}
  
  	if (put_user(len, optlen))
  		return -EFAULT;
  	if (copy_to_user(optval, &val, len))
  		return -EFAULT;
  
  	return 0;
  }
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1609
1610
1611
1612
1613
1614
1615
1616
1617
1618
1619
1620
1621
1622
1623
1624
1625
  /* Callback wrappers - called from iucv base support */
  static int iucv_callback_connreq(struct iucv_path *path,
  				 u8 ipvmid[8], u8 ipuser[16])
  {
  	unsigned char user_data[16];
  	unsigned char nuser_data[16];
  	unsigned char src_name[8];
  	struct hlist_node *node;
  	struct sock *sk, *nsk;
  	struct iucv_sock *iucv, *niucv;
  	int err;
  
  	memcpy(src_name, ipuser, 8);
  	EBCASC(src_name, 8);
  	/* Find out if this path belongs to af_iucv. */
  	read_lock(&iucv_sk_list.lock);
  	iucv = NULL;
febca281f   Ursula Braun   [AF_IUCV]: Add lo...
1626
  	sk = NULL;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1627
1628
1629
1630
1631
1632
1633
1634
1635
1636
1637
1638
1639
1640
1641
1642
1643
1644
1645
1646
1647
1648
  	sk_for_each(sk, node, &iucv_sk_list.head)
  		if (sk->sk_state == IUCV_LISTEN &&
  		    !memcmp(&iucv_sk(sk)->src_name, src_name, 8)) {
  			/*
  			 * Found a listening socket with
  			 * src_name == ipuser[0-7].
  			 */
  			iucv = iucv_sk(sk);
  			break;
  		}
  	read_unlock(&iucv_sk_list.lock);
  	if (!iucv)
  		/* No socket found, not one of our paths. */
  		return -EINVAL;
  
  	bh_lock_sock(sk);
  
  	/* Check if parent socket is listening */
  	low_nmcpy(user_data, iucv->src_name);
  	high_nmcpy(user_data, iucv->dst_name);
  	ASCEBC(user_data, sizeof(user_data));
  	if (sk->sk_state != IUCV_LISTEN) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1649
  		err = pr_iucv->path_sever(path, user_data);
65dbd7c27   Hendrik Brueckner   af_iucv: Free iuc...
1650
  		iucv_path_free(path);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1651
1652
1653
1654
1655
  		goto fail;
  	}
  
  	/* Check for backlog size */
  	if (sk_acceptq_is_full(sk)) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1656
  		err = pr_iucv->path_sever(path, user_data);
65dbd7c27   Hendrik Brueckner   af_iucv: Free iuc...
1657
  		iucv_path_free(path);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1658
1659
1660
1661
  		goto fail;
  	}
  
  	/* Create the new socket */
aa8e71f58   Hendrik Brueckner   af_iucv: Provide ...
1662
  	nsk = iucv_sock_alloc(NULL, sk->sk_type, GFP_ATOMIC);
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
1663
  	if (!nsk) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1664
  		err = pr_iucv->path_sever(path, user_data);
65dbd7c27   Hendrik Brueckner   af_iucv: Free iuc...
1665
  		iucv_path_free(path);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1666
1667
1668
1669
1670
1671
1672
1673
1674
1675
1676
1677
1678
1679
1680
1681
1682
1683
  		goto fail;
  	}
  
  	niucv = iucv_sk(nsk);
  	iucv_sock_init(nsk, sk);
  
  	/* Set the new iucv_sock */
  	memcpy(niucv->dst_name, ipuser + 8, 8);
  	EBCASC(niucv->dst_name, 8);
  	memcpy(niucv->dst_user_id, ipvmid, 8);
  	memcpy(niucv->src_name, iucv->src_name, 8);
  	memcpy(niucv->src_user_id, iucv->src_user_id, 8);
  	niucv->path = path;
  
  	/* Call iucv_accept */
  	high_nmcpy(nuser_data, ipuser + 8);
  	memcpy(nuser_data + 8, niucv->src_name, 8);
  	ASCEBC(nuser_data + 8, 8);
09488e2e0   Hendrik Brueckner   af_iucv: New sock...
1684
1685
1686
  	/* set message limit for path based on msglimit of accepting socket */
  	niucv->msglimit = iucv->msglimit;
  	path->msglim = iucv->msglimit;
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1687
  	err = pr_iucv->path_accept(path, &af_iucv_handler, nuser_data, nsk);
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
1688
  	if (err) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1689
  		err = pr_iucv->path_sever(path, user_data);
65dbd7c27   Hendrik Brueckner   af_iucv: Free iuc...
1690
1691
  		iucv_path_free(path);
  		iucv_sock_kill(nsk);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1692
1693
1694
1695
1696
1697
1698
1699
1700
1701
1702
1703
1704
1705
1706
1707
1708
1709
1710
1711
1712
1713
1714
1715
1716
  		goto fail;
  	}
  
  	iucv_accept_enqueue(sk, nsk);
  
  	/* Wake up accept */
  	nsk->sk_state = IUCV_CONNECTED;
  	sk->sk_data_ready(sk, 1);
  	err = 0;
  fail:
  	bh_unlock_sock(sk);
  	return 0;
  }
  
  static void iucv_callback_connack(struct iucv_path *path, u8 ipuser[16])
  {
  	struct sock *sk = path->private;
  
  	sk->sk_state = IUCV_CONNECTED;
  	sk->sk_state_change(sk);
  }
  
  static void iucv_callback_rx(struct iucv_path *path, struct iucv_message *msg)
  {
  	struct sock *sk = path->private;
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1717
  	struct iucv_sock *iucv = iucv_sk(sk);
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1718
1719
1720
  	struct sk_buff *skb;
  	struct sock_msg_q *save_msg;
  	int len;
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1721

fe86e54ef   Hendrik Brueckner   af_iucv: Reject i...
1722
  	if (sk->sk_shutdown & RCV_SHUTDOWN) {
6fcd61f7b   Frank Blaschka   af_iucv: use load...
1723
  		pr_iucv->message_reject(path, msg);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1724
  		return;
fe86e54ef   Hendrik Brueckner   af_iucv: Reject i...
1725
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1726

3fa6b5adb   Hendrik Brueckner   af_iucv: Fix race...
1727
  	spin_lock(&iucv->message_q.lock);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1728

f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1729
1730
1731
1732
1733
  	if (!list_empty(&iucv->message_q.list) ||
  	    !skb_queue_empty(&iucv->backlog_skb_q))
  		goto save_message;
  
  	len = atomic_read(&sk->sk_rmem_alloc);
87fb4b7b5   Eric Dumazet   net: more accurat...
1734
  	len += SKB_TRUESIZE(iucv_msg_length(msg));
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1735
1736
  	if (len > sk->sk_rcvbuf)
  		goto save_message;
b8942e3b6   Hendrik Brueckner   af_iucv: Support ...
1737
  	skb = alloc_skb(iucv_msg_length(msg), GFP_ATOMIC | GFP_DMA);
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1738
1739
  	if (!skb)
  		goto save_message;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1740

f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1741
  	iucv_process_message(sk, skb, path, msg);
3fa6b5adb   Hendrik Brueckner   af_iucv: Fix race...
1742
  	goto out_unlock;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1743

f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1744
1745
  save_message:
  	save_msg = kzalloc(sizeof(struct sock_msg_q), GFP_ATOMIC | GFP_DMA);
d44447229   Ursula Braun   [AF_IUCV]: broken...
1746
  	if (!save_msg)
a56635a56   Julia Lawall   net/iucv: Add mis...
1747
  		goto out_unlock;
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1748
1749
  	save_msg->path = path;
  	save_msg->msg = *msg;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1750

f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1751
  	list_add_tail(&save_msg->list, &iucv->message_q.list);
3fa6b5adb   Hendrik Brueckner   af_iucv: Fix race...
1752
1753
  
  out_unlock:
f0703c80e   Ursula Braun   [AF_IUCV]: postpo...
1754
  	spin_unlock(&iucv->message_q.lock);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1755
1756
1757
1758
1759
1760
  }
  
  static void iucv_callback_txdone(struct iucv_path *path,
  				 struct iucv_message *msg)
  {
  	struct sock *sk = path->private;
f2a77991a   Ursula Braun   [AF_IUCV]: defens...
1761
  	struct sk_buff *this = NULL;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1762
1763
1764
  	struct sk_buff_head *list = &iucv_sk(sk)->send_skb_q;
  	struct sk_buff *list_skb = list->next;
  	unsigned long flags;
f2a77991a   Ursula Braun   [AF_IUCV]: defens...
1765
  	if (!skb_queue_empty(list)) {
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1766
  		spin_lock_irqsave(&list->lock, flags);
f2a77991a   Ursula Braun   [AF_IUCV]: defens...
1767
  		while (list_skb != (struct sk_buff *)list) {
44b1e6b5f   Hendrik Brueckner   af_iucv: Modify i...
1768
  			if (!memcmp(&msg->tag, CB_TAG(list_skb), CB_TAG_LEN)) {
f2a77991a   Ursula Braun   [AF_IUCV]: defens...
1769
1770
1771
  				this = list_skb;
  				break;
  			}
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1772
  			list_skb = list_skb->next;
f2a77991a   Ursula Braun   [AF_IUCV]: defens...
1773
1774
1775
  		}
  		if (this)
  			__skb_unlink(this, list);
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1776
1777
  
  		spin_unlock_irqrestore(&list->lock, flags);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1778

0ea920d21   Hendrik Brueckner   af_iucv: Return -...
1779
1780
1781
1782
1783
  		if (this) {
  			kfree_skb(this);
  			/* wake up any process waiting for sending */
  			iucv_sock_wake_msglim(sk);
  		}
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1784
  	}
c2b4afd2f   Ursula Braun   [S390] Cleanup iu...
1785
  	BUG_ON(!this);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1786

da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
1787
  	if (sk->sk_state == IUCV_CLOSING) {
561e03600   Jennifer Hunt   [AF_IUCV]: Implem...
1788
1789
1790
1791
1792
  		if (skb_queue_empty(&iucv_sk(sk)->send_skb_q)) {
  			sk->sk_state = IUCV_CLOSED;
  			sk->sk_state_change(sk);
  		}
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1793

eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1794
1795
1796
1797
1798
  }
  
  static void iucv_callback_connrej(struct iucv_path *path, u8 ipuser[16])
  {
  	struct sock *sk = path->private;
aac6399c6   Ursula Braun   af_iucv: get rid ...
1799
  	sk->sk_state = IUCV_DISCONN;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
1800
1801
1802
  
  	sk->sk_state_change(sk);
  }
af88b52de   Hendrik Brueckner   af_iucv: sync sk ...
1803
1804
1805
1806
1807
1808
1809
1810
1811
1812
1813
1814
1815
1816
  /* called if the other communication side shuts down its RECV direction;
   * in turn, the callback sets SEND_SHUTDOWN to disable sending of data.
   */
  static void iucv_callback_shutdown(struct iucv_path *path, u8 ipuser[16])
  {
  	struct sock *sk = path->private;
  
  	bh_lock_sock(sk);
  	if (sk->sk_state != IUCV_CLOSED) {
  		sk->sk_shutdown |= SEND_SHUTDOWN;
  		sk->sk_state_change(sk);
  	}
  	bh_unlock_sock(sk);
  }
3881ac441   Ursula Braun   af_iucv: add Hipe...
1817
1818
1819
1820
1821
1822
1823
1824
1825
1826
1827
1828
1829
1830
1831
1832
1833
1834
1835
1836
1837
1838
1839
1840
1841
1842
1843
1844
1845
1846
1847
1848
1849
1850
1851
1852
1853
1854
1855
1856
1857
1858
1859
1860
1861
1862
1863
1864
1865
1866
1867
1868
1869
1870
1871
1872
1873
1874
1875
1876
1877
1878
1879
1880
1881
1882
1883
1884
1885
1886
1887
1888
1889
1890
1891
1892
1893
1894
1895
1896
1897
1898
1899
1900
1901
1902
1903
1904
1905
1906
1907
1908
1909
1910
1911
1912
1913
1914
1915
1916
1917
1918
1919
1920
1921
1922
1923
1924
1925
1926
1927
1928
1929
1930
1931
1932
1933
1934
1935
1936
1937
1938
1939
1940
1941
1942
1943
1944
1945
1946
1947
1948
1949
1950
1951
1952
1953
1954
1955
1956
  /***************** HiperSockets transport callbacks ********************/
  static void afiucv_swap_src_dest(struct sk_buff *skb)
  {
  	struct af_iucv_trans_hdr *trans_hdr =
  				(struct af_iucv_trans_hdr *)skb->data;
  	char tmpID[8];
  	char tmpName[8];
  
  	ASCEBC(trans_hdr->destUserID, sizeof(trans_hdr->destUserID));
  	ASCEBC(trans_hdr->destAppName, sizeof(trans_hdr->destAppName));
  	ASCEBC(trans_hdr->srcUserID, sizeof(trans_hdr->srcUserID));
  	ASCEBC(trans_hdr->srcAppName, sizeof(trans_hdr->srcAppName));
  	memcpy(tmpID, trans_hdr->srcUserID, 8);
  	memcpy(tmpName, trans_hdr->srcAppName, 8);
  	memcpy(trans_hdr->srcUserID, trans_hdr->destUserID, 8);
  	memcpy(trans_hdr->srcAppName, trans_hdr->destAppName, 8);
  	memcpy(trans_hdr->destUserID, tmpID, 8);
  	memcpy(trans_hdr->destAppName, tmpName, 8);
  	skb_push(skb, ETH_HLEN);
  	memset(skb->data, 0, ETH_HLEN);
  }
  
  /**
   * afiucv_hs_callback_syn - react on received SYN
   **/
  static int afiucv_hs_callback_syn(struct sock *sk, struct sk_buff *skb)
  {
  	struct sock *nsk;
  	struct iucv_sock *iucv, *niucv;
  	struct af_iucv_trans_hdr *trans_hdr;
  	int err;
  
  	iucv = iucv_sk(sk);
  	trans_hdr = (struct af_iucv_trans_hdr *)skb->data;
  	if (!iucv) {
  		/* no sock - connection refused */
  		afiucv_swap_src_dest(skb);
  		trans_hdr->flags = AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_FIN;
  		err = dev_queue_xmit(skb);
  		goto out;
  	}
  
  	nsk = iucv_sock_alloc(NULL, sk->sk_type, GFP_ATOMIC);
  	bh_lock_sock(sk);
  	if ((sk->sk_state != IUCV_LISTEN) ||
  	    sk_acceptq_is_full(sk) ||
  	    !nsk) {
  		/* error on server socket - connection refused */
  		if (nsk)
  			sk_free(nsk);
  		afiucv_swap_src_dest(skb);
  		trans_hdr->flags = AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_FIN;
  		err = dev_queue_xmit(skb);
  		bh_unlock_sock(sk);
  		goto out;
  	}
  
  	niucv = iucv_sk(nsk);
  	iucv_sock_init(nsk, sk);
  	niucv->transport = AF_IUCV_TRANS_HIPER;
  	niucv->msglimit = iucv->msglimit;
  	if (!trans_hdr->window)
  		niucv->msglimit_peer = IUCV_HIPER_MSGLIM_DEFAULT;
  	else
  		niucv->msglimit_peer = trans_hdr->window;
  	memcpy(niucv->dst_name, trans_hdr->srcAppName, 8);
  	memcpy(niucv->dst_user_id, trans_hdr->srcUserID, 8);
  	memcpy(niucv->src_name, iucv->src_name, 8);
  	memcpy(niucv->src_user_id, iucv->src_user_id, 8);
  	nsk->sk_bound_dev_if = sk->sk_bound_dev_if;
  	afiucv_swap_src_dest(skb);
  	trans_hdr->flags = AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_ACK;
  	trans_hdr->window = niucv->msglimit;
  	/* if receiver acks the xmit connection is established */
  	err = dev_queue_xmit(skb);
  	if (!err) {
  		iucv_accept_enqueue(sk, nsk);
  		nsk->sk_state = IUCV_CONNECTED;
  		sk->sk_data_ready(sk, 1);
  	} else
  		iucv_sock_kill(nsk);
  	bh_unlock_sock(sk);
  
  out:
  	return NET_RX_SUCCESS;
  }
  
  /**
   * afiucv_hs_callback_synack() - react on received SYN-ACK
   **/
  static int afiucv_hs_callback_synack(struct sock *sk, struct sk_buff *skb)
  {
  	struct iucv_sock *iucv = iucv_sk(sk);
  	struct af_iucv_trans_hdr *trans_hdr =
  					(struct af_iucv_trans_hdr *)skb->data;
  
  	if (!iucv)
  		goto out;
  	if (sk->sk_state != IUCV_BOUND)
  		goto out;
  	bh_lock_sock(sk);
  	iucv->msglimit_peer = trans_hdr->window;
  	sk->sk_state = IUCV_CONNECTED;
  	sk->sk_state_change(sk);
  	bh_unlock_sock(sk);
  out:
  	kfree_skb(skb);
  	return NET_RX_SUCCESS;
  }
  
  /**
   * afiucv_hs_callback_synfin() - react on received SYN_FIN
   **/
  static int afiucv_hs_callback_synfin(struct sock *sk, struct sk_buff *skb)
  {
  	struct iucv_sock *iucv = iucv_sk(sk);
  
  	if (!iucv)
  		goto out;
  	if (sk->sk_state != IUCV_BOUND)
  		goto out;
  	bh_lock_sock(sk);
  	sk->sk_state = IUCV_DISCONN;
  	sk->sk_state_change(sk);
  	bh_unlock_sock(sk);
  out:
  	kfree_skb(skb);
  	return NET_RX_SUCCESS;
  }
  
  /**
   * afiucv_hs_callback_fin() - react on received FIN
   **/
  static int afiucv_hs_callback_fin(struct sock *sk, struct sk_buff *skb)
  {
  	struct iucv_sock *iucv = iucv_sk(sk);
  
  	/* other end of connection closed */
  	if (iucv) {
  		bh_lock_sock(sk);
aac6399c6   Ursula Braun   af_iucv: get rid ...
1957
  		sk->sk_state = IUCV_DISCONN;
3881ac441   Ursula Braun   af_iucv: add Hipe...
1958
1959
1960
1961
1962
1963
1964
1965
1966
1967
1968
1969
1970
1971
1972
1973
1974
1975
1976
1977
1978
1979
1980
1981
1982
1983
1984
1985
1986
1987
1988
1989
1990
1991
1992
1993
1994
1995
1996
1997
1998
1999
2000
2001
2002
2003
2004
2005
2006
2007
2008
2009
2010
2011
2012
2013
2014
2015
2016
2017
2018
2019
2020
2021
2022
2023
2024
2025
2026
2027
2028
2029
2030
2031
2032
2033
2034
2035
2036
2037
2038
2039
2040
2041
2042
2043
2044
2045
2046
2047
2048
2049
2050
2051
2052
2053
2054
2055
2056
2057
2058
2059
2060
2061
2062
2063
2064
2065
2066
2067
2068
2069
2070
2071
2072
2073
2074
2075
2076
2077
2078
2079
2080
2081
2082
2083
2084
2085
2086
2087
2088
2089
2090
2091
2092
2093
2094
2095
2096
2097
2098
2099
2100
2101
2102
2103
2104
2105
2106
2107
2108
2109
2110
2111
  		sk->sk_state_change(sk);
  		bh_unlock_sock(sk);
  	}
  	kfree_skb(skb);
  	return NET_RX_SUCCESS;
  }
  
  /**
   * afiucv_hs_callback_win() - react on received WIN
   **/
  static int afiucv_hs_callback_win(struct sock *sk, struct sk_buff *skb)
  {
  	struct iucv_sock *iucv = iucv_sk(sk);
  	struct af_iucv_trans_hdr *trans_hdr =
  					(struct af_iucv_trans_hdr *)skb->data;
  
  	if (!iucv)
  		return NET_RX_SUCCESS;
  
  	if (sk->sk_state != IUCV_CONNECTED)
  		return NET_RX_SUCCESS;
  
  	atomic_sub(trans_hdr->window, &iucv->msg_sent);
  	iucv_sock_wake_msglim(sk);
  	return NET_RX_SUCCESS;
  }
  
  /**
   * afiucv_hs_callback_rx() - react on received data
   **/
  static int afiucv_hs_callback_rx(struct sock *sk, struct sk_buff *skb)
  {
  	struct iucv_sock *iucv = iucv_sk(sk);
  
  	if (!iucv) {
  		kfree_skb(skb);
  		return NET_RX_SUCCESS;
  	}
  
  	if (sk->sk_state != IUCV_CONNECTED) {
  		kfree_skb(skb);
  		return NET_RX_SUCCESS;
  	}
  
  		/* write stuff from iucv_msg to skb cb */
  	if (skb->len <= sizeof(struct af_iucv_trans_hdr)) {
  		kfree_skb(skb);
  		return NET_RX_SUCCESS;
  	}
  	skb_pull(skb, sizeof(struct af_iucv_trans_hdr));
  	skb_reset_transport_header(skb);
  	skb_reset_network_header(skb);
  	spin_lock(&iucv->message_q.lock);
  	if (skb_queue_empty(&iucv->backlog_skb_q)) {
  		if (sock_queue_rcv_skb(sk, skb)) {
  			/* handle rcv queue full */
  			skb_queue_tail(&iucv->backlog_skb_q, skb);
  		}
  	} else
  		skb_queue_tail(&iucv_sk(sk)->backlog_skb_q, skb);
  	spin_unlock(&iucv->message_q.lock);
  	return NET_RX_SUCCESS;
  }
  
  /**
   * afiucv_hs_rcv() - base function for arriving data through HiperSockets
   *                   transport
   *                   called from netif RX softirq
   **/
  static int afiucv_hs_rcv(struct sk_buff *skb, struct net_device *dev,
  	struct packet_type *pt, struct net_device *orig_dev)
  {
  	struct hlist_node *node;
  	struct sock *sk;
  	struct iucv_sock *iucv;
  	struct af_iucv_trans_hdr *trans_hdr;
  	char nullstring[8];
  	int err = 0;
  
  	skb_pull(skb, ETH_HLEN);
  	trans_hdr = (struct af_iucv_trans_hdr *)skb->data;
  	EBCASC(trans_hdr->destAppName, sizeof(trans_hdr->destAppName));
  	EBCASC(trans_hdr->destUserID, sizeof(trans_hdr->destUserID));
  	EBCASC(trans_hdr->srcAppName, sizeof(trans_hdr->srcAppName));
  	EBCASC(trans_hdr->srcUserID, sizeof(trans_hdr->srcUserID));
  	memset(nullstring, 0, sizeof(nullstring));
  	iucv = NULL;
  	sk = NULL;
  	read_lock(&iucv_sk_list.lock);
  	sk_for_each(sk, node, &iucv_sk_list.head) {
  		if (trans_hdr->flags == AF_IUCV_FLAG_SYN) {
  			if ((!memcmp(&iucv_sk(sk)->src_name,
  				     trans_hdr->destAppName, 8)) &&
  			    (!memcmp(&iucv_sk(sk)->src_user_id,
  				     trans_hdr->destUserID, 8)) &&
  			    (!memcmp(&iucv_sk(sk)->dst_name, nullstring, 8)) &&
  			    (!memcmp(&iucv_sk(sk)->dst_user_id,
  				     nullstring, 8))) {
  				iucv = iucv_sk(sk);
  				break;
  			}
  		} else {
  			if ((!memcmp(&iucv_sk(sk)->src_name,
  				     trans_hdr->destAppName, 8)) &&
  			    (!memcmp(&iucv_sk(sk)->src_user_id,
  				     trans_hdr->destUserID, 8)) &&
  			    (!memcmp(&iucv_sk(sk)->dst_name,
  				     trans_hdr->srcAppName, 8)) &&
  			    (!memcmp(&iucv_sk(sk)->dst_user_id,
  				     trans_hdr->srcUserID, 8))) {
  				iucv = iucv_sk(sk);
  				break;
  			}
  		}
  	}
  	read_unlock(&iucv_sk_list.lock);
  	if (!iucv)
  		sk = NULL;
  
  	/* no sock
  	how should we send with no sock
  	1) send without sock no send rc checking?
  	2) introduce default sock to handle this cases
  
  	 SYN -> send SYN|ACK in good case, send SYN|FIN in bad case
  	 data -> send FIN
  	 SYN|ACK, SYN|FIN, FIN -> no action? */
  
  	switch (trans_hdr->flags) {
  	case AF_IUCV_FLAG_SYN:
  		/* connect request */
  		err = afiucv_hs_callback_syn(sk, skb);
  		break;
  	case (AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_ACK):
  		/* connect request confirmed */
  		err = afiucv_hs_callback_synack(sk, skb);
  		break;
  	case (AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_FIN):
  		/* connect request refused */
  		err = afiucv_hs_callback_synfin(sk, skb);
  		break;
  	case (AF_IUCV_FLAG_FIN):
  		/* close request */
  		err = afiucv_hs_callback_fin(sk, skb);
  		break;
  	case (AF_IUCV_FLAG_WIN):
  		err = afiucv_hs_callback_win(sk, skb);
  		if (skb->len > sizeof(struct af_iucv_trans_hdr))
  			err = afiucv_hs_callback_rx(sk, skb);
  		else
  			kfree(skb);
  		break;
  	case 0:
  		/* plain data frame */
c64d3f8f5   Ursula Braun   af_iucv: support ...
2112
2113
  		memcpy(CB_TRGCLS(skb), &trans_hdr->iucv_hdr.class,
  		       CB_TRGCLS_LEN);
3881ac441   Ursula Braun   af_iucv: add Hipe...
2114
2115
2116
2117
2118
2119
2120
2121
2122
2123
2124
2125
2126
2127
2128
2129
2130
2131
2132
2133
2134
2135
2136
2137
2138
2139
2140
2141
2142
2143
2144
2145
2146
2147
2148
2149
2150
2151
2152
2153
2154
2155
2156
2157
2158
2159
2160
2161
2162
2163
  		err = afiucv_hs_callback_rx(sk, skb);
  		break;
  	default:
  		;
  	}
  
  	return err;
  }
  
  /**
   * afiucv_hs_callback_txnotify() - handle send notifcations from HiperSockets
   *                                 transport
   **/
  static void afiucv_hs_callback_txnotify(struct sk_buff *skb,
  					enum iucv_tx_notify n)
  {
  	struct sock *isk = skb->sk;
  	struct sock *sk = NULL;
  	struct iucv_sock *iucv = NULL;
  	struct sk_buff_head *list;
  	struct sk_buff *list_skb;
  	struct sk_buff *this = NULL;
  	unsigned long flags;
  	struct hlist_node *node;
  
  	read_lock(&iucv_sk_list.lock);
  	sk_for_each(sk, node, &iucv_sk_list.head)
  		if (sk == isk) {
  			iucv = iucv_sk(sk);
  			break;
  		}
  	read_unlock(&iucv_sk_list.lock);
  
  	if (!iucv)
  		return;
  
  	bh_lock_sock(sk);
  	list = &iucv->send_skb_q;
  	list_skb = list->next;
  	if (skb_queue_empty(list))
  		goto out_unlock;
  
  	spin_lock_irqsave(&list->lock, flags);
  	while (list_skb != (struct sk_buff *)list) {
  		if (skb_shinfo(list_skb) == skb_shinfo(skb)) {
  			this = list_skb;
  			switch (n) {
  			case TX_NOTIFY_OK:
  				__skb_unlink(this, list);
  				iucv_sock_wake_msglim(sk);
816abbadf   Ursula Braun   af_iucv: release ...
2164
  				dev_put(this->dev);
3881ac441   Ursula Braun   af_iucv: add Hipe...
2165
2166
2167
2168
2169
2170
2171
2172
2173
2174
  				kfree_skb(this);
  				break;
  			case TX_NOTIFY_PENDING:
  				atomic_inc(&iucv->pendings);
  				break;
  			case TX_NOTIFY_DELAYED_OK:
  				__skb_unlink(this, list);
  				atomic_dec(&iucv->pendings);
  				if (atomic_read(&iucv->pendings) <= 0)
  					iucv_sock_wake_msglim(sk);
816abbadf   Ursula Braun   af_iucv: release ...
2175
  				dev_put(this->dev);
3881ac441   Ursula Braun   af_iucv: add Hipe...
2176
2177
2178
2179
2180
2181
2182
2183
  				kfree_skb(this);
  				break;
  			case TX_NOTIFY_UNREACHABLE:
  			case TX_NOTIFY_DELAYED_UNREACHABLE:
  			case TX_NOTIFY_TPQFULL: /* not yet used */
  			case TX_NOTIFY_GENERALERROR:
  			case TX_NOTIFY_DELAYED_GENERALERROR:
  				__skb_unlink(this, list);
816abbadf   Ursula Braun   af_iucv: release ...
2184
  				dev_put(this->dev);
3881ac441   Ursula Braun   af_iucv: add Hipe...
2185
  				kfree_skb(this);
aac6399c6   Ursula Braun   af_iucv: get rid ...
2186
  				sk->sk_state = IUCV_DISCONN;
3881ac441   Ursula Braun   af_iucv: add Hipe...
2187
2188
2189
2190
2191
2192
2193
2194
  				sk->sk_state_change(sk);
  				break;
  			}
  			break;
  		}
  		list_skb = list_skb->next;
  	}
  	spin_unlock_irqrestore(&list->lock, flags);
42bd48e01   Ursula Braun   af_iucv: accelera...
2195
2196
2197
2198
2199
2200
  	if (sk->sk_state == IUCV_CLOSING) {
  		if (skb_queue_empty(&iucv_sk(sk)->send_skb_q)) {
  			sk->sk_state = IUCV_CLOSED;
  			sk->sk_state_change(sk);
  		}
  	}
3881ac441   Ursula Braun   af_iucv: add Hipe...
2201
2202
2203
  out_unlock:
  	bh_unlock_sock(sk);
  }
5708e868d   Alexey Dobriyan   net: constify rem...
2204
  static const struct proto_ops iucv_sock_ops = {
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2205
2206
2207
2208
2209
2210
2211
2212
2213
2214
2215
2216
2217
2218
2219
  	.family		= PF_IUCV,
  	.owner		= THIS_MODULE,
  	.release	= iucv_sock_release,
  	.bind		= iucv_sock_bind,
  	.connect	= iucv_sock_connect,
  	.listen		= iucv_sock_listen,
  	.accept		= iucv_sock_accept,
  	.getname	= iucv_sock_getname,
  	.sendmsg	= iucv_sock_sendmsg,
  	.recvmsg	= iucv_sock_recvmsg,
  	.poll		= iucv_sock_poll,
  	.ioctl		= sock_no_ioctl,
  	.mmap		= sock_no_mmap,
  	.socketpair	= sock_no_socketpair,
  	.shutdown	= iucv_sock_shutdown,
9d5c5d8f4   Hendrik Brueckner   af_iucv: add sock...
2220
2221
  	.setsockopt	= iucv_sock_setsockopt,
  	.getsockopt	= iucv_sock_getsockopt,
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2222
  };
ec1b4cf74   Stephen Hemminger   net: mark net_pro...
2223
  static const struct net_proto_family iucv_sock_family_ops = {
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2224
2225
2226
2227
  	.family	= AF_IUCV,
  	.owner	= THIS_MODULE,
  	.create	= iucv_sock_create,
  };
3881ac441   Ursula Braun   af_iucv: add Hipe...
2228
2229
2230
2231
2232
2233
  static struct packet_type iucv_packet_type = {
  	.type = cpu_to_be16(ETH_P_AF_IUCV),
  	.func = afiucv_hs_rcv,
  };
  
  static int afiucv_iucv_init(void)
6fcd61f7b   Frank Blaschka   af_iucv: use load...
2234
2235
2236
2237
2238
2239
2240
2241
2242
2243
2244
2245
2246
2247
2248
2249
2250
2251
2252
2253
2254
2255
2256
2257
2258
2259
2260
2261
2262
2263
2264
2265
2266
  {
  	int err;
  
  	err = pr_iucv->iucv_register(&af_iucv_handler, 0);
  	if (err)
  		goto out;
  	/* establish dummy device */
  	af_iucv_driver.bus = pr_iucv->bus;
  	err = driver_register(&af_iucv_driver);
  	if (err)
  		goto out_iucv;
  	af_iucv_dev = kzalloc(sizeof(struct device), GFP_KERNEL);
  	if (!af_iucv_dev) {
  		err = -ENOMEM;
  		goto out_driver;
  	}
  	dev_set_name(af_iucv_dev, "af_iucv");
  	af_iucv_dev->bus = pr_iucv->bus;
  	af_iucv_dev->parent = pr_iucv->root;
  	af_iucv_dev->release = (void (*)(struct device *))kfree;
  	af_iucv_dev->driver = &af_iucv_driver;
  	err = device_register(af_iucv_dev);
  	if (err)
  		goto out_driver;
  	return 0;
  
  out_driver:
  	driver_unregister(&af_iucv_driver);
  out_iucv:
  	pr_iucv->iucv_unregister(&af_iucv_handler, 0);
  out:
  	return err;
  }
da99f0565   Heiko Carstens   [AF_IUCV/IUCV] : ...
2267
  static int __init afiucv_init(void)
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2268
2269
  {
  	int err;
3881ac441   Ursula Braun   af_iucv: add Hipe...
2270
2271
2272
2273
2274
2275
2276
  	if (MACHINE_IS_VM) {
  		cpcmd("QUERY USERID", iucv_userid, sizeof(iucv_userid), &err);
  		if (unlikely(err)) {
  			WARN_ON(err);
  			err = -EPROTONOSUPPORT;
  			goto out;
  		}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2277

3881ac441   Ursula Braun   af_iucv: add Hipe...
2278
2279
2280
2281
2282
2283
2284
2285
2286
  		pr_iucv = try_then_request_module(symbol_get(iucv_if), "iucv");
  		if (!pr_iucv) {
  			printk(KERN_WARNING "iucv_if lookup failed
  ");
  			memset(&iucv_userid, 0, sizeof(iucv_userid));
  		}
  	} else {
  		memset(&iucv_userid, 0, sizeof(iucv_userid));
  		pr_iucv = NULL;
6fcd61f7b   Frank Blaschka   af_iucv: use load...
2287
  	}
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2288
2289
  	err = proto_register(&iucv_proto, 0);
  	if (err)
6fcd61f7b   Frank Blaschka   af_iucv: use load...
2290
  		goto out;
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2291
2292
2293
  	err = sock_register(&iucv_sock_family_ops);
  	if (err)
  		goto out_proto;
6fcd61f7b   Frank Blaschka   af_iucv: use load...
2294

3881ac441   Ursula Braun   af_iucv: add Hipe...
2295
2296
2297
2298
2299
2300
  	if (pr_iucv) {
  		err = afiucv_iucv_init();
  		if (err)
  			goto out_sock;
  	}
  	dev_add_pack(&iucv_packet_type);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2301
  	return 0;
c23cad923   Ursula Braun   [S390] PM: af_iuc...
2302
2303
  out_sock:
  	sock_unregister(PF_IUCV);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2304
2305
  out_proto:
  	proto_unregister(&iucv_proto);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2306
  out:
6fcd61f7b   Frank Blaschka   af_iucv: use load...
2307
2308
  	if (pr_iucv)
  		symbol_put(iucv_if);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2309
2310
2311
2312
2313
  	return err;
  }
  
  static void __exit afiucv_exit(void)
  {
3881ac441   Ursula Braun   af_iucv: add Hipe...
2314
2315
2316
2317
2318
2319
2320
  	if (pr_iucv) {
  		device_unregister(af_iucv_dev);
  		driver_unregister(&af_iucv_driver);
  		pr_iucv->iucv_unregister(&af_iucv_handler, 0);
  		symbol_put(iucv_if);
  	}
  	dev_remove_pack(&iucv_packet_type);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2321
2322
  	sock_unregister(PF_IUCV);
  	proto_unregister(&iucv_proto);
eac3731bd   Jennifer Hunt   [S390]: Add AF_IU...
2323
2324
2325
2326
2327
2328
2329
2330
2331
2332
  }
  
  module_init(afiucv_init);
  module_exit(afiucv_exit);
  
  MODULE_AUTHOR("Jennifer Hunt <jenhunt@us.ibm.com>");
  MODULE_DESCRIPTION("IUCV Sockets ver " VERSION);
  MODULE_VERSION(VERSION);
  MODULE_LICENSE("GPL");
  MODULE_ALIAS_NETPROTO(PF_IUCV);
3881ac441   Ursula Braun   af_iucv: add Hipe...
2333