1f6f9279fSSrinivas Kandagatla // SPDX-License-Identifier: GPL-2.0 2f6f9279fSSrinivas Kandagatla // Copyright (c) 2011-2018, The Linux Foundation. All rights reserved. 3f6f9279fSSrinivas Kandagatla // Copyright (c) 2018, Linaro Limited 4f6f9279fSSrinivas Kandagatla 5c68cfb71SSrinivas Kandagatla #include <linux/completion.h> 6f6f9279fSSrinivas Kandagatla #include <linux/device.h> 7c68cfb71SSrinivas Kandagatla #include <linux/dma-buf.h> 8f6f9279fSSrinivas Kandagatla #include <linux/dma-mapping.h> 9f6f9279fSSrinivas Kandagatla #include <linux/idr.h> 10f6f9279fSSrinivas Kandagatla #include <linux/list.h> 11f6f9279fSSrinivas Kandagatla #include <linux/miscdevice.h> 12f6f9279fSSrinivas Kandagatla #include <linux/module.h> 13f6f9279fSSrinivas Kandagatla #include <linux/of_address.h> 14f6f9279fSSrinivas Kandagatla #include <linux/of.h> 1525e8dfb8SSrinivas Kandagatla #include <linux/sort.h> 16f6f9279fSSrinivas Kandagatla #include <linux/of_platform.h> 17f6f9279fSSrinivas Kandagatla #include <linux/rpmsg.h> 18f6f9279fSSrinivas Kandagatla #include <linux/scatterlist.h> 19f6f9279fSSrinivas Kandagatla #include <linux/slab.h> 20c68cfb71SSrinivas Kandagatla #include <uapi/misc/fastrpc.h> 21f6f9279fSSrinivas Kandagatla 22f6f9279fSSrinivas Kandagatla #define ADSP_DOMAIN_ID (0) 23f6f9279fSSrinivas Kandagatla #define MDSP_DOMAIN_ID (1) 24f6f9279fSSrinivas Kandagatla #define SDSP_DOMAIN_ID (2) 25f6f9279fSSrinivas Kandagatla #define CDSP_DOMAIN_ID (3) 26f6f9279fSSrinivas Kandagatla #define FASTRPC_DEV_MAX 4 /* adsp, mdsp, slpi, cdsp*/ 27f6f9279fSSrinivas Kandagatla #define FASTRPC_MAX_SESSIONS 9 /*8 compute, 1 cpz*/ 28c68cfb71SSrinivas Kandagatla #define FASTRPC_ALIGN 128 29c68cfb71SSrinivas Kandagatla #define FASTRPC_MAX_FDLIST 16 30c68cfb71SSrinivas Kandagatla #define FASTRPC_MAX_CRCLIST 64 31c68cfb71SSrinivas Kandagatla #define FASTRPC_PHYS(p) ((p) & 0xffffffff) 32f6f9279fSSrinivas Kandagatla #define FASTRPC_CTX_MAX (256) 33d73f71c7SSrinivas Kandagatla #define FASTRPC_INIT_HANDLE 1 34f6f9279fSSrinivas Kandagatla #define FASTRPC_CTXID_MASK (0xFF0) 35f1cf11c2SSrinivas Kandagatla #define INIT_FILELEN_MAX (64 * 1024 * 1024) 36d73f71c7SSrinivas Kandagatla #define INIT_MEMLEN_MAX (8 * 1024 * 1024) 37f6f9279fSSrinivas Kandagatla #define FASTRPC_DEVICE_NAME "fastrpc" 38f6f9279fSSrinivas Kandagatla 39c68cfb71SSrinivas Kandagatla /* Retrives number of input buffers from the scalars parameter */ 40c68cfb71SSrinivas Kandagatla #define REMOTE_SCALARS_INBUFS(sc) (((sc) >> 16) & 0x0ff) 41c68cfb71SSrinivas Kandagatla 42c68cfb71SSrinivas Kandagatla /* Retrives number of output buffers from the scalars parameter */ 43c68cfb71SSrinivas Kandagatla #define REMOTE_SCALARS_OUTBUFS(sc) (((sc) >> 8) & 0x0ff) 44c68cfb71SSrinivas Kandagatla 45c68cfb71SSrinivas Kandagatla /* Retrives number of input handles from the scalars parameter */ 46c68cfb71SSrinivas Kandagatla #define REMOTE_SCALARS_INHANDLES(sc) (((sc) >> 4) & 0x0f) 47c68cfb71SSrinivas Kandagatla 48c68cfb71SSrinivas Kandagatla /* Retrives number of output handles from the scalars parameter */ 49c68cfb71SSrinivas Kandagatla #define REMOTE_SCALARS_OUTHANDLES(sc) ((sc) & 0x0f) 50c68cfb71SSrinivas Kandagatla 51c68cfb71SSrinivas Kandagatla #define REMOTE_SCALARS_LENGTH(sc) (REMOTE_SCALARS_INBUFS(sc) + \ 52c68cfb71SSrinivas Kandagatla REMOTE_SCALARS_OUTBUFS(sc) + \ 53c68cfb71SSrinivas Kandagatla REMOTE_SCALARS_INHANDLES(sc)+ \ 54c68cfb71SSrinivas Kandagatla REMOTE_SCALARS_OUTHANDLES(sc)) 55c68cfb71SSrinivas Kandagatla #define FASTRPC_BUILD_SCALARS(attr, method, in, out, oin, oout) \ 56c68cfb71SSrinivas Kandagatla (((attr & 0x07) << 29) | \ 57c68cfb71SSrinivas Kandagatla ((method & 0x1f) << 24) | \ 58c68cfb71SSrinivas Kandagatla ((in & 0xff) << 16) | \ 59c68cfb71SSrinivas Kandagatla ((out & 0xff) << 8) | \ 60c68cfb71SSrinivas Kandagatla ((oin & 0x0f) << 4) | \ 61c68cfb71SSrinivas Kandagatla (oout & 0x0f)) 62c68cfb71SSrinivas Kandagatla 63c68cfb71SSrinivas Kandagatla #define FASTRPC_SCALARS(method, in, out) \ 64c68cfb71SSrinivas Kandagatla FASTRPC_BUILD_SCALARS(0, method, in, out, 0, 0) 65c68cfb71SSrinivas Kandagatla 66d73f71c7SSrinivas Kandagatla #define FASTRPC_CREATE_PROCESS_NARGS 6 67d73f71c7SSrinivas Kandagatla /* Remote Method id table */ 68d73f71c7SSrinivas Kandagatla #define FASTRPC_RMID_INIT_ATTACH 0 69d73f71c7SSrinivas Kandagatla #define FASTRPC_RMID_INIT_RELEASE 1 70d73f71c7SSrinivas Kandagatla #define FASTRPC_RMID_INIT_CREATE 6 71d73f71c7SSrinivas Kandagatla #define FASTRPC_RMID_INIT_CREATE_ATTR 7 72d73f71c7SSrinivas Kandagatla #define FASTRPC_RMID_INIT_CREATE_STATIC 8 73d73f71c7SSrinivas Kandagatla 74f6f9279fSSrinivas Kandagatla #define miscdev_to_cctx(d) container_of(d, struct fastrpc_channel_ctx, miscdev) 75f6f9279fSSrinivas Kandagatla 76f6f9279fSSrinivas Kandagatla static const char *domains[FASTRPC_DEV_MAX] = { "adsp", "mdsp", 77f6f9279fSSrinivas Kandagatla "sdsp", "cdsp"}; 78c68cfb71SSrinivas Kandagatla struct fastrpc_phy_page { 79c68cfb71SSrinivas Kandagatla u64 addr; /* physical address */ 80c68cfb71SSrinivas Kandagatla u64 size; /* size of contiguous region */ 81c68cfb71SSrinivas Kandagatla }; 82c68cfb71SSrinivas Kandagatla 83c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_buf { 84c68cfb71SSrinivas Kandagatla u32 num; /* number of contiguous regions */ 85c68cfb71SSrinivas Kandagatla u32 pgidx; /* index to start of contiguous region */ 86c68cfb71SSrinivas Kandagatla }; 87c68cfb71SSrinivas Kandagatla 88c68cfb71SSrinivas Kandagatla struct fastrpc_remote_arg { 89c68cfb71SSrinivas Kandagatla u64 pv; 90c68cfb71SSrinivas Kandagatla u64 len; 91c68cfb71SSrinivas Kandagatla }; 92c68cfb71SSrinivas Kandagatla 93c68cfb71SSrinivas Kandagatla struct fastrpc_msg { 94c68cfb71SSrinivas Kandagatla int pid; /* process group id */ 95c68cfb71SSrinivas Kandagatla int tid; /* thread id */ 96c68cfb71SSrinivas Kandagatla u64 ctx; /* invoke caller context */ 97c68cfb71SSrinivas Kandagatla u32 handle; /* handle to invoke */ 98c68cfb71SSrinivas Kandagatla u32 sc; /* scalars structure describing the data */ 99c68cfb71SSrinivas Kandagatla u64 addr; /* physical address */ 100c68cfb71SSrinivas Kandagatla u64 size; /* size of contiguous region */ 101c68cfb71SSrinivas Kandagatla }; 102c68cfb71SSrinivas Kandagatla 103c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_rsp { 104c68cfb71SSrinivas Kandagatla u64 ctx; /* invoke caller context */ 105c68cfb71SSrinivas Kandagatla int retval; /* invoke return value */ 106c68cfb71SSrinivas Kandagatla }; 107c68cfb71SSrinivas Kandagatla 10825e8dfb8SSrinivas Kandagatla struct fastrpc_buf_overlap { 10925e8dfb8SSrinivas Kandagatla u64 start; 11025e8dfb8SSrinivas Kandagatla u64 end; 11125e8dfb8SSrinivas Kandagatla int raix; 11225e8dfb8SSrinivas Kandagatla u64 mstart; 11325e8dfb8SSrinivas Kandagatla u64 mend; 11425e8dfb8SSrinivas Kandagatla u64 offset; 11525e8dfb8SSrinivas Kandagatla }; 11625e8dfb8SSrinivas Kandagatla 117c68cfb71SSrinivas Kandagatla struct fastrpc_buf { 118c68cfb71SSrinivas Kandagatla struct fastrpc_user *fl; 1196cffd795SSrinivas Kandagatla struct dma_buf *dmabuf; 120c68cfb71SSrinivas Kandagatla struct device *dev; 121c68cfb71SSrinivas Kandagatla void *virt; 122c68cfb71SSrinivas Kandagatla u64 phys; 123c68cfb71SSrinivas Kandagatla u64 size; 1246cffd795SSrinivas Kandagatla /* Lock for dma buf attachments */ 1256cffd795SSrinivas Kandagatla struct mutex lock; 1266cffd795SSrinivas Kandagatla struct list_head attachments; 1276cffd795SSrinivas Kandagatla }; 1286cffd795SSrinivas Kandagatla 1296cffd795SSrinivas Kandagatla struct fastrpc_dma_buf_attachment { 1306cffd795SSrinivas Kandagatla struct device *dev; 1316cffd795SSrinivas Kandagatla struct sg_table sgt; 1326cffd795SSrinivas Kandagatla struct list_head node; 133c68cfb71SSrinivas Kandagatla }; 134c68cfb71SSrinivas Kandagatla 135c68cfb71SSrinivas Kandagatla struct fastrpc_map { 136c68cfb71SSrinivas Kandagatla struct list_head node; 137c68cfb71SSrinivas Kandagatla struct fastrpc_user *fl; 138c68cfb71SSrinivas Kandagatla int fd; 139c68cfb71SSrinivas Kandagatla struct dma_buf *buf; 140c68cfb71SSrinivas Kandagatla struct sg_table *table; 141c68cfb71SSrinivas Kandagatla struct dma_buf_attachment *attach; 142c68cfb71SSrinivas Kandagatla u64 phys; 143c68cfb71SSrinivas Kandagatla u64 size; 144c68cfb71SSrinivas Kandagatla void *va; 145c68cfb71SSrinivas Kandagatla u64 len; 146c68cfb71SSrinivas Kandagatla struct kref refcount; 147c68cfb71SSrinivas Kandagatla }; 148c68cfb71SSrinivas Kandagatla 149c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_ctx { 150c68cfb71SSrinivas Kandagatla int nscalars; 151c68cfb71SSrinivas Kandagatla int nbufs; 152c68cfb71SSrinivas Kandagatla int retval; 153c68cfb71SSrinivas Kandagatla int pid; 154c68cfb71SSrinivas Kandagatla int tgid; 155c68cfb71SSrinivas Kandagatla u32 sc; 156c68cfb71SSrinivas Kandagatla u32 *crc; 157c68cfb71SSrinivas Kandagatla u64 ctxid; 158c68cfb71SSrinivas Kandagatla u64 msg_sz; 159c68cfb71SSrinivas Kandagatla struct kref refcount; 160c68cfb71SSrinivas Kandagatla struct list_head node; /* list of ctxs */ 161c68cfb71SSrinivas Kandagatla struct completion work; 1628e7389c7SThierry Escande struct work_struct put_work; 163c68cfb71SSrinivas Kandagatla struct fastrpc_msg msg; 164c68cfb71SSrinivas Kandagatla struct fastrpc_user *fl; 165c68cfb71SSrinivas Kandagatla struct fastrpc_remote_arg *rpra; 166c68cfb71SSrinivas Kandagatla struct fastrpc_map **maps; 167c68cfb71SSrinivas Kandagatla struct fastrpc_buf *buf; 168c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_args *args; 16925e8dfb8SSrinivas Kandagatla struct fastrpc_buf_overlap *olaps; 170c68cfb71SSrinivas Kandagatla struct fastrpc_channel_ctx *cctx; 171c68cfb71SSrinivas Kandagatla }; 172f6f9279fSSrinivas Kandagatla 173f6f9279fSSrinivas Kandagatla struct fastrpc_session_ctx { 174f6f9279fSSrinivas Kandagatla struct device *dev; 175f6f9279fSSrinivas Kandagatla int sid; 176f6f9279fSSrinivas Kandagatla bool used; 177f6f9279fSSrinivas Kandagatla bool valid; 178f6f9279fSSrinivas Kandagatla }; 179f6f9279fSSrinivas Kandagatla 180f6f9279fSSrinivas Kandagatla struct fastrpc_channel_ctx { 181f6f9279fSSrinivas Kandagatla int domain_id; 182f6f9279fSSrinivas Kandagatla int sesscount; 183f6f9279fSSrinivas Kandagatla struct rpmsg_device *rpdev; 184f6f9279fSSrinivas Kandagatla struct fastrpc_session_ctx session[FASTRPC_MAX_SESSIONS]; 185f6f9279fSSrinivas Kandagatla spinlock_t lock; 186f6f9279fSSrinivas Kandagatla struct idr ctx_idr; 187f6f9279fSSrinivas Kandagatla struct list_head users; 188f6f9279fSSrinivas Kandagatla struct miscdevice miscdev; 189*278d56f9SBjorn Andersson struct kref refcount; 190f6f9279fSSrinivas Kandagatla }; 191f6f9279fSSrinivas Kandagatla 192f6f9279fSSrinivas Kandagatla struct fastrpc_user { 193f6f9279fSSrinivas Kandagatla struct list_head user; 194f6f9279fSSrinivas Kandagatla struct list_head maps; 195f6f9279fSSrinivas Kandagatla struct list_head pending; 196f6f9279fSSrinivas Kandagatla 197f6f9279fSSrinivas Kandagatla struct fastrpc_channel_ctx *cctx; 198f6f9279fSSrinivas Kandagatla struct fastrpc_session_ctx *sctx; 199c68cfb71SSrinivas Kandagatla struct fastrpc_buf *init_mem; 200f6f9279fSSrinivas Kandagatla 201f6f9279fSSrinivas Kandagatla int tgid; 202f6f9279fSSrinivas Kandagatla int pd; 203f6f9279fSSrinivas Kandagatla /* Lock for lists */ 204f6f9279fSSrinivas Kandagatla spinlock_t lock; 205f6f9279fSSrinivas Kandagatla /* lock for allocations */ 206f6f9279fSSrinivas Kandagatla struct mutex mutex; 207f6f9279fSSrinivas Kandagatla }; 208f6f9279fSSrinivas Kandagatla 209c68cfb71SSrinivas Kandagatla static void fastrpc_free_map(struct kref *ref) 210c68cfb71SSrinivas Kandagatla { 211c68cfb71SSrinivas Kandagatla struct fastrpc_map *map; 212c68cfb71SSrinivas Kandagatla 213c68cfb71SSrinivas Kandagatla map = container_of(ref, struct fastrpc_map, refcount); 214c68cfb71SSrinivas Kandagatla 215c68cfb71SSrinivas Kandagatla if (map->table) { 216c68cfb71SSrinivas Kandagatla dma_buf_unmap_attachment(map->attach, map->table, 217c68cfb71SSrinivas Kandagatla DMA_BIDIRECTIONAL); 218c68cfb71SSrinivas Kandagatla dma_buf_detach(map->buf, map->attach); 219c68cfb71SSrinivas Kandagatla dma_buf_put(map->buf); 220c68cfb71SSrinivas Kandagatla } 221c68cfb71SSrinivas Kandagatla 222c68cfb71SSrinivas Kandagatla kfree(map); 223c68cfb71SSrinivas Kandagatla } 224c68cfb71SSrinivas Kandagatla 225c68cfb71SSrinivas Kandagatla static void fastrpc_map_put(struct fastrpc_map *map) 226c68cfb71SSrinivas Kandagatla { 227c68cfb71SSrinivas Kandagatla if (map) 228c68cfb71SSrinivas Kandagatla kref_put(&map->refcount, fastrpc_free_map); 229c68cfb71SSrinivas Kandagatla } 230c68cfb71SSrinivas Kandagatla 231c68cfb71SSrinivas Kandagatla static void fastrpc_map_get(struct fastrpc_map *map) 232c68cfb71SSrinivas Kandagatla { 233c68cfb71SSrinivas Kandagatla if (map) 234c68cfb71SSrinivas Kandagatla kref_get(&map->refcount); 235c68cfb71SSrinivas Kandagatla } 236c68cfb71SSrinivas Kandagatla 237c68cfb71SSrinivas Kandagatla static int fastrpc_map_find(struct fastrpc_user *fl, int fd, 238c68cfb71SSrinivas Kandagatla struct fastrpc_map **ppmap) 239c68cfb71SSrinivas Kandagatla { 240c68cfb71SSrinivas Kandagatla struct fastrpc_map *map = NULL; 241c68cfb71SSrinivas Kandagatla 242c68cfb71SSrinivas Kandagatla mutex_lock(&fl->mutex); 243c68cfb71SSrinivas Kandagatla list_for_each_entry(map, &fl->maps, node) { 244c68cfb71SSrinivas Kandagatla if (map->fd == fd) { 245c68cfb71SSrinivas Kandagatla fastrpc_map_get(map); 246c68cfb71SSrinivas Kandagatla *ppmap = map; 247c68cfb71SSrinivas Kandagatla mutex_unlock(&fl->mutex); 248c68cfb71SSrinivas Kandagatla return 0; 249c68cfb71SSrinivas Kandagatla } 250c68cfb71SSrinivas Kandagatla } 251c68cfb71SSrinivas Kandagatla mutex_unlock(&fl->mutex); 252c68cfb71SSrinivas Kandagatla 253c68cfb71SSrinivas Kandagatla return -ENOENT; 254c68cfb71SSrinivas Kandagatla } 255c68cfb71SSrinivas Kandagatla 256c68cfb71SSrinivas Kandagatla static void fastrpc_buf_free(struct fastrpc_buf *buf) 257c68cfb71SSrinivas Kandagatla { 258c68cfb71SSrinivas Kandagatla dma_free_coherent(buf->dev, buf->size, buf->virt, 259c68cfb71SSrinivas Kandagatla FASTRPC_PHYS(buf->phys)); 260c68cfb71SSrinivas Kandagatla kfree(buf); 261c68cfb71SSrinivas Kandagatla } 262c68cfb71SSrinivas Kandagatla 263c68cfb71SSrinivas Kandagatla static int fastrpc_buf_alloc(struct fastrpc_user *fl, struct device *dev, 264c68cfb71SSrinivas Kandagatla u64 size, struct fastrpc_buf **obuf) 265c68cfb71SSrinivas Kandagatla { 266c68cfb71SSrinivas Kandagatla struct fastrpc_buf *buf; 267c68cfb71SSrinivas Kandagatla 268c68cfb71SSrinivas Kandagatla buf = kzalloc(sizeof(*buf), GFP_KERNEL); 269c68cfb71SSrinivas Kandagatla if (!buf) 270c68cfb71SSrinivas Kandagatla return -ENOMEM; 271c68cfb71SSrinivas Kandagatla 2726cffd795SSrinivas Kandagatla INIT_LIST_HEAD(&buf->attachments); 2736cffd795SSrinivas Kandagatla mutex_init(&buf->lock); 2746cffd795SSrinivas Kandagatla 275c68cfb71SSrinivas Kandagatla buf->fl = fl; 276c68cfb71SSrinivas Kandagatla buf->virt = NULL; 277c68cfb71SSrinivas Kandagatla buf->phys = 0; 278c68cfb71SSrinivas Kandagatla buf->size = size; 279c68cfb71SSrinivas Kandagatla buf->dev = dev; 280c68cfb71SSrinivas Kandagatla 281c68cfb71SSrinivas Kandagatla buf->virt = dma_alloc_coherent(dev, buf->size, (dma_addr_t *)&buf->phys, 282c68cfb71SSrinivas Kandagatla GFP_KERNEL); 28341db5f83SJorge Ramirez-Ortiz if (!buf->virt) { 28441db5f83SJorge Ramirez-Ortiz mutex_destroy(&buf->lock); 28541db5f83SJorge Ramirez-Ortiz kfree(buf); 286c68cfb71SSrinivas Kandagatla return -ENOMEM; 28741db5f83SJorge Ramirez-Ortiz } 288c68cfb71SSrinivas Kandagatla 289c68cfb71SSrinivas Kandagatla if (fl->sctx && fl->sctx->sid) 290c68cfb71SSrinivas Kandagatla buf->phys += ((u64)fl->sctx->sid << 32); 291c68cfb71SSrinivas Kandagatla 292c68cfb71SSrinivas Kandagatla *obuf = buf; 293c68cfb71SSrinivas Kandagatla 294c68cfb71SSrinivas Kandagatla return 0; 295c68cfb71SSrinivas Kandagatla } 296c68cfb71SSrinivas Kandagatla 297*278d56f9SBjorn Andersson static void fastrpc_channel_ctx_free(struct kref *ref) 298*278d56f9SBjorn Andersson { 299*278d56f9SBjorn Andersson struct fastrpc_channel_ctx *cctx; 300*278d56f9SBjorn Andersson 301*278d56f9SBjorn Andersson cctx = container_of(ref, struct fastrpc_channel_ctx, refcount); 302*278d56f9SBjorn Andersson 303*278d56f9SBjorn Andersson kfree(cctx); 304*278d56f9SBjorn Andersson } 305*278d56f9SBjorn Andersson 306*278d56f9SBjorn Andersson static void fastrpc_channel_ctx_get(struct fastrpc_channel_ctx *cctx) 307*278d56f9SBjorn Andersson { 308*278d56f9SBjorn Andersson kref_get(&cctx->refcount); 309*278d56f9SBjorn Andersson } 310*278d56f9SBjorn Andersson 311*278d56f9SBjorn Andersson static void fastrpc_channel_ctx_put(struct fastrpc_channel_ctx *cctx) 312*278d56f9SBjorn Andersson { 313*278d56f9SBjorn Andersson kref_put(&cctx->refcount, fastrpc_channel_ctx_free); 314*278d56f9SBjorn Andersson } 315*278d56f9SBjorn Andersson 316c68cfb71SSrinivas Kandagatla static void fastrpc_context_free(struct kref *ref) 317c68cfb71SSrinivas Kandagatla { 318c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_ctx *ctx; 319c68cfb71SSrinivas Kandagatla struct fastrpc_channel_ctx *cctx; 320977e6c8dSSrinivas Kandagatla unsigned long flags; 321c68cfb71SSrinivas Kandagatla int i; 322c68cfb71SSrinivas Kandagatla 323c68cfb71SSrinivas Kandagatla ctx = container_of(ref, struct fastrpc_invoke_ctx, refcount); 324c68cfb71SSrinivas Kandagatla cctx = ctx->cctx; 325c68cfb71SSrinivas Kandagatla 326c68cfb71SSrinivas Kandagatla for (i = 0; i < ctx->nscalars; i++) 327c68cfb71SSrinivas Kandagatla fastrpc_map_put(ctx->maps[i]); 328c68cfb71SSrinivas Kandagatla 329c68cfb71SSrinivas Kandagatla if (ctx->buf) 330c68cfb71SSrinivas Kandagatla fastrpc_buf_free(ctx->buf); 331c68cfb71SSrinivas Kandagatla 332977e6c8dSSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 333c68cfb71SSrinivas Kandagatla idr_remove(&cctx->ctx_idr, ctx->ctxid >> 4); 334977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 335c68cfb71SSrinivas Kandagatla 336c68cfb71SSrinivas Kandagatla kfree(ctx->maps); 33725e8dfb8SSrinivas Kandagatla kfree(ctx->olaps); 338c68cfb71SSrinivas Kandagatla kfree(ctx); 339*278d56f9SBjorn Andersson 340*278d56f9SBjorn Andersson fastrpc_channel_ctx_put(cctx); 341c68cfb71SSrinivas Kandagatla } 342c68cfb71SSrinivas Kandagatla 343c68cfb71SSrinivas Kandagatla static void fastrpc_context_get(struct fastrpc_invoke_ctx *ctx) 344c68cfb71SSrinivas Kandagatla { 345c68cfb71SSrinivas Kandagatla kref_get(&ctx->refcount); 346c68cfb71SSrinivas Kandagatla } 347c68cfb71SSrinivas Kandagatla 348c68cfb71SSrinivas Kandagatla static void fastrpc_context_put(struct fastrpc_invoke_ctx *ctx) 349c68cfb71SSrinivas Kandagatla { 350c68cfb71SSrinivas Kandagatla kref_put(&ctx->refcount, fastrpc_context_free); 351c68cfb71SSrinivas Kandagatla } 352c68cfb71SSrinivas Kandagatla 3538e7389c7SThierry Escande static void fastrpc_context_put_wq(struct work_struct *work) 3548e7389c7SThierry Escande { 3558e7389c7SThierry Escande struct fastrpc_invoke_ctx *ctx = 3568e7389c7SThierry Escande container_of(work, struct fastrpc_invoke_ctx, put_work); 3578e7389c7SThierry Escande 3588e7389c7SThierry Escande fastrpc_context_put(ctx); 3598e7389c7SThierry Escande } 3608e7389c7SThierry Escande 36125e8dfb8SSrinivas Kandagatla #define CMP(aa, bb) ((aa) == (bb) ? 0 : (aa) < (bb) ? -1 : 1) 36225e8dfb8SSrinivas Kandagatla static int olaps_cmp(const void *a, const void *b) 36325e8dfb8SSrinivas Kandagatla { 36425e8dfb8SSrinivas Kandagatla struct fastrpc_buf_overlap *pa = (struct fastrpc_buf_overlap *)a; 36525e8dfb8SSrinivas Kandagatla struct fastrpc_buf_overlap *pb = (struct fastrpc_buf_overlap *)b; 36625e8dfb8SSrinivas Kandagatla /* sort with lowest starting buffer first */ 36725e8dfb8SSrinivas Kandagatla int st = CMP(pa->start, pb->start); 36825e8dfb8SSrinivas Kandagatla /* sort with highest ending buffer first */ 36925e8dfb8SSrinivas Kandagatla int ed = CMP(pb->end, pa->end); 37025e8dfb8SSrinivas Kandagatla 37125e8dfb8SSrinivas Kandagatla return st == 0 ? ed : st; 37225e8dfb8SSrinivas Kandagatla } 37325e8dfb8SSrinivas Kandagatla 37425e8dfb8SSrinivas Kandagatla static void fastrpc_get_buff_overlaps(struct fastrpc_invoke_ctx *ctx) 37525e8dfb8SSrinivas Kandagatla { 37625e8dfb8SSrinivas Kandagatla u64 max_end = 0; 37725e8dfb8SSrinivas Kandagatla int i; 37825e8dfb8SSrinivas Kandagatla 37925e8dfb8SSrinivas Kandagatla for (i = 0; i < ctx->nbufs; ++i) { 38025e8dfb8SSrinivas Kandagatla ctx->olaps[i].start = ctx->args[i].ptr; 38125e8dfb8SSrinivas Kandagatla ctx->olaps[i].end = ctx->olaps[i].start + ctx->args[i].length; 38225e8dfb8SSrinivas Kandagatla ctx->olaps[i].raix = i; 38325e8dfb8SSrinivas Kandagatla } 38425e8dfb8SSrinivas Kandagatla 38525e8dfb8SSrinivas Kandagatla sort(ctx->olaps, ctx->nbufs, sizeof(*ctx->olaps), olaps_cmp, NULL); 38625e8dfb8SSrinivas Kandagatla 38725e8dfb8SSrinivas Kandagatla for (i = 0; i < ctx->nbufs; ++i) { 38825e8dfb8SSrinivas Kandagatla /* Falling inside previous range */ 38925e8dfb8SSrinivas Kandagatla if (ctx->olaps[i].start < max_end) { 39025e8dfb8SSrinivas Kandagatla ctx->olaps[i].mstart = max_end; 39125e8dfb8SSrinivas Kandagatla ctx->olaps[i].mend = ctx->olaps[i].end; 39225e8dfb8SSrinivas Kandagatla ctx->olaps[i].offset = max_end - ctx->olaps[i].start; 39325e8dfb8SSrinivas Kandagatla 39425e8dfb8SSrinivas Kandagatla if (ctx->olaps[i].end > max_end) { 39525e8dfb8SSrinivas Kandagatla max_end = ctx->olaps[i].end; 39625e8dfb8SSrinivas Kandagatla } else { 39725e8dfb8SSrinivas Kandagatla ctx->olaps[i].mend = 0; 39825e8dfb8SSrinivas Kandagatla ctx->olaps[i].mstart = 0; 39925e8dfb8SSrinivas Kandagatla } 40025e8dfb8SSrinivas Kandagatla 40125e8dfb8SSrinivas Kandagatla } else { 40225e8dfb8SSrinivas Kandagatla ctx->olaps[i].mend = ctx->olaps[i].end; 40325e8dfb8SSrinivas Kandagatla ctx->olaps[i].mstart = ctx->olaps[i].start; 40425e8dfb8SSrinivas Kandagatla ctx->olaps[i].offset = 0; 40525e8dfb8SSrinivas Kandagatla max_end = ctx->olaps[i].end; 40625e8dfb8SSrinivas Kandagatla } 40725e8dfb8SSrinivas Kandagatla } 40825e8dfb8SSrinivas Kandagatla } 40925e8dfb8SSrinivas Kandagatla 410c68cfb71SSrinivas Kandagatla static struct fastrpc_invoke_ctx *fastrpc_context_alloc( 411c68cfb71SSrinivas Kandagatla struct fastrpc_user *user, u32 kernel, u32 sc, 412c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_args *args) 413c68cfb71SSrinivas Kandagatla { 414c68cfb71SSrinivas Kandagatla struct fastrpc_channel_ctx *cctx = user->cctx; 415c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_ctx *ctx = NULL; 416977e6c8dSSrinivas Kandagatla unsigned long flags; 417c68cfb71SSrinivas Kandagatla int ret; 418c68cfb71SSrinivas Kandagatla 419c68cfb71SSrinivas Kandagatla ctx = kzalloc(sizeof(*ctx), GFP_KERNEL); 420c68cfb71SSrinivas Kandagatla if (!ctx) 421c68cfb71SSrinivas Kandagatla return ERR_PTR(-ENOMEM); 422c68cfb71SSrinivas Kandagatla 423c68cfb71SSrinivas Kandagatla INIT_LIST_HEAD(&ctx->node); 424c68cfb71SSrinivas Kandagatla ctx->fl = user; 425c68cfb71SSrinivas Kandagatla ctx->nscalars = REMOTE_SCALARS_LENGTH(sc); 426c68cfb71SSrinivas Kandagatla ctx->nbufs = REMOTE_SCALARS_INBUFS(sc) + 427c68cfb71SSrinivas Kandagatla REMOTE_SCALARS_OUTBUFS(sc); 428c68cfb71SSrinivas Kandagatla 429c68cfb71SSrinivas Kandagatla if (ctx->nscalars) { 430c68cfb71SSrinivas Kandagatla ctx->maps = kcalloc(ctx->nscalars, 431c68cfb71SSrinivas Kandagatla sizeof(*ctx->maps), GFP_KERNEL); 432c68cfb71SSrinivas Kandagatla if (!ctx->maps) { 433c68cfb71SSrinivas Kandagatla kfree(ctx); 434c68cfb71SSrinivas Kandagatla return ERR_PTR(-ENOMEM); 435c68cfb71SSrinivas Kandagatla } 43625e8dfb8SSrinivas Kandagatla ctx->olaps = kcalloc(ctx->nscalars, 43725e8dfb8SSrinivas Kandagatla sizeof(*ctx->olaps), GFP_KERNEL); 43825e8dfb8SSrinivas Kandagatla if (!ctx->olaps) { 43925e8dfb8SSrinivas Kandagatla kfree(ctx->maps); 44025e8dfb8SSrinivas Kandagatla kfree(ctx); 44125e8dfb8SSrinivas Kandagatla return ERR_PTR(-ENOMEM); 44225e8dfb8SSrinivas Kandagatla } 443c68cfb71SSrinivas Kandagatla ctx->args = args; 44425e8dfb8SSrinivas Kandagatla fastrpc_get_buff_overlaps(ctx); 445c68cfb71SSrinivas Kandagatla } 446c68cfb71SSrinivas Kandagatla 447*278d56f9SBjorn Andersson /* Released in fastrpc_context_put() */ 448*278d56f9SBjorn Andersson fastrpc_channel_ctx_get(cctx); 449*278d56f9SBjorn Andersson 450c68cfb71SSrinivas Kandagatla ctx->sc = sc; 451c68cfb71SSrinivas Kandagatla ctx->retval = -1; 452c68cfb71SSrinivas Kandagatla ctx->pid = current->pid; 453c68cfb71SSrinivas Kandagatla ctx->tgid = user->tgid; 454c68cfb71SSrinivas Kandagatla ctx->cctx = cctx; 455c68cfb71SSrinivas Kandagatla init_completion(&ctx->work); 4568e7389c7SThierry Escande INIT_WORK(&ctx->put_work, fastrpc_context_put_wq); 457c68cfb71SSrinivas Kandagatla 458c68cfb71SSrinivas Kandagatla spin_lock(&user->lock); 459c68cfb71SSrinivas Kandagatla list_add_tail(&ctx->node, &user->pending); 460c68cfb71SSrinivas Kandagatla spin_unlock(&user->lock); 461c68cfb71SSrinivas Kandagatla 462977e6c8dSSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 463c68cfb71SSrinivas Kandagatla ret = idr_alloc_cyclic(&cctx->ctx_idr, ctx, 1, 464c68cfb71SSrinivas Kandagatla FASTRPC_CTX_MAX, GFP_ATOMIC); 465c68cfb71SSrinivas Kandagatla if (ret < 0) { 466977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 467c68cfb71SSrinivas Kandagatla goto err_idr; 468c68cfb71SSrinivas Kandagatla } 469c68cfb71SSrinivas Kandagatla ctx->ctxid = ret << 4; 470977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 471c68cfb71SSrinivas Kandagatla 472c68cfb71SSrinivas Kandagatla kref_init(&ctx->refcount); 473c68cfb71SSrinivas Kandagatla 474c68cfb71SSrinivas Kandagatla return ctx; 475c68cfb71SSrinivas Kandagatla err_idr: 476c68cfb71SSrinivas Kandagatla spin_lock(&user->lock); 477c68cfb71SSrinivas Kandagatla list_del(&ctx->node); 478c68cfb71SSrinivas Kandagatla spin_unlock(&user->lock); 479*278d56f9SBjorn Andersson fastrpc_channel_ctx_put(cctx); 480c68cfb71SSrinivas Kandagatla kfree(ctx->maps); 48125e8dfb8SSrinivas Kandagatla kfree(ctx->olaps); 482c68cfb71SSrinivas Kandagatla kfree(ctx); 483c68cfb71SSrinivas Kandagatla 484c68cfb71SSrinivas Kandagatla return ERR_PTR(ret); 485c68cfb71SSrinivas Kandagatla } 486c68cfb71SSrinivas Kandagatla 4876cffd795SSrinivas Kandagatla static struct sg_table * 4886cffd795SSrinivas Kandagatla fastrpc_map_dma_buf(struct dma_buf_attachment *attachment, 4896cffd795SSrinivas Kandagatla enum dma_data_direction dir) 4906cffd795SSrinivas Kandagatla { 4916cffd795SSrinivas Kandagatla struct fastrpc_dma_buf_attachment *a = attachment->priv; 4926cffd795SSrinivas Kandagatla struct sg_table *table; 4936cffd795SSrinivas Kandagatla 4946cffd795SSrinivas Kandagatla table = &a->sgt; 4956cffd795SSrinivas Kandagatla 4966cffd795SSrinivas Kandagatla if (!dma_map_sg(attachment->dev, table->sgl, table->nents, dir)) 4976cffd795SSrinivas Kandagatla return ERR_PTR(-ENOMEM); 4986cffd795SSrinivas Kandagatla 4996cffd795SSrinivas Kandagatla return table; 5006cffd795SSrinivas Kandagatla } 5016cffd795SSrinivas Kandagatla 5026cffd795SSrinivas Kandagatla static void fastrpc_unmap_dma_buf(struct dma_buf_attachment *attach, 5036cffd795SSrinivas Kandagatla struct sg_table *table, 5046cffd795SSrinivas Kandagatla enum dma_data_direction dir) 5056cffd795SSrinivas Kandagatla { 5066cffd795SSrinivas Kandagatla dma_unmap_sg(attach->dev, table->sgl, table->nents, dir); 5076cffd795SSrinivas Kandagatla } 5086cffd795SSrinivas Kandagatla 5096cffd795SSrinivas Kandagatla static void fastrpc_release(struct dma_buf *dmabuf) 5106cffd795SSrinivas Kandagatla { 5116cffd795SSrinivas Kandagatla struct fastrpc_buf *buffer = dmabuf->priv; 5126cffd795SSrinivas Kandagatla 5136cffd795SSrinivas Kandagatla fastrpc_buf_free(buffer); 5146cffd795SSrinivas Kandagatla } 5156cffd795SSrinivas Kandagatla 5166cffd795SSrinivas Kandagatla static int fastrpc_dma_buf_attach(struct dma_buf *dmabuf, 5176cffd795SSrinivas Kandagatla struct dma_buf_attachment *attachment) 5186cffd795SSrinivas Kandagatla { 5196cffd795SSrinivas Kandagatla struct fastrpc_dma_buf_attachment *a; 5206cffd795SSrinivas Kandagatla struct fastrpc_buf *buffer = dmabuf->priv; 5216cffd795SSrinivas Kandagatla int ret; 5226cffd795SSrinivas Kandagatla 5236cffd795SSrinivas Kandagatla a = kzalloc(sizeof(*a), GFP_KERNEL); 5246cffd795SSrinivas Kandagatla if (!a) 5256cffd795SSrinivas Kandagatla return -ENOMEM; 5266cffd795SSrinivas Kandagatla 5276cffd795SSrinivas Kandagatla ret = dma_get_sgtable(buffer->dev, &a->sgt, buffer->virt, 5286cffd795SSrinivas Kandagatla FASTRPC_PHYS(buffer->phys), buffer->size); 5296cffd795SSrinivas Kandagatla if (ret < 0) { 5306cffd795SSrinivas Kandagatla dev_err(buffer->dev, "failed to get scatterlist from DMA API\n"); 5316cffd795SSrinivas Kandagatla return -EINVAL; 5326cffd795SSrinivas Kandagatla } 5336cffd795SSrinivas Kandagatla 5346cffd795SSrinivas Kandagatla a->dev = attachment->dev; 5356cffd795SSrinivas Kandagatla INIT_LIST_HEAD(&a->node); 5366cffd795SSrinivas Kandagatla attachment->priv = a; 5376cffd795SSrinivas Kandagatla 5386cffd795SSrinivas Kandagatla mutex_lock(&buffer->lock); 5396cffd795SSrinivas Kandagatla list_add(&a->node, &buffer->attachments); 5406cffd795SSrinivas Kandagatla mutex_unlock(&buffer->lock); 5416cffd795SSrinivas Kandagatla 5426cffd795SSrinivas Kandagatla return 0; 5436cffd795SSrinivas Kandagatla } 5446cffd795SSrinivas Kandagatla 5456cffd795SSrinivas Kandagatla static void fastrpc_dma_buf_detatch(struct dma_buf *dmabuf, 5466cffd795SSrinivas Kandagatla struct dma_buf_attachment *attachment) 5476cffd795SSrinivas Kandagatla { 5486cffd795SSrinivas Kandagatla struct fastrpc_dma_buf_attachment *a = attachment->priv; 5496cffd795SSrinivas Kandagatla struct fastrpc_buf *buffer = dmabuf->priv; 5506cffd795SSrinivas Kandagatla 5516cffd795SSrinivas Kandagatla mutex_lock(&buffer->lock); 5526cffd795SSrinivas Kandagatla list_del(&a->node); 5536cffd795SSrinivas Kandagatla mutex_unlock(&buffer->lock); 5546cffd795SSrinivas Kandagatla kfree(a); 5556cffd795SSrinivas Kandagatla } 5566cffd795SSrinivas Kandagatla 5576cffd795SSrinivas Kandagatla static void *fastrpc_kmap(struct dma_buf *dmabuf, unsigned long pgnum) 5586cffd795SSrinivas Kandagatla { 5596cffd795SSrinivas Kandagatla struct fastrpc_buf *buf = dmabuf->priv; 5606cffd795SSrinivas Kandagatla 5616cffd795SSrinivas Kandagatla return buf->virt ? buf->virt + pgnum * PAGE_SIZE : NULL; 5626cffd795SSrinivas Kandagatla } 5636cffd795SSrinivas Kandagatla 5646cffd795SSrinivas Kandagatla static void *fastrpc_vmap(struct dma_buf *dmabuf) 5656cffd795SSrinivas Kandagatla { 5666cffd795SSrinivas Kandagatla struct fastrpc_buf *buf = dmabuf->priv; 5676cffd795SSrinivas Kandagatla 5686cffd795SSrinivas Kandagatla return buf->virt; 5696cffd795SSrinivas Kandagatla } 5706cffd795SSrinivas Kandagatla 5716cffd795SSrinivas Kandagatla static int fastrpc_mmap(struct dma_buf *dmabuf, 5726cffd795SSrinivas Kandagatla struct vm_area_struct *vma) 5736cffd795SSrinivas Kandagatla { 5746cffd795SSrinivas Kandagatla struct fastrpc_buf *buf = dmabuf->priv; 5756cffd795SSrinivas Kandagatla size_t size = vma->vm_end - vma->vm_start; 5766cffd795SSrinivas Kandagatla 5776cffd795SSrinivas Kandagatla return dma_mmap_coherent(buf->dev, vma, buf->virt, 5786cffd795SSrinivas Kandagatla FASTRPC_PHYS(buf->phys), size); 5796cffd795SSrinivas Kandagatla } 5806cffd795SSrinivas Kandagatla 5816cffd795SSrinivas Kandagatla static const struct dma_buf_ops fastrpc_dma_buf_ops = { 5826cffd795SSrinivas Kandagatla .attach = fastrpc_dma_buf_attach, 5836cffd795SSrinivas Kandagatla .detach = fastrpc_dma_buf_detatch, 5846cffd795SSrinivas Kandagatla .map_dma_buf = fastrpc_map_dma_buf, 5856cffd795SSrinivas Kandagatla .unmap_dma_buf = fastrpc_unmap_dma_buf, 5866cffd795SSrinivas Kandagatla .mmap = fastrpc_mmap, 5876cffd795SSrinivas Kandagatla .map = fastrpc_kmap, 5886cffd795SSrinivas Kandagatla .vmap = fastrpc_vmap, 5896cffd795SSrinivas Kandagatla .release = fastrpc_release, 5906cffd795SSrinivas Kandagatla }; 5916cffd795SSrinivas Kandagatla 592c68cfb71SSrinivas Kandagatla static int fastrpc_map_create(struct fastrpc_user *fl, int fd, 593c68cfb71SSrinivas Kandagatla u64 len, struct fastrpc_map **ppmap) 594c68cfb71SSrinivas Kandagatla { 595c68cfb71SSrinivas Kandagatla struct fastrpc_session_ctx *sess = fl->sctx; 596c68cfb71SSrinivas Kandagatla struct fastrpc_map *map = NULL; 597c68cfb71SSrinivas Kandagatla int err = 0; 598c68cfb71SSrinivas Kandagatla 599c68cfb71SSrinivas Kandagatla if (!fastrpc_map_find(fl, fd, ppmap)) 600c68cfb71SSrinivas Kandagatla return 0; 601c68cfb71SSrinivas Kandagatla 602c68cfb71SSrinivas Kandagatla map = kzalloc(sizeof(*map), GFP_KERNEL); 603c68cfb71SSrinivas Kandagatla if (!map) 604c68cfb71SSrinivas Kandagatla return -ENOMEM; 605c68cfb71SSrinivas Kandagatla 606c68cfb71SSrinivas Kandagatla INIT_LIST_HEAD(&map->node); 607c68cfb71SSrinivas Kandagatla map->fl = fl; 608c68cfb71SSrinivas Kandagatla map->fd = fd; 609c68cfb71SSrinivas Kandagatla map->buf = dma_buf_get(fd); 610682a6044SWei Yongjun if (IS_ERR(map->buf)) { 611682a6044SWei Yongjun err = PTR_ERR(map->buf); 612c68cfb71SSrinivas Kandagatla goto get_err; 613c68cfb71SSrinivas Kandagatla } 614c68cfb71SSrinivas Kandagatla 615c68cfb71SSrinivas Kandagatla map->attach = dma_buf_attach(map->buf, sess->dev); 616c68cfb71SSrinivas Kandagatla if (IS_ERR(map->attach)) { 617c68cfb71SSrinivas Kandagatla dev_err(sess->dev, "Failed to attach dmabuf\n"); 618c68cfb71SSrinivas Kandagatla err = PTR_ERR(map->attach); 619c68cfb71SSrinivas Kandagatla goto attach_err; 620c68cfb71SSrinivas Kandagatla } 621c68cfb71SSrinivas Kandagatla 622c68cfb71SSrinivas Kandagatla map->table = dma_buf_map_attachment(map->attach, DMA_BIDIRECTIONAL); 623c68cfb71SSrinivas Kandagatla if (IS_ERR(map->table)) { 624c68cfb71SSrinivas Kandagatla err = PTR_ERR(map->table); 625c68cfb71SSrinivas Kandagatla goto map_err; 626c68cfb71SSrinivas Kandagatla } 627c68cfb71SSrinivas Kandagatla 628c68cfb71SSrinivas Kandagatla map->phys = sg_dma_address(map->table->sgl); 629c68cfb71SSrinivas Kandagatla map->phys += ((u64)fl->sctx->sid << 32); 630c68cfb71SSrinivas Kandagatla map->size = len; 631c68cfb71SSrinivas Kandagatla map->va = sg_virt(map->table->sgl); 632c68cfb71SSrinivas Kandagatla map->len = len; 633c68cfb71SSrinivas Kandagatla kref_init(&map->refcount); 634c68cfb71SSrinivas Kandagatla 635c68cfb71SSrinivas Kandagatla spin_lock(&fl->lock); 636c68cfb71SSrinivas Kandagatla list_add_tail(&map->node, &fl->maps); 637c68cfb71SSrinivas Kandagatla spin_unlock(&fl->lock); 638c68cfb71SSrinivas Kandagatla *ppmap = map; 639c68cfb71SSrinivas Kandagatla 640c68cfb71SSrinivas Kandagatla return 0; 641c68cfb71SSrinivas Kandagatla 642c68cfb71SSrinivas Kandagatla map_err: 643c68cfb71SSrinivas Kandagatla dma_buf_detach(map->buf, map->attach); 644c68cfb71SSrinivas Kandagatla attach_err: 645c68cfb71SSrinivas Kandagatla dma_buf_put(map->buf); 646c68cfb71SSrinivas Kandagatla get_err: 647c68cfb71SSrinivas Kandagatla kfree(map); 648c68cfb71SSrinivas Kandagatla 649c68cfb71SSrinivas Kandagatla return err; 650c68cfb71SSrinivas Kandagatla } 651c68cfb71SSrinivas Kandagatla 652c68cfb71SSrinivas Kandagatla /* 653c68cfb71SSrinivas Kandagatla * Fastrpc payload buffer with metadata looks like: 654c68cfb71SSrinivas Kandagatla * 655c68cfb71SSrinivas Kandagatla * >>>>>> START of METADATA <<<<<<<<< 656c68cfb71SSrinivas Kandagatla * +---------------------------------+ 657c68cfb71SSrinivas Kandagatla * | Arguments | 658c68cfb71SSrinivas Kandagatla * | type:(struct fastrpc_remote_arg)| 659c68cfb71SSrinivas Kandagatla * | (0 - N) | 660c68cfb71SSrinivas Kandagatla * +---------------------------------+ 661c68cfb71SSrinivas Kandagatla * | Invoke Buffer list | 662c68cfb71SSrinivas Kandagatla * | type:(struct fastrpc_invoke_buf)| 663c68cfb71SSrinivas Kandagatla * | (0 - N) | 664c68cfb71SSrinivas Kandagatla * +---------------------------------+ 665c68cfb71SSrinivas Kandagatla * | Page info list | 666c68cfb71SSrinivas Kandagatla * | type:(struct fastrpc_phy_page) | 667c68cfb71SSrinivas Kandagatla * | (0 - N) | 668c68cfb71SSrinivas Kandagatla * +---------------------------------+ 669c68cfb71SSrinivas Kandagatla * | Optional info | 670c68cfb71SSrinivas Kandagatla * |(can be specific to SoC/Firmware)| 671c68cfb71SSrinivas Kandagatla * +---------------------------------+ 672c68cfb71SSrinivas Kandagatla * >>>>>>>> END of METADATA <<<<<<<<< 673c68cfb71SSrinivas Kandagatla * +---------------------------------+ 674c68cfb71SSrinivas Kandagatla * | Inline ARGS | 675c68cfb71SSrinivas Kandagatla * | (0-N) | 676c68cfb71SSrinivas Kandagatla * +---------------------------------+ 677c68cfb71SSrinivas Kandagatla */ 678c68cfb71SSrinivas Kandagatla 679c68cfb71SSrinivas Kandagatla static int fastrpc_get_meta_size(struct fastrpc_invoke_ctx *ctx) 680c68cfb71SSrinivas Kandagatla { 681c68cfb71SSrinivas Kandagatla int size = 0; 682c68cfb71SSrinivas Kandagatla 683c68cfb71SSrinivas Kandagatla size = (sizeof(struct fastrpc_remote_arg) + 684c68cfb71SSrinivas Kandagatla sizeof(struct fastrpc_invoke_buf) + 685c68cfb71SSrinivas Kandagatla sizeof(struct fastrpc_phy_page)) * ctx->nscalars + 686c68cfb71SSrinivas Kandagatla sizeof(u64) * FASTRPC_MAX_FDLIST + 687c68cfb71SSrinivas Kandagatla sizeof(u32) * FASTRPC_MAX_CRCLIST; 688c68cfb71SSrinivas Kandagatla 689c68cfb71SSrinivas Kandagatla return size; 690c68cfb71SSrinivas Kandagatla } 691c68cfb71SSrinivas Kandagatla 692c68cfb71SSrinivas Kandagatla static u64 fastrpc_get_payload_size(struct fastrpc_invoke_ctx *ctx, int metalen) 693c68cfb71SSrinivas Kandagatla { 694c68cfb71SSrinivas Kandagatla u64 size = 0; 695c68cfb71SSrinivas Kandagatla int i; 696c68cfb71SSrinivas Kandagatla 697c68cfb71SSrinivas Kandagatla size = ALIGN(metalen, FASTRPC_ALIGN); 698c68cfb71SSrinivas Kandagatla for (i = 0; i < ctx->nscalars; i++) { 699c68cfb71SSrinivas Kandagatla if (ctx->args[i].fd == 0 || ctx->args[i].fd == -1) { 70025e8dfb8SSrinivas Kandagatla 70125e8dfb8SSrinivas Kandagatla if (ctx->olaps[i].offset == 0) 702c68cfb71SSrinivas Kandagatla size = ALIGN(size, FASTRPC_ALIGN); 70325e8dfb8SSrinivas Kandagatla 70425e8dfb8SSrinivas Kandagatla size += (ctx->olaps[i].mend - ctx->olaps[i].mstart); 705c68cfb71SSrinivas Kandagatla } 706c68cfb71SSrinivas Kandagatla } 707c68cfb71SSrinivas Kandagatla 708c68cfb71SSrinivas Kandagatla return size; 709c68cfb71SSrinivas Kandagatla } 710c68cfb71SSrinivas Kandagatla 711c68cfb71SSrinivas Kandagatla static int fastrpc_create_maps(struct fastrpc_invoke_ctx *ctx) 712c68cfb71SSrinivas Kandagatla { 713c68cfb71SSrinivas Kandagatla struct device *dev = ctx->fl->sctx->dev; 714c68cfb71SSrinivas Kandagatla int i, err; 715c68cfb71SSrinivas Kandagatla 716c68cfb71SSrinivas Kandagatla for (i = 0; i < ctx->nscalars; ++i) { 717c68cfb71SSrinivas Kandagatla /* Make sure reserved field is set to 0 */ 718c68cfb71SSrinivas Kandagatla if (ctx->args[i].reserved) 719c68cfb71SSrinivas Kandagatla return -EINVAL; 720c68cfb71SSrinivas Kandagatla 721c68cfb71SSrinivas Kandagatla if (ctx->args[i].fd == 0 || ctx->args[i].fd == -1 || 722c68cfb71SSrinivas Kandagatla ctx->args[i].length == 0) 723c68cfb71SSrinivas Kandagatla continue; 724c68cfb71SSrinivas Kandagatla 725c68cfb71SSrinivas Kandagatla err = fastrpc_map_create(ctx->fl, ctx->args[i].fd, 726c68cfb71SSrinivas Kandagatla ctx->args[i].length, &ctx->maps[i]); 727c68cfb71SSrinivas Kandagatla if (err) { 728c68cfb71SSrinivas Kandagatla dev_err(dev, "Error Creating map %d\n", err); 729c68cfb71SSrinivas Kandagatla return -EINVAL; 730c68cfb71SSrinivas Kandagatla } 731c68cfb71SSrinivas Kandagatla 732c68cfb71SSrinivas Kandagatla } 733c68cfb71SSrinivas Kandagatla return 0; 734c68cfb71SSrinivas Kandagatla } 735c68cfb71SSrinivas Kandagatla 736c68cfb71SSrinivas Kandagatla static int fastrpc_get_args(u32 kernel, struct fastrpc_invoke_ctx *ctx) 737c68cfb71SSrinivas Kandagatla { 738c68cfb71SSrinivas Kandagatla struct device *dev = ctx->fl->sctx->dev; 739c68cfb71SSrinivas Kandagatla struct fastrpc_remote_arg *rpra; 740c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_buf *list; 741c68cfb71SSrinivas Kandagatla struct fastrpc_phy_page *pages; 74225e8dfb8SSrinivas Kandagatla int inbufs, i, oix, err = 0; 74325e8dfb8SSrinivas Kandagatla u64 len, rlen, pkt_size; 74402b45b47SSrinivas Kandagatla u64 pg_start, pg_end; 745c68cfb71SSrinivas Kandagatla uintptr_t args; 746c68cfb71SSrinivas Kandagatla int metalen; 747c68cfb71SSrinivas Kandagatla 748c68cfb71SSrinivas Kandagatla inbufs = REMOTE_SCALARS_INBUFS(ctx->sc); 749c68cfb71SSrinivas Kandagatla metalen = fastrpc_get_meta_size(ctx); 750c68cfb71SSrinivas Kandagatla pkt_size = fastrpc_get_payload_size(ctx, metalen); 751c68cfb71SSrinivas Kandagatla 752c68cfb71SSrinivas Kandagatla err = fastrpc_create_maps(ctx); 753c68cfb71SSrinivas Kandagatla if (err) 754c68cfb71SSrinivas Kandagatla return err; 755c68cfb71SSrinivas Kandagatla 756c68cfb71SSrinivas Kandagatla ctx->msg_sz = pkt_size; 757c68cfb71SSrinivas Kandagatla 758c68cfb71SSrinivas Kandagatla err = fastrpc_buf_alloc(ctx->fl, dev, pkt_size, &ctx->buf); 759c68cfb71SSrinivas Kandagatla if (err) 760c68cfb71SSrinivas Kandagatla return err; 761c68cfb71SSrinivas Kandagatla 762c68cfb71SSrinivas Kandagatla rpra = ctx->buf->virt; 763c68cfb71SSrinivas Kandagatla list = ctx->buf->virt + ctx->nscalars * sizeof(*rpra); 764c68cfb71SSrinivas Kandagatla pages = ctx->buf->virt + ctx->nscalars * (sizeof(*list) + 765c68cfb71SSrinivas Kandagatla sizeof(*rpra)); 766c68cfb71SSrinivas Kandagatla args = (uintptr_t)ctx->buf->virt + metalen; 767c68cfb71SSrinivas Kandagatla rlen = pkt_size - metalen; 768c68cfb71SSrinivas Kandagatla ctx->rpra = rpra; 769c68cfb71SSrinivas Kandagatla 77025e8dfb8SSrinivas Kandagatla for (oix = 0; oix < ctx->nbufs; ++oix) { 77125e8dfb8SSrinivas Kandagatla int mlen; 77225e8dfb8SSrinivas Kandagatla 77325e8dfb8SSrinivas Kandagatla i = ctx->olaps[oix].raix; 77425e8dfb8SSrinivas Kandagatla len = ctx->args[i].length; 775c68cfb71SSrinivas Kandagatla 776c68cfb71SSrinivas Kandagatla rpra[i].pv = 0; 777c68cfb71SSrinivas Kandagatla rpra[i].len = len; 778c68cfb71SSrinivas Kandagatla list[i].num = len ? 1 : 0; 779c68cfb71SSrinivas Kandagatla list[i].pgidx = i; 780c68cfb71SSrinivas Kandagatla 781c68cfb71SSrinivas Kandagatla if (!len) 782c68cfb71SSrinivas Kandagatla continue; 783c68cfb71SSrinivas Kandagatla 784c68cfb71SSrinivas Kandagatla if (ctx->maps[i]) { 78580f3afd7SSrinivas Kandagatla struct vm_area_struct *vma = NULL; 78680f3afd7SSrinivas Kandagatla 787c68cfb71SSrinivas Kandagatla rpra[i].pv = (u64) ctx->args[i].ptr; 788c68cfb71SSrinivas Kandagatla pages[i].addr = ctx->maps[i]->phys; 78980f3afd7SSrinivas Kandagatla 79080f3afd7SSrinivas Kandagatla vma = find_vma(current->mm, ctx->args[i].ptr); 79180f3afd7SSrinivas Kandagatla if (vma) 79280f3afd7SSrinivas Kandagatla pages[i].addr += ctx->args[i].ptr - 79380f3afd7SSrinivas Kandagatla vma->vm_start; 79480f3afd7SSrinivas Kandagatla 79502b45b47SSrinivas Kandagatla pg_start = (ctx->args[i].ptr & PAGE_MASK) >> PAGE_SHIFT; 79602b45b47SSrinivas Kandagatla pg_end = ((ctx->args[i].ptr + len - 1) & PAGE_MASK) >> 79702b45b47SSrinivas Kandagatla PAGE_SHIFT; 79802b45b47SSrinivas Kandagatla pages[i].size = (pg_end - pg_start + 1) * PAGE_SIZE; 79902b45b47SSrinivas Kandagatla 800c68cfb71SSrinivas Kandagatla } else { 80125e8dfb8SSrinivas Kandagatla 80225e8dfb8SSrinivas Kandagatla if (ctx->olaps[oix].offset == 0) { 803c68cfb71SSrinivas Kandagatla rlen -= ALIGN(args, FASTRPC_ALIGN) - args; 804c68cfb71SSrinivas Kandagatla args = ALIGN(args, FASTRPC_ALIGN); 80525e8dfb8SSrinivas Kandagatla } 80625e8dfb8SSrinivas Kandagatla 80725e8dfb8SSrinivas Kandagatla mlen = ctx->olaps[oix].mend - ctx->olaps[oix].mstart; 80825e8dfb8SSrinivas Kandagatla 80925e8dfb8SSrinivas Kandagatla if (rlen < mlen) 810c68cfb71SSrinivas Kandagatla goto bail; 811c68cfb71SSrinivas Kandagatla 81225e8dfb8SSrinivas Kandagatla rpra[i].pv = args - ctx->olaps[oix].offset; 81325e8dfb8SSrinivas Kandagatla pages[i].addr = ctx->buf->phys - 81425e8dfb8SSrinivas Kandagatla ctx->olaps[oix].offset + 81525e8dfb8SSrinivas Kandagatla (pkt_size - rlen); 816c68cfb71SSrinivas Kandagatla pages[i].addr = pages[i].addr & PAGE_MASK; 81725e8dfb8SSrinivas Kandagatla 81802b45b47SSrinivas Kandagatla pg_start = (args & PAGE_MASK) >> PAGE_SHIFT; 81902b45b47SSrinivas Kandagatla pg_end = ((args + len - 1) & PAGE_MASK) >> PAGE_SHIFT; 82002b45b47SSrinivas Kandagatla pages[i].size = (pg_end - pg_start + 1) * PAGE_SIZE; 82125e8dfb8SSrinivas Kandagatla args = args + mlen; 82225e8dfb8SSrinivas Kandagatla rlen -= mlen; 823c68cfb71SSrinivas Kandagatla } 824c68cfb71SSrinivas Kandagatla 825c68cfb71SSrinivas Kandagatla if (i < inbufs && !ctx->maps[i]) { 826c68cfb71SSrinivas Kandagatla void *dst = (void *)(uintptr_t)rpra[i].pv; 827c68cfb71SSrinivas Kandagatla void *src = (void *)(uintptr_t)ctx->args[i].ptr; 828c68cfb71SSrinivas Kandagatla 829c68cfb71SSrinivas Kandagatla if (!kernel) { 830c68cfb71SSrinivas Kandagatla if (copy_from_user(dst, (void __user *)src, 831c68cfb71SSrinivas Kandagatla len)) { 832c68cfb71SSrinivas Kandagatla err = -EFAULT; 833c68cfb71SSrinivas Kandagatla goto bail; 834c68cfb71SSrinivas Kandagatla } 835c68cfb71SSrinivas Kandagatla } else { 836c68cfb71SSrinivas Kandagatla memcpy(dst, src, len); 837c68cfb71SSrinivas Kandagatla } 838c68cfb71SSrinivas Kandagatla } 839c68cfb71SSrinivas Kandagatla } 840c68cfb71SSrinivas Kandagatla 841c68cfb71SSrinivas Kandagatla for (i = ctx->nbufs; i < ctx->nscalars; ++i) { 842c68cfb71SSrinivas Kandagatla rpra[i].pv = (u64) ctx->args[i].ptr; 843c68cfb71SSrinivas Kandagatla rpra[i].len = ctx->args[i].length; 844c68cfb71SSrinivas Kandagatla list[i].num = ctx->args[i].length ? 1 : 0; 845c68cfb71SSrinivas Kandagatla list[i].pgidx = i; 846c68cfb71SSrinivas Kandagatla pages[i].addr = ctx->maps[i]->phys; 847c68cfb71SSrinivas Kandagatla pages[i].size = ctx->maps[i]->size; 848c68cfb71SSrinivas Kandagatla } 849c68cfb71SSrinivas Kandagatla 850c68cfb71SSrinivas Kandagatla bail: 851c68cfb71SSrinivas Kandagatla if (err) 852c68cfb71SSrinivas Kandagatla dev_err(dev, "Error: get invoke args failed:%d\n", err); 853c68cfb71SSrinivas Kandagatla 854c68cfb71SSrinivas Kandagatla return err; 855c68cfb71SSrinivas Kandagatla } 856c68cfb71SSrinivas Kandagatla 857c68cfb71SSrinivas Kandagatla static int fastrpc_put_args(struct fastrpc_invoke_ctx *ctx, 858c68cfb71SSrinivas Kandagatla u32 kernel) 859c68cfb71SSrinivas Kandagatla { 860c68cfb71SSrinivas Kandagatla struct fastrpc_remote_arg *rpra = ctx->rpra; 861c68cfb71SSrinivas Kandagatla int i, inbufs; 862c68cfb71SSrinivas Kandagatla 863c68cfb71SSrinivas Kandagatla inbufs = REMOTE_SCALARS_INBUFS(ctx->sc); 864c68cfb71SSrinivas Kandagatla 865c68cfb71SSrinivas Kandagatla for (i = inbufs; i < ctx->nbufs; ++i) { 866c68cfb71SSrinivas Kandagatla void *src = (void *)(uintptr_t)rpra[i].pv; 867c68cfb71SSrinivas Kandagatla void *dst = (void *)(uintptr_t)ctx->args[i].ptr; 868c68cfb71SSrinivas Kandagatla u64 len = rpra[i].len; 869c68cfb71SSrinivas Kandagatla 870c68cfb71SSrinivas Kandagatla if (!kernel) { 871c68cfb71SSrinivas Kandagatla if (copy_to_user((void __user *)dst, src, len)) 872c68cfb71SSrinivas Kandagatla return -EFAULT; 873c68cfb71SSrinivas Kandagatla } else { 874c68cfb71SSrinivas Kandagatla memcpy(dst, src, len); 875c68cfb71SSrinivas Kandagatla } 876c68cfb71SSrinivas Kandagatla } 877c68cfb71SSrinivas Kandagatla 878c68cfb71SSrinivas Kandagatla return 0; 879c68cfb71SSrinivas Kandagatla } 880c68cfb71SSrinivas Kandagatla 881c68cfb71SSrinivas Kandagatla static int fastrpc_invoke_send(struct fastrpc_session_ctx *sctx, 882c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_ctx *ctx, 883c68cfb71SSrinivas Kandagatla u32 kernel, uint32_t handle) 884c68cfb71SSrinivas Kandagatla { 885c68cfb71SSrinivas Kandagatla struct fastrpc_channel_ctx *cctx; 886c68cfb71SSrinivas Kandagatla struct fastrpc_user *fl = ctx->fl; 887c68cfb71SSrinivas Kandagatla struct fastrpc_msg *msg = &ctx->msg; 888c68cfb71SSrinivas Kandagatla 889c68cfb71SSrinivas Kandagatla cctx = fl->cctx; 890c68cfb71SSrinivas Kandagatla msg->pid = fl->tgid; 891c68cfb71SSrinivas Kandagatla msg->tid = current->pid; 892c68cfb71SSrinivas Kandagatla 893c68cfb71SSrinivas Kandagatla if (kernel) 894c68cfb71SSrinivas Kandagatla msg->pid = 0; 895c68cfb71SSrinivas Kandagatla 896c68cfb71SSrinivas Kandagatla msg->ctx = ctx->ctxid | fl->pd; 897c68cfb71SSrinivas Kandagatla msg->handle = handle; 898c68cfb71SSrinivas Kandagatla msg->sc = ctx->sc; 899c68cfb71SSrinivas Kandagatla msg->addr = ctx->buf ? ctx->buf->phys : 0; 900c68cfb71SSrinivas Kandagatla msg->size = roundup(ctx->msg_sz, PAGE_SIZE); 901c68cfb71SSrinivas Kandagatla fastrpc_context_get(ctx); 902c68cfb71SSrinivas Kandagatla 903c68cfb71SSrinivas Kandagatla return rpmsg_send(cctx->rpdev->ept, (void *)msg, sizeof(*msg)); 904c68cfb71SSrinivas Kandagatla } 905c68cfb71SSrinivas Kandagatla 906c68cfb71SSrinivas Kandagatla static int fastrpc_internal_invoke(struct fastrpc_user *fl, u32 kernel, 907c68cfb71SSrinivas Kandagatla u32 handle, u32 sc, 908c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_args *args) 909c68cfb71SSrinivas Kandagatla { 910c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_ctx *ctx = NULL; 911c68cfb71SSrinivas Kandagatla int err = 0; 912c68cfb71SSrinivas Kandagatla 913c68cfb71SSrinivas Kandagatla if (!fl->sctx) 914c68cfb71SSrinivas Kandagatla return -EINVAL; 915c68cfb71SSrinivas Kandagatla 916c68cfb71SSrinivas Kandagatla ctx = fastrpc_context_alloc(fl, kernel, sc, args); 917c68cfb71SSrinivas Kandagatla if (IS_ERR(ctx)) 918c68cfb71SSrinivas Kandagatla return PTR_ERR(ctx); 919c68cfb71SSrinivas Kandagatla 920c68cfb71SSrinivas Kandagatla if (ctx->nscalars) { 921c68cfb71SSrinivas Kandagatla err = fastrpc_get_args(kernel, ctx); 922c68cfb71SSrinivas Kandagatla if (err) 923c68cfb71SSrinivas Kandagatla goto bail; 924c68cfb71SSrinivas Kandagatla } 925415a0729SSrinivas Kandagatla 926415a0729SSrinivas Kandagatla /* make sure that all CPU memory writes are seen by DSP */ 927415a0729SSrinivas Kandagatla dma_wmb(); 928c68cfb71SSrinivas Kandagatla /* Send invoke buffer to remote dsp */ 929c68cfb71SSrinivas Kandagatla err = fastrpc_invoke_send(fl->sctx, ctx, kernel, handle); 930c68cfb71SSrinivas Kandagatla if (err) 931c68cfb71SSrinivas Kandagatla goto bail; 932c68cfb71SSrinivas Kandagatla 933c68cfb71SSrinivas Kandagatla /* Wait for remote dsp to respond or time out */ 934c68cfb71SSrinivas Kandagatla err = wait_for_completion_interruptible(&ctx->work); 935c68cfb71SSrinivas Kandagatla if (err) 936c68cfb71SSrinivas Kandagatla goto bail; 937c68cfb71SSrinivas Kandagatla 938c68cfb71SSrinivas Kandagatla /* Check the response from remote dsp */ 939c68cfb71SSrinivas Kandagatla err = ctx->retval; 940c68cfb71SSrinivas Kandagatla if (err) 941c68cfb71SSrinivas Kandagatla goto bail; 942c68cfb71SSrinivas Kandagatla 943c68cfb71SSrinivas Kandagatla if (ctx->nscalars) { 944415a0729SSrinivas Kandagatla /* make sure that all memory writes by DSP are seen by CPU */ 945415a0729SSrinivas Kandagatla dma_rmb(); 946c68cfb71SSrinivas Kandagatla /* populate all the output buffers with results */ 947c68cfb71SSrinivas Kandagatla err = fastrpc_put_args(ctx, kernel); 948c68cfb71SSrinivas Kandagatla if (err) 949c68cfb71SSrinivas Kandagatla goto bail; 950c68cfb71SSrinivas Kandagatla } 951c68cfb71SSrinivas Kandagatla 952c68cfb71SSrinivas Kandagatla bail: 953c68cfb71SSrinivas Kandagatla /* We are done with this compute context, remove it from pending list */ 954c68cfb71SSrinivas Kandagatla spin_lock(&fl->lock); 955c68cfb71SSrinivas Kandagatla list_del(&ctx->node); 956c68cfb71SSrinivas Kandagatla spin_unlock(&fl->lock); 957c68cfb71SSrinivas Kandagatla fastrpc_context_put(ctx); 958c68cfb71SSrinivas Kandagatla 959c68cfb71SSrinivas Kandagatla if (err) 960c68cfb71SSrinivas Kandagatla dev_dbg(fl->sctx->dev, "Error: Invoke Failed %d\n", err); 961c68cfb71SSrinivas Kandagatla 962c68cfb71SSrinivas Kandagatla return err; 963c68cfb71SSrinivas Kandagatla } 964c68cfb71SSrinivas Kandagatla 965d73f71c7SSrinivas Kandagatla static int fastrpc_init_create_process(struct fastrpc_user *fl, 966d73f71c7SSrinivas Kandagatla char __user *argp) 967d73f71c7SSrinivas Kandagatla { 968d73f71c7SSrinivas Kandagatla struct fastrpc_init_create init; 969d73f71c7SSrinivas Kandagatla struct fastrpc_invoke_args *args; 970d73f71c7SSrinivas Kandagatla struct fastrpc_phy_page pages[1]; 971d73f71c7SSrinivas Kandagatla struct fastrpc_map *map = NULL; 972d73f71c7SSrinivas Kandagatla struct fastrpc_buf *imem = NULL; 973d73f71c7SSrinivas Kandagatla int memlen; 974d73f71c7SSrinivas Kandagatla int err; 975d73f71c7SSrinivas Kandagatla struct { 976d73f71c7SSrinivas Kandagatla int pgid; 977d73f71c7SSrinivas Kandagatla u32 namelen; 978d73f71c7SSrinivas Kandagatla u32 filelen; 979d73f71c7SSrinivas Kandagatla u32 pageslen; 980d73f71c7SSrinivas Kandagatla u32 attrs; 981d73f71c7SSrinivas Kandagatla u32 siglen; 982d73f71c7SSrinivas Kandagatla } inbuf; 983d73f71c7SSrinivas Kandagatla u32 sc; 984d73f71c7SSrinivas Kandagatla 985d73f71c7SSrinivas Kandagatla args = kcalloc(FASTRPC_CREATE_PROCESS_NARGS, sizeof(*args), GFP_KERNEL); 986d73f71c7SSrinivas Kandagatla if (!args) 987d73f71c7SSrinivas Kandagatla return -ENOMEM; 988d73f71c7SSrinivas Kandagatla 989d73f71c7SSrinivas Kandagatla if (copy_from_user(&init, argp, sizeof(init))) { 990d73f71c7SSrinivas Kandagatla err = -EFAULT; 991b49f6d83SThierry Escande goto err; 992d73f71c7SSrinivas Kandagatla } 993d73f71c7SSrinivas Kandagatla 994d73f71c7SSrinivas Kandagatla if (init.filelen > INIT_FILELEN_MAX) { 995d73f71c7SSrinivas Kandagatla err = -EINVAL; 996b49f6d83SThierry Escande goto err; 997d73f71c7SSrinivas Kandagatla } 998d73f71c7SSrinivas Kandagatla 999d73f71c7SSrinivas Kandagatla inbuf.pgid = fl->tgid; 1000d73f71c7SSrinivas Kandagatla inbuf.namelen = strlen(current->comm) + 1; 1001d73f71c7SSrinivas Kandagatla inbuf.filelen = init.filelen; 1002d73f71c7SSrinivas Kandagatla inbuf.pageslen = 1; 1003d73f71c7SSrinivas Kandagatla inbuf.attrs = init.attrs; 1004d73f71c7SSrinivas Kandagatla inbuf.siglen = init.siglen; 1005d73f71c7SSrinivas Kandagatla fl->pd = 1; 1006d73f71c7SSrinivas Kandagatla 1007d73f71c7SSrinivas Kandagatla if (init.filelen && init.filefd) { 1008d73f71c7SSrinivas Kandagatla err = fastrpc_map_create(fl, init.filefd, init.filelen, &map); 1009d73f71c7SSrinivas Kandagatla if (err) 1010b49f6d83SThierry Escande goto err; 1011d73f71c7SSrinivas Kandagatla } 1012d73f71c7SSrinivas Kandagatla 1013d73f71c7SSrinivas Kandagatla memlen = ALIGN(max(INIT_FILELEN_MAX, (int)init.filelen * 4), 1014d73f71c7SSrinivas Kandagatla 1024 * 1024); 1015d73f71c7SSrinivas Kandagatla err = fastrpc_buf_alloc(fl, fl->sctx->dev, memlen, 1016d73f71c7SSrinivas Kandagatla &imem); 1017b49f6d83SThierry Escande if (err) 1018b49f6d83SThierry Escande goto err_alloc; 1019d73f71c7SSrinivas Kandagatla 1020d73f71c7SSrinivas Kandagatla fl->init_mem = imem; 1021d73f71c7SSrinivas Kandagatla args[0].ptr = (u64)(uintptr_t)&inbuf; 1022d73f71c7SSrinivas Kandagatla args[0].length = sizeof(inbuf); 1023d73f71c7SSrinivas Kandagatla args[0].fd = -1; 1024d73f71c7SSrinivas Kandagatla 1025d73f71c7SSrinivas Kandagatla args[1].ptr = (u64)(uintptr_t)current->comm; 1026d73f71c7SSrinivas Kandagatla args[1].length = inbuf.namelen; 1027d73f71c7SSrinivas Kandagatla args[1].fd = -1; 1028d73f71c7SSrinivas Kandagatla 1029d73f71c7SSrinivas Kandagatla args[2].ptr = (u64) init.file; 1030d73f71c7SSrinivas Kandagatla args[2].length = inbuf.filelen; 1031d73f71c7SSrinivas Kandagatla args[2].fd = init.filefd; 1032d73f71c7SSrinivas Kandagatla 1033d73f71c7SSrinivas Kandagatla pages[0].addr = imem->phys; 1034d73f71c7SSrinivas Kandagatla pages[0].size = imem->size; 1035d73f71c7SSrinivas Kandagatla 1036d73f71c7SSrinivas Kandagatla args[3].ptr = (u64)(uintptr_t) pages; 1037d73f71c7SSrinivas Kandagatla args[3].length = 1 * sizeof(*pages); 1038d73f71c7SSrinivas Kandagatla args[3].fd = -1; 1039d73f71c7SSrinivas Kandagatla 1040d73f71c7SSrinivas Kandagatla args[4].ptr = (u64)(uintptr_t)&inbuf.attrs; 1041d73f71c7SSrinivas Kandagatla args[4].length = sizeof(inbuf.attrs); 1042d73f71c7SSrinivas Kandagatla args[4].fd = -1; 1043d73f71c7SSrinivas Kandagatla 1044d73f71c7SSrinivas Kandagatla args[5].ptr = (u64)(uintptr_t) &inbuf.siglen; 1045d73f71c7SSrinivas Kandagatla args[5].length = sizeof(inbuf.siglen); 1046d73f71c7SSrinivas Kandagatla args[5].fd = -1; 1047d73f71c7SSrinivas Kandagatla 1048d73f71c7SSrinivas Kandagatla sc = FASTRPC_SCALARS(FASTRPC_RMID_INIT_CREATE, 4, 0); 1049d73f71c7SSrinivas Kandagatla if (init.attrs) 1050d73f71c7SSrinivas Kandagatla sc = FASTRPC_SCALARS(FASTRPC_RMID_INIT_CREATE_ATTR, 6, 0); 1051d73f71c7SSrinivas Kandagatla 1052d73f71c7SSrinivas Kandagatla err = fastrpc_internal_invoke(fl, true, FASTRPC_INIT_HANDLE, 1053d73f71c7SSrinivas Kandagatla sc, args); 1054b49f6d83SThierry Escande if (err) 1055b49f6d83SThierry Escande goto err_invoke; 1056d73f71c7SSrinivas Kandagatla 1057b49f6d83SThierry Escande kfree(args); 1058b49f6d83SThierry Escande 1059b49f6d83SThierry Escande return 0; 1060b49f6d83SThierry Escande 1061b49f6d83SThierry Escande err_invoke: 1062b49f6d83SThierry Escande fl->init_mem = NULL; 1063d73f71c7SSrinivas Kandagatla fastrpc_buf_free(imem); 1064b49f6d83SThierry Escande err_alloc: 1065b49f6d83SThierry Escande if (map) { 1066b49f6d83SThierry Escande spin_lock(&fl->lock); 1067b49f6d83SThierry Escande list_del(&map->node); 1068b49f6d83SThierry Escande spin_unlock(&fl->lock); 1069b49f6d83SThierry Escande fastrpc_map_put(map); 1070d73f71c7SSrinivas Kandagatla } 1071b49f6d83SThierry Escande err: 1072d73f71c7SSrinivas Kandagatla kfree(args); 1073d73f71c7SSrinivas Kandagatla 1074d73f71c7SSrinivas Kandagatla return err; 1075d73f71c7SSrinivas Kandagatla } 1076d73f71c7SSrinivas Kandagatla 1077f6f9279fSSrinivas Kandagatla static struct fastrpc_session_ctx *fastrpc_session_alloc( 1078f6f9279fSSrinivas Kandagatla struct fastrpc_channel_ctx *cctx) 1079f6f9279fSSrinivas Kandagatla { 1080f6f9279fSSrinivas Kandagatla struct fastrpc_session_ctx *session = NULL; 1081977e6c8dSSrinivas Kandagatla unsigned long flags; 1082f6f9279fSSrinivas Kandagatla int i; 1083f6f9279fSSrinivas Kandagatla 1084977e6c8dSSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 1085f6f9279fSSrinivas Kandagatla for (i = 0; i < cctx->sesscount; i++) { 1086f6f9279fSSrinivas Kandagatla if (!cctx->session[i].used && cctx->session[i].valid) { 1087f6f9279fSSrinivas Kandagatla cctx->session[i].used = true; 1088f6f9279fSSrinivas Kandagatla session = &cctx->session[i]; 1089f6f9279fSSrinivas Kandagatla break; 1090f6f9279fSSrinivas Kandagatla } 1091f6f9279fSSrinivas Kandagatla } 1092977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 1093f6f9279fSSrinivas Kandagatla 1094f6f9279fSSrinivas Kandagatla return session; 1095f6f9279fSSrinivas Kandagatla } 1096f6f9279fSSrinivas Kandagatla 1097f6f9279fSSrinivas Kandagatla static void fastrpc_session_free(struct fastrpc_channel_ctx *cctx, 1098f6f9279fSSrinivas Kandagatla struct fastrpc_session_ctx *session) 1099f6f9279fSSrinivas Kandagatla { 1100977e6c8dSSrinivas Kandagatla unsigned long flags; 1101977e6c8dSSrinivas Kandagatla 1102977e6c8dSSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 1103f6f9279fSSrinivas Kandagatla session->used = false; 1104977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 1105f6f9279fSSrinivas Kandagatla } 1106f6f9279fSSrinivas Kandagatla 1107d73f71c7SSrinivas Kandagatla static int fastrpc_release_current_dsp_process(struct fastrpc_user *fl) 1108d73f71c7SSrinivas Kandagatla { 1109d73f71c7SSrinivas Kandagatla struct fastrpc_invoke_args args[1]; 1110d73f71c7SSrinivas Kandagatla int tgid = 0; 1111d73f71c7SSrinivas Kandagatla u32 sc; 1112d73f71c7SSrinivas Kandagatla 1113d73f71c7SSrinivas Kandagatla tgid = fl->tgid; 1114d73f71c7SSrinivas Kandagatla args[0].ptr = (u64)(uintptr_t) &tgid; 1115d73f71c7SSrinivas Kandagatla args[0].length = sizeof(tgid); 1116d73f71c7SSrinivas Kandagatla args[0].fd = -1; 1117d73f71c7SSrinivas Kandagatla args[0].reserved = 0; 1118d73f71c7SSrinivas Kandagatla sc = FASTRPC_SCALARS(FASTRPC_RMID_INIT_RELEASE, 1, 0); 1119d73f71c7SSrinivas Kandagatla 1120d73f71c7SSrinivas Kandagatla return fastrpc_internal_invoke(fl, true, FASTRPC_INIT_HANDLE, 1121d73f71c7SSrinivas Kandagatla sc, &args[0]); 1122d73f71c7SSrinivas Kandagatla } 1123d73f71c7SSrinivas Kandagatla 1124f6f9279fSSrinivas Kandagatla static int fastrpc_device_release(struct inode *inode, struct file *file) 1125f6f9279fSSrinivas Kandagatla { 1126f6f9279fSSrinivas Kandagatla struct fastrpc_user *fl = (struct fastrpc_user *)file->private_data; 1127f6f9279fSSrinivas Kandagatla struct fastrpc_channel_ctx *cctx = fl->cctx; 1128c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_ctx *ctx, *n; 1129c68cfb71SSrinivas Kandagatla struct fastrpc_map *map, *m; 1130977e6c8dSSrinivas Kandagatla unsigned long flags; 1131f6f9279fSSrinivas Kandagatla 1132d73f71c7SSrinivas Kandagatla fastrpc_release_current_dsp_process(fl); 1133d73f71c7SSrinivas Kandagatla 1134977e6c8dSSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 1135f6f9279fSSrinivas Kandagatla list_del(&fl->user); 1136977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 1137f6f9279fSSrinivas Kandagatla 1138c68cfb71SSrinivas Kandagatla if (fl->init_mem) 1139c68cfb71SSrinivas Kandagatla fastrpc_buf_free(fl->init_mem); 1140c68cfb71SSrinivas Kandagatla 1141c68cfb71SSrinivas Kandagatla list_for_each_entry_safe(ctx, n, &fl->pending, node) { 1142c68cfb71SSrinivas Kandagatla list_del(&ctx->node); 1143c68cfb71SSrinivas Kandagatla fastrpc_context_put(ctx); 1144c68cfb71SSrinivas Kandagatla } 1145c68cfb71SSrinivas Kandagatla 1146c68cfb71SSrinivas Kandagatla list_for_each_entry_safe(map, m, &fl->maps, node) { 1147c68cfb71SSrinivas Kandagatla list_del(&map->node); 1148c68cfb71SSrinivas Kandagatla fastrpc_map_put(map); 1149c68cfb71SSrinivas Kandagatla } 1150c68cfb71SSrinivas Kandagatla 1151f6f9279fSSrinivas Kandagatla fastrpc_session_free(cctx, fl->sctx); 1152*278d56f9SBjorn Andersson fastrpc_channel_ctx_put(cctx); 1153f6f9279fSSrinivas Kandagatla 1154f6f9279fSSrinivas Kandagatla mutex_destroy(&fl->mutex); 1155f6f9279fSSrinivas Kandagatla kfree(fl); 1156f6f9279fSSrinivas Kandagatla file->private_data = NULL; 1157f6f9279fSSrinivas Kandagatla 1158f6f9279fSSrinivas Kandagatla return 0; 1159f6f9279fSSrinivas Kandagatla } 1160f6f9279fSSrinivas Kandagatla 1161f6f9279fSSrinivas Kandagatla static int fastrpc_device_open(struct inode *inode, struct file *filp) 1162f6f9279fSSrinivas Kandagatla { 1163f6f9279fSSrinivas Kandagatla struct fastrpc_channel_ctx *cctx = miscdev_to_cctx(filp->private_data); 1164f6f9279fSSrinivas Kandagatla struct fastrpc_user *fl = NULL; 1165977e6c8dSSrinivas Kandagatla unsigned long flags; 1166f6f9279fSSrinivas Kandagatla 1167f6f9279fSSrinivas Kandagatla fl = kzalloc(sizeof(*fl), GFP_KERNEL); 1168f6f9279fSSrinivas Kandagatla if (!fl) 1169f6f9279fSSrinivas Kandagatla return -ENOMEM; 1170f6f9279fSSrinivas Kandagatla 1171*278d56f9SBjorn Andersson /* Released in fastrpc_device_release() */ 1172*278d56f9SBjorn Andersson fastrpc_channel_ctx_get(cctx); 1173*278d56f9SBjorn Andersson 1174f6f9279fSSrinivas Kandagatla filp->private_data = fl; 1175f6f9279fSSrinivas Kandagatla spin_lock_init(&fl->lock); 1176f6f9279fSSrinivas Kandagatla mutex_init(&fl->mutex); 1177f6f9279fSSrinivas Kandagatla INIT_LIST_HEAD(&fl->pending); 1178f6f9279fSSrinivas Kandagatla INIT_LIST_HEAD(&fl->maps); 1179f6f9279fSSrinivas Kandagatla INIT_LIST_HEAD(&fl->user); 1180f6f9279fSSrinivas Kandagatla fl->tgid = current->tgid; 1181f6f9279fSSrinivas Kandagatla fl->cctx = cctx; 11827c11df42SThierry Escande 11837c11df42SThierry Escande fl->sctx = fastrpc_session_alloc(cctx); 11847c11df42SThierry Escande if (!fl->sctx) { 11857c11df42SThierry Escande dev_err(&cctx->rpdev->dev, "No session available\n"); 11867c11df42SThierry Escande mutex_destroy(&fl->mutex); 11877c11df42SThierry Escande kfree(fl); 11887c11df42SThierry Escande 11897c11df42SThierry Escande return -EBUSY; 11907c11df42SThierry Escande } 11917c11df42SThierry Escande 1192977e6c8dSSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 1193f6f9279fSSrinivas Kandagatla list_add_tail(&fl->user, &cctx->users); 1194977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 1195f6f9279fSSrinivas Kandagatla 1196f6f9279fSSrinivas Kandagatla return 0; 1197f6f9279fSSrinivas Kandagatla } 1198f6f9279fSSrinivas Kandagatla 11996cffd795SSrinivas Kandagatla static int fastrpc_dmabuf_free(struct fastrpc_user *fl, char __user *argp) 12006cffd795SSrinivas Kandagatla { 12016cffd795SSrinivas Kandagatla struct dma_buf *buf; 12026cffd795SSrinivas Kandagatla int info; 12036cffd795SSrinivas Kandagatla 12046cffd795SSrinivas Kandagatla if (copy_from_user(&info, argp, sizeof(info))) 12056cffd795SSrinivas Kandagatla return -EFAULT; 12066cffd795SSrinivas Kandagatla 12076cffd795SSrinivas Kandagatla buf = dma_buf_get(info); 12086cffd795SSrinivas Kandagatla if (IS_ERR_OR_NULL(buf)) 12096cffd795SSrinivas Kandagatla return -EINVAL; 12106cffd795SSrinivas Kandagatla /* 12116cffd795SSrinivas Kandagatla * one for the last get and other for the ALLOC_DMA_BUFF ioctl 12126cffd795SSrinivas Kandagatla */ 12136cffd795SSrinivas Kandagatla dma_buf_put(buf); 12146cffd795SSrinivas Kandagatla dma_buf_put(buf); 12156cffd795SSrinivas Kandagatla 12166cffd795SSrinivas Kandagatla return 0; 12176cffd795SSrinivas Kandagatla } 12186cffd795SSrinivas Kandagatla 12196cffd795SSrinivas Kandagatla static int fastrpc_dmabuf_alloc(struct fastrpc_user *fl, char __user *argp) 12206cffd795SSrinivas Kandagatla { 12216cffd795SSrinivas Kandagatla struct fastrpc_alloc_dma_buf bp; 12226cffd795SSrinivas Kandagatla DEFINE_DMA_BUF_EXPORT_INFO(exp_info); 12236cffd795SSrinivas Kandagatla struct fastrpc_buf *buf = NULL; 12246cffd795SSrinivas Kandagatla int err; 12256cffd795SSrinivas Kandagatla 12266cffd795SSrinivas Kandagatla if (copy_from_user(&bp, argp, sizeof(bp))) 12276cffd795SSrinivas Kandagatla return -EFAULT; 12286cffd795SSrinivas Kandagatla 12296cffd795SSrinivas Kandagatla err = fastrpc_buf_alloc(fl, fl->sctx->dev, bp.size, &buf); 12306cffd795SSrinivas Kandagatla if (err) 12316cffd795SSrinivas Kandagatla return err; 12326cffd795SSrinivas Kandagatla exp_info.ops = &fastrpc_dma_buf_ops; 12336cffd795SSrinivas Kandagatla exp_info.size = bp.size; 12346cffd795SSrinivas Kandagatla exp_info.flags = O_RDWR; 12356cffd795SSrinivas Kandagatla exp_info.priv = buf; 12366cffd795SSrinivas Kandagatla buf->dmabuf = dma_buf_export(&exp_info); 12376cffd795SSrinivas Kandagatla if (IS_ERR(buf->dmabuf)) { 12386cffd795SSrinivas Kandagatla err = PTR_ERR(buf->dmabuf); 12396cffd795SSrinivas Kandagatla fastrpc_buf_free(buf); 12406cffd795SSrinivas Kandagatla return err; 12416cffd795SSrinivas Kandagatla } 12426cffd795SSrinivas Kandagatla 12436cffd795SSrinivas Kandagatla bp.fd = dma_buf_fd(buf->dmabuf, O_ACCMODE); 12446cffd795SSrinivas Kandagatla if (bp.fd < 0) { 12456cffd795SSrinivas Kandagatla dma_buf_put(buf->dmabuf); 12466cffd795SSrinivas Kandagatla return -EINVAL; 12476cffd795SSrinivas Kandagatla } 12486cffd795SSrinivas Kandagatla 12496cffd795SSrinivas Kandagatla if (copy_to_user(argp, &bp, sizeof(bp))) { 12506cffd795SSrinivas Kandagatla dma_buf_put(buf->dmabuf); 12516cffd795SSrinivas Kandagatla return -EFAULT; 12526cffd795SSrinivas Kandagatla } 12536cffd795SSrinivas Kandagatla 12546cffd795SSrinivas Kandagatla get_dma_buf(buf->dmabuf); 12556cffd795SSrinivas Kandagatla 12566cffd795SSrinivas Kandagatla return 0; 12576cffd795SSrinivas Kandagatla } 12586cffd795SSrinivas Kandagatla 1259d73f71c7SSrinivas Kandagatla static int fastrpc_init_attach(struct fastrpc_user *fl) 1260d73f71c7SSrinivas Kandagatla { 1261d73f71c7SSrinivas Kandagatla struct fastrpc_invoke_args args[1]; 1262d73f71c7SSrinivas Kandagatla int tgid = fl->tgid; 1263d73f71c7SSrinivas Kandagatla u32 sc; 1264d73f71c7SSrinivas Kandagatla 1265d73f71c7SSrinivas Kandagatla args[0].ptr = (u64)(uintptr_t) &tgid; 1266d73f71c7SSrinivas Kandagatla args[0].length = sizeof(tgid); 1267d73f71c7SSrinivas Kandagatla args[0].fd = -1; 1268d73f71c7SSrinivas Kandagatla args[0].reserved = 0; 1269d73f71c7SSrinivas Kandagatla sc = FASTRPC_SCALARS(FASTRPC_RMID_INIT_ATTACH, 1, 0); 1270d73f71c7SSrinivas Kandagatla fl->pd = 0; 1271d73f71c7SSrinivas Kandagatla 1272d73f71c7SSrinivas Kandagatla return fastrpc_internal_invoke(fl, true, FASTRPC_INIT_HANDLE, 1273d73f71c7SSrinivas Kandagatla sc, &args[0]); 1274d73f71c7SSrinivas Kandagatla } 1275d73f71c7SSrinivas Kandagatla 1276c68cfb71SSrinivas Kandagatla static int fastrpc_invoke(struct fastrpc_user *fl, char __user *argp) 1277c68cfb71SSrinivas Kandagatla { 1278c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_args *args = NULL; 1279c68cfb71SSrinivas Kandagatla struct fastrpc_invoke inv; 1280c68cfb71SSrinivas Kandagatla u32 nscalars; 1281c68cfb71SSrinivas Kandagatla int err; 1282c68cfb71SSrinivas Kandagatla 1283c68cfb71SSrinivas Kandagatla if (copy_from_user(&inv, argp, sizeof(inv))) 1284c68cfb71SSrinivas Kandagatla return -EFAULT; 1285c68cfb71SSrinivas Kandagatla 1286c68cfb71SSrinivas Kandagatla /* nscalars is truncated here to max supported value */ 1287c68cfb71SSrinivas Kandagatla nscalars = REMOTE_SCALARS_LENGTH(inv.sc); 1288c68cfb71SSrinivas Kandagatla if (nscalars) { 1289c68cfb71SSrinivas Kandagatla args = kcalloc(nscalars, sizeof(*args), GFP_KERNEL); 1290c68cfb71SSrinivas Kandagatla if (!args) 1291c68cfb71SSrinivas Kandagatla return -ENOMEM; 1292c68cfb71SSrinivas Kandagatla 1293c68cfb71SSrinivas Kandagatla if (copy_from_user(args, (void __user *)(uintptr_t)inv.args, 1294c68cfb71SSrinivas Kandagatla nscalars * sizeof(*args))) { 1295c68cfb71SSrinivas Kandagatla kfree(args); 1296c68cfb71SSrinivas Kandagatla return -EFAULT; 1297c68cfb71SSrinivas Kandagatla } 1298c68cfb71SSrinivas Kandagatla } 1299c68cfb71SSrinivas Kandagatla 1300c68cfb71SSrinivas Kandagatla err = fastrpc_internal_invoke(fl, false, inv.handle, inv.sc, args); 1301c68cfb71SSrinivas Kandagatla kfree(args); 1302c68cfb71SSrinivas Kandagatla 1303c68cfb71SSrinivas Kandagatla return err; 1304c68cfb71SSrinivas Kandagatla } 1305c68cfb71SSrinivas Kandagatla 1306c68cfb71SSrinivas Kandagatla static long fastrpc_device_ioctl(struct file *file, unsigned int cmd, 1307c68cfb71SSrinivas Kandagatla unsigned long arg) 1308c68cfb71SSrinivas Kandagatla { 1309c68cfb71SSrinivas Kandagatla struct fastrpc_user *fl = (struct fastrpc_user *)file->private_data; 1310c68cfb71SSrinivas Kandagatla char __user *argp = (char __user *)arg; 1311c68cfb71SSrinivas Kandagatla int err; 1312c68cfb71SSrinivas Kandagatla 1313c68cfb71SSrinivas Kandagatla switch (cmd) { 1314c68cfb71SSrinivas Kandagatla case FASTRPC_IOCTL_INVOKE: 1315c68cfb71SSrinivas Kandagatla err = fastrpc_invoke(fl, argp); 1316c68cfb71SSrinivas Kandagatla break; 1317d73f71c7SSrinivas Kandagatla case FASTRPC_IOCTL_INIT_ATTACH: 1318d73f71c7SSrinivas Kandagatla err = fastrpc_init_attach(fl); 1319d73f71c7SSrinivas Kandagatla break; 1320d73f71c7SSrinivas Kandagatla case FASTRPC_IOCTL_INIT_CREATE: 1321d73f71c7SSrinivas Kandagatla err = fastrpc_init_create_process(fl, argp); 1322d73f71c7SSrinivas Kandagatla break; 13236cffd795SSrinivas Kandagatla case FASTRPC_IOCTL_FREE_DMA_BUFF: 13246cffd795SSrinivas Kandagatla err = fastrpc_dmabuf_free(fl, argp); 13256cffd795SSrinivas Kandagatla break; 13266cffd795SSrinivas Kandagatla case FASTRPC_IOCTL_ALLOC_DMA_BUFF: 13276cffd795SSrinivas Kandagatla err = fastrpc_dmabuf_alloc(fl, argp); 13286cffd795SSrinivas Kandagatla break; 1329c68cfb71SSrinivas Kandagatla default: 1330c68cfb71SSrinivas Kandagatla err = -ENOTTY; 1331c68cfb71SSrinivas Kandagatla break; 1332c68cfb71SSrinivas Kandagatla } 1333c68cfb71SSrinivas Kandagatla 1334c68cfb71SSrinivas Kandagatla return err; 1335c68cfb71SSrinivas Kandagatla } 1336c68cfb71SSrinivas Kandagatla 1337f6f9279fSSrinivas Kandagatla static const struct file_operations fastrpc_fops = { 1338f6f9279fSSrinivas Kandagatla .open = fastrpc_device_open, 1339f6f9279fSSrinivas Kandagatla .release = fastrpc_device_release, 1340c68cfb71SSrinivas Kandagatla .unlocked_ioctl = fastrpc_device_ioctl, 1341c68cfb71SSrinivas Kandagatla .compat_ioctl = fastrpc_device_ioctl, 1342f6f9279fSSrinivas Kandagatla }; 1343f6f9279fSSrinivas Kandagatla 1344f6f9279fSSrinivas Kandagatla static int fastrpc_cb_probe(struct platform_device *pdev) 1345f6f9279fSSrinivas Kandagatla { 1346f6f9279fSSrinivas Kandagatla struct fastrpc_channel_ctx *cctx; 1347f6f9279fSSrinivas Kandagatla struct fastrpc_session_ctx *sess; 1348f6f9279fSSrinivas Kandagatla struct device *dev = &pdev->dev; 1349f6f9279fSSrinivas Kandagatla int i, sessions = 0; 1350977e6c8dSSrinivas Kandagatla unsigned long flags; 135101b76c32SBo YU int rc; 1352f6f9279fSSrinivas Kandagatla 1353f6f9279fSSrinivas Kandagatla cctx = dev_get_drvdata(dev->parent); 1354f6f9279fSSrinivas Kandagatla if (!cctx) 1355f6f9279fSSrinivas Kandagatla return -EINVAL; 1356f6f9279fSSrinivas Kandagatla 1357f6f9279fSSrinivas Kandagatla of_property_read_u32(dev->of_node, "qcom,nsessions", &sessions); 1358f6f9279fSSrinivas Kandagatla 1359977e6c8dSSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 1360f6f9279fSSrinivas Kandagatla sess = &cctx->session[cctx->sesscount]; 1361f6f9279fSSrinivas Kandagatla sess->used = false; 1362f6f9279fSSrinivas Kandagatla sess->valid = true; 1363f6f9279fSSrinivas Kandagatla sess->dev = dev; 1364f6f9279fSSrinivas Kandagatla dev_set_drvdata(dev, sess); 1365f6f9279fSSrinivas Kandagatla 1366f6f9279fSSrinivas Kandagatla if (of_property_read_u32(dev->of_node, "reg", &sess->sid)) 1367f6f9279fSSrinivas Kandagatla dev_info(dev, "FastRPC Session ID not specified in DT\n"); 1368f6f9279fSSrinivas Kandagatla 1369f6f9279fSSrinivas Kandagatla if (sessions > 0) { 1370f6f9279fSSrinivas Kandagatla struct fastrpc_session_ctx *dup_sess; 1371f6f9279fSSrinivas Kandagatla 1372f6f9279fSSrinivas Kandagatla for (i = 1; i < sessions; i++) { 1373f6f9279fSSrinivas Kandagatla if (cctx->sesscount++ >= FASTRPC_MAX_SESSIONS) 1374f6f9279fSSrinivas Kandagatla break; 1375f6f9279fSSrinivas Kandagatla dup_sess = &cctx->session[cctx->sesscount]; 1376f6f9279fSSrinivas Kandagatla memcpy(dup_sess, sess, sizeof(*dup_sess)); 1377f6f9279fSSrinivas Kandagatla } 1378f6f9279fSSrinivas Kandagatla } 1379f6f9279fSSrinivas Kandagatla cctx->sesscount++; 1380977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 138101b76c32SBo YU rc = dma_set_mask(dev, DMA_BIT_MASK(32)); 138201b76c32SBo YU if (rc) { 138301b76c32SBo YU dev_err(dev, "32-bit DMA enable failed\n"); 138401b76c32SBo YU return rc; 138501b76c32SBo YU } 1386f6f9279fSSrinivas Kandagatla 1387f6f9279fSSrinivas Kandagatla return 0; 1388f6f9279fSSrinivas Kandagatla } 1389f6f9279fSSrinivas Kandagatla 1390f6f9279fSSrinivas Kandagatla static int fastrpc_cb_remove(struct platform_device *pdev) 1391f6f9279fSSrinivas Kandagatla { 1392f6f9279fSSrinivas Kandagatla struct fastrpc_channel_ctx *cctx = dev_get_drvdata(pdev->dev.parent); 1393f6f9279fSSrinivas Kandagatla struct fastrpc_session_ctx *sess = dev_get_drvdata(&pdev->dev); 1394977e6c8dSSrinivas Kandagatla unsigned long flags; 1395f6f9279fSSrinivas Kandagatla int i; 1396f6f9279fSSrinivas Kandagatla 1397977e6c8dSSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 1398f6f9279fSSrinivas Kandagatla for (i = 1; i < FASTRPC_MAX_SESSIONS; i++) { 1399f6f9279fSSrinivas Kandagatla if (cctx->session[i].sid == sess->sid) { 1400f6f9279fSSrinivas Kandagatla cctx->session[i].valid = false; 1401f6f9279fSSrinivas Kandagatla cctx->sesscount--; 1402f6f9279fSSrinivas Kandagatla } 1403f6f9279fSSrinivas Kandagatla } 1404977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 1405f6f9279fSSrinivas Kandagatla 1406f6f9279fSSrinivas Kandagatla return 0; 1407f6f9279fSSrinivas Kandagatla } 1408f6f9279fSSrinivas Kandagatla 1409f6f9279fSSrinivas Kandagatla static const struct of_device_id fastrpc_match_table[] = { 1410f6f9279fSSrinivas Kandagatla { .compatible = "qcom,fastrpc-compute-cb", }, 1411f6f9279fSSrinivas Kandagatla {} 1412f6f9279fSSrinivas Kandagatla }; 1413f6f9279fSSrinivas Kandagatla 1414f6f9279fSSrinivas Kandagatla static struct platform_driver fastrpc_cb_driver = { 1415f6f9279fSSrinivas Kandagatla .probe = fastrpc_cb_probe, 1416f6f9279fSSrinivas Kandagatla .remove = fastrpc_cb_remove, 1417f6f9279fSSrinivas Kandagatla .driver = { 1418f6f9279fSSrinivas Kandagatla .name = "qcom,fastrpc-cb", 1419f6f9279fSSrinivas Kandagatla .of_match_table = fastrpc_match_table, 1420f6f9279fSSrinivas Kandagatla .suppress_bind_attrs = true, 1421f6f9279fSSrinivas Kandagatla }, 1422f6f9279fSSrinivas Kandagatla }; 1423f6f9279fSSrinivas Kandagatla 1424f6f9279fSSrinivas Kandagatla static int fastrpc_rpmsg_probe(struct rpmsg_device *rpdev) 1425f6f9279fSSrinivas Kandagatla { 1426f6f9279fSSrinivas Kandagatla struct device *rdev = &rpdev->dev; 1427f6f9279fSSrinivas Kandagatla struct fastrpc_channel_ctx *data; 1428f6f9279fSSrinivas Kandagatla int i, err, domain_id = -1; 1429f6f9279fSSrinivas Kandagatla const char *domain; 1430f6f9279fSSrinivas Kandagatla 1431f6f9279fSSrinivas Kandagatla err = of_property_read_string(rdev->of_node, "label", &domain); 1432f6f9279fSSrinivas Kandagatla if (err) { 1433f6f9279fSSrinivas Kandagatla dev_info(rdev, "FastRPC Domain not specified in DT\n"); 1434f6f9279fSSrinivas Kandagatla return err; 1435f6f9279fSSrinivas Kandagatla } 1436f6f9279fSSrinivas Kandagatla 1437f6f9279fSSrinivas Kandagatla for (i = 0; i <= CDSP_DOMAIN_ID; i++) { 1438f6f9279fSSrinivas Kandagatla if (!strcmp(domains[i], domain)) { 1439f6f9279fSSrinivas Kandagatla domain_id = i; 1440f6f9279fSSrinivas Kandagatla break; 1441f6f9279fSSrinivas Kandagatla } 1442f6f9279fSSrinivas Kandagatla } 1443f6f9279fSSrinivas Kandagatla 1444f6f9279fSSrinivas Kandagatla if (domain_id < 0) { 1445f6f9279fSSrinivas Kandagatla dev_info(rdev, "FastRPC Invalid Domain ID %d\n", domain_id); 1446f6f9279fSSrinivas Kandagatla return -EINVAL; 1447f6f9279fSSrinivas Kandagatla } 1448f6f9279fSSrinivas Kandagatla 1449*278d56f9SBjorn Andersson data = kzalloc(sizeof(*data), GFP_KERNEL); 1450*278d56f9SBjorn Andersson if (!data) 1451*278d56f9SBjorn Andersson return -ENOMEM; 1452*278d56f9SBjorn Andersson 1453f6f9279fSSrinivas Kandagatla data->miscdev.minor = MISC_DYNAMIC_MINOR; 1454f6f9279fSSrinivas Kandagatla data->miscdev.name = kasprintf(GFP_KERNEL, "fastrpc-%s", 1455f6f9279fSSrinivas Kandagatla domains[domain_id]); 1456f6f9279fSSrinivas Kandagatla data->miscdev.fops = &fastrpc_fops; 1457f6f9279fSSrinivas Kandagatla err = misc_register(&data->miscdev); 1458f6f9279fSSrinivas Kandagatla if (err) 1459f6f9279fSSrinivas Kandagatla return err; 1460f6f9279fSSrinivas Kandagatla 1461*278d56f9SBjorn Andersson kref_init(&data->refcount); 1462*278d56f9SBjorn Andersson 1463f6f9279fSSrinivas Kandagatla dev_set_drvdata(&rpdev->dev, data); 1464f6f9279fSSrinivas Kandagatla dma_set_mask_and_coherent(rdev, DMA_BIT_MASK(32)); 1465f6f9279fSSrinivas Kandagatla INIT_LIST_HEAD(&data->users); 1466f6f9279fSSrinivas Kandagatla spin_lock_init(&data->lock); 1467f6f9279fSSrinivas Kandagatla idr_init(&data->ctx_idr); 1468f6f9279fSSrinivas Kandagatla data->domain_id = domain_id; 1469f6f9279fSSrinivas Kandagatla data->rpdev = rpdev; 1470f6f9279fSSrinivas Kandagatla 1471f6f9279fSSrinivas Kandagatla return of_platform_populate(rdev->of_node, NULL, NULL, rdev); 1472f6f9279fSSrinivas Kandagatla } 1473f6f9279fSSrinivas Kandagatla 1474c68cfb71SSrinivas Kandagatla static void fastrpc_notify_users(struct fastrpc_user *user) 1475c68cfb71SSrinivas Kandagatla { 1476c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_ctx *ctx; 1477c68cfb71SSrinivas Kandagatla 1478c68cfb71SSrinivas Kandagatla spin_lock(&user->lock); 1479c68cfb71SSrinivas Kandagatla list_for_each_entry(ctx, &user->pending, node) 1480c68cfb71SSrinivas Kandagatla complete(&ctx->work); 1481c68cfb71SSrinivas Kandagatla spin_unlock(&user->lock); 1482c68cfb71SSrinivas Kandagatla } 1483c68cfb71SSrinivas Kandagatla 1484f6f9279fSSrinivas Kandagatla static void fastrpc_rpmsg_remove(struct rpmsg_device *rpdev) 1485f6f9279fSSrinivas Kandagatla { 1486f6f9279fSSrinivas Kandagatla struct fastrpc_channel_ctx *cctx = dev_get_drvdata(&rpdev->dev); 1487c68cfb71SSrinivas Kandagatla struct fastrpc_user *user; 1488977e6c8dSSrinivas Kandagatla unsigned long flags; 1489c68cfb71SSrinivas Kandagatla 1490977e6c8dSSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 1491c68cfb71SSrinivas Kandagatla list_for_each_entry(user, &cctx->users, user) 1492c68cfb71SSrinivas Kandagatla fastrpc_notify_users(user); 1493977e6c8dSSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 1494f6f9279fSSrinivas Kandagatla 1495f6f9279fSSrinivas Kandagatla misc_deregister(&cctx->miscdev); 1496f6f9279fSSrinivas Kandagatla of_platform_depopulate(&rpdev->dev); 1497*278d56f9SBjorn Andersson 1498*278d56f9SBjorn Andersson fastrpc_channel_ctx_put(cctx); 1499f6f9279fSSrinivas Kandagatla } 1500f6f9279fSSrinivas Kandagatla 1501f6f9279fSSrinivas Kandagatla static int fastrpc_rpmsg_callback(struct rpmsg_device *rpdev, void *data, 1502f6f9279fSSrinivas Kandagatla int len, void *priv, u32 addr) 1503f6f9279fSSrinivas Kandagatla { 1504c68cfb71SSrinivas Kandagatla struct fastrpc_channel_ctx *cctx = dev_get_drvdata(&rpdev->dev); 1505c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_rsp *rsp = data; 1506c68cfb71SSrinivas Kandagatla struct fastrpc_invoke_ctx *ctx; 1507c68cfb71SSrinivas Kandagatla unsigned long flags; 1508c68cfb71SSrinivas Kandagatla unsigned long ctxid; 1509c68cfb71SSrinivas Kandagatla 1510c68cfb71SSrinivas Kandagatla if (len < sizeof(*rsp)) 1511c68cfb71SSrinivas Kandagatla return -EINVAL; 1512c68cfb71SSrinivas Kandagatla 1513c68cfb71SSrinivas Kandagatla ctxid = ((rsp->ctx & FASTRPC_CTXID_MASK) >> 4); 1514c68cfb71SSrinivas Kandagatla 1515c68cfb71SSrinivas Kandagatla spin_lock_irqsave(&cctx->lock, flags); 1516c68cfb71SSrinivas Kandagatla ctx = idr_find(&cctx->ctx_idr, ctxid); 1517c68cfb71SSrinivas Kandagatla spin_unlock_irqrestore(&cctx->lock, flags); 1518c68cfb71SSrinivas Kandagatla 1519c68cfb71SSrinivas Kandagatla if (!ctx) { 1520c68cfb71SSrinivas Kandagatla dev_err(&rpdev->dev, "No context ID matches response\n"); 1521c68cfb71SSrinivas Kandagatla return -ENOENT; 1522c68cfb71SSrinivas Kandagatla } 1523c68cfb71SSrinivas Kandagatla 1524c68cfb71SSrinivas Kandagatla ctx->retval = rsp->retval; 1525c68cfb71SSrinivas Kandagatla complete(&ctx->work); 15268e7389c7SThierry Escande 15278e7389c7SThierry Escande /* 15288e7389c7SThierry Escande * The DMA buffer associated with the context cannot be freed in 15298e7389c7SThierry Escande * interrupt context so schedule it through a worker thread to 15308e7389c7SThierry Escande * avoid a kernel BUG. 15318e7389c7SThierry Escande */ 15328e7389c7SThierry Escande schedule_work(&ctx->put_work); 1533c68cfb71SSrinivas Kandagatla 1534f6f9279fSSrinivas Kandagatla return 0; 1535f6f9279fSSrinivas Kandagatla } 1536f6f9279fSSrinivas Kandagatla 1537f6f9279fSSrinivas Kandagatla static const struct of_device_id fastrpc_rpmsg_of_match[] = { 1538f6f9279fSSrinivas Kandagatla { .compatible = "qcom,fastrpc" }, 1539f6f9279fSSrinivas Kandagatla { }, 1540f6f9279fSSrinivas Kandagatla }; 1541f6f9279fSSrinivas Kandagatla MODULE_DEVICE_TABLE(of, fastrpc_rpmsg_of_match); 1542f6f9279fSSrinivas Kandagatla 1543f6f9279fSSrinivas Kandagatla static struct rpmsg_driver fastrpc_driver = { 1544f6f9279fSSrinivas Kandagatla .probe = fastrpc_rpmsg_probe, 1545f6f9279fSSrinivas Kandagatla .remove = fastrpc_rpmsg_remove, 1546f6f9279fSSrinivas Kandagatla .callback = fastrpc_rpmsg_callback, 1547f6f9279fSSrinivas Kandagatla .drv = { 1548f6f9279fSSrinivas Kandagatla .name = "qcom,fastrpc", 1549f6f9279fSSrinivas Kandagatla .of_match_table = fastrpc_rpmsg_of_match, 1550f6f9279fSSrinivas Kandagatla }, 1551f6f9279fSSrinivas Kandagatla }; 1552f6f9279fSSrinivas Kandagatla 1553f6f9279fSSrinivas Kandagatla static int fastrpc_init(void) 1554f6f9279fSSrinivas Kandagatla { 1555f6f9279fSSrinivas Kandagatla int ret; 1556f6f9279fSSrinivas Kandagatla 1557f6f9279fSSrinivas Kandagatla ret = platform_driver_register(&fastrpc_cb_driver); 1558f6f9279fSSrinivas Kandagatla if (ret < 0) { 1559f6f9279fSSrinivas Kandagatla pr_err("fastrpc: failed to register cb driver\n"); 1560f6f9279fSSrinivas Kandagatla return ret; 1561f6f9279fSSrinivas Kandagatla } 1562f6f9279fSSrinivas Kandagatla 1563f6f9279fSSrinivas Kandagatla ret = register_rpmsg_driver(&fastrpc_driver); 1564f6f9279fSSrinivas Kandagatla if (ret < 0) { 1565f6f9279fSSrinivas Kandagatla pr_err("fastrpc: failed to register rpmsg driver\n"); 1566f6f9279fSSrinivas Kandagatla platform_driver_unregister(&fastrpc_cb_driver); 1567f6f9279fSSrinivas Kandagatla return ret; 1568f6f9279fSSrinivas Kandagatla } 1569f6f9279fSSrinivas Kandagatla 1570f6f9279fSSrinivas Kandagatla return 0; 1571f6f9279fSSrinivas Kandagatla } 1572f6f9279fSSrinivas Kandagatla module_init(fastrpc_init); 1573f6f9279fSSrinivas Kandagatla 1574f6f9279fSSrinivas Kandagatla static void fastrpc_exit(void) 1575f6f9279fSSrinivas Kandagatla { 1576f6f9279fSSrinivas Kandagatla platform_driver_unregister(&fastrpc_cb_driver); 1577f6f9279fSSrinivas Kandagatla unregister_rpmsg_driver(&fastrpc_driver); 1578f6f9279fSSrinivas Kandagatla } 1579f6f9279fSSrinivas Kandagatla module_exit(fastrpc_exit); 1580f6f9279fSSrinivas Kandagatla 1581f6f9279fSSrinivas Kandagatla MODULE_LICENSE("GPL v2"); 1582