/*-
 * SPDX-License-Identifier: BSD-2-Clause OR GPL-2.0
 *
 * Copyright (c) 2005 Topspin Communications.  All rights reserved.
 * Copyright (c) 2005 Intel Corporation.  All rights reserved.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the
 * OpenIB.org BSD license below:
 *
 *     Redistribution and use in source and binary forms, with or
 *     without modification, are permitted provided that the following
 *     conditions are met:
 *
 *      - Redistributions of source code must retain the above
 *      copyright notice, this list of conditions and the following
 *      disclaimer.
 *
 *      - Redistributions in binary form must reproduce the above
 *      copyright notice, this list of conditions and the following
 *      disclaimer in the documentation and/or other materials
 *      provided with the distribution.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 */

#include <sys/cdefs.h>
#include <linux/completion.h>
#include <linux/fs.h>
#include <linux/module.h>
#include <linux/device.h>
#include <linux/err.h>
#include <linux/poll.h>
#include <linux/sched.h>
#include <linux/file.h>
#include <linux/cdev.h>
#include <linux/idr.h>
#include <linux/mutex.h>
#include <linux/slab.h>

#include <asm/uaccess.h>

#include <rdma/ib.h>
#include <rdma/ib_cm.h>
#include <rdma/ib_user_cm.h>
#include <rdma/ib_marshall.h>

MODULE_AUTHOR("Libor Michalek");
MODULE_DESCRIPTION("InfiniBand userspace Connection Manager access");
MODULE_LICENSE("Dual BSD/GPL");

struct ib_ucm_device {
        int                     devnum;
        struct cdev             cdev;
        struct device           dev;
        struct ib_device        *ib_dev;
};

struct ib_ucm_file {
        struct mutex file_mutex;
        struct file *filp;
        struct ib_ucm_device *device;

        struct list_head  ctxs;
        struct list_head  events;
        wait_queue_head_t poll_wait;
};

struct ib_ucm_context {
        int                 id;
        struct completion   comp;
        atomic_t            ref;
        int                 events_reported;

        struct ib_ucm_file *file;
        struct ib_cm_id    *cm_id;
        __u64              uid;

        struct list_head    events;    /* list of pending events. */
        struct list_head    file_list; /* member in file ctx list */
};

struct ib_ucm_event {
        struct ib_ucm_context *ctx;
        struct list_head file_list; /* member in file event list */
        struct list_head ctx_list;  /* member in ctx event list */

        struct ib_cm_id *cm_id;
        struct ib_ucm_event_resp resp;
        void *data;
        void *info;
        int data_len;
        int info_len;
};

enum {
        IB_UCM_MAJOR = 231,
        IB_UCM_BASE_MINOR = 224,
        IB_UCM_MAX_DEVICES = 32
};

#define IB_UCM_BASE_DEV MKDEV(IB_UCM_MAJOR, IB_UCM_BASE_MINOR)

static void ib_ucm_add_one(struct ib_device *device);
static void ib_ucm_remove_one(struct ib_device *device, void *client_data);

static struct ib_client ucm_client = {
        .name   = "ucm",
        .add    = ib_ucm_add_one,
        .remove = ib_ucm_remove_one
};

static DEFINE_MUTEX(ctx_id_mutex);
static DEFINE_IDR(ctx_id_table);
static DECLARE_BITMAP(dev_map, IB_UCM_MAX_DEVICES);

static struct ib_ucm_context *ib_ucm_ctx_get(struct ib_ucm_file *file, int id)
{
        struct ib_ucm_context *ctx;

        mutex_lock(&ctx_id_mutex);
        ctx = idr_find(&ctx_id_table, id);
        if (!ctx)
                ctx = ERR_PTR(-ENOENT);
        else if (ctx->file != file)
                ctx = ERR_PTR(-EINVAL);
        else
                atomic_inc(&ctx->ref);
        mutex_unlock(&ctx_id_mutex);

        return ctx;
}

static void ib_ucm_ctx_put(struct ib_ucm_context *ctx)
{
        if (atomic_dec_and_test(&ctx->ref))
                complete(&ctx->comp);
}

static inline int ib_ucm_new_cm_id(int event)
{
        return event == IB_CM_REQ_RECEIVED || event == IB_CM_SIDR_REQ_RECEIVED;
}

static void ib_ucm_cleanup_events(struct ib_ucm_context *ctx)
{
        struct ib_ucm_event *uevent;

        mutex_lock(&ctx->file->file_mutex);
        list_del(&ctx->file_list);
        while (!list_empty(&ctx->events)) {

                uevent = list_entry(ctx->events.next,
                                    struct ib_ucm_event, ctx_list);
                list_del(&uevent->file_list);
                list_del(&uevent->ctx_list);
                mutex_unlock(&ctx->file->file_mutex);

                /* clear incoming connections. */
                if (ib_ucm_new_cm_id(uevent->resp.event))
                        ib_destroy_cm_id(uevent->cm_id);

                kfree(uevent);
                mutex_lock(&ctx->file->file_mutex);
        }
        mutex_unlock(&ctx->file->file_mutex);
}

static struct ib_ucm_context *ib_ucm_ctx_alloc(struct ib_ucm_file *file)
{
        struct ib_ucm_context *ctx;

        ctx = kzalloc(sizeof *ctx, GFP_KERNEL);
        if (!ctx)
                return NULL;

        atomic_set(&ctx->ref, 1);
        init_completion(&ctx->comp);
        ctx->file = file;
        INIT_LIST_HEAD(&ctx->events);

