/* * Copyright (C) 2010 Google, Inc. * * Author: * Dima Zavin * * Based on original NVRM code from NVIDIA, and a partial rewrite by * Gary King * * This software is licensed under the terms of the GNU General Public * License version 2, as published by the Free Software Foundation, and * may be copied, distributed, and modified under those terms. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * */ #include #include #include #include #include #include #include #include #include #include #include #include #include "trpc.h" #include "trpc_sema.h" #include "nvavp.h" struct tegra_rpc_info { struct trpc_endpoint *rpc_ep; struct tegra_sema_info *sema; }; /* ports names reserved for system functions, i.e. communicating with the * AVP */ static const char reserved_ports[][TEGRA_RPC_MAX_NAME_LEN] = { "RPC_AVP_PORT", "RPC_CPU_PORT", }; static int num_reserved_ports = ARRAY_SIZE(reserved_ports); static void rpc_notify_recv(struct trpc_endpoint *ep); /* TODO: do we need to do anything when port is closed from the other side? */ static struct trpc_ep_ops ep_ops = { .notify_recv = rpc_notify_recv, }; static struct trpc_node rpc_node = { .name = "local", .type = TRPC_NODE_LOCAL, }; static void rpc_notify_recv(struct trpc_endpoint *ep) { struct tegra_rpc_info *info = trpc_priv(ep); if (WARN_ON(!info)) return; if (info->sema) tegra_sema_signal(info->sema); } int tegra_rpc_open(struct tegra_rpc_info **info) { struct tegra_rpc_info *new_info; new_info = kzalloc(sizeof(struct tegra_rpc_info), GFP_KERNEL); if (!new_info) return -ENOMEM; *info = new_info; return 0; } static int local_rpc_open(struct inode *inode, struct file *file) { struct tegra_rpc_info *info; int ret = 0; ret = tegra_rpc_open(&info); if (ret < 0) return -ENOMEM; nonseekable_open(inode, file); file->private_data = info; return 0; } int tegra_rpc_release(struct tegra_rpc_info *info) { if (info->rpc_ep) trpc_close(info->rpc_ep); if (info->sema) trpc_sema_put(info->sema); kfree(info); return 0; } EXPORT_SYMBOL(tegra_rpc_release); static int local_rpc_release(struct inode *inode, struct file *file) { struct tegra_rpc_info *info = file->private_data; tegra_rpc_release(info); file->private_data = NULL; return 0; } static char uniq_name[] = "aaaaaaaa+"; static const int uniq_len = sizeof(uniq_name) - 1; static DEFINE_MUTEX(uniq_lock); static void _gen_port_name(char *new_name) { int i; mutex_lock(&uniq_lock); for (i = 0; i < uniq_len - 1; i++) { ++uniq_name[i]; if (uniq_name[i] != 'z') break; uniq_name[i] = 'a'; } strlcpy(new_name, uniq_name, TEGRA_RPC_MAX_NAME_LEN); mutex_unlock(&uniq_lock); } static int _validate_port_name(const char *name) { int i; for (i = 0; i < num_reserved_ports; i++) if (!strncmp(name, reserved_ports[i], TEGRA_RPC_MAX_NAME_LEN)) return -EINVAL; return 0; } int tegra_rpc_port_create(struct tegra_rpc_info *info, char *name, struct tegra_sema_info *sema) { struct trpc_endpoint *ep; int ret = 0; if (info->rpc_ep) { ret = -EINVAL; goto err; } name[TEGRA_RPC_MAX_NAME_LEN - 1] = '\0'; if (name[0]) { ret = _validate_port_name(name); if (ret) goto err; } else { _gen_port_name(name); } ep = trpc_create(&rpc_node, name, &ep_ops, info); if (IS_ERR(ep)) { ret = PTR_ERR(ep); goto err; } info->rpc_ep = ep; info->sema = sema; return 0; err: return ret; } int tegra_rpc_get_name(struct tegra_rpc_info *info, char* name) { if (!info->rpc_ep) return -EINVAL; strcpy(name, trpc_name(info->rpc_ep)); return 0; } int tegra_rpc_port_connect(struct tegra_rpc_info *info, long timeout) { if (!info->rpc_ep) return -EINVAL; return trpc_connect(info->rpc_ep, timeout); } int tegra_rpc_port_listen(struct tegra_rpc_info *info, long timeout) { if (!info->rpc_ep) return -EINVAL; return trpc_wait_peer(info->rpc_ep, timeout); } static long local_rpc_ioctl(struct file *file, unsigned int cmd, unsigned long arg) { struct tegra_rpc_info *info = file->private_data; struct tegra_rpc_port_desc desc; struct tegra_sema_info *sema = NULL; int ret = 0; if (_IOC_TYPE(cmd) != TEGRA_RPC_IOCTL_MAGIC || _IOC_NR(cmd) < TEGRA_RPC_IOCTL_MIN_NR || _IOC_NR(cmd) > TEGRA_RPC_IOCTL_MAX_NR) { ret = -ENOTTY; goto err; } switch (cmd) { case TEGRA_RPC_IOCTL_PORT_CREATE: if (_IOC_SIZE(cmd) != sizeof(struct tegra_rpc_port_desc)) return -EINVAL; if (copy_from_user(&desc, (void __user *)arg, sizeof(desc))) return -EFAULT; if (desc.notify_fd != -1) { sema = trpc_sema_get_from_fd(desc.notify_fd); if (IS_ERR(sema)) { ret = PTR_ERR(sema); goto err; } } ret = tegra_rpc_port_create(info, desc.name, sema); if (ret < 0) goto err; break; case TEGRA_RPC_IOCTL_PORT_GET_NAME: if (!info->rpc_ep) { ret = -EINVAL; goto err; } if (copy_to_user((void __user *)arg, trpc_name(info->rpc_ep), TEGRA_RPC_MAX_NAME_LEN)) { ret = -EFAULT; goto err; } break; case TEGRA_RPC_IOCTL_PORT_CONNECT: if (!info->rpc_ep) { ret = -EINVAL; goto err; } ret = trpc_connect(info->rpc_ep, (long)arg); if (ret) { pr_err("%s: can't connect to '%s' (%d)\n", __func__, trpc_name(info->rpc_ep), ret); goto err; } break; case TEGRA_RPC_IOCTL_PORT_LISTEN: if (!info->rpc_ep) { ret = -EINVAL; goto err; } ret = trpc_wait_peer(info->rpc_ep, (long)arg); if (ret) { pr_err("%s: error waiting for peer for '%s' (%d)\n", __func__, trpc_name(info->rpc_ep), ret); goto err; } break; default: pr_err("%s: unknown cmd %d\n", __func__, _IOC_NR(cmd)); ret = -EINVAL; goto err; } return 0; err: if (ret && ret != -ERESTARTSYS) pr_err("tegra_rpc: pid=%d ioctl=%x/%lx (%x) ret=%d\n", current->pid, cmd, arg, _IOC_NR(cmd), ret); return (long)ret; } int tegra_rpc_write(struct tegra_rpc_info *info, u8* buf, size_t size) { int ret; if (!info->rpc_ep) return -EINVAL; if (TEGRA_RPC_MAX_MSG_LEN < size) return -EINVAL; ret = trpc_send_msg(&rpc_node, info->rpc_ep, buf, size, GFP_KERNEL); if (ret) return ret; return size; } static ssize_t local_rpc_write(struct file *file, const char __user *buf, size_t count, loff_t *ppos) { struct tegra_rpc_info *info = file->private_data; u8 data[TEGRA_RPC_MAX_MSG_LEN]; int ret; if (!info) return -EINVAL; else if (count > TEGRA_RPC_MAX_MSG_LEN) return -EINVAL; if (copy_from_user(data, buf, count)) return -EFAULT; ret = trpc_send_msg(&rpc_node, info->rpc_ep, data, count, GFP_KERNEL); if (ret) return ret; return count; } int tegra_rpc_read(struct tegra_rpc_info *info, u8 *buf, size_t max) { int ret; if (max > TEGRA_RPC_MAX_MSG_LEN) return -EINVAL; ret = trpc_recv_msg(&rpc_node, info->rpc_ep, buf, TEGRA_RPC_MAX_MSG_LEN, 0); if (ret == 0) return 0; else if (ret < 0) return ret; else if (ret > max) return -ENOSPC; return ret; } static ssize_t local_rpc_read(struct file *file, char __user *buf, size_t max, loff_t *ppos) { struct tegra_rpc_info *info = file->private_data; int ret; u8 data[TEGRA_RPC_MAX_MSG_LEN]; if (max > TEGRA_RPC_MAX_MSG_LEN) return -EINVAL; ret = trpc_recv_msg(&rpc_node, info->rpc_ep, data, TEGRA_RPC_MAX_MSG_LEN, 0); if (ret == 0) return 0; else if (ret < 0) return ret; else if (ret > max) return -ENOSPC; else if (copy_to_user(buf, data, ret)) return -EFAULT; return ret; } static const struct file_operations local_rpc_misc_fops = { .owner = THIS_MODULE, .open = local_rpc_open, .release = local_rpc_release, .unlocked_ioctl = local_rpc_ioctl, .write = local_rpc_write, .read = local_rpc_read, }; static struct miscdevice local_rpc_misc_device = { .minor = MISC_DYNAMIC_MINOR, .name = "tegra_rpc", .fops = &local_rpc_misc_fops, }; int __init rpc_local_init(void) { int ret; ret = trpc_sema_init(); if (ret) { pr_err("%s: error in trpc_sema_init\n", __func__); goto err_sema_init; } ret = misc_register(&local_rpc_misc_device); if (ret) { pr_err("%s: can't register misc device\n", __func__); goto err_misc; } ret = trpc_node_register(&rpc_node); if (ret) { pr_err("%s: can't register rpc node\n", __func__); goto err_node_reg; } return 0; err_node_reg: misc_deregister(&local_rpc_misc_device); err_misc: err_sema_init: return ret; } module_init(rpc_local_init);