328 lines
7.1 KiB
C
328 lines
7.1 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2019 Amlogic, Inc. All rights reserved.
|
||
|
|
*
|
||
|
|
* This source code is subject to the terms and conditions defined in below
|
||
|
|
* which is part of this source code package.
|
||
|
|
*
|
||
|
|
* Description:
|
||
|
|
*/
|
||
|
|
|
||
|
|
// Copyright (C) 2019 Amlogic, Inc. All rights reserved.
|
||
|
|
//
|
||
|
|
// All information contained herein is Amlogic confidential.
|
||
|
|
//
|
||
|
|
// This software is provided to you pursuant to Software License
|
||
|
|
// Agreement (SLA) with Amlogic Inc ("Amlogic"). This software may be
|
||
|
|
// used only in accordance with the terms of this agreement.
|
||
|
|
//
|
||
|
|
// Redistribution and use in source and binary forms, with or without
|
||
|
|
// modification is strictly prohibited without prior written permission
|
||
|
|
// from Amlogic.
|
||
|
|
//
|
||
|
|
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||
|
|
// "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||
|
|
// LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
|
||
|
|
// A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
||
|
|
// OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
||
|
|
// SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
||
|
|
// LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||
|
|
// DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||
|
|
// THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||
|
|
// (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
||
|
|
// OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
|
|
|
||
|
|
#include <errno.h>
|
||
|
|
#include <fcntl.h>
|
||
|
|
#include <getopt.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <stdlib.h>
|
||
|
|
#include <string.h>
|
||
|
|
#include <sys/ioctl.h>
|
||
|
|
#include <sys/mman.h>
|
||
|
|
#include <sys/socket.h>
|
||
|
|
#include <sys/stat.h>
|
||
|
|
#include <sys/types.h>
|
||
|
|
#include <unistd.h>
|
||
|
|
|
||
|
|
#include "./test_dma_api.h"
|
||
|
|
#include <IONmem.h>
|
||
|
|
|
||
|
|
|
||
|
|
#define USE_ION_DMA_BUFF
|
||
|
|
|
||
|
|
int create_ctx(struct usr_ctx_s *ctx)
|
||
|
|
{
|
||
|
|
memset(ctx, 0, sizeof(struct usr_ctx_s));
|
||
|
|
ctx->fd[0] = ctx->fd[1] = ctx->fd[2] = -1;
|
||
|
|
ctx->ion_client = -1;
|
||
|
|
ctx->gdc_client = -1;
|
||
|
|
|
||
|
|
#ifdef USE_ION_DMA_BUFF
|
||
|
|
ctx->ion_client = ion_mem_init();
|
||
|
|
if (ctx->ion_client < 0)
|
||
|
|
{
|
||
|
|
printf("ion open failed error=%d, %s", errno, strerror(errno));
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
#endif
|
||
|
|
ctx->gdc_client = open("/dev/gdc", O_RDWR | O_SYNC);
|
||
|
|
|
||
|
|
if (ctx->gdc_client < 0)
|
||
|
|
{
|
||
|
|
printf("gdc open failed error=%d, %s", errno, strerror(errno));
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int destroy_ctx(struct usr_ctx_s *ctx)
|
||
|
|
{
|
||
|
|
if (ctx->cmemParm[0] != NULL)
|
||
|
|
{
|
||
|
|
free((IONMEM_AllocParams*)ctx->cmemParm[0]);
|
||
|
|
ctx->cmemParm[0] = NULL;
|
||
|
|
}
|
||
|
|
if (ctx->cmemParm[1] != NULL)
|
||
|
|
{
|
||
|
|
free((IONMEM_AllocParams*)ctx->cmemParm[1]);
|
||
|
|
ctx->cmemParm[1] = NULL;
|
||
|
|
}
|
||
|
|
if (ctx->cmemParm[2] != NULL)
|
||
|
|
{
|
||
|
|
free((IONMEM_AllocParams*)ctx->cmemParm[2]);
|
||
|
|
ctx->cmemParm[2] = NULL;
|
||
|
|
}
|
||
|
|
if (ctx->i_buff[0] != NULL)
|
||
|
|
{
|
||
|
|
munmap(ctx->i_buff[0], ctx->i_len[0]);
|
||
|
|
ctx->i_buff[0] = NULL;
|
||
|
|
ctx->i_len[0] = 0;
|
||
|
|
}
|
||
|
|
if (ctx->i_buff[1] != NULL)
|
||
|
|
{
|
||
|
|
munmap(ctx->i_buff[1], ctx->i_len[1]);
|
||
|
|
ctx->i_buff[1] = NULL;
|
||
|
|
ctx->i_len[1] = 0;
|
||
|
|
}
|
||
|
|
if (ctx->i_buff[2] != NULL)
|
||
|
|
{
|
||
|
|
munmap(ctx->i_buff[2], ctx->i_len[2]);
|
||
|
|
ctx->i_buff[2] = NULL;
|
||
|
|
ctx->i_len[2] = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ctx->o_buff != NULL)
|
||
|
|
{
|
||
|
|
munmap(ctx->o_buff, ctx->o_len);
|
||
|
|
ctx->o_buff = NULL;
|
||
|
|
ctx->o_len = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ctx->c_buff != NULL)
|
||
|
|
{
|
||
|
|
munmap(ctx->c_buff, ctx->c_len);
|
||
|
|
ctx->c_buff = NULL;
|
||
|
|
ctx->c_len = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ctx->gdc_client >= 0)
|
||
|
|
{
|
||
|
|
close(ctx->gdc_client);
|
||
|
|
ctx->gdc_client = -1;
|
||
|
|
}
|
||
|
|
if (ctx->ion_client >= 0)
|
||
|
|
{
|
||
|
|
ion_mem_exit(ctx->ion_client);
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int _alloc_dma_buffer(int fd, unsigned int dir, unsigned int len)
|
||
|
|
{
|
||
|
|
int ret = -1;
|
||
|
|
struct dmabuf_req_s buf_cfg;
|
||
|
|
|
||
|
|
memset(&buf_cfg, 0, sizeof(buf_cfg));
|
||
|
|
|
||
|
|
buf_cfg.dma_dir = dir;
|
||
|
|
buf_cfg.len = len;
|
||
|
|
|
||
|
|
ret = ioctl(fd, GDC_REQUEST_DMA_BUFF, &buf_cfg);
|
||
|
|
if (ret < 0)
|
||
|
|
{
|
||
|
|
printf("GDC_REQUEST_DMA_BUFF %s failed: %s\n", __func__,
|
||
|
|
strerror(ret));
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
return buf_cfg.index;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int _get_dma_buffer_fd(int fd, int index)
|
||
|
|
{
|
||
|
|
struct dmabuf_exp_s ex_buf;
|
||
|
|
|
||
|
|
ex_buf.index = index;
|
||
|
|
ex_buf.flags = O_RDWR;
|
||
|
|
ex_buf.fd = -1;
|
||
|
|
|
||
|
|
if (ioctl(fd, GDC_EXP_DMA_BUFF, &ex_buf))
|
||
|
|
{
|
||
|
|
printf("failed get dma buf fd\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
printf("dma buffer export, fd=%d\n", ex_buf.fd);
|
||
|
|
|
||
|
|
return ex_buf.fd;
|
||
|
|
}
|
||
|
|
|
||
|
|
static int _free_dma_buffer(int fd, int index)
|
||
|
|
{
|
||
|
|
printf("_free_dma_buffer: index=%d\n", index);
|
||
|
|
if (ioctl(fd, GDC_FREE_DMA_BUFF, &index))
|
||
|
|
{
|
||
|
|
printf("failed free dma buf fd\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int gdc_alloc_dma_buffer(struct usr_ctx_s *ctx, uint32_t type, size_t len)
|
||
|
|
{
|
||
|
|
int dir = 0, index = -1, dma_fd = -1;
|
||
|
|
int i = 0;
|
||
|
|
|
||
|
|
if (type == OUTPUT_BUFF_TYPE)
|
||
|
|
dir = DMA_FROM_DEVICE;
|
||
|
|
else
|
||
|
|
dir = DMA_TO_DEVICE;
|
||
|
|
|
||
|
|
index = _alloc_dma_buffer(ctx->gdc_client, dir, len);
|
||
|
|
if (index < 0)
|
||
|
|
return -1;
|
||
|
|
|
||
|
|
/* get dma fd */
|
||
|
|
dma_fd = _get_dma_buffer_fd(ctx->gdc_client, index);
|
||
|
|
if (dma_fd < 0)
|
||
|
|
return -1;
|
||
|
|
printf("alloc_dma_buffer: fd=%d\n", dma_fd);
|
||
|
|
/* after alloc, dmabuffer free can be called, it just dec refcount */
|
||
|
|
_free_dma_buffer(ctx->gdc_client, index);
|
||
|
|
|
||
|
|
switch (type)
|
||
|
|
{
|
||
|
|
case INPUT_BUFF_TYPE:
|
||
|
|
i = ctx->inbuf_num;
|
||
|
|
ctx->i_len[i] = len;
|
||
|
|
ctx->i_buff[i] =
|
||
|
|
(char
|
||
|
|
*) (mmap(NULL, len, PROT_READ | PROT_WRITE, MAP_SHARED,
|
||
|
|
dma_fd, 0));
|
||
|
|
if (ctx->i_buff[i] == MAP_FAILED)
|
||
|
|
{
|
||
|
|
ctx->i_buff[i] = NULL;
|
||
|
|
printf("Failed to alloc i_buff:%s\n", strerror(errno));
|
||
|
|
}
|
||
|
|
ctx->fd[i] = dma_fd;
|
||
|
|
ctx->inbuf_num++;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
printf("Error no such buff type\n");
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
return dma_fd;
|
||
|
|
}
|
||
|
|
|
||
|
|
int ion_alloc_dma_buffer(struct usr_ctx_s *ctx, uint32_t type, size_t len)
|
||
|
|
{
|
||
|
|
int ret = -1, i;
|
||
|
|
int dma_fd = -1;
|
||
|
|
unsigned int nbytes = 0;
|
||
|
|
|
||
|
|
switch (type)
|
||
|
|
{
|
||
|
|
case INPUT_BUFF_TYPE:
|
||
|
|
i = ctx->inbuf_num;
|
||
|
|
ctx->cmemParm[i] = malloc(sizeof(IONMEM_AllocParams));
|
||
|
|
if (ctx->cmemParm[i] == NULL)
|
||
|
|
return -1;
|
||
|
|
ret = ion_mem_alloc(ctx->ion_client, len, ctx->cmemParm[i], 0);
|
||
|
|
if (ret < 0) {
|
||
|
|
printf("%s,%d,Not enough memory\n",__func__, __LINE__);
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
dma_fd = ((IONMEM_AllocParams*)ctx->cmemParm[i])->mImageFd;
|
||
|
|
ctx->i_len[i] = len;
|
||
|
|
ctx->i_buff[i] =
|
||
|
|
(char
|
||
|
|
*) (mmap(NULL, len, PROT_READ | PROT_WRITE, MAP_SHARED,
|
||
|
|
dma_fd, 0));
|
||
|
|
if (!ctx->i_buff[i])
|
||
|
|
{
|
||
|
|
ctx->i_buff[i] = NULL;
|
||
|
|
printf("Failed to alloc i_buff:%s\n", strerror(errno));
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
ctx->fd[i] = dma_fd;
|
||
|
|
ctx->inbuf_num++;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
printf("Error no such buff type\n");
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
return dma_fd;
|
||
|
|
}
|
||
|
|
int alloc_dma_buffer(struct usr_ctx_s *ctx, uint32_t type, size_t len)
|
||
|
|
{
|
||
|
|
#ifdef USE_ION_DMA_BUFF
|
||
|
|
return ion_alloc_dma_buffer(ctx, type, len);
|
||
|
|
#else
|
||
|
|
return gdc_alloc_dma_buffer(ctx, type, len);
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
int sync_cpu(struct usr_ctx_s *ctx)
|
||
|
|
{
|
||
|
|
#ifdef USE_ION_DMA_BUFF
|
||
|
|
return 0;
|
||
|
|
#endif
|
||
|
|
int ret = 0;
|
||
|
|
int shared_fd = -1;
|
||
|
|
|
||
|
|
if (ctx->i_buff[0])
|
||
|
|
{
|
||
|
|
shared_fd = ctx->fd[0];
|
||
|
|
ret = ioctl(ctx->gdc_client, GDC_SYNC_CPU, &shared_fd);
|
||
|
|
if (ret < 0)
|
||
|
|
{
|
||
|
|
printf("sync_cpu ioctl failed\n");
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ctx->i_buff[1])
|
||
|
|
{
|
||
|
|
shared_fd = ctx->fd[1];
|
||
|
|
ret = ioctl(ctx->gdc_client, GDC_SYNC_CPU, &shared_fd);
|
||
|
|
if (ret < 0)
|
||
|
|
{
|
||
|
|
printf("sync_cpu ioctl failed\n");
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ctx->i_buff[2])
|
||
|
|
{
|
||
|
|
shared_fd = ctx->fd[2];
|
||
|
|
ret = ioctl(ctx->gdc_client, GDC_SYNC_CPU, &shared_fd);
|
||
|
|
if (ret < 0)
|
||
|
|
{
|
||
|
|
printf("sync_cpu ioctl failed\n");
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return 0;
|
||
|
|
}
|