        mutex_lock(&ctx_id_mutex);
        ctx->id = idr_alloc(&ctx_id_table, ctx, 0, 0, GFP_KERNEL);
        mutex_unlock(&ctx_id_mutex);
        if (ctx->id < 0)
                goto error;

        list_add_tail(&ctx->file_list, &file->ctxs);
        return ctx;

error:
        kfree(ctx);
        return NULL;
}

static void ib_ucm_event_req_get(struct ib_ucm_req_event_resp *ureq,
                                 struct ib_cm_req_event_param *kreq)
{
        ureq->remote_ca_guid             = kreq->remote_ca_guid;
        ureq->remote_qkey                = kreq->remote_qkey;
        ureq->remote_qpn                 = kreq->remote_qpn;
        ureq->qp_type                    = kreq->qp_type;
        ureq->starting_psn               = kreq->starting_psn;
        ureq->responder_resources        = kreq->responder_resources;
        ureq->initiator_depth            = kreq->initiator_depth;
        ureq->local_cm_response_timeout  = kreq->local_cm_response_timeout;
        ureq->flow_control               = kreq->flow_control;
        ureq->remote_cm_response_timeout = kreq->remote_cm_response_timeout;
        ureq->retry_count                = kreq->retry_count;
        ureq->rnr_retry_count            = kreq->rnr_retry_count;
        ureq->srq                        = kreq->srq;
        ureq->port                       = kreq->port;

        ib_copy_path_rec_to_user(&ureq->primary_path, kreq->primary_path);
        if (kreq->alternate_path)
                ib_copy_path_rec_to_user(&ureq->alternate_path,
                                         kreq->alternate_path);
}

static void ib_ucm_event_rep_get(struct ib_ucm_rep_event_resp *urep,
                                 struct ib_cm_rep_event_param *krep)
{
        urep->remote_ca_guid      = krep->remote_ca_guid;
        urep->remote_qkey         = krep->remote_qkey;
        urep->remote_qpn          = krep->remote_qpn;
        urep->starting_psn        = krep->starting_psn;
        urep->responder_resources = krep->responder_resources;
        urep->initiator_depth     = krep->initiator_depth;
        urep->target_ack_delay    = krep->target_ack_delay;
        urep->failover_accepted   = krep->failover_accepted;
        urep->flow_control        = krep->flow_control;
        urep->rnr_retry_count     = krep->rnr_retry_count;
        urep->srq                 = krep->srq;
}

static void ib_ucm_event_sidr_rep_get(struct ib_ucm_sidr_rep_event_resp *urep,
                                      struct ib_cm_sidr_rep_event_param *krep)
{
        urep->status = krep->status;
        urep->qkey   = krep->qkey;
        urep->qpn    = krep->qpn;
};

static int ib_ucm_event_process(struct ib_cm_event *evt,
                                struct ib_ucm_event *uvt)
{
        void *info = NULL;

        switch (evt->event) {
        case IB_CM_REQ_RECEIVED:
                ib_ucm_event_req_get(&uvt->resp.u.req_resp,
                                     &evt->param.req_rcvd);
                uvt->data_len      = IB_CM_REQ_PRIVATE_DATA_SIZE;
                uvt->resp.present  = IB_UCM_PRES_PRIMARY;
                uvt->resp.present |= (evt->param.req_rcvd.alternate_path ?
                                      IB_UCM_PRES_ALTERNATE : 0);
                break;
        case IB_CM_REP_RECEIVED:
                ib_ucm_event_rep_get(&uvt->resp.u.rep_resp,
                                     &evt->param.rep_rcvd);
                uvt->data_len = IB_CM_REP_PRIVATE_DATA_SIZE;
                break;
        case IB_CM_RTU_RECEIVED:
                uvt->data_len = IB_CM_RTU_PRIVATE_DATA_SIZE;
                uvt->resp.u.send_status = evt->param.send_status;
                break;
        case IB_CM_DREQ_RECEIVED:
                uvt->data_len = IB_CM_DREQ_PRIVATE_DATA_SIZE;
                uvt->resp.u.send_status = evt->param.send_status;
                break;
        case IB_CM_DREP_RECEIVED:
                uvt->data_len = IB_CM_DREP_PRIVATE_DATA_SIZE;
                uvt->resp.u.send_status = evt->param.send_status;
                break;
        case IB_CM_MRA_RECEIVED:
                uvt->resp.u.mra_resp.timeout =
                                        evt->param.mra_rcvd.service_timeout;
                uvt->data_len = IB_CM_MRA_PRIVATE_DATA_SIZE;
                break;
        case IB_CM_REJ_RECEIVED:
                uvt->resp.u.rej_resp.reason = evt->param.rej_rcvd.reason;
                uvt->data_len = IB_CM_REJ_PRIVATE_DATA_SIZE;
                uvt->info_len = evt->param.rej_rcvd.ari_length;
                info          = evt->param.rej_rcvd.ari;
                break;
        case IB_CM_LAP_RECEIVED:
                ib_copy_path_rec_to_user(&uvt->resp.u.lap_resp.path,
                                         evt->param.lap_rcvd.alternate_path);
                uvt->data_len = IB_CM_LAP_PRIVATE_DATA_SIZE;
                uvt->resp.present = IB_UCM_PRES_ALTERNATE;
                break;
        case IB_CM_APR_RECEIVED:
                uvt->resp.u.apr_resp.status = evt->param.apr_rcvd.ap_status;
                uvt->data_len = IB_CM_APR_PRIVATE_DATA_SIZE;
                uvt->info_len = evt->param.apr_rcvd.info_len;
                info          = evt->param.apr_rcvd.apr_info;
                break;
        case IB_CM_SIDR_REQ_RECEIVED:
                uvt->resp.u.sidr_req_resp.pkey =
                                        evt->param.sidr_req_rcvd.pkey;
                uvt->resp.u.sidr_req_resp.port =
                                        evt->param.sidr_req_rcvd.port;
                uvt->data_len = IB_CM_SIDR_REQ_PRIVATE_DATA_SIZE;
                break;
        case IB_CM_SIDR_REP_RECEIVED:
                ib_ucm_event_sidr_rep_get(&uvt->resp.u.sidr_rep_resp,
                                          &evt->param.sidr_rep_rcvd);
                uvt->data_len = IB_CM_SIDR_REP_PRIVATE_DATA_SIZE;
                uvt->info_len = evt->param.sidr_rep_rcvd.info_len;
                info          = evt->param.sidr_rep_rcvd.info;
                break;
        default:
                uvt->resp.u.send_status = evt->param.send_status;
                break;
        }

