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