// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) STMicroelectronics SA 2015
 * Authors: Yannick Fertre <yannick.fertre@st.com>
 *          Hugues Fruchet <hugues.fruchet@st.com>
 */

#include "hva.h"
#include "hva-mem.h"

int hva_mem_alloc(struct hva_ctx *ctx, u32 size, const char *name,
                  struct hva_buffer **buf)
{
        struct device *dev = ctx_to_dev(ctx);
        struct hva_buffer *b;
        dma_addr_t paddr;
        void *base;

        b = devm_kzalloc(dev, sizeof(*b), GFP_KERNEL);
        if (!b) {
                ctx->sys_errors++;
                return -ENOMEM;
        }

        base = dma_alloc_attrs(dev, size, &paddr, GFP_KERNEL,
                               DMA_ATTR_WRITE_COMBINE);
        if (!base) {
                dev_err(dev, "%s %s : dma_alloc_attrs failed for %s (size=%d)\n",
                        ctx->name, __func__, name, size);
                ctx->sys_errors++;
                devm_kfree(dev, b);
                return -ENOMEM;
        }

        b->size = size;
        b->paddr = paddr;
        b->vaddr = base;
        b->name = name;

        dev_dbg(dev,
                "%s allocate %d bytes of HW memory @(virt=%p, phy=%pad): %s\n",
                ctx->name, size, b->vaddr, &b->paddr, b->name);

        /* return  hva buffer to user */
        *buf = b;

        return 0;
}

void hva_mem_free(struct hva_ctx *ctx, struct hva_buffer *buf)
{
        struct device *dev = ctx_to_dev(ctx);

        dev_dbg(dev,
                "%s free %d bytes of HW memory @(virt=%p, phy=%pad): %s\n",
                ctx->name, buf->size, buf->vaddr, &buf->paddr, buf->name);

        dma_free_attrs(dev, buf->size, buf->vaddr, buf->paddr,
                       DMA_ATTR_WRITE_COMBINE);

        devm_kfree(dev, buf);
}