        if (uvt->data_len) {
                uvt->data = kmemdup(evt->private_data, uvt->data_len, GFP_KERNEL);
                if (!uvt->data)
                        goto err1;

                uvt->resp.present |= IB_UCM_PRES_DATA;
        }

        if (uvt->info_len) {
                uvt->info = kmemdup(info, uvt->info_len, GFP_KERNEL);
                if (!uvt->info)
                        goto err2;

                uvt->resp.present |= IB_UCM_PRES_INFO;
        }
        return 0;

err2:
        kfree(uvt->data);
err1:
        return -ENOMEM;
}

static int ib_ucm_event_handler(struct ib_cm_id *cm_id,
                                struct ib_cm_event *event)
{
        struct ib_ucm_event *uevent;
        struct ib_ucm_context *ctx;
        int result = 0;

        ctx = cm_id->context;

        uevent = kzalloc(sizeof *uevent, GFP_KERNEL);
        if (!uevent)
                goto err1;

        uevent->ctx = ctx;
        uevent->cm_id = cm_id;
        uevent->resp.uid = ctx->uid;
        uevent->resp.id = ctx->id;
        uevent->resp.event = event->event;

        result = ib_ucm_event_process(event, uevent);
        if (result)
                goto err2;

        mutex_lock(&ctx->file->file_mutex);
        list_add_tail(&uevent->file_list, &ctx->file->events);
        list_add_tail(&uevent->ctx_list, &ctx->events);
        wake_up_interruptible(&ctx->file->poll_wait);
        mutex_unlock(&ctx->file->file_mutex);
        return 0;

err2:
        kfree(uevent);
err1:
        /* Destroy new cm_id's */
        return ib_ucm_new_cm_id(event->event);
}

static ssize_t ib_ucm_event(struct ib_ucm_file *file,
                            const char __user *inbuf,
                            int in_len, int out_len)
{
        struct ib_ucm_context *ctx;
        struct ib_ucm_event_get cmd;
        struct ib_ucm_event *uevent;
        int result = 0;

        if (out_len < sizeof(struct ib_ucm_event_resp))
                return -ENOSPC;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        mutex_lock(&file->file_mutex);
        while (list_empty(&file->events)) {
                mutex_unlock(&file->file_mutex);

                if (file->filp->f_flags & O_NONBLOCK)
                        return -EAGAIN;

                if (wait_event_interruptible(file->poll_wait,
                                             !list_empty(&file->events)))
                        return -ERESTARTSYS;

                mutex_lock(&file->file_mutex);
        }

        uevent = list_entry(file->events.next, struct ib_ucm_event, file_list);

        if (ib_ucm_new_cm_id(uevent->resp.event)) {
                ctx = ib_ucm_ctx_alloc(file);
                if (!ctx) {
                        result = -ENOMEM;
                        goto done;
                }

                ctx->cm_id = uevent->cm_id;
                ctx->cm_id->context = ctx;
                uevent->resp.id = ctx->id;
        }

        if (copy_to_user((void __user *)(unsigned long)cmd.response,
                         &uevent->resp, sizeof(uevent->resp))) {
                result = -EFAULT;
                goto done;
        }

        if (uevent->data) {
                if (cmd.data_len < uevent->data_len) {
                        result = -ENOMEM;
                        goto done;
                }
                if (copy_to_user((void __user *)(unsigned long)cmd.data,
                                 uevent->data, uevent->data_len)) {
                        result = -EFAULT;
                        goto done;
                }
        }

        if (uevent->info) {
                if (cmd.info_len < uevent->info_len) {
                        result = -ENOMEM;
                        goto done;
                }
                if (copy_to_user((void __user *)(unsigned long)cmd.info,
                                 uevent->info, uevent->info_len)) {
                        result = -EFAULT;
                        goto done;
                }
        }

        list_del(&uevent->file_list);
        list_del(&uevent->ctx_list);
        uevent->ctx->events_reported++;

        kfree(uevent->data);
        kfree(uevent->info);
        kfree(uevent);
done:
        mutex_unlock(&file->file_mutex);
        return result;
}

