18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright (C) STMicroelectronics SA 2015
48c2ecf20Sopenharmony_ci * Authors: Yannick Fertre <yannick.fertre@st.com>
58c2ecf20Sopenharmony_ci *          Hugues Fruchet <hugues.fruchet@st.com>
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_ci#include "hva.h"
98c2ecf20Sopenharmony_ci#include "hva-mem.h"
108c2ecf20Sopenharmony_ci
118c2ecf20Sopenharmony_ciint hva_mem_alloc(struct hva_ctx *ctx, u32 size, const char *name,
128c2ecf20Sopenharmony_ci		  struct hva_buffer **buf)
138c2ecf20Sopenharmony_ci{
148c2ecf20Sopenharmony_ci	struct device *dev = ctx_to_dev(ctx);
158c2ecf20Sopenharmony_ci	struct hva_buffer *b;
168c2ecf20Sopenharmony_ci	dma_addr_t paddr;
178c2ecf20Sopenharmony_ci	void *base;
188c2ecf20Sopenharmony_ci
198c2ecf20Sopenharmony_ci	b = devm_kzalloc(dev, sizeof(*b), GFP_KERNEL);
208c2ecf20Sopenharmony_ci	if (!b) {
218c2ecf20Sopenharmony_ci		ctx->sys_errors++;
228c2ecf20Sopenharmony_ci		return -ENOMEM;
238c2ecf20Sopenharmony_ci	}
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ci	base = dma_alloc_attrs(dev, size, &paddr, GFP_KERNEL,
268c2ecf20Sopenharmony_ci			       DMA_ATTR_WRITE_COMBINE);
278c2ecf20Sopenharmony_ci	if (!base) {
288c2ecf20Sopenharmony_ci		dev_err(dev, "%s %s : dma_alloc_attrs failed for %s (size=%d)\n",
298c2ecf20Sopenharmony_ci			ctx->name, __func__, name, size);
308c2ecf20Sopenharmony_ci		ctx->sys_errors++;
318c2ecf20Sopenharmony_ci		devm_kfree(dev, b);
328c2ecf20Sopenharmony_ci		return -ENOMEM;
338c2ecf20Sopenharmony_ci	}
348c2ecf20Sopenharmony_ci
358c2ecf20Sopenharmony_ci	b->size = size;
368c2ecf20Sopenharmony_ci	b->paddr = paddr;
378c2ecf20Sopenharmony_ci	b->vaddr = base;
388c2ecf20Sopenharmony_ci	b->name = name;
398c2ecf20Sopenharmony_ci
408c2ecf20Sopenharmony_ci	dev_dbg(dev,
418c2ecf20Sopenharmony_ci		"%s allocate %d bytes of HW memory @(virt=%p, phy=%pad): %s\n",
428c2ecf20Sopenharmony_ci		ctx->name, size, b->vaddr, &b->paddr, b->name);
438c2ecf20Sopenharmony_ci
448c2ecf20Sopenharmony_ci	/* return  hva buffer to user */
458c2ecf20Sopenharmony_ci	*buf = b;
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_ci	return 0;
488c2ecf20Sopenharmony_ci}
498c2ecf20Sopenharmony_ci
508c2ecf20Sopenharmony_civoid hva_mem_free(struct hva_ctx *ctx, struct hva_buffer *buf)
518c2ecf20Sopenharmony_ci{
528c2ecf20Sopenharmony_ci	struct device *dev = ctx_to_dev(ctx);
538c2ecf20Sopenharmony_ci
548c2ecf20Sopenharmony_ci	dev_dbg(dev,
558c2ecf20Sopenharmony_ci		"%s free %d bytes of HW memory @(virt=%p, phy=%pad): %s\n",
568c2ecf20Sopenharmony_ci		ctx->name, buf->size, buf->vaddr, &buf->paddr, buf->name);
578c2ecf20Sopenharmony_ci
588c2ecf20Sopenharmony_ci	dma_free_attrs(dev, buf->size, buf->vaddr, buf->paddr,
598c2ecf20Sopenharmony_ci		       DMA_ATTR_WRITE_COMBINE);
608c2ecf20Sopenharmony_ci
618c2ecf20Sopenharmony_ci	devm_kfree(dev, buf);
628c2ecf20Sopenharmony_ci}
63