linux/net/iucv/af_iucv.c
<<
>>
Prefs
   1/*
   2 *  IUCV protocol stack for Linux on zSeries
   3 *
   4 *  Copyright IBM Corp. 2006, 2009
   5 *
   6 *  Author(s):  Jennifer Hunt <jenhunt@us.ibm.com>
   7 *              Hendrik Brueckner <brueckner@linux.vnet.ibm.com>
   8 *  PM functions:
   9 *              Ursula Braun <ursula.braun@de.ibm.com>
  10 */
  11
  12#define KMSG_COMPONENT "af_iucv"
  13#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
  14
  15#include <linux/module.h>
  16#include <linux/types.h>
  17#include <linux/list.h>
  18#include <linux/errno.h>
  19#include <linux/kernel.h>
  20#include <linux/sched/signal.h>
  21#include <linux/slab.h>
  22#include <linux/skbuff.h>
  23#include <linux/init.h>
  24#include <linux/poll.h>
  25#include <linux/security.h>
  26#include <net/sock.h>
  27#include <asm/ebcdic.h>
  28#include <asm/cpcmd.h>
  29#include <linux/kmod.h>
  30
  31#include <net/iucv/af_iucv.h>
  32
  33#define VERSION "1.2"
  34
  35static char iucv_userid[80];
  36
  37static const struct proto_ops iucv_sock_ops;
  38
  39static struct proto iucv_proto = {
  40        .name           = "AF_IUCV",
  41        .owner          = THIS_MODULE,
  42        .obj_size       = sizeof(struct iucv_sock),
  43};
  44
  45static struct iucv_interface *pr_iucv;
  46
  47/* special AF_IUCV IPRM messages */
  48static const u8 iprm_shutdown[8] =
  49        {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01};
  50
  51#define TRGCLS_SIZE     (sizeof(((struct iucv_message *)0)->class))
  52
  53#define __iucv_sock_wait(sk, condition, timeo, ret)                     \
  54do {                                                                    \
  55        DEFINE_WAIT(__wait);                                            \
  56        long __timeo = timeo;                                           \
  57        ret = 0;                                                        \
  58        prepare_to_wait(sk_sleep(sk), &__wait, TASK_INTERRUPTIBLE);     \
  59        while (!(condition)) {                                          \
  60                if (!__timeo) {                                         \
  61                        ret = -EAGAIN;                                  \
  62                        break;                                          \
  63                }                                                       \
  64                if (signal_pending(current)) {                          \
  65                        ret = sock_intr_errno(__timeo);                 \
  66                        break;                                          \
  67                }                                                       \
  68                release_sock(sk);                                       \
  69                __timeo = schedule_timeout(__timeo);                    \
  70                lock_sock(sk);                                          \
  71                ret = sock_error(sk);                                   \
  72                if (ret)                                                \
  73                        break;                                          \
  74        }                                                               \
  75        finish_wait(sk_sleep(sk), &__wait);                             \
  76} while (0)
  77
  78#define iucv_sock_wait(sk, condition, timeo)                            \
  79({                                                                      \
  80        int __ret = 0;                                                  \
  81        if (!(condition))                                               \
  82                __iucv_sock_wait(sk, condition, timeo, __ret);          \
  83        __ret;                                                          \
  84})
  85
  86static void iucv_sock_kill(struct sock *sk);
  87static void iucv_sock_close(struct sock *sk);
  88static void iucv_sever_path(struct sock *, int);
  89
  90static int afiucv_hs_rcv(struct sk_buff *skb, struct net_device *dev,
  91        struct packet_type *pt, struct net_device *orig_dev);
  92static int afiucv_hs_send(struct iucv_message *imsg, struct sock *sock,
  93                   struct sk_buff *skb, u8 flags);
  94static void afiucv_hs_callback_txnotify(struct sk_buff *, enum iucv_tx_notify);
  95
  96/* Call Back functions */
  97static void iucv_callback_rx(struct iucv_path *, struct iucv_message *);
  98static void iucv_callback_txdone(struct iucv_path *, struct iucv_message *);
  99static void iucv_callback_connack(struct iucv_path *, u8 *);
 100static int iucv_callback_connreq(struct iucv_path *, u8 *, u8 *);
 101static void iucv_callback_connrej(struct iucv_path *, u8 *);
 102static void iucv_callback_shutdown(struct iucv_path *, u8 *);
 103
 104static struct iucv_sock_list iucv_sk_list = {
 105        .lock = __RW_LOCK_UNLOCKED(iucv_sk_list.lock),
 106        .autobind_name = ATOMIC_INIT(0)
 107};
 108
 109static struct iucv_handler af_iucv_handler = {
 110        .path_pending     = iucv_callback_connreq,
 111        .path_complete    = iucv_callback_connack,
 112        .path_severed     = iucv_callback_connrej,
 113        .message_pending  = iucv_callback_rx,
 114        .message_complete = iucv_callback_txdone,
 115        .path_quiesced    = iucv_callback_shutdown,
 116};
 117
 118static inline void high_nmcpy(unsigned char *dst, char *src)
 119{
 120       memcpy(dst, src, 8);
 121}
 122
 123static inline void low_nmcpy(unsigned char *dst, char *src)
 124{
 125       memcpy(&dst[8], src, 8);
 126}
 127
 128static int afiucv_pm_prepare(struct device *dev)
 129{
 130#ifdef CONFIG_PM_DEBUG
 131        printk(KERN_WARNING "afiucv_pm_prepare\n");
 132#endif
 133        return 0;
 134}
 135
 136static void afiucv_pm_complete(struct device *dev)
 137{
 138#ifdef CONFIG_PM_DEBUG
 139        printk(KERN_WARNING "afiucv_pm_complete\n");
 140#endif
 141}
 142
 143/**
 144 * afiucv_pm_freeze() - Freeze PM callback
 145 * @dev:        AFIUCV dummy device
 146 *
 147 * Sever all established IUCV communication pathes
 148 */
 149static int afiucv_pm_freeze(struct device *dev)
 150{
 151        struct iucv_sock *iucv;
 152        struct sock *sk;
 153        int err = 0;
 154
 155#ifdef CONFIG_PM_DEBUG
 156        printk(KERN_WARNING "afiucv_pm_freeze\n");
 157#endif
 158        read_lock(&iucv_sk_list.lock);
 159        sk_for_each(sk, &iucv_sk_list.head) {
 160                iucv = iucv_sk(sk);
 161                switch (sk->sk_state) {
 162                case IUCV_DISCONN:
 163                case IUCV_CLOSING:
 164                case IUCV_CONNECTED:
 165                        iucv_sever_path(sk, 0);
 166                        break;
 167                case IUCV_OPEN:
 168                case IUCV_BOUND:
 169                case IUCV_LISTEN:
 170                case IUCV_CLOSED:
 171                default:
 172                        break;
 173                }
 174                skb_queue_purge(&iucv->send_skb_q);
 175                skb_queue_purge(&iucv->backlog_skb_q);
 176        }
 177        read_unlock(&iucv_sk_list.lock);
 178        return err;
 179}
 180
 181/**
 182 * afiucv_pm_restore_thaw() - Thaw and restore PM callback
 183 * @dev:        AFIUCV dummy device
 184 *
 185 * socket clean up after freeze
 186 */
 187static int afiucv_pm_restore_thaw(struct device *dev)
 188{
 189        struct sock *sk;
 190
 191#ifdef CONFIG_PM_DEBUG
 192        printk(KERN_WARNING "afiucv_pm_restore_thaw\n");
 193#endif
 194        read_lock(&iucv_sk_list.lock);
 195        sk_for_each(sk, &iucv_sk_list.head) {
 196                switch (sk->sk_state) {
 197                case IUCV_CONNECTED:
 198                        sk->sk_err = EPIPE;
 199                        sk->sk_state = IUCV_DISCONN;
 200                        sk->sk_state_change(sk);
 201                        break;
 202                case IUCV_DISCONN:
 203                case IUCV_CLOSING:
 204                case IUCV_LISTEN:
 205                case IUCV_BOUND:
 206                case IUCV_OPEN:
 207                default:
 208                        break;
 209                }
 210        }
 211        read_unlock(&iucv_sk_list.lock);
 212        return 0;
 213}
 214
 215static const struct dev_pm_ops afiucv_pm_ops = {
 216        .prepare = afiucv_pm_prepare,
 217        .complete = afiucv_pm_complete,
 218        .freeze = afiucv_pm_freeze,
 219        .thaw = afiucv_pm_restore_thaw,
 220        .restore = afiucv_pm_restore_thaw,
 221};
 222
 223static struct device_driver af_iucv_driver = {
 224        .owner = THIS_MODULE,
 225        .name = "afiucv",
 226        .bus  = NULL,
 227        .pm   = &afiucv_pm_ops,
 228};
 229
 230/* dummy device used as trigger for PM functions */
 231static struct device *af_iucv_dev;
 232
 233/**
 234 * iucv_msg_length() - Returns the length of an iucv message.
 235 * @msg:        Pointer to struct iucv_message, MUST NOT be NULL
 236 *
 237 * The function returns the length of the specified iucv message @msg of data
 238 * stored in a buffer and of data stored in the parameter list (PRMDATA).
 239 *
 240 * For IUCV_IPRMDATA, AF_IUCV uses the following convention to transport socket
 241 * data:
 242 *      PRMDATA[0..6]   socket data (max 7 bytes);
 243 *      PRMDATA[7]      socket data length value (len is 0xff - PRMDATA[7])
 244 *
 245 * The socket data length is computed by subtracting the socket data length
 246 * value from 0xFF.
 247 * If the socket data len is greater 7, then PRMDATA can be used for special
 248 * notifications (see iucv_sock_shutdown); and further,
 249 * if the socket data len is > 7, the function returns 8.
 250 *
 251 * Use this function to allocate socket buffers to store iucv message data.
 252 */
 253static inline size_t iucv_msg_length(struct iucv_message *msg)
 254{
 255        size_t datalen;
 256
 257        if (msg->flags & IUCV_IPRMDATA) {
 258                datalen = 0xff - msg->rmmsg[7];
 259                return (datalen < 8) ? datalen : 8;
 260        }
 261        return msg->length;
 262}
 263
 264/**
 265 * iucv_sock_in_state() - check for specific states
 266 * @sk:         sock structure
 267 * @state:      first iucv sk state
 268 * @state:      second iucv sk state
 269 *
 270 * Returns true if the socket in either in the first or second state.
 271 */
 272static int iucv_sock_in_state(struct sock *sk, int state, int state2)
 273{
 274        return (sk->sk_state == state || sk->sk_state == state2);
 275}
 276
 277/**
 278 * iucv_below_msglim() - function to check if messages can be sent
 279 * @sk:         sock structure
 280 *
 281 * Returns true if the send queue length is lower than the message limit.
 282 * Always returns true if the socket is not connected (no iucv path for
 283 * checking the message limit).
 284 */
 285static inline int iucv_below_msglim(struct sock *sk)
 286{
 287        struct iucv_sock *iucv = iucv_sk(sk);
 288
 289        if (sk->sk_state != IUCV_CONNECTED)
 290                return 1;
 291        if (iucv->transport == AF_IUCV_TRANS_IUCV)
 292                return (skb_queue_len(&iucv->send_skb_q) < iucv->path->msglim);
 293        else
 294                return ((atomic_read(&iucv->msg_sent) < iucv->msglimit_peer) &&
 295                        (atomic_read(&iucv->pendings) <= 0));
 296}
 297
 298/**
 299 * iucv_sock_wake_msglim() - Wake up thread waiting on msg limit
 300 */
 301static void iucv_sock_wake_msglim(struct sock *sk)
 302{
 303        struct socket_wq *wq;
 304
 305        rcu_read_lock();
 306        wq = rcu_dereference(sk->sk_wq);
 307        if (skwq_has_sleeper(wq))
 308                wake_up_interruptible_all(&wq->wait);
 309        sk_wake_async(sk, SOCK_WAKE_SPACE, POLL_OUT);
 310        rcu_read_unlock();
 311}
 312
 313/**
 314 * afiucv_hs_send() - send a message through HiperSockets transport
 315 */
 316static int afiucv_hs_send(struct iucv_message *imsg, struct sock *sock,
 317                   struct sk_buff *skb, u8 flags)
 318{
 319        struct iucv_sock *iucv = iucv_sk(sock);
 320        struct af_iucv_trans_hdr *phs_hdr;
 321        struct sk_buff *nskb;
 322        int err, confirm_recv = 0;
 323
 324        memset(skb->head, 0, ETH_HLEN);
 325        phs_hdr = skb_push(skb, sizeof(struct af_iucv_trans_hdr));
 326        skb_reset_mac_header(skb);
 327        skb_reset_network_header(skb);
 328        skb_push(skb, ETH_HLEN);
 329        skb_reset_mac_header(skb);
 330        memset(phs_hdr, 0, sizeof(struct af_iucv_trans_hdr));
 331
 332        phs_hdr->magic = ETH_P_AF_IUCV;
 333        phs_hdr->version = 1;
 334        phs_hdr->flags = flags;
 335        if (flags == AF_IUCV_FLAG_SYN)
 336                phs_hdr->window = iucv->msglimit;
 337        else if ((flags == AF_IUCV_FLAG_WIN) || !flags) {
 338                confirm_recv = atomic_read(&iucv->msg_recv);
 339                phs_hdr->window = confirm_recv;
 340                if (confirm_recv)
 341                        phs_hdr->flags = phs_hdr->flags | AF_IUCV_FLAG_WIN;
 342        }
 343        memcpy(phs_hdr->destUserID, iucv->dst_user_id, 8);
 344        memcpy(phs_hdr->destAppName, iucv->dst_name, 8);
 345        memcpy(phs_hdr->srcUserID, iucv->src_user_id, 8);
 346        memcpy(phs_hdr->srcAppName, iucv->src_name, 8);
 347        ASCEBC(phs_hdr->destUserID, sizeof(phs_hdr->destUserID));
 348        ASCEBC(phs_hdr->destAppName, sizeof(phs_hdr->destAppName));
 349        ASCEBC(phs_hdr->srcUserID, sizeof(phs_hdr->srcUserID));
 350        ASCEBC(phs_hdr->srcAppName, sizeof(phs_hdr->srcAppName));
 351        if (imsg)
 352                memcpy(&phs_hdr->iucv_hdr, imsg, sizeof(struct iucv_message));
 353
 354        skb->dev = iucv->hs_dev;
 355        if (!skb->dev)
 356                return -ENODEV;
 357        if (!(skb->dev->flags & IFF_UP) || !netif_carrier_ok(skb->dev))
 358                return -ENETDOWN;
 359        if (skb->len > skb->dev->mtu) {
 360                if (sock->sk_type == SOCK_SEQPACKET)
 361                        return -EMSGSIZE;
 362                else
 363                        skb_trim(skb, skb->dev->mtu);
 364        }
 365        skb->protocol = cpu_to_be16(ETH_P_AF_IUCV);
 366        nskb = skb_clone(skb, GFP_ATOMIC);
 367        if (!nskb)
 368                return -ENOMEM;
 369        skb_queue_tail(&iucv->send_skb_q, nskb);
 370        err = dev_queue_xmit(skb);
 371        if (net_xmit_eval(err)) {
 372                skb_unlink(nskb, &iucv->send_skb_q);
 373                kfree_skb(nskb);
 374        } else {
 375                atomic_sub(confirm_recv, &iucv->msg_recv);
 376                WARN_ON(atomic_read(&iucv->msg_recv) < 0);
 377        }
 378        return net_xmit_eval(err);
 379}
 380
 381static struct sock *__iucv_get_sock_by_name(char *nm)
 382{
 383        struct sock *sk;
 384
 385        sk_for_each(sk, &iucv_sk_list.head)
 386                if (!memcmp(&iucv_sk(sk)->src_name, nm, 8))
 387                        return sk;
 388
 389        return NULL;
 390}
 391
 392static void iucv_sock_destruct(struct sock *sk)
 393{
 394        skb_queue_purge(&sk->sk_receive_queue);
 395        skb_queue_purge(&sk->sk_error_queue);
 396
 397        sk_mem_reclaim(sk);
 398
 399        if (!sock_flag(sk, SOCK_DEAD)) {
 400                pr_err("Attempt to release alive iucv socket %p\n", sk);
 401                return;
 402        }
 403
 404        WARN_ON(atomic_read(&sk->sk_rmem_alloc));
 405        WARN_ON(refcount_read(&sk->sk_wmem_alloc));
 406        WARN_ON(sk->sk_wmem_queued);
 407        WARN_ON(sk->sk_forward_alloc);
 408}
 409
 410/* Cleanup Listen */
 411static void iucv_sock_cleanup_listen(struct sock *parent)
 412{
 413        struct sock *sk;
 414
 415        /* Close non-accepted connections */
 416        while ((sk = iucv_accept_dequeue(parent, NULL))) {
 417                iucv_sock_close(sk);
 418                iucv_sock_kill(sk);
 419        }
 420
 421        parent->sk_state = IUCV_CLOSED;
 422}
 423
 424/* Kill socket (only if zapped and orphaned) */
 425static void iucv_sock_kill(struct sock *sk)
 426{
 427        if (!sock_flag(sk, SOCK_ZAPPED) || sk->sk_socket)
 428                return;
 429
 430        iucv_sock_unlink(&iucv_sk_list, sk);
 431        sock_set_flag(sk, SOCK_DEAD);
 432        sock_put(sk);
 433}
 434
 435/* Terminate an IUCV path */
 436static void iucv_sever_path(struct sock *sk, int with_user_data)
 437{
 438        unsigned char user_data[16];
 439        struct iucv_sock *iucv = iucv_sk(sk);
 440        struct iucv_path *path = iucv->path;
 441
 442        if (iucv->path) {
 443                iucv->path = NULL;
 444                if (with_user_data) {
 445                        low_nmcpy(user_data, iucv->src_name);
 446                        high_nmcpy(user_data, iucv->dst_name);
 447                        ASCEBC(user_data, sizeof(user_data));
 448                        pr_iucv->path_sever(path, user_data);
 449                } else
 450                        pr_iucv->path_sever(path, NULL);
 451                iucv_path_free(path);
 452        }
 453}
 454
 455/* Send controlling flags through an IUCV socket for HIPER transport */
 456static int iucv_send_ctrl(struct sock *sk, u8 flags)
 457{
 458        int err = 0;
 459        int blen;
 460        struct sk_buff *skb;
 461        u8 shutdown = 0;
 462
 463        blen = sizeof(struct af_iucv_trans_hdr) + ETH_HLEN;
 464        if (sk->sk_shutdown & SEND_SHUTDOWN) {
 465                /* controlling flags should be sent anyway */
 466                shutdown = sk->sk_shutdown;
 467                sk->sk_shutdown &= RCV_SHUTDOWN;
 468        }
 469        skb = sock_alloc_send_skb(sk, blen, 1, &err);
 470        if (skb) {
 471                skb_reserve(skb, blen);
 472                err = afiucv_hs_send(NULL, sk, skb, flags);
 473        }
 474        if (shutdown)
 475                sk->sk_shutdown = shutdown;
 476        return err;
 477}
 478
 479/* Close an IUCV socket */
 480static void iucv_sock_close(struct sock *sk)
 481{
 482        struct iucv_sock *iucv = iucv_sk(sk);
 483        unsigned long timeo;
 484        int err = 0;
 485
 486        lock_sock(sk);
 487
 488        switch (sk->sk_state) {
 489        case IUCV_LISTEN:
 490                iucv_sock_cleanup_listen(sk);
 491                break;
 492
 493        case IUCV_CONNECTED:
 494                if (iucv->transport == AF_IUCV_TRANS_HIPER) {
 495                        err = iucv_send_ctrl(sk, AF_IUCV_FLAG_FIN);
 496                        sk->sk_state = IUCV_DISCONN;
 497                        sk->sk_state_change(sk);
 498                }
 499        case IUCV_DISCONN:   /* fall through */
 500                sk->sk_state = IUCV_CLOSING;
 501                sk->sk_state_change(sk);
 502
 503                if (!err && !skb_queue_empty(&iucv->send_skb_q)) {
 504                        if (sock_flag(sk, SOCK_LINGER) && sk->sk_lingertime)
 505                                timeo = sk->sk_lingertime;
 506                        else
 507                                timeo = IUCV_DISCONN_TIMEOUT;
 508                        iucv_sock_wait(sk,
 509                                        iucv_sock_in_state(sk, IUCV_CLOSED, 0),
 510                                        timeo);
 511                }
 512
 513        case IUCV_CLOSING:   /* fall through */
 514                sk->sk_state = IUCV_CLOSED;
 515                sk->sk_state_change(sk);
 516
 517                sk->sk_err = ECONNRESET;
 518                sk->sk_state_change(sk);
 519
 520                skb_queue_purge(&iucv->send_skb_q);
 521                skb_queue_purge(&iucv->backlog_skb_q);
 522
 523        default:   /* fall through */
 524                iucv_sever_path(sk, 1);
 525        }
 526
 527        if (iucv->hs_dev) {
 528                dev_put(iucv->hs_dev);
 529                iucv->hs_dev = NULL;
 530                sk->sk_bound_dev_if = 0;
 531        }
 532
 533        /* mark socket for deletion by iucv_sock_kill() */
 534        sock_set_flag(sk, SOCK_ZAPPED);
 535
 536        release_sock(sk);
 537}
 538
 539static void iucv_sock_init(struct sock *sk, struct sock *parent)
 540{
 541        if (parent) {
 542                sk->sk_type = parent->sk_type;
 543                security_sk_clone(parent, sk);
 544        }
 545}
 546
 547static struct sock *iucv_sock_alloc(struct socket *sock, int proto, gfp_t prio, int kern)
 548{
 549        struct sock *sk;
 550        struct iucv_sock *iucv;
 551
 552        sk = sk_alloc(&init_net, PF_IUCV, prio, &iucv_proto, kern);
 553        if (!sk)
 554                return NULL;
 555        iucv = iucv_sk(sk);
 556
 557        sock_init_data(sock, sk);
 558        INIT_LIST_HEAD(&iucv->accept_q);
 559        spin_lock_init(&iucv->accept_q_lock);
 560        skb_queue_head_init(&iucv->send_skb_q);
 561        INIT_LIST_HEAD(&iucv->message_q.list);
 562        spin_lock_init(&iucv->message_q.lock);
 563        skb_queue_head_init(&iucv->backlog_skb_q);
 564        iucv->send_tag = 0;
 565        atomic_set(&iucv->pendings, 0);
 566        iucv->flags = 0;
 567        iucv->msglimit = 0;
 568        atomic_set(&iucv->msg_sent, 0);
 569        atomic_set(&iucv->msg_recv, 0);
 570        iucv->path = NULL;
 571        iucv->sk_txnotify = afiucv_hs_callback_txnotify;
 572        memset(&iucv->src_user_id , 0, 32);
 573        if (pr_iucv)
 574                iucv->transport = AF_IUCV_TRANS_IUCV;
 575        else
 576                iucv->transport = AF_IUCV_TRANS_HIPER;
 577
 578        sk->sk_destruct = iucv_sock_destruct;
 579        sk->sk_sndtimeo = IUCV_CONN_TIMEOUT;
 580        sk->sk_allocation = GFP_DMA;
 581
 582        sock_reset_flag(sk, SOCK_ZAPPED);
 583
 584        sk->sk_protocol = proto;
 585        sk->sk_state    = IUCV_OPEN;
 586
 587        iucv_sock_link(&iucv_sk_list, sk);
 588        return sk;
 589}
 590
 591/* Create an IUCV socket */
 592static int iucv_sock_create(struct net *net, struct socket *sock, int protocol,
 593                            int kern)
 594{
 595        struct sock *sk;
 596
 597        if (protocol && protocol != PF_IUCV)
 598                return -EPROTONOSUPPORT;
 599
 600        sock->state = SS_UNCONNECTED;
 601
 602        switch (sock->type) {
 603        case SOCK_STREAM:
 604                sock->ops = &iucv_sock_ops;
 605                break;
 606        case SOCK_SEQPACKET:
 607                /* currently, proto ops can handle both sk types */
 608                sock->ops = &iucv_sock_ops;
 609                break;
 610        default:
 611                return -ESOCKTNOSUPPORT;
 612        }
 613
 614        sk = iucv_sock_alloc(sock, protocol, GFP_KERNEL, kern);
 615        if (!sk)
 616                return -ENOMEM;
 617
 618        iucv_sock_init(sk, NULL);
 619
 620        return 0;
 621}
 622
 623void iucv_sock_link(struct iucv_sock_list *l, struct sock *sk)
 624{
 625        write_lock_bh(&l->lock);
 626        sk_add_node(sk, &l->head);
 627        write_unlock_bh(&l->lock);
 628}
 629
 630void iucv_sock_unlink(struct iucv_sock_list *l, struct sock *sk)
 631{
 632        write_lock_bh(&l->lock);
 633        sk_del_node_init(sk);
 634        write_unlock_bh(&l->lock);
 635}
 636
 637void iucv_accept_enqueue(struct sock *parent, struct sock *sk)
 638{
 639        unsigned long flags;
 640        struct iucv_sock *par = iucv_sk(parent);
 641
 642        sock_hold(sk);
 643        spin_lock_irqsave(&par->accept_q_lock, flags);
 644        list_add_tail(&iucv_sk(sk)->accept_q, &par->accept_q);
 645        spin_unlock_irqrestore(&par->accept_q_lock, flags);
 646        iucv_sk(sk)->parent = parent;
 647        sk_acceptq_added(parent);
 648}
 649
 650void iucv_accept_unlink(struct sock *sk)
 651{
 652        unsigned long flags;
 653        struct iucv_sock *par = iucv_sk(iucv_sk(sk)->parent);
 654
 655        spin_lock_irqsave(&par->accept_q_lock, flags);
 656        list_del_init(&iucv_sk(sk)->accept_q);
 657        spin_unlock_irqrestore(&par->accept_q_lock, flags);
 658        sk_acceptq_removed(iucv_sk(sk)->parent);
 659        iucv_sk(sk)->parent = NULL;
 660        sock_put(sk);
 661}
 662
 663struct sock *iucv_accept_dequeue(struct sock *parent, struct socket *newsock)
 664{
 665        struct iucv_sock *isk, *n;
 666        struct sock *sk;
 667
 668        list_for_each_entry_safe(isk, n, &iucv_sk(parent)->accept_q, accept_q) {
 669                sk = (struct sock *) isk;
 670                lock_sock(sk);
 671
 672                if (sk->sk_state == IUCV_CLOSED) {
 673                        iucv_accept_unlink(sk);
 674                        release_sock(sk);
 675                        continue;
 676                }
 677
 678                if (sk->sk_state == IUCV_CONNECTED ||
 679                    sk->sk_state == IUCV_DISCONN ||
 680                    !newsock) {
 681                        iucv_accept_unlink(sk);
 682                        if (newsock)
 683                                sock_graft(sk, newsock);
 684
 685                        release_sock(sk);
 686                        return sk;
 687                }
 688
 689                release_sock(sk);
 690        }
 691        return NULL;
 692}
 693
 694static void __iucv_auto_name(struct iucv_sock *iucv)
 695{
 696        char name[12];
 697
 698        sprintf(name, "%08x", atomic_inc_return(&iucv_sk_list.autobind_name));
 699        while (__iucv_get_sock_by_name(name)) {
 700                sprintf(name, "%08x",
 701                        atomic_inc_return(&iucv_sk_list.autobind_name));
 702        }
 703        memcpy(iucv->src_name, name, 8);
 704}
 705
 706/* Bind an unbound socket */
 707static int iucv_sock_bind(struct socket *sock, struct sockaddr *addr,
 708                          int addr_len)
 709{
 710        struct sockaddr_iucv *sa = (struct sockaddr_iucv *) addr;
 711        struct sock *sk = sock->sk;
 712        struct iucv_sock *iucv;
 713        int err = 0;
 714        struct net_device *dev;
 715        char uid[9];
 716
 717        /* Verify the input sockaddr */
 718        if (addr_len < sizeof(struct sockaddr_iucv) ||
 719            addr->sa_family != AF_IUCV)
 720                return -EINVAL;
 721
 722        lock_sock(sk);
 723        if (sk->sk_state != IUCV_OPEN) {
 724                err = -EBADFD;
 725                goto done;
 726        }
 727
 728        write_lock_bh(&iucv_sk_list.lock);
 729
 730        iucv = iucv_sk(sk);
 731        if (__iucv_get_sock_by_name(sa->siucv_name)) {
 732                err = -EADDRINUSE;
 733                goto done_unlock;
 734        }
 735        if (iucv->path)
 736                goto done_unlock;
 737
 738        /* Bind the socket */
 739        if (pr_iucv)
 740                if (!memcmp(sa->siucv_user_id, iucv_userid, 8))
 741                        goto vm_bind; /* VM IUCV transport */
 742
 743        /* try hiper transport */
 744        memcpy(uid, sa->siucv_user_id, sizeof(uid));
 745        ASCEBC(uid, 8);
 746        rcu_read_lock();
 747        for_each_netdev_rcu(&init_net, dev) {
 748                if (!memcmp(dev->perm_addr, uid, 8)) {
 749                        memcpy(iucv->src_user_id, sa->siucv_user_id, 8);
 750                        /* Check for unitialized siucv_name */
 751                        if (strncmp(sa->siucv_name, "        ", 8) == 0)
 752                                __iucv_auto_name(iucv);
 753                        else
 754                                memcpy(iucv->src_name, sa->siucv_name, 8);
 755                        sk->sk_bound_dev_if = dev->ifindex;
 756                        iucv->hs_dev = dev;
 757                        dev_hold(dev);
 758                        sk->sk_state = IUCV_BOUND;
 759                        iucv->transport = AF_IUCV_TRANS_HIPER;
 760                        if (!iucv->msglimit)
 761                                iucv->msglimit = IUCV_HIPER_MSGLIM_DEFAULT;
 762                        rcu_read_unlock();
 763                        goto done_unlock;
 764                }
 765        }
 766        rcu_read_unlock();
 767vm_bind:
 768        if (pr_iucv) {
 769                /* use local userid for backward compat */
 770                memcpy(iucv->src_name, sa->siucv_name, 8);
 771                memcpy(iucv->src_user_id, iucv_userid, 8);
 772                sk->sk_state = IUCV_BOUND;
 773                iucv->transport = AF_IUCV_TRANS_IUCV;
 774                if (!iucv->msglimit)
 775                        iucv->msglimit = IUCV_QUEUELEN_DEFAULT;
 776                goto done_unlock;
 777        }
 778        /* found no dev to bind */
 779        err = -ENODEV;
 780done_unlock:
 781        /* Release the socket list lock */
 782        write_unlock_bh(&iucv_sk_list.lock);
 783done:
 784        release_sock(sk);
 785        return err;
 786}
 787
 788/* Automatically bind an unbound socket */
 789static int iucv_sock_autobind(struct sock *sk)
 790{
 791        struct iucv_sock *iucv = iucv_sk(sk);
 792        int err = 0;
 793
 794        if (unlikely(!pr_iucv))
 795                return -EPROTO;
 796
 797        memcpy(iucv->src_user_id, iucv_userid, 8);
 798
 799        write_lock_bh(&iucv_sk_list.lock);
 800        __iucv_auto_name(iucv);
 801        write_unlock_bh(&iucv_sk_list.lock);
 802
 803        if (!iucv->msglimit)
 804                iucv->msglimit = IUCV_QUEUELEN_DEFAULT;
 805
 806        return err;
 807}
 808
 809static int afiucv_path_connect(struct socket *sock, struct sockaddr *addr)
 810{
 811        struct sockaddr_iucv *sa = (struct sockaddr_iucv *) addr;
 812        struct sock *sk = sock->sk;
 813        struct iucv_sock *iucv = iucv_sk(sk);
 814        unsigned char user_data[16];
 815        int err;
 816
 817        high_nmcpy(user_data, sa->siucv_name);
 818        low_nmcpy(user_data, iucv->src_name);
 819        ASCEBC(user_data, sizeof(user_data));
 820
 821        /* Create path. */
 822        iucv->path = iucv_path_alloc(iucv->msglimit,
 823                                     IUCV_IPRMDATA, GFP_KERNEL);
 824        if (!iucv->path) {
 825                err = -ENOMEM;
 826                goto done;
 827        }
 828        err = pr_iucv->path_connect(iucv->path, &af_iucv_handler,
 829                                    sa->siucv_user_id, NULL, user_data,
 830                                    sk);
 831        if (err) {
 832                iucv_path_free(iucv->path);
 833                iucv->path = NULL;
 834                switch (err) {
 835                case 0x0b:      /* Target communicator is not logged on */
 836                        err = -ENETUNREACH;
 837                        break;
 838                case 0x0d:      /* Max connections for this guest exceeded */
 839                case 0x0e:      /* Max connections for target guest exceeded */
 840                        err = -EAGAIN;
 841                        break;
 842                case 0x0f:      /* Missing IUCV authorization */
 843                        err = -EACCES;
 844                        break;
 845                default:
 846                        err = -ECONNREFUSED;
 847                        break;
 848                }
 849        }
 850done:
 851        return err;
 852}
 853
 854/* Connect an unconnected socket */
 855static int iucv_sock_connect(struct socket *sock, struct sockaddr *addr,
 856                             int alen, int flags)
 857{
 858        struct sockaddr_iucv *sa = (struct sockaddr_iucv *) addr;
 859        struct sock *sk = sock->sk;
 860        struct iucv_sock *iucv = iucv_sk(sk);
 861        int err;
 862
 863        if (alen < sizeof(struct sockaddr_iucv) || addr->sa_family != AF_IUCV)
 864                return -EINVAL;
 865
 866        if (sk->sk_state != IUCV_OPEN && sk->sk_state != IUCV_BOUND)
 867                return -EBADFD;
 868
 869        if (sk->sk_state == IUCV_OPEN &&
 870            iucv->transport == AF_IUCV_TRANS_HIPER)
 871                return -EBADFD; /* explicit bind required */
 872
 873        if (sk->sk_type != SOCK_STREAM && sk->sk_type != SOCK_SEQPACKET)
 874                return -EINVAL;
 875
 876        if (sk->sk_state == IUCV_OPEN) {
 877                err = iucv_sock_autobind(sk);
 878                if (unlikely(err))
 879                        return err;
 880        }
 881
 882        lock_sock(sk);
 883
 884        /* Set the destination information */
 885        memcpy(iucv->dst_user_id, sa->siucv_user_id, 8);
 886        memcpy(iucv->dst_name, sa->siucv_name, 8);
 887
 888        if (iucv->transport == AF_IUCV_TRANS_HIPER)
 889                err = iucv_send_ctrl(sock->sk, AF_IUCV_FLAG_SYN);
 890        else
 891                err = afiucv_path_connect(sock, addr);
 892        if (err)
 893                goto done;
 894
 895        if (sk->sk_state != IUCV_CONNECTED)
 896                err = iucv_sock_wait(sk, iucv_sock_in_state(sk, IUCV_CONNECTED,
 897                                                            IUCV_DISCONN),
 898                                     sock_sndtimeo(sk, flags & O_NONBLOCK));
 899
 900        if (sk->sk_state == IUCV_DISCONN || sk->sk_state == IUCV_CLOSED)
 901                err = -ECONNREFUSED;
 902
 903        if (err && iucv->transport == AF_IUCV_TRANS_IUCV)
 904                iucv_sever_path(sk, 0);
 905
 906done:
 907        release_sock(sk);
 908        return err;
 909}
 910
 911/* Move a socket into listening state. */
 912static int iucv_sock_listen(struct socket *sock, int backlog)
 913{
 914        struct sock *sk = sock->sk;
 915        int err;
 916
 917        lock_sock(sk);
 918
 919        err = -EINVAL;
 920        if (sk->sk_state != IUCV_BOUND)
 921                goto done;
 922
 923        if (sock->type != SOCK_STREAM && sock->type != SOCK_SEQPACKET)
 924                goto done;
 925
 926        sk->sk_max_ack_backlog = backlog;
 927        sk->sk_ack_backlog = 0;
 928        sk->sk_state = IUCV_LISTEN;
 929        err = 0;
 930
 931done:
 932        release_sock(sk);
 933        return err;
 934}
 935
 936/* Accept a pending connection */
 937static int iucv_sock_accept(struct socket *sock, struct socket *newsock,
 938                            int flags, bool kern)
 939{
 940        DECLARE_WAITQUEUE(wait, current);
 941        struct sock *sk = sock->sk, *nsk;
 942        long timeo;
 943        int err = 0;
 944
 945        lock_sock_nested(sk, SINGLE_DEPTH_NESTING);
 946
 947        if (sk->sk_state != IUCV_LISTEN) {
 948                err = -EBADFD;
 949                goto done;
 950        }
 951
 952        timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
 953
 954        /* Wait for an incoming connection */
 955        add_wait_queue_exclusive(sk_sleep(sk), &wait);
 956        while (!(nsk = iucv_accept_dequeue(sk, newsock))) {
 957                set_current_state(TASK_INTERRUPTIBLE);
 958                if (!timeo) {
 959                        err = -EAGAIN;
 960                        break;
 961                }
 962
 963                release_sock(sk);
 964                timeo = schedule_timeout(timeo);
 965                lock_sock_nested(sk, SINGLE_DEPTH_NESTING);
 966
 967                if (sk->sk_state != IUCV_LISTEN) {
 968                        err = -EBADFD;
 969                        break;
 970                }
 971
 972                if (signal_pending(current)) {
 973                        err = sock_intr_errno(timeo);
 974                        break;
 975                }
 976        }
 977
 978        set_current_state(TASK_RUNNING);
 979        remove_wait_queue(sk_sleep(sk), &wait);
 980
 981        if (err)
 982                goto done;
 983
 984        newsock->state = SS_CONNECTED;
 985
 986done:
 987        release_sock(sk);
 988        return err;
 989}
 990
 991static int iucv_sock_getname(struct socket *sock, struct sockaddr *addr,
 992                             int peer)
 993{
 994        struct sockaddr_iucv *siucv = (struct sockaddr_iucv *) addr;
 995        struct sock *sk = sock->sk;
 996        struct iucv_sock *iucv = iucv_sk(sk);
 997
 998        addr->sa_family = AF_IUCV;
 999
1000        if (peer) {
1001                memcpy(siucv->siucv_user_id, iucv->dst_user_id, 8);
1002                memcpy(siucv->siucv_name, iucv->dst_name, 8);
1003        } else {
1004                memcpy(siucv->siucv_user_id, iucv->src_user_id, 8);
1005                memcpy(siucv->siucv_name, iucv->src_name, 8);
1006        }
1007        memset(&siucv->siucv_port, 0, sizeof(siucv->siucv_port));
1008        memset(&siucv->siucv_addr, 0, sizeof(siucv->siucv_addr));
1009        memset(&siucv->siucv_nodeid, 0, sizeof(siucv->siucv_nodeid));
1010
1011        return sizeof(struct sockaddr_iucv);
1012}
1013
1014/**
1015 * iucv_send_iprm() - Send socket data in parameter list of an iucv message.
1016 * @path:       IUCV path
1017 * @msg:        Pointer to a struct iucv_message
1018 * @skb:        The socket data to send, skb->len MUST BE <= 7
1019 *
1020 * Send the socket data in the parameter list in the iucv message
1021 * (IUCV_IPRMDATA). The socket data is stored at index 0 to 6 in the parameter
1022 * list and the socket data len at index 7 (last byte).
1023 * See also iucv_msg_length().
1024 *
1025 * Returns the error code from the iucv_message_send() call.
1026 */
1027static int iucv_send_iprm(struct iucv_path *path, struct iucv_message *msg,
1028                          struct sk_buff *skb)
1029{
1030        u8 prmdata[8];
1031
1032        memcpy(prmdata, (void *) skb->data, skb->len);
1033        prmdata[7] = 0xff - (u8) skb->len;
1034        return pr_iucv->message_send(path, msg, IUCV_IPRMDATA, 0,
1035                                 (void *) prmdata, 8);
1036}
1037
1038static int iucv_sock_sendmsg(struct socket *sock, struct msghdr *msg,
1039                             size_t len)
1040{
1041        struct sock *sk = sock->sk;
1042        struct iucv_sock *iucv = iucv_sk(sk);
1043        size_t headroom = 0;
1044        size_t linear;
1045        struct sk_buff *skb;
1046        struct iucv_message txmsg = {0};
1047        struct cmsghdr *cmsg;
1048        int cmsg_done;
1049        long timeo;
1050        char user_id[9];
1051        char appl_id[9];
1052        int err;
1053        int noblock = msg->msg_flags & MSG_DONTWAIT;
1054
1055        err = sock_error(sk);
1056        if (err)
1057                return err;
1058
1059        if (msg->msg_flags & MSG_OOB)
1060                return -EOPNOTSUPP;
1061
1062        /* SOCK_SEQPACKET: we do not support segmented records */
1063        if (sk->sk_type == SOCK_SEQPACKET && !(msg->msg_flags & MSG_EOR))
1064                return -EOPNOTSUPP;
1065
1066        lock_sock(sk);
1067
1068        if (sk->sk_shutdown & SEND_SHUTDOWN) {
1069                err = -EPIPE;
1070                goto out;
1071        }
1072
1073        /* Return if the socket is not in connected state */
1074        if (sk->sk_state != IUCV_CONNECTED) {
1075                err = -ENOTCONN;
1076                goto out;
1077        }
1078
1079        /* initialize defaults */
1080        cmsg_done   = 0;        /* check for duplicate headers */
1081        txmsg.class = 0;
1082
1083        /* iterate over control messages */
1084        for_each_cmsghdr(cmsg, msg) {
1085                if (!CMSG_OK(msg, cmsg)) {
1086                        err = -EINVAL;
1087                        goto out;
1088                }
1089
1090                if (cmsg->cmsg_level != SOL_IUCV)
1091                        continue;
1092
1093                if (cmsg->cmsg_type & cmsg_done) {
1094                        err = -EINVAL;
1095                        goto out;
1096                }
1097                cmsg_done |= cmsg->cmsg_type;
1098
1099                switch (cmsg->cmsg_type) {
1100                case SCM_IUCV_TRGCLS:
1101                        if (cmsg->cmsg_len != CMSG_LEN(TRGCLS_SIZE)) {
1102                                err = -EINVAL;
1103                                goto out;
1104                        }
1105
1106                        /* set iucv message target class */
1107                        memcpy(&txmsg.class,
1108                                (void *) CMSG_DATA(cmsg), TRGCLS_SIZE);
1109
1110                        break;
1111
1112                default:
1113                        err = -EINVAL;
1114                        goto out;
1115                }
1116        }
1117
1118        /* allocate one skb for each iucv message:
1119         * this is fine for SOCK_SEQPACKET (unless we want to support
1120         * segmented records using the MSG_EOR flag), but
1121         * for SOCK_STREAM we might want to improve it in future */
1122        if (iucv->transport == AF_IUCV_TRANS_HIPER) {
1123                headroom = sizeof(struct af_iucv_trans_hdr) + ETH_HLEN;
1124                linear = len;
1125        } else {
1126                if (len < PAGE_SIZE) {
1127                        linear = len;
1128                } else {
1129                        /* In nonlinear "classic" iucv skb,
1130                         * reserve space for iucv_array
1131                         */
1132                        headroom = sizeof(struct iucv_array) *
1133                                   (MAX_SKB_FRAGS + 1);
1134                        linear = PAGE_SIZE - headroom;
1135                }
1136        }
1137        skb = sock_alloc_send_pskb(sk, headroom + linear, len - linear,
1138                                   noblock, &err, 0);
1139        if (!skb)
1140                goto out;
1141        if (headroom)
1142                skb_reserve(skb, headroom);
1143        skb_put(skb, linear);
1144        skb->len = len;
1145        skb->data_len = len - linear;
1146        err = skb_copy_datagram_from_iter(skb, 0, &msg->msg_iter, len);
1147        if (err)
1148                goto fail;
1149
1150        /* wait if outstanding messages for iucv path has reached */
1151        timeo = sock_sndtimeo(sk, noblock);
1152        err = iucv_sock_wait(sk, iucv_below_msglim(sk), timeo);
1153        if (err)
1154                goto fail;
1155
1156        /* return -ECONNRESET if the socket is no longer connected */
1157        if (sk->sk_state != IUCV_CONNECTED) {
1158                err = -ECONNRESET;
1159                goto fail;
1160        }
1161
1162        /* increment and save iucv message tag for msg_completion cbk */
1163        txmsg.tag = iucv->send_tag++;
1164        IUCV_SKB_CB(skb)->tag = txmsg.tag;
1165
1166        if (iucv->transport == AF_IUCV_TRANS_HIPER) {
1167                atomic_inc(&iucv->msg_sent);
1168                err = afiucv_hs_send(&txmsg, sk, skb, 0);
1169                if (err) {
1170                        atomic_dec(&iucv->msg_sent);
1171                        goto fail;
1172                }
1173        } else { /* Classic VM IUCV transport */
1174                skb_queue_tail(&iucv->send_skb_q, skb);
1175
1176                if (((iucv->path->flags & IUCV_IPRMDATA) & iucv->flags) &&
1177                    skb->len <= 7) {
1178                        err = iucv_send_iprm(iucv->path, &txmsg, skb);
1179
1180                        /* on success: there is no message_complete callback */
1181                        /* for an IPRMDATA msg; remove skb from send queue   */
1182                        if (err == 0) {
1183                                skb_unlink(skb, &iucv->send_skb_q);
1184                                kfree_skb(skb);
1185                        }
1186
1187                        /* this error should never happen since the     */
1188                        /* IUCV_IPRMDATA path flag is set... sever path */
1189                        if (err == 0x15) {
1190                                pr_iucv->path_sever(iucv->path, NULL);
1191                                skb_unlink(skb, &iucv->send_skb_q);
1192                                err = -EPIPE;
1193                                goto fail;
1194                        }
1195                } else if (skb_is_nonlinear(skb)) {
1196                        struct iucv_array *iba = (struct iucv_array *)skb->head;
1197                        int i;
1198
1199                        /* skip iucv_array lying in the headroom */
1200                        iba[0].address = (u32)(addr_t)skb->data;
1201                        iba[0].length = (u32)skb_headlen(skb);
1202                        for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1203                                skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
1204
1205                                iba[i + 1].address =
1206                                        (u32)(addr_t)skb_frag_address(frag);
1207                                iba[i + 1].length = (u32)skb_frag_size(frag);
1208                        }
1209                        err = pr_iucv->message_send(iucv->path, &txmsg,
1210                                                    IUCV_IPBUFLST, 0,
1211                                                    (void *)iba, skb->len);
1212                } else { /* non-IPRM Linear skb */
1213                        err = pr_iucv->message_send(iucv->path, &txmsg,
1214                                        0, 0, (void *)skb->data, skb->len);
1215                }
1216                if (err) {
1217                        if (err == 3) {
1218                                user_id[8] = 0;
1219                                memcpy(user_id, iucv->dst_user_id, 8);
1220                                appl_id[8] = 0;
1221                                memcpy(appl_id, iucv->dst_name, 8);
1222                                pr_err(
1223                "Application %s on z/VM guest %s exceeds message limit\n",
1224                                        appl_id, user_id);
1225                                err = -EAGAIN;
1226                        } else {
1227                                err = -EPIPE;
1228                        }
1229                        skb_unlink(skb, &iucv->send_skb_q);
1230                        goto fail;
1231                }
1232        }
1233
1234        release_sock(sk);
1235        return len;
1236
1237fail:
1238        kfree_skb(skb);
1239out:
1240        release_sock(sk);
1241        return err;
1242}
1243
1244static struct sk_buff *alloc_iucv_recv_skb(unsigned long len)
1245{
1246        size_t headroom, linear;
1247        struct sk_buff *skb;
1248        int err;
1249
1250        if (len < PAGE_SIZE) {
1251                headroom = 0;
1252                linear = len;
1253        } else {
1254                headroom = sizeof(struct iucv_array) * (MAX_SKB_FRAGS + 1);
1255                linear = PAGE_SIZE - headroom;
1256        }
1257        skb = alloc_skb_with_frags(headroom + linear, len - linear,
1258                                   0, &err, GFP_ATOMIC | GFP_DMA);
1259        WARN_ONCE(!skb,
1260                  "alloc of recv iucv skb len=%lu failed with errcode=%d\n",
1261                  len, err);
1262        if (skb) {
1263                if (headroom)
1264                        skb_reserve(skb, headroom);
1265                skb_put(skb, linear);
1266                skb->len = len;
1267                skb->data_len = len - linear;
1268        }
1269        return skb;
1270}
1271
1272/* iucv_process_message() - Receive a single outstanding IUCV message
1273 *
1274 * Locking: must be called with message_q.lock held
1275 */
1276static void iucv_process_message(struct sock *sk, struct sk_buff *skb,
1277                                 struct iucv_path *path,
1278                                 struct iucv_message *msg)
1279{
1280        int rc;
1281        unsigned int len;
1282
1283        len = iucv_msg_length(msg);
1284
1285        /* store msg target class in the second 4 bytes of skb ctrl buffer */
1286        /* Note: the first 4 bytes are reserved for msg tag */
1287        IUCV_SKB_CB(skb)->class = msg->class;
1288
1289        /* check for special IPRM messages (e.g. iucv_sock_shutdown) */
1290        if ((msg->flags & IUCV_IPRMDATA) && len > 7) {
1291                if (memcmp(msg->rmmsg, iprm_shutdown, 8) == 0) {
1292                        skb->data = NULL;
1293                        skb->len = 0;
1294                }
1295        } else {
1296                if (skb_is_nonlinear(skb)) {
1297                        struct iucv_array *iba = (struct iucv_array *)skb->head;
1298                        int i;
1299
1300                        iba[0].address = (u32)(addr_t)skb->data;
1301                        iba[0].length = (u32)skb_headlen(skb);
1302                        for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
1303                                skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
1304
1305                                iba[i + 1].address =
1306                                        (u32)(addr_t)skb_frag_address(frag);
1307                                iba[i + 1].length = (u32)skb_frag_size(frag);
1308                        }
1309                        rc = pr_iucv->message_receive(path, msg,
1310                                              IUCV_IPBUFLST,
1311                                              (void *)iba, len, NULL);
1312                } else {
1313                        rc = pr_iucv->message_receive(path, msg,
1314                                              msg->flags & IUCV_IPRMDATA,
1315                                              skb->data, len, NULL);
1316                }
1317                if (rc) {
1318                        kfree_skb(skb);
1319                        return;
1320                }
1321                WARN_ON_ONCE(skb->len != len);
1322        }
1323
1324        IUCV_SKB_CB(skb)->offset = 0;
1325        if (sk_filter(sk, skb)) {
1326                atomic_inc(&sk->sk_drops);      /* skb rejected by filter */
1327                kfree_skb(skb);
1328                return;
1329        }
1330        if (__sock_queue_rcv_skb(sk, skb))      /* handle rcv queue full */
1331                skb_queue_tail(&iucv_sk(sk)->backlog_skb_q, skb);
1332}
1333
1334/* iucv_process_message_q() - Process outstanding IUCV messages
1335 *
1336 * Locking: must be called with message_q.lock held
1337 */
1338static void iucv_process_message_q(struct sock *sk)
1339{
1340        struct iucv_sock *iucv = iucv_sk(sk);
1341        struct sk_buff *skb;
1342        struct sock_msg_q *p, *n;
1343
1344        list_for_each_entry_safe(p, n, &iucv->message_q.list, list) {
1345                skb = alloc_iucv_recv_skb(iucv_msg_length(&p->msg));
1346                if (!skb)
1347                        break;
1348                iucv_process_message(sk, skb, p->path, &p->msg);
1349                list_del(&p->list);
1350                kfree(p);
1351                if (!skb_queue_empty(&iucv->backlog_skb_q))
1352                        break;
1353        }
1354}
1355
1356static int iucv_sock_recvmsg(struct socket *sock, struct msghdr *msg,
1357                             size_t len, int flags)
1358{
1359        int noblock = flags & MSG_DONTWAIT;
1360        struct sock *sk = sock->sk;
1361        struct iucv_sock *iucv = iucv_sk(sk);
1362        unsigned int copied, rlen;
1363        struct sk_buff *skb, *rskb, *cskb;
1364        int err = 0;
1365        u32 offset;
1366
1367        if ((sk->sk_state == IUCV_DISCONN) &&
1368            skb_queue_empty(&iucv->backlog_skb_q) &&
1369            skb_queue_empty(&sk->sk_receive_queue) &&
1370            list_empty(&iucv->message_q.list))
1371                return 0;
1372
1373        if (flags & (MSG_OOB))
1374                return -EOPNOTSUPP;
1375
1376        /* receive/dequeue next skb:
1377         * the function understands MSG_PEEK and, thus, does not dequeue skb */
1378        skb = skb_recv_datagram(sk, flags, noblock, &err);
1379        if (!skb) {
1380                if (sk->sk_shutdown & RCV_SHUTDOWN)
1381                        return 0;
1382                return err;
1383        }
1384
1385        offset = IUCV_SKB_CB(skb)->offset;
1386        rlen   = skb->len - offset;             /* real length of skb */
1387        copied = min_t(unsigned int, rlen, len);
1388        if (!rlen)
1389                sk->sk_shutdown = sk->sk_shutdown | RCV_SHUTDOWN;
1390
1391        cskb = skb;
1392        if (skb_copy_datagram_msg(cskb, offset, msg, copied)) {
1393                if (!(flags & MSG_PEEK))
1394                        skb_queue_head(&sk->sk_receive_queue, skb);
1395                return -EFAULT;
1396        }
1397
1398        /* SOCK_SEQPACKET: set MSG_TRUNC if recv buf size is too small */
1399        if (sk->sk_type == SOCK_SEQPACKET) {
1400                if (copied < rlen)
1401                        msg->msg_flags |= MSG_TRUNC;
1402                /* each iucv message contains a complete record */
1403                msg->msg_flags |= MSG_EOR;
1404        }
1405
1406        /* create control message to store iucv msg target class:
1407         * get the trgcls from the control buffer of the skb due to
1408         * fragmentation of original iucv message. */
1409        err = put_cmsg(msg, SOL_IUCV, SCM_IUCV_TRGCLS,
1410                       sizeof(IUCV_SKB_CB(skb)->class),
1411                       (void *)&IUCV_SKB_CB(skb)->class);
1412        if (err) {
1413                if (!(flags & MSG_PEEK))
1414                        skb_queue_head(&sk->sk_receive_queue, skb);
1415                return err;
1416        }
1417
1418        /* Mark read part of skb as used */
1419        if (!(flags & MSG_PEEK)) {
1420
1421                /* SOCK_STREAM: re-queue skb if it contains unreceived data */
1422                if (sk->sk_type == SOCK_STREAM) {
1423                        if (copied < rlen) {
1424                                IUCV_SKB_CB(skb)->offset = offset + copied;
1425                                skb_queue_head(&sk->sk_receive_queue, skb);
1426                                goto done;
1427                        }
1428                }
1429
1430                kfree_skb(skb);
1431                if (iucv->transport == AF_IUCV_TRANS_HIPER) {
1432                        atomic_inc(&iucv->msg_recv);
1433                        if (atomic_read(&iucv->msg_recv) > iucv->msglimit) {
1434                                WARN_ON(1);
1435                                iucv_sock_close(sk);
1436                                return -EFAULT;
1437                        }
1438                }
1439
1440                /* Queue backlog skbs */
1441                spin_lock_bh(&iucv->message_q.lock);
1442                rskb = skb_dequeue(&iucv->backlog_skb_q);
1443                while (rskb) {
1444                        IUCV_SKB_CB(rskb)->offset = 0;
1445                        if (__sock_queue_rcv_skb(sk, rskb)) {
1446                                /* handle rcv queue full */
1447                                skb_queue_head(&iucv->backlog_skb_q,
1448                                                rskb);
1449                                break;
1450                        }
1451                        rskb = skb_dequeue(&iucv->backlog_skb_q);
1452                }
1453                if (skb_queue_empty(&iucv->backlog_skb_q)) {
1454                        if (!list_empty(&iucv->message_q.list))
1455                                iucv_process_message_q(sk);
1456                        if (atomic_read(&iucv->msg_recv) >=
1457                                                        iucv->msglimit / 2) {
1458                                err = iucv_send_ctrl(sk, AF_IUCV_FLAG_WIN);
1459                                if (err) {
1460                                        sk->sk_state = IUCV_DISCONN;
1461                                        sk->sk_state_change(sk);
1462                                }
1463                        }
1464                }
1465                spin_unlock_bh(&iucv->message_q.lock);
1466        }
1467
1468done:
1469        /* SOCK_SEQPACKET: return real length if MSG_TRUNC is set */
1470        if (sk->sk_type == SOCK_SEQPACKET && (flags & MSG_TRUNC))
1471                copied = rlen;
1472
1473        return copied;
1474}
1475
1476static inline __poll_t iucv_accept_poll(struct sock *parent)
1477{
1478        struct iucv_sock *isk, *n;
1479        struct sock *sk;
1480
1481        list_for_each_entry_safe(isk, n, &iucv_sk(parent)->accept_q, accept_q) {
1482                sk = (struct sock *) isk;
1483
1484                if (sk->sk_state == IUCV_CONNECTED)
1485                        return EPOLLIN | EPOLLRDNORM;
1486        }
1487
1488        return 0;
1489}
1490
1491__poll_t iucv_sock_poll(struct file *file, struct socket *sock,
1492                            poll_table *wait)
1493{
1494        struct sock *sk = sock->sk;
1495        __poll_t mask = 0;
1496
1497        sock_poll_wait(file, sk_sleep(sk), wait);
1498
1499        if (sk->sk_state == IUCV_LISTEN)
1500                return iucv_accept_poll(sk);
1501
1502        if (sk->sk_err || !skb_queue_empty(&sk->sk_error_queue))
1503                mask |= EPOLLERR |
1504                        (sock_flag(sk, SOCK_SELECT_ERR_QUEUE) ? EPOLLPRI : 0);
1505
1506        if (sk->sk_shutdown & RCV_SHUTDOWN)
1507                mask |= EPOLLRDHUP;
1508
1509        if (sk->sk_shutdown == SHUTDOWN_MASK)
1510                mask |= EPOLLHUP;
1511
1512        if (!skb_queue_empty(&sk->sk_receive_queue) ||
1513            (sk->sk_shutdown & RCV_SHUTDOWN))
1514                mask |= EPOLLIN | EPOLLRDNORM;
1515
1516        if (sk->sk_state == IUCV_CLOSED)
1517                mask |= EPOLLHUP;
1518
1519        if (sk->sk_state == IUCV_DISCONN)
1520                mask |= EPOLLIN;
1521
1522        if (sock_writeable(sk) && iucv_below_msglim(sk))
1523                mask |= EPOLLOUT | EPOLLWRNORM | EPOLLWRBAND;
1524        else
1525                sk_set_bit(SOCKWQ_ASYNC_NOSPACE, sk);
1526
1527        return mask;
1528}
1529
1530static int iucv_sock_shutdown(struct socket *sock, int how)
1531{
1532        struct sock *sk = sock->sk;
1533        struct iucv_sock *iucv = iucv_sk(sk);
1534        struct iucv_message txmsg;
1535        int err = 0;
1536
1537        how++;
1538
1539        if ((how & ~SHUTDOWN_MASK) || !how)
1540                return -EINVAL;
1541
1542        lock_sock(sk);
1543        switch (sk->sk_state) {
1544        case IUCV_LISTEN:
1545        case IUCV_DISCONN:
1546        case IUCV_CLOSING:
1547        case IUCV_CLOSED:
1548                err = -ENOTCONN;
1549                goto fail;
1550        default:
1551                break;
1552        }
1553
1554        if (how == SEND_SHUTDOWN || how == SHUTDOWN_MASK) {
1555                if (iucv->transport == AF_IUCV_TRANS_IUCV) {
1556                        txmsg.class = 0;
1557                        txmsg.tag = 0;
1558                        err = pr_iucv->message_send(iucv->path, &txmsg,
1559                                IUCV_IPRMDATA, 0, (void *) iprm_shutdown, 8);
1560                        if (err) {
1561                                switch (err) {
1562                                case 1:
1563                                        err = -ENOTCONN;
1564                                        break;
1565                                case 2:
1566                                        err = -ECONNRESET;
1567                                        break;
1568                                default:
1569                                        err = -ENOTCONN;
1570                                        break;
1571                                }
1572                        }
1573                } else
1574                        iucv_send_ctrl(sk, AF_IUCV_FLAG_SHT);
1575        }
1576
1577        sk->sk_shutdown |= how;
1578        if (how == RCV_SHUTDOWN || how == SHUTDOWN_MASK) {
1579                if ((iucv->transport == AF_IUCV_TRANS_IUCV) &&
1580                    iucv->path) {
1581                        err = pr_iucv->path_quiesce(iucv->path, NULL);
1582                        if (err)
1583                                err = -ENOTCONN;
1584/*                      skb_queue_purge(&sk->sk_receive_queue); */
1585                }
1586                skb_queue_purge(&sk->sk_receive_queue);
1587        }
1588
1589        /* Wake up anyone sleeping in poll */
1590        sk->sk_state_change(sk);
1591
1592fail:
1593        release_sock(sk);
1594        return err;
1595}
1596
1597static int iucv_sock_release(struct socket *sock)
1598{
1599        struct sock *sk = sock->sk;
1600        int err = 0;
1601
1602        if (!sk)
1603                return 0;
1604
1605        iucv_sock_close(sk);
1606
1607        sock_orphan(sk);
1608        iucv_sock_kill(sk);
1609        return err;
1610}
1611
1612/* getsockopt and setsockopt */
1613static int iucv_sock_setsockopt(struct socket *sock, int level, int optname,
1614                                char __user *optval, unsigned int optlen)
1615{
1616        struct sock *sk = sock->sk;
1617        struct iucv_sock *iucv = iucv_sk(sk);
1618        int val;
1619        int rc;
1620
1621        if (level != SOL_IUCV)
1622                return -ENOPROTOOPT;
1623
1624        if (optlen < sizeof(int))
1625                return -EINVAL;
1626
1627        if (get_user(val, (int __user *) optval))
1628                return -EFAULT;
1629
1630        rc = 0;
1631
1632        lock_sock(sk);
1633        switch (optname) {
1634        case SO_IPRMDATA_MSG:
1635                if (val)
1636                        iucv->flags |= IUCV_IPRMDATA;
1637                else
1638                        iucv->flags &= ~IUCV_IPRMDATA;
1639                break;
1640        case SO_MSGLIMIT:
1641                switch (sk->sk_state) {
1642                case IUCV_OPEN:
1643                case IUCV_BOUND:
1644                        if (val < 1 || val > (u16)(~0))
1645                                rc = -EINVAL;
1646                        else
1647                                iucv->msglimit = val;
1648                        break;
1649                default:
1650                        rc = -EINVAL;
1651                        break;
1652                }
1653                break;
1654        default:
1655                rc = -ENOPROTOOPT;
1656                break;
1657        }
1658        release_sock(sk);
1659
1660        return rc;
1661}
1662
1663static int iucv_sock_getsockopt(struct socket *sock, int level, int optname,
1664                                char __user *optval, int __user *optlen)
1665{
1666        struct sock *sk = sock->sk;
1667        struct iucv_sock *iucv = iucv_sk(sk);
1668        unsigned int val;
1669        int len;
1670
1671        if (level != SOL_IUCV)
1672                return -ENOPROTOOPT;
1673
1674        if (get_user(len, optlen))
1675                return -EFAULT;
1676
1677        if (len < 0)
1678                return -EINVAL;
1679
1680        len = min_t(unsigned int, len, sizeof(int));
1681
1682        switch (optname) {
1683        case SO_IPRMDATA_MSG:
1684                val = (iucv->flags & IUCV_IPRMDATA) ? 1 : 0;
1685                break;
1686        case SO_MSGLIMIT:
1687                lock_sock(sk);
1688                val = (iucv->path != NULL) ? iucv->path->msglim /* connected */
1689                                           : iucv->msglimit;    /* default */
1690                release_sock(sk);
1691                break;
1692        case SO_MSGSIZE:
1693                if (sk->sk_state == IUCV_OPEN)
1694                        return -EBADFD;
1695                val = (iucv->hs_dev) ? iucv->hs_dev->mtu -
1696                                sizeof(struct af_iucv_trans_hdr) - ETH_HLEN :
1697                                0x7fffffff;
1698                break;
1699        default:
1700                return -ENOPROTOOPT;
1701        }
1702
1703        if (put_user(len, optlen))
1704                return -EFAULT;
1705        if (copy_to_user(optval, &val, len))
1706                return -EFAULT;
1707
1708        return 0;
1709}
1710
1711
1712/* Callback wrappers - called from iucv base support */
1713static int iucv_callback_connreq(struct iucv_path *path,
1714                                 u8 ipvmid[8], u8 ipuser[16])
1715{
1716        unsigned char user_data[16];
1717        unsigned char nuser_data[16];
1718        unsigned char src_name[8];
1719        struct sock *sk, *nsk;
1720        struct iucv_sock *iucv, *niucv;
1721        int err;
1722
1723        memcpy(src_name, ipuser, 8);
1724        EBCASC(src_name, 8);
1725        /* Find out if this path belongs to af_iucv. */
1726        read_lock(&iucv_sk_list.lock);
1727        iucv = NULL;
1728        sk = NULL;
1729        sk_for_each(sk, &iucv_sk_list.head)
1730                if (sk->sk_state == IUCV_LISTEN &&
1731                    !memcmp(&iucv_sk(sk)->src_name, src_name, 8)) {
1732                        /*
1733                         * Found a listening socket with
1734                         * src_name == ipuser[0-7].
1735                         */
1736                        iucv = iucv_sk(sk);
1737                        break;
1738                }
1739        read_unlock(&iucv_sk_list.lock);
1740        if (!iucv)
1741                /* No socket found, not one of our paths. */
1742                return -EINVAL;
1743
1744        bh_lock_sock(sk);
1745
1746        /* Check if parent socket is listening */
1747        low_nmcpy(user_data, iucv->src_name);
1748        high_nmcpy(user_data, iucv->dst_name);
1749        ASCEBC(user_data, sizeof(user_data));
1750        if (sk->sk_state != IUCV_LISTEN) {
1751                err = pr_iucv->path_sever(path, user_data);
1752                iucv_path_free(path);
1753                goto fail;
1754        }
1755
1756        /* Check for backlog size */
1757        if (sk_acceptq_is_full(sk)) {
1758                err = pr_iucv->path_sever(path, user_data);
1759                iucv_path_free(path);
1760                goto fail;
1761        }
1762
1763        /* Create the new socket */
1764        nsk = iucv_sock_alloc(NULL, sk->sk_type, GFP_ATOMIC, 0);
1765        if (!nsk) {
1766                err = pr_iucv->path_sever(path, user_data);
1767                iucv_path_free(path);
1768                goto fail;
1769        }
1770
1771        niucv = iucv_sk(nsk);
1772        iucv_sock_init(nsk, sk);
1773
1774        /* Set the new iucv_sock */
1775        memcpy(niucv->dst_name, ipuser + 8, 8);
1776        EBCASC(niucv->dst_name, 8);
1777        memcpy(niucv->dst_user_id, ipvmid, 8);
1778        memcpy(niucv->src_name, iucv->src_name, 8);
1779        memcpy(niucv->src_user_id, iucv->src_user_id, 8);
1780        niucv->path = path;
1781
1782        /* Call iucv_accept */
1783        high_nmcpy(nuser_data, ipuser + 8);
1784        memcpy(nuser_data + 8, niucv->src_name, 8);
1785        ASCEBC(nuser_data + 8, 8);
1786
1787        /* set message limit for path based on msglimit of accepting socket */
1788        niucv->msglimit = iucv->msglimit;
1789        path->msglim = iucv->msglimit;
1790        err = pr_iucv->path_accept(path, &af_iucv_handler, nuser_data, nsk);
1791        if (err) {
1792                iucv_sever_path(nsk, 1);
1793                iucv_sock_kill(nsk);
1794                goto fail;
1795        }
1796
1797        iucv_accept_enqueue(sk, nsk);
1798
1799        /* Wake up accept */
1800        nsk->sk_state = IUCV_CONNECTED;
1801        sk->sk_data_ready(sk);
1802        err = 0;
1803fail:
1804        bh_unlock_sock(sk);
1805        return 0;
1806}
1807
1808static void iucv_callback_connack(struct iucv_path *path, u8 ipuser[16])
1809{
1810        struct sock *sk = path->private;
1811
1812        sk->sk_state = IUCV_CONNECTED;
1813        sk->sk_state_change(sk);
1814}
1815
1816static void iucv_callback_rx(struct iucv_path *path, struct iucv_message *msg)
1817{
1818        struct sock *sk = path->private;
1819        struct iucv_sock *iucv = iucv_sk(sk);
1820        struct sk_buff *skb;
1821        struct sock_msg_q *save_msg;
1822        int len;
1823
1824        if (sk->sk_shutdown & RCV_SHUTDOWN) {
1825                pr_iucv->message_reject(path, msg);
1826                return;
1827        }
1828
1829        spin_lock(&iucv->message_q.lock);
1830
1831        if (!list_empty(&iucv->message_q.list) ||
1832            !skb_queue_empty(&iucv->backlog_skb_q))
1833                goto save_message;
1834
1835        len = atomic_read(&sk->sk_rmem_alloc);
1836        len += SKB_TRUESIZE(iucv_msg_length(msg));
1837        if (len > sk->sk_rcvbuf)
1838                goto save_message;
1839
1840        skb = alloc_iucv_recv_skb(iucv_msg_length(msg));
1841        if (!skb)
1842                goto save_message;
1843
1844        iucv_process_message(sk, skb, path, msg);
1845        goto out_unlock;
1846
1847save_message:
1848        save_msg = kzalloc(sizeof(struct sock_msg_q), GFP_ATOMIC | GFP_DMA);
1849        if (!save_msg)
1850                goto out_unlock;
1851        save_msg->path = path;
1852        save_msg->msg = *msg;
1853
1854        list_add_tail(&save_msg->list, &iucv->message_q.list);
1855
1856out_unlock:
1857        spin_unlock(&iucv->message_q.lock);
1858}
1859
1860static void iucv_callback_txdone(struct iucv_path *path,
1861                                 struct iucv_message *msg)
1862{
1863        struct sock *sk = path->private;
1864        struct sk_buff *this = NULL;
1865        struct sk_buff_head *list = &iucv_sk(sk)->send_skb_q;
1866        struct sk_buff *list_skb = list->next;
1867        unsigned long flags;
1868
1869        bh_lock_sock(sk);
1870        if (!skb_queue_empty(list)) {
1871                spin_lock_irqsave(&list->lock, flags);
1872
1873                while (list_skb != (struct sk_buff *)list) {
1874                        if (msg->tag == IUCV_SKB_CB(list_skb)->tag) {
1875                                this = list_skb;
1876                                break;
1877                        }
1878                        list_skb = list_skb->next;
1879                }
1880                if (this)
1881                        __skb_unlink(this, list);
1882
1883                spin_unlock_irqrestore(&list->lock, flags);
1884
1885                if (this) {
1886                        kfree_skb(this);
1887                        /* wake up any process waiting for sending */
1888                        iucv_sock_wake_msglim(sk);
1889                }
1890        }
1891
1892        if (sk->sk_state == IUCV_CLOSING) {
1893                if (skb_queue_empty(&iucv_sk(sk)->send_skb_q)) {
1894                        sk->sk_state = IUCV_CLOSED;
1895                        sk->sk_state_change(sk);
1896                }
1897        }
1898        bh_unlock_sock(sk);
1899
1900}
1901
1902static void iucv_callback_connrej(struct iucv_path *path, u8 ipuser[16])
1903{
1904        struct sock *sk = path->private;
1905
1906        if (sk->sk_state == IUCV_CLOSED)
1907                return;
1908
1909        bh_lock_sock(sk);
1910        iucv_sever_path(sk, 1);
1911        sk->sk_state = IUCV_DISCONN;
1912
1913        sk->sk_state_change(sk);
1914        bh_unlock_sock(sk);
1915}
1916
1917/* called if the other communication side shuts down its RECV direction;
1918 * in turn, the callback sets SEND_SHUTDOWN to disable sending of data.
1919 */
1920static void iucv_callback_shutdown(struct iucv_path *path, u8 ipuser[16])
1921{
1922        struct sock *sk = path->private;
1923
1924        bh_lock_sock(sk);
1925        if (sk->sk_state != IUCV_CLOSED) {
1926                sk->sk_shutdown |= SEND_SHUTDOWN;
1927                sk->sk_state_change(sk);
1928        }
1929        bh_unlock_sock(sk);
1930}
1931
1932/***************** HiperSockets transport callbacks ********************/
1933static void afiucv_swap_src_dest(struct sk_buff *skb)
1934{
1935        struct af_iucv_trans_hdr *trans_hdr =
1936                                (struct af_iucv_trans_hdr *)skb->data;
1937        char tmpID[8];
1938        char tmpName[8];
1939
1940        ASCEBC(trans_hdr->destUserID, sizeof(trans_hdr->destUserID));
1941        ASCEBC(trans_hdr->destAppName, sizeof(trans_hdr->destAppName));
1942        ASCEBC(trans_hdr->srcUserID, sizeof(trans_hdr->srcUserID));
1943        ASCEBC(trans_hdr->srcAppName, sizeof(trans_hdr->srcAppName));
1944        memcpy(tmpID, trans_hdr->srcUserID, 8);
1945        memcpy(tmpName, trans_hdr->srcAppName, 8);
1946        memcpy(trans_hdr->srcUserID, trans_hdr->destUserID, 8);
1947        memcpy(trans_hdr->srcAppName, trans_hdr->destAppName, 8);
1948        memcpy(trans_hdr->destUserID, tmpID, 8);
1949        memcpy(trans_hdr->destAppName, tmpName, 8);
1950        skb_push(skb, ETH_HLEN);
1951        memset(skb->data, 0, ETH_HLEN);
1952}
1953
1954/**
1955 * afiucv_hs_callback_syn - react on received SYN
1956 **/
1957static int afiucv_hs_callback_syn(struct sock *sk, struct sk_buff *skb)
1958{
1959        struct sock *nsk;
1960        struct iucv_sock *iucv, *niucv;
1961        struct af_iucv_trans_hdr *trans_hdr;
1962        int err;
1963
1964        iucv = iucv_sk(sk);
1965        trans_hdr = (struct af_iucv_trans_hdr *)skb->data;
1966        if (!iucv) {
1967                /* no sock - connection refused */
1968                afiucv_swap_src_dest(skb);
1969                trans_hdr->flags = AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_FIN;
1970                err = dev_queue_xmit(skb);
1971                goto out;
1972        }
1973
1974        nsk = iucv_sock_alloc(NULL, sk->sk_type, GFP_ATOMIC, 0);
1975        bh_lock_sock(sk);
1976        if ((sk->sk_state != IUCV_LISTEN) ||
1977            sk_acceptq_is_full(sk) ||
1978            !nsk) {
1979                /* error on server socket - connection refused */
1980                afiucv_swap_src_dest(skb);
1981                trans_hdr->flags = AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_FIN;
1982                err = dev_queue_xmit(skb);
1983                iucv_sock_kill(nsk);
1984                bh_unlock_sock(sk);
1985                goto out;
1986        }
1987
1988        niucv = iucv_sk(nsk);
1989        iucv_sock_init(nsk, sk);
1990        niucv->transport = AF_IUCV_TRANS_HIPER;
1991        niucv->msglimit = iucv->msglimit;
1992        if (!trans_hdr->window)
1993                niucv->msglimit_peer = IUCV_HIPER_MSGLIM_DEFAULT;
1994        else
1995                niucv->msglimit_peer = trans_hdr->window;
1996        memcpy(niucv->dst_name, trans_hdr->srcAppName, 8);
1997        memcpy(niucv->dst_user_id, trans_hdr->srcUserID, 8);
1998        memcpy(niucv->src_name, iucv->src_name, 8);
1999        memcpy(niucv->src_user_id, iucv->src_user_id, 8);
2000        nsk->sk_bound_dev_if = sk->sk_bound_dev_if;
2001        niucv->hs_dev = iucv->hs_dev;
2002        dev_hold(niucv->hs_dev);
2003        afiucv_swap_src_dest(skb);
2004        trans_hdr->flags = AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_ACK;
2005        trans_hdr->window = niucv->msglimit;
2006        /* if receiver acks the xmit connection is established */
2007        err = dev_queue_xmit(skb);
2008        if (!err) {
2009                iucv_accept_enqueue(sk, nsk);
2010                nsk->sk_state = IUCV_CONNECTED;
2011                sk->sk_data_ready(sk);
2012        } else
2013                iucv_sock_kill(nsk);
2014        bh_unlock_sock(sk);
2015
2016out:
2017        return NET_RX_SUCCESS;
2018}
2019
2020/**
2021 * afiucv_hs_callback_synack() - react on received SYN-ACK
2022 **/
2023static int afiucv_hs_callback_synack(struct sock *sk, struct sk_buff *skb)
2024{
2025        struct iucv_sock *iucv = iucv_sk(sk);
2026        struct af_iucv_trans_hdr *trans_hdr =
2027                                        (struct af_iucv_trans_hdr *)skb->data;
2028
2029        if (!iucv)
2030                goto out;
2031        if (sk->sk_state != IUCV_BOUND)
2032                goto out;
2033        bh_lock_sock(sk);
2034        iucv->msglimit_peer = trans_hdr->window;
2035        sk->sk_state = IUCV_CONNECTED;
2036        sk->sk_state_change(sk);
2037        bh_unlock_sock(sk);
2038out:
2039        kfree_skb(skb);
2040        return NET_RX_SUCCESS;
2041}
2042
2043/**
2044 * afiucv_hs_callback_synfin() - react on received SYN_FIN
2045 **/
2046static int afiucv_hs_callback_synfin(struct sock *sk, struct sk_buff *skb)
2047{
2048        struct iucv_sock *iucv = iucv_sk(sk);
2049
2050        if (!iucv)
2051                goto out;
2052        if (sk->sk_state != IUCV_BOUND)
2053                goto out;
2054        bh_lock_sock(sk);
2055        sk->sk_state = IUCV_DISCONN;
2056        sk->sk_state_change(sk);
2057        bh_unlock_sock(sk);
2058out:
2059        kfree_skb(skb);
2060        return NET_RX_SUCCESS;
2061}
2062
2063/**
2064 * afiucv_hs_callback_fin() - react on received FIN
2065 **/
2066static int afiucv_hs_callback_fin(struct sock *sk, struct sk_buff *skb)
2067{
2068        struct iucv_sock *iucv = iucv_sk(sk);
2069
2070        /* other end of connection closed */
2071        if (!iucv)
2072                goto out;
2073        bh_lock_sock(sk);
2074        if (sk->sk_state == IUCV_CONNECTED) {
2075                sk->sk_state = IUCV_DISCONN;
2076                sk->sk_state_change(sk);
2077        }
2078        bh_unlock_sock(sk);
2079out:
2080        kfree_skb(skb);
2081        return NET_RX_SUCCESS;
2082}
2083
2084/**
2085 * afiucv_hs_callback_win() - react on received WIN
2086 **/
2087static int afiucv_hs_callback_win(struct sock *sk, struct sk_buff *skb)
2088{
2089        struct iucv_sock *iucv = iucv_sk(sk);
2090        struct af_iucv_trans_hdr *trans_hdr =
2091                                        (struct af_iucv_trans_hdr *)skb->data;
2092
2093        if (!iucv)
2094                return NET_RX_SUCCESS;
2095
2096        if (sk->sk_state != IUCV_CONNECTED)
2097                return NET_RX_SUCCESS;
2098
2099        atomic_sub(trans_hdr->window, &iucv->msg_sent);
2100        iucv_sock_wake_msglim(sk);
2101        return NET_RX_SUCCESS;
2102}
2103
2104/**
2105 * afiucv_hs_callback_rx() - react on received data
2106 **/
2107static int afiucv_hs_callback_rx(struct sock *sk, struct sk_buff *skb)
2108{
2109        struct iucv_sock *iucv = iucv_sk(sk);
2110
2111        if (!iucv) {
2112                kfree_skb(skb);
2113                return NET_RX_SUCCESS;
2114        }
2115
2116        if (sk->sk_state != IUCV_CONNECTED) {
2117                kfree_skb(skb);
2118                return NET_RX_SUCCESS;
2119        }
2120
2121        if (sk->sk_shutdown & RCV_SHUTDOWN) {
2122                kfree_skb(skb);
2123                return NET_RX_SUCCESS;
2124        }
2125
2126        /* write stuff from iucv_msg to skb cb */
2127        skb_pull(skb, sizeof(struct af_iucv_trans_hdr));
2128        skb_reset_transport_header(skb);
2129        skb_reset_network_header(skb);
2130        IUCV_SKB_CB(skb)->offset = 0;
2131        if (sk_filter(sk, skb)) {
2132                atomic_inc(&sk->sk_drops);      /* skb rejected by filter */
2133                kfree_skb(skb);
2134                return NET_RX_SUCCESS;
2135        }
2136
2137        spin_lock(&iucv->message_q.lock);
2138        if (skb_queue_empty(&iucv->backlog_skb_q)) {
2139                if (__sock_queue_rcv_skb(sk, skb))
2140                        /* handle rcv queue full */
2141                        skb_queue_tail(&iucv->backlog_skb_q, skb);
2142        } else
2143                skb_queue_tail(&iucv_sk(sk)->backlog_skb_q, skb);
2144        spin_unlock(&iucv->message_q.lock);
2145        return NET_RX_SUCCESS;
2146}
2147
2148/**
2149 * afiucv_hs_rcv() - base function for arriving data through HiperSockets
2150 *                   transport
2151 *                   called from netif RX softirq
2152 **/
2153static int afiucv_hs_rcv(struct sk_buff *skb, struct net_device *dev,
2154        struct packet_type *pt, struct net_device *orig_dev)
2155{
2156        struct sock *sk;
2157        struct iucv_sock *iucv;
2158        struct af_iucv_trans_hdr *trans_hdr;
2159        char nullstring[8];
2160        int err = 0;
2161
2162        if (skb->len < (ETH_HLEN + sizeof(struct af_iucv_trans_hdr))) {
2163                WARN_ONCE(1, "AF_IUCV too short skb, len=%d, min=%d",
2164                          (int)skb->len,
2165                          (int)(ETH_HLEN + sizeof(struct af_iucv_trans_hdr)));
2166                kfree_skb(skb);
2167                return NET_RX_SUCCESS;
2168        }
2169        if (skb_headlen(skb) < (ETH_HLEN + sizeof(struct af_iucv_trans_hdr)))
2170                if (skb_linearize(skb)) {
2171                        WARN_ONCE(1, "AF_IUCV skb_linearize failed, len=%d",
2172                                  (int)skb->len);
2173                        kfree_skb(skb);
2174                        return NET_RX_SUCCESS;
2175                }
2176        skb_pull(skb, ETH_HLEN);
2177        trans_hdr = (struct af_iucv_trans_hdr *)skb->data;
2178        EBCASC(trans_hdr->destAppName, sizeof(trans_hdr->destAppName));
2179        EBCASC(trans_hdr->destUserID, sizeof(trans_hdr->destUserID));
2180        EBCASC(trans_hdr->srcAppName, sizeof(trans_hdr->srcAppName));
2181        EBCASC(trans_hdr->srcUserID, sizeof(trans_hdr->srcUserID));
2182        memset(nullstring, 0, sizeof(nullstring));
2183        iucv = NULL;
2184        sk = NULL;
2185        read_lock(&iucv_sk_list.lock);
2186        sk_for_each(sk, &iucv_sk_list.head) {
2187                if (trans_hdr->flags == AF_IUCV_FLAG_SYN) {
2188                        if ((!memcmp(&iucv_sk(sk)->src_name,
2189                                     trans_hdr->destAppName, 8)) &&
2190                            (!memcmp(&iucv_sk(sk)->src_user_id,
2191                                     trans_hdr->destUserID, 8)) &&
2192                            (!memcmp(&iucv_sk(sk)->dst_name, nullstring, 8)) &&
2193                            (!memcmp(&iucv_sk(sk)->dst_user_id,
2194                                     nullstring, 8))) {
2195                                iucv = iucv_sk(sk);
2196                                break;
2197                        }
2198                } else {
2199                        if ((!memcmp(&iucv_sk(sk)->src_name,
2200                                     trans_hdr->destAppName, 8)) &&
2201                            (!memcmp(&iucv_sk(sk)->src_user_id,
2202                                     trans_hdr->destUserID, 8)) &&
2203                            (!memcmp(&iucv_sk(sk)->dst_name,
2204                                     trans_hdr->srcAppName, 8)) &&
2205                            (!memcmp(&iucv_sk(sk)->dst_user_id,
2206                                     trans_hdr->srcUserID, 8))) {
2207                                iucv = iucv_sk(sk);
2208                                break;
2209                        }
2210                }
2211        }
2212        read_unlock(&iucv_sk_list.lock);
2213        if (!iucv)
2214                sk = NULL;
2215
2216        /* no sock
2217        how should we send with no sock
2218        1) send without sock no send rc checking?
2219        2) introduce default sock to handle this cases
2220
2221         SYN -> send SYN|ACK in good case, send SYN|FIN in bad case
2222         data -> send FIN
2223         SYN|ACK, SYN|FIN, FIN -> no action? */
2224
2225        switch (trans_hdr->flags) {
2226        case AF_IUCV_FLAG_SYN:
2227                /* connect request */
2228                err = afiucv_hs_callback_syn(sk, skb);
2229                break;
2230        case (AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_ACK):
2231                /* connect request confirmed */
2232                err = afiucv_hs_callback_synack(sk, skb);
2233                break;
2234        case (AF_IUCV_FLAG_SYN | AF_IUCV_FLAG_FIN):
2235                /* connect request refused */
2236                err = afiucv_hs_callback_synfin(sk, skb);
2237                break;
2238        case (AF_IUCV_FLAG_FIN):
2239                /* close request */
2240                err = afiucv_hs_callback_fin(sk, skb);
2241                break;
2242        case (AF_IUCV_FLAG_WIN):
2243                err = afiucv_hs_callback_win(sk, skb);
2244                if (skb->len == sizeof(struct af_iucv_trans_hdr)) {
2245                        kfree_skb(skb);
2246                        break;
2247                }
2248                /* fall through and receive non-zero length data */
2249        case (AF_IUCV_FLAG_SHT):
2250                /* shutdown request */
2251                /* fall through and receive zero length data */
2252        case 0:
2253                /* plain data frame */
2254                IUCV_SKB_CB(skb)->class = trans_hdr->iucv_hdr.class;
2255                err = afiucv_hs_callback_rx(sk, skb);
2256                break;
2257        default:
2258                ;
2259        }
2260
2261        return err;
2262}
2263
2264/**
2265 * afiucv_hs_callback_txnotify() - handle send notifcations from HiperSockets
2266 *                                 transport
2267 **/
2268static void afiucv_hs_callback_txnotify(struct sk_buff *skb,
2269                                        enum iucv_tx_notify n)
2270{
2271        struct sock *isk = skb->sk;
2272        struct sock *sk = NULL;
2273        struct iucv_sock *iucv = NULL;
2274        struct sk_buff_head *list;
2275        struct sk_buff *list_skb;
2276        struct sk_buff *nskb;
2277        unsigned long flags;
2278
2279        read_lock_irqsave(&iucv_sk_list.lock, flags);
2280        sk_for_each(sk, &iucv_sk_list.head)
2281                if (sk == isk) {
2282                        iucv = iucv_sk(sk);
2283                        break;
2284                }
2285        read_unlock_irqrestore(&iucv_sk_list.lock, flags);
2286
2287        if (!iucv || sock_flag(sk, SOCK_ZAPPED))
2288                return;
2289
2290        list = &iucv->send_skb_q;
2291        spin_lock_irqsave(&list->lock, flags);
2292        if (skb_queue_empty(list))
2293                goto out_unlock;
2294        list_skb = list->next;
2295        nskb = list_skb->next;
2296        while (list_skb != (struct sk_buff *)list) {
2297                if (skb_shinfo(list_skb) == skb_shinfo(skb)) {
2298                        switch (n) {
2299                        case TX_NOTIFY_OK:
2300                                __skb_unlink(list_skb, list);
2301                                kfree_skb(list_skb);
2302                                iucv_sock_wake_msglim(sk);
2303                                break;
2304                        case TX_NOTIFY_PENDING:
2305                                atomic_inc(&iucv->pendings);
2306                                break;
2307                        case TX_NOTIFY_DELAYED_OK:
2308                                __skb_unlink(list_skb, list);
2309                                atomic_dec(&iucv->pendings);
2310                                if (atomic_read(&iucv->pendings) <= 0)
2311                                        iucv_sock_wake_msglim(sk);
2312                                kfree_skb(list_skb);
2313                                break;
2314                        case TX_NOTIFY_UNREACHABLE:
2315                        case TX_NOTIFY_DELAYED_UNREACHABLE:
2316                        case TX_NOTIFY_TPQFULL: /* not yet used */
2317                        case TX_NOTIFY_GENERALERROR:
2318                        case TX_NOTIFY_DELAYED_GENERALERROR:
2319                                __skb_unlink(list_skb, list);
2320                                kfree_skb(list_skb);
2321                                if (sk->sk_state == IUCV_CONNECTED) {
2322                                        sk->sk_state = IUCV_DISCONN;
2323                                        sk->sk_state_change(sk);
2324                                }
2325                                break;
2326                        }
2327                        break;
2328                }
2329                list_skb = nskb;
2330                nskb = nskb->next;
2331        }
2332out_unlock:
2333        spin_unlock_irqrestore(&list->lock, flags);
2334
2335        if (sk->sk_state == IUCV_CLOSING) {
2336                if (skb_queue_empty(&iucv_sk(sk)->send_skb_q)) {
2337                        sk->sk_state = IUCV_CLOSED;
2338                        sk->sk_state_change(sk);
2339                }
2340        }
2341
2342}
2343
2344/*
2345 * afiucv_netdev_event: handle netdev notifier chain events
2346 */
2347static int afiucv_netdev_event(struct notifier_block *this,
2348                               unsigned long event, void *ptr)
2349{
2350        struct net_device *event_dev = netdev_notifier_info_to_dev(ptr);
2351        struct sock *sk;
2352        struct iucv_sock *iucv;
2353
2354        switch (event) {
2355        case NETDEV_REBOOT:
2356        case NETDEV_GOING_DOWN:
2357                sk_for_each(sk, &iucv_sk_list.head) {
2358                        iucv = iucv_sk(sk);
2359                        if ((iucv->hs_dev == event_dev) &&
2360                            (sk->sk_state == IUCV_CONNECTED)) {
2361                                if (event == NETDEV_GOING_DOWN)
2362                                        iucv_send_ctrl(sk, AF_IUCV_FLAG_FIN);
2363                                sk->sk_state = IUCV_DISCONN;
2364                                sk->sk_state_change(sk);
2365                        }
2366                }
2367                break;
2368        case NETDEV_DOWN:
2369        case NETDEV_UNREGISTER:
2370        default:
2371                break;
2372        }
2373        return NOTIFY_DONE;
2374}
2375
2376static struct notifier_block afiucv_netdev_notifier = {
2377        .notifier_call = afiucv_netdev_event,
2378};
2379
2380static const struct proto_ops iucv_sock_ops = {
2381        .family         = PF_IUCV,
2382        .owner          = THIS_MODULE,
2383        .release        = iucv_sock_release,
2384        .bind           = iucv_sock_bind,
2385        .connect        = iucv_sock_connect,
2386        .listen         = iucv_sock_listen,
2387        .accept         = iucv_sock_accept,
2388        .getname        = iucv_sock_getname,
2389        .sendmsg        = iucv_sock_sendmsg,
2390        .recvmsg        = iucv_sock_recvmsg,
2391        .poll           = iucv_sock_poll,
2392        .ioctl          = sock_no_ioctl,
2393        .mmap           = sock_no_mmap,
2394        .socketpair     = sock_no_socketpair,
2395        .shutdown       = iucv_sock_shutdown,
2396        .setsockopt     = iucv_sock_setsockopt,
2397        .getsockopt     = iucv_sock_getsockopt,
2398};
2399
2400static const struct net_proto_family iucv_sock_family_ops = {
2401        .family = AF_IUCV,
2402        .owner  = THIS_MODULE,
2403        .create = iucv_sock_create,
2404};
2405
2406static struct packet_type iucv_packet_type = {
2407        .type = cpu_to_be16(ETH_P_AF_IUCV),
2408        .func = afiucv_hs_rcv,
2409};
2410
2411static int afiucv_iucv_init(void)
2412{
2413        int err;
2414
2415        err = pr_iucv->iucv_register(&af_iucv_handler, 0);
2416        if (err)
2417                goto out;
2418        /* establish dummy device */
2419        af_iucv_driver.bus = pr_iucv->bus;
2420        err = driver_register(&af_iucv_driver);
2421        if (err)
2422                goto out_iucv;
2423        af_iucv_dev = kzalloc(sizeof(struct device), GFP_KERNEL);
2424        if (!af_iucv_dev) {
2425                err = -ENOMEM;
2426                goto out_driver;
2427        }
2428        dev_set_name(af_iucv_dev, "af_iucv");
2429        af_iucv_dev->bus = pr_iucv->bus;
2430        af_iucv_dev->parent = pr_iucv->root;
2431        af_iucv_dev->release = (void (*)(struct device *))kfree;
2432        af_iucv_dev->driver = &af_iucv_driver;
2433        err = device_register(af_iucv_dev);
2434        if (err)
2435                goto out_iucv_dev;
2436        return 0;
2437
2438out_iucv_dev:
2439        put_device(af_iucv_dev);
2440out_driver:
2441        driver_unregister(&af_iucv_driver);
2442out_iucv:
2443        pr_iucv->iucv_unregister(&af_iucv_handler, 0);
2444out:
2445        return err;
2446}
2447
2448static int __init afiucv_init(void)
2449{
2450        int err;
2451
2452        if (MACHINE_IS_VM) {
2453                cpcmd("QUERY USERID", iucv_userid, sizeof(iucv_userid), &err);
2454                if (unlikely(err)) {
2455                        WARN_ON(err);
2456                        err = -EPROTONOSUPPORT;
2457                        goto out;
2458                }
2459
2460                pr_iucv = try_then_request_module(symbol_get(iucv_if), "iucv");
2461                if (!pr_iucv) {
2462                        printk(KERN_WARNING "iucv_if lookup failed\n");
2463                        memset(&iucv_userid, 0, sizeof(iucv_userid));
2464                }
2465        } else {
2466                memset(&iucv_userid, 0, sizeof(iucv_userid));
2467                pr_iucv = NULL;
2468        }
2469
2470        err = proto_register(&iucv_proto, 0);
2471        if (err)
2472                goto out;
2473        err = sock_register(&iucv_sock_family_ops);
2474        if (err)
2475                goto out_proto;
2476
2477        if (pr_iucv) {
2478                err = afiucv_iucv_init();
2479                if (err)
2480                        goto out_sock;
2481        } else
2482                register_netdevice_notifier(&afiucv_netdev_notifier);
2483        dev_add_pack(&iucv_packet_type);
2484        return 0;
2485
2486out_sock:
2487        sock_unregister(PF_IUCV);
2488out_proto:
2489        proto_unregister(&iucv_proto);
2490out:
2491        if (pr_iucv)
2492                symbol_put(iucv_if);
2493        return err;
2494}
2495
2496static void __exit afiucv_exit(void)
2497{
2498        if (pr_iucv) {
2499                device_unregister(af_iucv_dev);
2500                driver_unregister(&af_iucv_driver);
2501                pr_iucv->iucv_unregister(&af_iucv_handler, 0);
2502                symbol_put(iucv_if);
2503        } else
2504                unregister_netdevice_notifier(&afiucv_netdev_notifier);
2505        dev_remove_pack(&iucv_packet_type);
2506        sock_unregister(PF_IUCV);
2507        proto_unregister(&iucv_proto);
2508}
2509
2510module_init(afiucv_init);
2511module_exit(afiucv_exit);
2512
2513MODULE_AUTHOR("Jennifer Hunt <jenhunt@us.ibm.com>");
2514MODULE_DESCRIPTION("IUCV Sockets ver " VERSION);
2515MODULE_VERSION(VERSION);
2516MODULE_LICENSE("GPL");
2517MODULE_ALIAS_NETPROTO(PF_IUCV);
2518
2519