static ssize_t ib_ucm_create_id(struct ib_ucm_file *file,
                                const char __user *inbuf,
                                int in_len, int out_len)
{
        struct ib_ucm_create_id cmd;
        struct ib_ucm_create_id_resp resp;
        struct ib_ucm_context *ctx;
        int result;

        if (out_len < sizeof(resp))
                return -ENOSPC;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        mutex_lock(&file->file_mutex);
        ctx = ib_ucm_ctx_alloc(file);
        mutex_unlock(&file->file_mutex);
        if (!ctx)
                return -ENOMEM;

        ctx->uid = cmd.uid;
        ctx->cm_id = ib_create_cm_id(file->device->ib_dev,
                                     ib_ucm_event_handler, ctx);
        if (IS_ERR(ctx->cm_id)) {
                result = PTR_ERR(ctx->cm_id);
                goto err1;
        }

        resp.id = ctx->id;
        if (copy_to_user((void __user *)(unsigned long)cmd.response,
                         &resp, sizeof(resp))) {
                result = -EFAULT;
                goto err2;
        }
        return 0;

err2:
        ib_destroy_cm_id(ctx->cm_id);
err1:
        mutex_lock(&ctx_id_mutex);
        idr_remove(&ctx_id_table, ctx->id);
        mutex_unlock(&ctx_id_mutex);
        kfree(ctx);
        return result;
}

static ssize_t ib_ucm_destroy_id(struct ib_ucm_file *file,
                                 const char __user *inbuf,
                                 int in_len, int out_len)
{
        struct ib_ucm_destroy_id cmd;
        struct ib_ucm_destroy_id_resp resp;
        struct ib_ucm_context *ctx;
        int result = 0;

        if (out_len < sizeof(resp))
                return -ENOSPC;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        mutex_lock(&ctx_id_mutex);
        ctx = idr_find(&ctx_id_table, cmd.id);
        if (!ctx)
                ctx = ERR_PTR(-ENOENT);
        else if (ctx->file != file)
                ctx = ERR_PTR(-EINVAL);
        else
                idr_remove(&ctx_id_table, ctx->id);
        mutex_unlock(&ctx_id_mutex);

        if (IS_ERR(ctx))
                return PTR_ERR(ctx);

        ib_ucm_ctx_put(ctx);
        wait_for_completion(&ctx->comp);

        /* No new events will be generated after destroying the cm_id. */
        ib_destroy_cm_id(ctx->cm_id);
        /* Cleanup events not yet reported to the user. */
        ib_ucm_cleanup_events(ctx);

        resp.events_reported = ctx->events_reported;
        if (copy_to_user((void __user *)(unsigned long)cmd.response,
                         &resp, sizeof(resp)))
                result = -EFAULT;

        kfree(ctx);
        return result;
}

static ssize_t ib_ucm_attr_id(struct ib_ucm_file *file,
                              const char __user *inbuf,
                              int in_len, int out_len)
{
        struct ib_ucm_attr_id_resp resp;
        struct ib_ucm_attr_id cmd;
        struct ib_ucm_context *ctx;
        int result = 0;

        if (out_len < sizeof(resp))
                return -ENOSPC;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (IS_ERR(ctx))
                return PTR_ERR(ctx);

        resp.service_id   = ctx->cm_id->service_id;
        resp.service_mask = ctx->cm_id->service_mask;
        resp.local_id     = ctx->cm_id->local_id;
        resp.remote_id    = ctx->cm_id->remote_id;

        if (copy_to_user((void __user *)(unsigned long)cmd.response,
                         &resp, sizeof(resp)))
                result = -EFAULT;

        ib_ucm_ctx_put(ctx);
        return result;
}

static ssize_t ib_ucm_init_qp_attr(struct ib_ucm_file *file,
                                   const char __user *inbuf,
                                   int in_len, int out_len)
{
        struct ib_uverbs_qp_attr resp;
        struct ib_ucm_init_qp_attr cmd;
        struct ib_ucm_context *ctx;
        struct ib_qp_attr qp_attr;
        int result = 0;

        if (out_len < sizeof(resp))
                return -ENOSPC;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (IS_ERR(ctx))
                return PTR_ERR(ctx);

        resp.qp_attr_mask = 0;
        memset(&qp_attr, 0, sizeof qp_attr);
        qp_attr.qp_state = cmd.qp_state;
        result = ib_cm_init_qp_attr(ctx->cm_id, &qp_attr, &resp.qp_attr_mask);
        if (result)
                goto out;

        ib_copy_qp_attr_to_user(&resp, &qp_attr);

        if (copy_to_user((void __user *)(unsigned long)cmd.response,
                         &resp, sizeof(resp)))
                result = -EFAULT;

out:
        ib_ucm_ctx_put(ctx);
        return result;
}

static int ucm_validate_listen(__be64 service_id, __be64 service_mask)
{
        service_id &= service_mask;

        if (((service_id & IB_CMA_SERVICE_ID_MASK) == IB_CMA_SERVICE_ID) ||
            ((service_id & IB_SDP_SERVICE_ID_MASK) == IB_SDP_SERVICE_ID))
                return -EINVAL;

        return 0;
}

static ssize_t ib_ucm_listen(struct ib_ucm_file *file,
                             const char __user *inbuf,
                             int in_len, int out_len)
{
        struct ib_ucm_listen cmd;
        struct ib_ucm_context *ctx;
        int result;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (IS_ERR(ctx))
                return PTR_ERR(ctx);

        result = ucm_validate_listen(cmd.service_id, cmd.service_mask);
        if (result)
                goto out;

        result = ib_cm_listen(ctx->cm_id, cmd.service_id, cmd.service_mask);
out:
        ib_ucm_ctx_put(ctx);
        return result;
}

