xref: /OK3568_Linux_fs/kernel/drivers/media/platform/sti/hva/hva-mem.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Copyright (C) STMicroelectronics SA 2015
4*4882a593Smuzhiyun  * Authors: Yannick Fertre <yannick.fertre@st.com>
5*4882a593Smuzhiyun  *          Hugues Fruchet <hugues.fruchet@st.com>
6*4882a593Smuzhiyun  */
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun #include "hva.h"
9*4882a593Smuzhiyun #include "hva-mem.h"
10*4882a593Smuzhiyun 
hva_mem_alloc(struct hva_ctx * ctx,u32 size,const char * name,struct hva_buffer ** buf)11*4882a593Smuzhiyun int hva_mem_alloc(struct hva_ctx *ctx, u32 size, const char *name,
12*4882a593Smuzhiyun 		  struct hva_buffer **buf)
13*4882a593Smuzhiyun {
14*4882a593Smuzhiyun 	struct device *dev = ctx_to_dev(ctx);
15*4882a593Smuzhiyun 	struct hva_buffer *b;
16*4882a593Smuzhiyun 	dma_addr_t paddr;
17*4882a593Smuzhiyun 	void *base;
18*4882a593Smuzhiyun 
19*4882a593Smuzhiyun 	b = devm_kzalloc(dev, sizeof(*b), GFP_KERNEL);
20*4882a593Smuzhiyun 	if (!b) {
21*4882a593Smuzhiyun 		ctx->sys_errors++;
22*4882a593Smuzhiyun 		return -ENOMEM;
23*4882a593Smuzhiyun 	}
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun 	base = dma_alloc_attrs(dev, size, &paddr, GFP_KERNEL,
26*4882a593Smuzhiyun 			       DMA_ATTR_WRITE_COMBINE);
27*4882a593Smuzhiyun 	if (!base) {
28*4882a593Smuzhiyun 		dev_err(dev, "%s %s : dma_alloc_attrs failed for %s (size=%d)\n",
29*4882a593Smuzhiyun 			ctx->name, __func__, name, size);
30*4882a593Smuzhiyun 		ctx->sys_errors++;
31*4882a593Smuzhiyun 		devm_kfree(dev, b);
32*4882a593Smuzhiyun 		return -ENOMEM;
33*4882a593Smuzhiyun 	}
34*4882a593Smuzhiyun 
35*4882a593Smuzhiyun 	b->size = size;
36*4882a593Smuzhiyun 	b->paddr = paddr;
37*4882a593Smuzhiyun 	b->vaddr = base;
38*4882a593Smuzhiyun 	b->name = name;
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun 	dev_dbg(dev,
41*4882a593Smuzhiyun 		"%s allocate %d bytes of HW memory @(virt=%p, phy=%pad): %s\n",
42*4882a593Smuzhiyun 		ctx->name, size, b->vaddr, &b->paddr, b->name);
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun 	/* return  hva buffer to user */
45*4882a593Smuzhiyun 	*buf = b;
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun 	return 0;
48*4882a593Smuzhiyun }
49*4882a593Smuzhiyun 
hva_mem_free(struct hva_ctx * ctx,struct hva_buffer * buf)50*4882a593Smuzhiyun void hva_mem_free(struct hva_ctx *ctx, struct hva_buffer *buf)
51*4882a593Smuzhiyun {
52*4882a593Smuzhiyun 	struct device *dev = ctx_to_dev(ctx);
53*4882a593Smuzhiyun 
54*4882a593Smuzhiyun 	dev_dbg(dev,
55*4882a593Smuzhiyun 		"%s free %d bytes of HW memory @(virt=%p, phy=%pad): %s\n",
56*4882a593Smuzhiyun 		ctx->name, buf->size, buf->vaddr, &buf->paddr, buf->name);
57*4882a593Smuzhiyun 
58*4882a593Smuzhiyun 	dma_free_attrs(dev, buf->size, buf->vaddr, buf->paddr,
59*4882a593Smuzhiyun 		       DMA_ATTR_WRITE_COMBINE);
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun 	devm_kfree(dev, buf);
62*4882a593Smuzhiyun }
63