xref: /openbmc/linux/drivers/misc/fastrpc.c (revision 278d56f970ae6e0bcda8970e78e088e3efe43da8)
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