static ssize_t ib_ucm_notify(struct ib_ucm_file *file,
                             const char __user *inbuf,
                             int in_len, int out_len)
{
        struct ib_ucm_notify cmd;
        struct ib_ucm_context *ctx;
        int result;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (IS_ERR(ctx))
                return PTR_ERR(ctx);

        result = ib_cm_notify(ctx->cm_id, (enum ib_event_type) cmd.event);
        ib_ucm_ctx_put(ctx);
        return result;
}

static int ib_ucm_alloc_data(const void **dest, u64 src, u32 len)
{
        void *data;

        *dest = NULL;

        if (!len)
                return 0;

        data = memdup_user((void __user *)(unsigned long)src, len);
        if (IS_ERR(data))
                return PTR_ERR(data);

        *dest = data;
        return 0;
}

static int ib_ucm_path_get(struct ib_sa_path_rec **path, u64 src)
{
        struct ib_user_path_rec upath;
        struct ib_sa_path_rec  *sa_path;

        *path = NULL;

        if (!src)
                return 0;

        sa_path = kmalloc(sizeof(*sa_path), GFP_KERNEL);
        if (!sa_path)
                return -ENOMEM;

        if (copy_from_user(&upath, (void __user *)(unsigned long)src,
                           sizeof(upath))) {

                kfree(sa_path);
                return -EFAULT;
        }

        ib_copy_path_rec_from_user(sa_path, &upath);
        *path = sa_path;
        return 0;
}

static ssize_t ib_ucm_send_req(struct ib_ucm_file *file,
                               const char __user *inbuf,
                               int in_len, int out_len)
{
        struct ib_cm_req_param param;
        struct ib_ucm_context *ctx;
        struct ib_ucm_req cmd;
        int result;

        param.private_data   = NULL;
        param.primary_path   = NULL;
        param.alternate_path = NULL;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        result = ib_ucm_alloc_data(&param.private_data, cmd.data, cmd.len);
        if (result)
                goto done;

        result = ib_ucm_path_get(&param.primary_path, cmd.primary_path);
        if (result)
                goto done;

        result = ib_ucm_path_get(&param.alternate_path, cmd.alternate_path);
        if (result)
                goto done;

        param.private_data_len           = cmd.len;
        param.service_id                 = cmd.sid;
        param.qp_num                     = cmd.qpn;
        param.qp_type                    = cmd.qp_type;
        param.starting_psn               = cmd.psn;
        param.peer_to_peer               = cmd.peer_to_peer;
        param.responder_resources        = cmd.responder_resources;
        param.initiator_depth            = cmd.initiator_depth;
        param.remote_cm_response_timeout = cmd.remote_cm_response_timeout;
        param.flow_control               = cmd.flow_control;
        param.local_cm_response_timeout  = cmd.local_cm_response_timeout;
        param.retry_count                = cmd.retry_count;
        param.rnr_retry_count            = cmd.rnr_retry_count;
        param.max_cm_retries             = cmd.max_cm_retries;
        param.srq                        = cmd.srq;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (!IS_ERR(ctx)) {
                result = ib_send_cm_req(ctx->cm_id, &param);
                ib_ucm_ctx_put(ctx);
        } else
                result = PTR_ERR(ctx);

done:
        kfree(param.private_data);
        kfree(param.primary_path);
        kfree(param.alternate_path);
        return result;
}

static ssize_t ib_ucm_send_rep(struct ib_ucm_file *file,
                               const char __user *inbuf,
                               int in_len, int out_len)
{
        struct ib_cm_rep_param param;
        struct ib_ucm_context *ctx;
        struct ib_ucm_rep cmd;
        int result;

        param.private_data = NULL;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        result = ib_ucm_alloc_data(&param.private_data, cmd.data, cmd.len);
        if (result)
                return result;

        param.qp_num              = cmd.qpn;
        param.starting_psn        = cmd.psn;
        param.private_data_len    = cmd.len;
        param.responder_resources = cmd.responder_resources;
        param.initiator_depth     = cmd.initiator_depth;
        param.failover_accepted   = cmd.failover_accepted;
        param.flow_control        = cmd.flow_control;
        param.rnr_retry_count     = cmd.rnr_retry_count;
        param.srq                 = cmd.srq;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (!IS_ERR(ctx)) {
                ctx->uid = cmd.uid;
                result = ib_send_cm_rep(ctx->cm_id, &param);
                ib_ucm_ctx_put(ctx);
        } else
                result = PTR_ERR(ctx);

        kfree(param.private_data);
        return result;
}

static ssize_t ib_ucm_send_private_data(struct ib_ucm_file *file,
                                        const char __user *inbuf, int in_len,
                                        int (*func)(struct ib_cm_id *cm_id,
                                                    const void *private_data,
                                                    u8 private_data_len))
{
        struct ib_ucm_private_data cmd;
        struct ib_ucm_context *ctx;
        const void *private_data = NULL;
        int result;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        result = ib_ucm_alloc_data(&private_data, cmd.data, cmd.len);
        if (result)
                return result;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (!IS_ERR(ctx)) {
                result = func(ctx->cm_id, private_data, cmd.len);
                ib_ucm_ctx_put(ctx);
        } else
                result = PTR_ERR(ctx);

        kfree(private_data);
        return result;
}

static ssize_t ib_ucm_send_rtu(struct ib_ucm_file *file,
                               const char __user *inbuf,
                               int in_len, int out_len)
{
        return ib_ucm_send_private_data(file, inbuf, in_len, ib_send_cm_rtu);
}

static ssize_t ib_ucm_send_dreq(struct ib_ucm_file *file,
                                const char __user *inbuf,
                                int in_len, int out_len)
{
        return ib_ucm_send_private_data(file, inbuf, in_len, ib_send_cm_dreq);
}

static ssize_t ib_ucm_send_drep(struct ib_ucm_file *file,
                                const char __user *inbuf,
                                int in_len, int out_len)
{
        return ib_ucm_send_private_data(file, inbuf, in_len, ib_send_cm_drep);
}

static ssize_t ib_ucm_send_info(struct ib_ucm_file *file,
                                const char __user *inbuf, int in_len,
                                int (*func)(struct ib_cm_id *cm_id,
                                            int status,
                                            const void *info,
                                            u8 info_len,
                                            const void *data,
                                            u8 data_len))
{
        struct ib_ucm_context *ctx;
        struct ib_ucm_info cmd;
        const void *data = NULL;
        const void *info = NULL;
        int result;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        result = ib_ucm_alloc_data(&data, cmd.data, cmd.data_len);
        if (result)
                goto done;

        result = ib_ucm_alloc_data(&info, cmd.info, cmd.info_len);
        if (result)
                goto done;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (!IS_ERR(ctx)) {
                result = func(ctx->cm_id, cmd.status, info, cmd.info_len,
                              data, cmd.data_len);
                ib_ucm_ctx_put(ctx);
        } else
                result = PTR_ERR(ctx);

done:
        kfree(data);
        kfree(info);
        return result;
}

static ssize_t ib_ucm_send_rej(struct ib_ucm_file *file,
                               const char __user *inbuf,
                               int in_len, int out_len)
{
        return ib_ucm_send_info(file, inbuf, in_len, (void *)ib_send_cm_rej);
}

static ssize_t ib_ucm_send_apr(struct ib_ucm_file *file,
                               const char __user *inbuf,
                               int in_len, int out_len)
{
        return ib_ucm_send_info(file, inbuf, in_len, (void *)ib_send_cm_apr);
}

static ssize_t ib_ucm_send_mra(struct ib_ucm_file *file,
                               const char __user *inbuf,
                               int in_len, int out_len)
{
        struct ib_ucm_context *ctx;
        struct ib_ucm_mra cmd;
        const void *data = NULL;
        int result;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        result = ib_ucm_alloc_data(&data, cmd.data, cmd.len);
        if (result)
                return result;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (!IS_ERR(ctx)) {
                result = ib_send_cm_mra(ctx->cm_id, cmd.timeout, data, cmd.len);
                ib_ucm_ctx_put(ctx);
        } else
                result = PTR_ERR(ctx);

        kfree(data);
        return result;
}

static ssize_t ib_ucm_send_lap(struct ib_ucm_file *file,
                               const char __user *inbuf,
                               int in_len, int out_len)
{
        struct ib_ucm_context *ctx;
        struct ib_sa_path_rec *path = NULL;
        struct ib_ucm_lap cmd;
        const void *data = NULL;
        int result;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        result = ib_ucm_alloc_data(&data, cmd.data, cmd.len);
        if (result)
                goto done;

        result = ib_ucm_path_get(&path, cmd.path);
        if (result)
                goto done;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (!IS_ERR(ctx)) {
                result = ib_send_cm_lap(ctx->cm_id, path, data, cmd.len);
                ib_ucm_ctx_put(ctx);
        } else
                result = PTR_ERR(ctx);

done:
        kfree(data);
        kfree(path);
        return result;
}

static ssize_t ib_ucm_send_sidr_req(struct ib_ucm_file *file,
                                    const char __user *inbuf,
                                    int in_len, int out_len)
{
        struct ib_cm_sidr_req_param param;
        struct ib_ucm_context *ctx;
        struct ib_ucm_sidr_req cmd;
        int result;

        param.private_data = NULL;
        param.path = NULL;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        result = ib_ucm_alloc_data(&param.private_data, cmd.data, cmd.len);
        if (result)
                goto done;

        result = ib_ucm_path_get(&param.path, cmd.path);
        if (result)
                goto done;

        param.private_data_len = cmd.len;
        param.service_id       = cmd.sid;
        param.timeout_ms       = cmd.timeout;
        param.max_cm_retries   = cmd.max_cm_retries;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (!IS_ERR(ctx)) {
                result = ib_send_cm_sidr_req(ctx->cm_id, &param);
                ib_ucm_ctx_put(ctx);
        } else
                result = PTR_ERR(ctx);

done:
        kfree(param.private_data);
        kfree(param.path);
        return result;
}

static ssize_t ib_ucm_send_sidr_rep(struct ib_ucm_file *file,
                                    const char __user *inbuf,
                                    int in_len, int out_len)
{
        struct ib_cm_sidr_rep_param param;
        struct ib_ucm_sidr_rep cmd;
        struct ib_ucm_context *ctx;
        int result;

        param.info = NULL;

        if (copy_from_user(&cmd, inbuf, sizeof(cmd)))
                return -EFAULT;

        result = ib_ucm_alloc_data(&param.private_data,
                                   cmd.data, cmd.data_len);
        if (result)
                goto done;

        result = ib_ucm_alloc_data(&param.info, cmd.info, cmd.info_len);
        if (result)
                goto done;

        param.qp_num            = cmd.qpn;
        param.qkey              = cmd.qkey;
        param.status            = cmd.status;
        param.info_length       = cmd.info_len;
        param.private_data_len  = cmd.data_len;

        ctx = ib_ucm_ctx_get(file, cmd.id);
        if (!IS_ERR(ctx)) {
                result = ib_send_cm_sidr_rep(ctx->cm_id, &param);
                ib_ucm_ctx_put(ctx);
        } else
                result = PTR_ERR(ctx);

done:
        kfree(param.private_data);
        kfree(param.info);
        return result;
}

static ssize_t (*ucm_cmd_table[])(struct ib_ucm_file *file,
                                  const char __user *inbuf,
                                  int in_len, int out_len) = {
        [IB_USER_CM_CMD_CREATE_ID]     = ib_ucm_create_id,
        [IB_USER_CM_CMD_DESTROY_ID]    = ib_ucm_destroy_id,
        [IB_USER_CM_CMD_ATTR_ID]       = ib_ucm_attr_id,
        [IB_USER_CM_CMD_LISTEN]        = ib_ucm_listen,
        [IB_USER_CM_CMD_NOTIFY]        = ib_ucm_notify,
        [IB_USER_CM_CMD_SEND_REQ]      = ib_ucm_send_req,
        [IB_USER_CM_CMD_SEND_REP]      = ib_ucm_send_rep,
        [IB_USER_CM_CMD_SEND_RTU]      = ib_ucm_send_rtu,
        [IB_USER_CM_CMD_SEND_DREQ]     = ib_ucm_send_dreq,
        [IB_USER_CM_CMD_SEND_DREP]     = ib_ucm_send_drep,
        [IB_USER_CM_CMD_SEND_REJ]      = ib_ucm_send_rej,
        [IB_USER_CM_CMD_SEND_MRA]      = ib_ucm_send_mra,
        [IB_USER_CM_CMD_SEND_LAP]      = ib_ucm_send_lap,
        [IB_USER_CM_CMD_SEND_APR]      = ib_ucm_send_apr,
        [IB_USER_CM_CMD_SEND_SIDR_REQ] = ib_ucm_send_sidr_req,
        [IB_USER_CM_CMD_SEND_SIDR_REP] = ib_ucm_send_sidr_rep,
        [IB_USER_CM_CMD_EVENT]         = ib_ucm_event,
        [IB_USER_CM_CMD_INIT_QP_ATTR]  = ib_ucm_init_qp_attr,
};

static ssize_t ib_ucm_write(struct file *filp, const char __user *buf,
                            size_t len, loff_t *pos)
{
        struct ib_ucm_file *file = filp->private_data;
        struct ib_ucm_cmd_hdr hdr;
        ssize_t result;

        if (WARN_ON_ONCE(!ib_safe_file_access(filp)))
                return -EACCES;

        if (len < sizeof(hdr))
                return -EINVAL;

        if (copy_from_user(&hdr, buf, sizeof(hdr)))
                return -EFAULT;

        if (hdr.cmd >= ARRAY_SIZE(ucm_cmd_table))
                return -EINVAL;

        if (hdr.in + sizeof(hdr) > len)
                return -EINVAL;

        result = ucm_cmd_table[hdr.cmd](file, buf + sizeof(hdr),
                                        hdr.in, hdr.out);
        if (!result)
                result = len;

        return result;
}

static unsigned int ib_ucm_poll(struct file *filp,
                                struct poll_table_struct *wait)
{
        struct ib_ucm_file *file = filp->private_data;
        unsigned int mask = 0;

        poll_wait(filp, &file->poll_wait, wait);

        if (!list_empty(&file->events))
                mask = POLLIN | POLLRDNORM;

        return mask;
}

/*
 * ib_ucm_open() does not need the BKL:
 *
 *  - no global state is referred to;
 *  - there is no ioctl method to race against;
 *  - no further module initialization is required for open to work
 *    after the device is registered.
 */
static int ib_ucm_open(struct inode *inode, struct file *filp)
{
        struct ib_ucm_file *file;

        file = kmalloc(sizeof(*file), GFP_KERNEL);
        if (!file)
                return -ENOMEM;

        INIT_LIST_HEAD(&file->events);
        INIT_LIST_HEAD(&file->ctxs);
        init_waitqueue_head(&file->poll_wait);

        mutex_init(&file->file_mutex);

        filp->private_data = file;
        file->filp = filp;
        file->device = container_of(inode->i_cdev->si_drv1, struct ib_ucm_device, cdev);

        return nonseekable_open(inode, filp);
}

static int ib_ucm_close(struct inode *inode, struct file *filp)
{
        struct ib_ucm_file *file = filp->private_data;
        struct ib_ucm_context *ctx;

        mutex_lock(&file->file_mutex);
        while (!list_empty(&file->ctxs)) {
                ctx = list_entry(file->ctxs.next,
                                 struct ib_ucm_context, file_list);
                mutex_unlock(&file->file_mutex);

                mutex_lock(&ctx_id_mutex);
                idr_remove(&ctx_id_table, ctx->id);
                mutex_unlock(&ctx_id_mutex);

                ib_destroy_cm_id(ctx->cm_id);
                ib_ucm_cleanup_events(ctx);
                kfree(ctx);

                mutex_lock(&file->file_mutex);
        }
        mutex_unlock(&file->file_mutex);
        kfree(file);
        return 0;
}

static DECLARE_BITMAP(overflow_map, IB_UCM_MAX_DEVICES);
static void ib_ucm_release_dev(struct device *dev)
{
        struct ib_ucm_device *ucm_dev;

        ucm_dev = container_of(dev, struct ib_ucm_device, dev);
        cdev_del(&ucm_dev->cdev);
        if (ucm_dev->devnum < IB_UCM_MAX_DEVICES)
                clear_bit(ucm_dev->devnum, dev_map);
        else
                clear_bit(ucm_dev->devnum - IB_UCM_MAX_DEVICES, overflow_map);
        kfree(ucm_dev);
}

static const struct file_operations ucm_fops = {
        .owner   = THIS_MODULE,
        .open    = ib_ucm_open,
        .release = ib_ucm_close,
        .write   = ib_ucm_write,
        .poll    = ib_ucm_poll,
        .llseek  = no_llseek,
};

static ssize_t show_ibdev(struct device *dev, struct device_attribute *attr,
                          char *buf)
{
        struct ib_ucm_device *ucm_dev;

        ucm_dev = container_of(dev, struct ib_ucm_device, dev);
        return sprintf(buf, "%s\n", ucm_dev->ib_dev->name);
}
static DEVICE_ATTR(ibdev, S_IRUGO, show_ibdev, NULL);

static dev_t overflow_maj;
static int find_overflow_devnum(void)
{
        int ret;

        if (!overflow_maj) {
                ret = alloc_chrdev_region(&overflow_maj, 0, IB_UCM_MAX_DEVICES,
                                          "infiniband_cm");
                if (ret) {
                        pr_err("ucm: couldn't register dynamic device number\n");
                        return ret;
                }
        }

        ret = find_first_zero_bit(overflow_map, IB_UCM_MAX_DEVICES);
        if (ret >= IB_UCM_MAX_DEVICES)
                return -1;

        return ret;
}

static void ib_ucm_add_one(struct ib_device *device)
{
        int devnum;
        dev_t base;
        struct ib_ucm_device *ucm_dev;

        if (!device->alloc_ucontext || !rdma_cap_ib_cm(device, 1))
                return;

        ucm_dev = kzalloc(sizeof *ucm_dev, GFP_KERNEL);
        if (!ucm_dev)
                return;

        ucm_dev->ib_dev = device;

        devnum = find_first_zero_bit(dev_map, IB_UCM_MAX_DEVICES);
        if (devnum >= IB_UCM_MAX_DEVICES) {
                devnum = find_overflow_devnum();
                if (devnum < 0)
                        goto err;

                ucm_dev->devnum = devnum + IB_UCM_MAX_DEVICES;
                base = devnum + overflow_maj;
                set_bit(devnum, overflow_map);
        } else {
                ucm_dev->devnum = devnum;
                base = devnum + IB_UCM_BASE_DEV;
                set_bit(devnum, dev_map);
        }

        cdev_init(&ucm_dev->cdev, &ucm_fops);
        ucm_dev->cdev.owner = THIS_MODULE;
        kobject_set_name(&ucm_dev->cdev.kobj, "ucm%d", ucm_dev->devnum);
        if (cdev_add(&ucm_dev->cdev, base, 1))
                goto err;

        ucm_dev->dev.class = &cm_class;
        ucm_dev->dev.parent = device->dma_device;
        ucm_dev->dev.devt = ucm_dev->cdev.dev;
        ucm_dev->dev.release = ib_ucm_release_dev;
        dev_set_name(&ucm_dev->dev, "ucm%d", ucm_dev->devnum);
        if (device_register(&ucm_dev->dev))
                goto err_cdev;

        if (device_create_file(&ucm_dev->dev, &dev_attr_ibdev))
                goto err_dev;

        ib_set_client_data(device, &ucm_client, ucm_dev);
        return;

err_dev:
        device_unregister(&ucm_dev->dev);
err_cdev:
        cdev_del(&ucm_dev->cdev);
        if (ucm_dev->devnum < IB_UCM_MAX_DEVICES)
                clear_bit(devnum, dev_map);
        else
                clear_bit(devnum, overflow_map);
err:
        kfree(ucm_dev);
        return;
}

static void ib_ucm_remove_one(struct ib_device *device, void *client_data)
{
        struct ib_ucm_device *ucm_dev = client_data;

        if (!ucm_dev)
                return;

        device_unregister(&ucm_dev->dev);
}

static CLASS_ATTR_STRING(abi_version, S_IRUGO,
                         __stringify(IB_USER_CM_ABI_VERSION));

static int __init ib_ucm_init(void)
{
        int ret;

        ret = register_chrdev_region(IB_UCM_BASE_DEV, IB_UCM_MAX_DEVICES,
                                     "infiniband_cm");
        if (ret) {
                pr_err("ucm: couldn't register device number\n");
                goto error1;
        }

        ret = class_create_file(&cm_class, &class_attr_abi_version.attr);
        if (ret) {
                pr_err("ucm: couldn't create abi_version attribute\n");
                goto error2;
        }

        ret = ib_register_client(&ucm_client);
        if (ret) {
                pr_err("ucm: couldn't register client\n");
                goto error3;
        }
        return 0;

error3:
        class_remove_file(&cm_class, &class_attr_abi_version.attr);
error2:
        unregister_chrdev_region(IB_UCM_BASE_DEV, IB_UCM_MAX_DEVICES);
error1:
        return ret;
}

static void __exit ib_ucm_cleanup(void)
{
        ib_unregister_client(&ucm_client);
        class_remove_file(&cm_class, &class_attr_abi_version.attr);
        unregister_chrdev_region(IB_UCM_BASE_DEV, IB_UCM_MAX_DEVICES);
        if (overflow_maj)
                unregister_chrdev_region(overflow_maj, IB_UCM_MAX_DEVICES);
        idr_destroy(&ctx_id_table);
}

module_init_order(ib_ucm_init, SI_ORDER_FIFTH);
module_exit_order(ib_ucm_cleanup, SI_ORDER_FIFTH);