package/mpp
1
0
Fork 0
mirror of https://github.com/nyanmisaka/mpp.git synced 2025-10-05 01:02:39 +08:00
Code Issues Actions Packages Projects Releases Wiki Activity
Files
f2231d147366bdfe070f51b54d268ea3ad6f1d49
mpp/osal/driver/mpp_service.c
Yandong Lin f2231d1473 [mpp/vcodec service]: Check whether the offset is configured repeatedly 
Signed-off-by: Yandong Lin <yandong.lin@rock-chips.com>
Change-Id: I217a138b62a7a17f7f371d76a591a02852950a10
2021-03-12 11:39:27 +08:00

521 lines
15 KiB
C
Raw Blame History

/*
* Copyright 2020 Rockchip Electronics Co. LTD
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#define MODULE_TAG "mpp_serivce"
#include <sys/ioctl.h>
#include <fcntl.h>
#include <errno.h>
#include <string.h>
#include "mpp_log.h"
#include "mpp_env.h"
#include "mpp_common.h"
#include "mpp_device_debug.h"
#include "mpp_service.h"
#include "mpp_service_api.h"
typedef struct MppServiceQueryCfg_t {
RK_U32 cmd_butt;
const char *name;
} MppServiceQueryCfg;
static const MppServiceQueryCfg query_cfg[] = {
{ MPP_CMD_QUERY_BASE, "query_cmd", },
{ MPP_CMD_INIT_BASE, "init_cmd", },
{ MPP_CMD_SEND_BASE, "query_cmd", },
{ MPP_CMD_POLL_BASE, "init_cmd", },
{ MPP_CMD_CONTROL_BASE, "control_cmd", },
};
static const RK_U32 query_count = MPP_ARRAY_ELEMS(query_cfg);
static const char *mpp_service_hw_name[] = {
/* 0 ~ 3 */
/* VPU_CLIENT_VDPU1 */ "vdpu1",
/* VPU_CLIENT_VDPU2 */ "vdpu2",
/* VPU_CLIENT_VDPU1_PP */ "vdpu1_pp",
/* VPU_CLIENT_VDPU2_PP */ "vdpu2_pp",
/* 4 ~ 7 */
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* 8 ~ 11 */
/* VPU_CLIENT_HEVC_DEC */ "rkhevc",
/* VPU_CLIENT_RKVDEC */ "rkvdec",
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* 12 ~ 15 */
/* VPU_CLIENT_AVSPLUS_DEC */ "avsd",
/* VPU_CLIENT_JPEG_DEC */ "rkjpegd",
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* 16 ~ 19 */
/* VPU_CLIENT_RKVENC */ "rkvenc",
/* VPU_CLIENT_VEPU1 */ "vepu1",
/* VPU_CLIENT_VEPU2 */ "vepu2",
/* VPU_CLIENT_VEPU2_LITE */ "vepu2_lite",
/* 20 ~ 23 */
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* 24 ~ 27 */
/* VPU_CLIENT_VEPU22 */ "vepu22",
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* 28 ~ 31 */
/* IEP_CLIENT_TYPE */ "iep",
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
/* VPU_CLIENT_BUTT */ NULL,
};
const char *mpp_get_mpp_service_name(void)
{
static const char *mpp_service_name = NULL;
static const char *mpp_service_dev[] = {
"/dev/mpp_service",
"/dev/mpp-service",
};
if (mpp_service_name)
return mpp_service_name;
if (!access(mpp_service_dev[0], F_OK | R_OK | W_OK)) {
mpp_service_name = mpp_service_dev[0];
} else if (!access(mpp_service_dev[1], F_OK | R_OK | W_OK))
mpp_service_name = mpp_service_dev[1];
return mpp_service_name;
}
static RK_S32 mpp_service_ioctl(RK_S32 fd, RK_U32 cmd, RK_U32 size, void *param)
{
MppReqV1 mpp_req;
memset(&mpp_req, 0, sizeof(mpp_req));
mpp_req.cmd = cmd;
mpp_req.flag = 0;
mpp_req.size = size;
mpp_req.offset = 0;
mpp_req.data_ptr = REQ_DATA_PTR(param);
return (RK_S32)ioctl(fd, MPP_IOC_CFG_V1, &mpp_req);
}
static RK_S32 mpp_service_ioctl_request(RK_S32 fd, MppReqV1 *req)
{
return (RK_S32)ioctl(fd, MPP_IOC_CFG_V1, req);
}
static MPP_RET mpp_service_check_cmd_valid(RK_U32 cmd, const MppServiceCmdCap *cap)
{
RK_U32 found = 0;
if (cap->support_cmd > 0) {
found = (cmd < cap->query_cmd) ? 1 : 0;
found = (cmd >= MPP_CMD_INIT_BASE && cmd < cap->init_cmd) ? 1 : found;
found = (cmd >= MPP_CMD_SEND_BASE && cmd < cap->send_cmd) ? 1 : found;
found = (cmd >= MPP_CMD_POLL_BASE && cmd < cap->poll_cmd) ? 1 : found;
found = (cmd >= MPP_CMD_CONTROL_BASE && cmd < cap->ctrl_cmd) ? 1 : found;
} else {
/* old kernel before support_cmd query is valid */
found = (cmd >= MPP_CMD_INIT_BASE && cmd <= MPP_CMD_INIT_TRANS_TABLE) ? 1 : found;
found = (cmd >= MPP_CMD_SEND_BASE && cmd <= MPP_CMD_SET_REG_ADDR_OFFSET) ? 1 : found;
found = (cmd >= MPP_CMD_POLL_BASE && cmd <= MPP_CMD_POLL_HW_FINISH) ? 1 : found;
found = (cmd >= MPP_CMD_CONTROL_BASE && cmd <= MPP_CMD_RELEASE_FD) ? 1 : found;
}
return found ? MPP_OK : MPP_NOK;
}
void check_mpp_service_cap(RK_U32 *codec_type, RK_U32 *hw_ids, MppServiceCmdCap *cap)
{
MppReqV1 mpp_req;
RK_S32 fd = -1;
RK_S32 ret = 0;
RK_U32 *cmd_butt = &cap->query_cmd;;
RK_U32 hw_support = 0;
RK_U32 val;
RK_U32 i;
/* for device check on startup */
mpp_env_get_u32("mpp_device_debug", &mpp_device_debug, 0);
*codec_type = 0;
memset(hw_ids, 0, sizeof(RK_U32) * 32);
/* check hw_support flag for valid client type */
fd = open(mpp_get_mpp_service_name(), O_RDWR);
if (fd < 0) {
mpp_err("open mpp_service to check cmd capability failed\n");
memset(cap, 0, sizeof(*cap));
return ;
}
ret = mpp_service_ioctl(fd, MPP_CMD_PROBE_HW_SUPPORT, 0, &hw_support);
if (!ret) {
mpp_dev_dbg_probe("vcodec_support %08x\n", hw_support);
*codec_type = hw_support;
}
cap->support_cmd = !access("/proc/mpp_service/supports-cmd", F_OK) ||
!access("/proc/mpp_service/support_cmd", F_OK);
if (cap->support_cmd) {
for (i = 0; i < query_count; i++, cmd_butt++) {
const MppServiceQueryCfg *cfg = &query_cfg[i];
memset(&mpp_req, 0, sizeof(mpp_req));
val = cfg->cmd_butt;
mpp_req.cmd = MPP_CMD_QUERY_CMD_SUPPORT;
mpp_req.data_ptr = REQ_DATA_PTR(&val);
ret = (RK_S32)ioctl(fd, MPP_IOC_CFG_V1, &mpp_req);
if (ret)
mpp_err_f("query %-11s support error %s.\n", cfg->name, strerror(errno));
else {
*cmd_butt = val;
mpp_dev_dbg_probe("query %-11s support %04x\n", cfg->name, val);
}
}
}
close(fd);
/* check each valid client type for hw_id */
/* kernel need to set client type then get hw_id */
for (i = 0; i < 32; i++) {
if (hw_support & (1 << i)) {
val = i;
fd = open(mpp_get_mpp_service_name(), O_RDWR);
if (fd < 0) {
mpp_err("open mpp_service to check cmd capability failed\n");
break;
}
/* set client type first */
ret = mpp_service_ioctl(fd, MPP_CMD_INIT_CLIENT_TYPE, sizeof(val), &val);
if (ret) {
mpp_err("check valid client type %d failed\n", i);
} else {
/* then get hw_id */
ret = mpp_service_ioctl(fd, MPP_CMD_QUERY_HW_ID, sizeof(val), &val);
if (!ret) {
mpp_dev_dbg_probe("client %-10s hw_id %08x\n", mpp_service_hw_name[i], val);
hw_ids[i] = val;
} else
mpp_err("check valid client %-10s for hw_id failed\n",
mpp_service_hw_name[i]);
}
close(fd);
}
}
}
#define MAX_REG_OFFSET 32
#define MAX_RCB_OFFSET 32
#define MAX_INFO_COUNT 16
typedef struct FdTransInfo_t {
RK_U32 reg_idx;
RK_U32 offset;
} RegOffsetInfo;
typedef struct RcbInfo_t {
RK_U32 reg_idx;
RK_U32 size;
} RcbInfo;
typedef struct MppDevMppService_t {
RK_S32 client_type;
RK_S32 fd;
RK_S32 req_cnt;
RK_S32 reg_offset_count;
MppReqV1 reqs[MAX_REQ_NUM];
RegOffsetInfo reg_offset_info[MAX_REG_OFFSET];
RK_S32 rcb_count;
RcbInfo rcb_info[MAX_RCB_OFFSET];
RK_S32 info_count;
MppDevInfoCfg info[MAX_INFO_COUNT];
/* support max cmd buttom */
const MppServiceCmdCap *cap;
RK_U32 support_set_info;
RK_U32 support_set_rcb_info;
} MppDevMppService;
MPP_RET mpp_service_init(void *ctx, MppClientType type)
{
MppDevMppService *p = (MppDevMppService *)ctx;
MPP_RET ret = MPP_NOK;
p->cap = mpp_get_mpp_service_cmd_cap();
p->fd = open(mpp_get_mpp_service_name(), O_RDWR);
if (p->fd < 0) {
mpp_err("open mpp_service failed\n");
return ret;
}
/* set client type first */
ret = mpp_service_ioctl(p->fd, MPP_CMD_INIT_CLIENT_TYPE, sizeof(type), &type);
if (ret)
mpp_err("set client type %d failed\n", type);
mpp_assert(p->cap);
if (MPP_OK == mpp_service_check_cmd_valid(MPP_CMD_SEND_CODEC_INFO, p->cap))
p->support_set_info = 1;
if (MPP_OK == mpp_service_check_cmd_valid(MPP_CMD_SET_RCB_INFO, p->cap))
p->support_set_rcb_info = 1;
return ret;
}
MPP_RET mpp_service_deinit(void *ctx)
{
MppDevMppService *p = (MppDevMppService *)ctx;
if (p->fd)
close(p->fd);
return MPP_OK;
}
MPP_RET mpp_service_reg_wr(void *ctx, MppDevRegWrCfg *cfg)
{
MppDevMppService *p = (MppDevMppService *)ctx;
if (!p->req_cnt)
memset(p->reqs, 0, sizeof(p->reqs));
MppReqV1 *mpp_req = &p->reqs[p->req_cnt];
mpp_req->cmd = MPP_CMD_SET_REG_WRITE;
mpp_req->flag = 0;
mpp_req->size = cfg->size;
mpp_req->offset = cfg->offset;
mpp_req->data_ptr = REQ_DATA_PTR(cfg->reg);
p->req_cnt++;
return MPP_OK;
}
MPP_RET mpp_service_reg_rd(void *ctx, MppDevRegRdCfg *cfg)
{
MppDevMppService *p = (MppDevMppService *)ctx;
if (!p->req_cnt)
memset(p->reqs, 0, sizeof(p->reqs));
MppReqV1 *mpp_req = &p->reqs[p->req_cnt];
mpp_req->cmd = MPP_CMD_SET_REG_READ;
mpp_req->flag = 0;
mpp_req->size = cfg->size;
mpp_req->offset = cfg->offset;
mpp_req->data_ptr = REQ_DATA_PTR(cfg->reg);
p->req_cnt++;
return MPP_OK;
}
MPP_RET mpp_service_reg_offset(void *ctx, MppDevRegOffsetCfg *cfg)
{
MppDevMppService *p = (MppDevMppService *)ctx;
RK_S32 i;
RegOffsetInfo *info;
if (!cfg->offset)
return MPP_OK;
if (p->reg_offset_count >= MAX_REG_OFFSET) {
mpp_err_f("reach max offset definition\n", MAX_REG_OFFSET);
return MPP_NOK;
}
for (i = 0; i < p->reg_offset_count; i++) {
info = &p->reg_offset_info[i];
if (info->reg_idx == cfg->reg_idx) {
mpp_err_f("reg[%d] offset has been set, cover old %d -> %d\n",
info->reg_idx, info->offset, cfg->offset);
info->offset = cfg->offset;
return MPP_OK;
}
}
info = &p->reg_offset_info[p->reg_offset_count++];
info->reg_idx = cfg->reg_idx;
info->offset = cfg->offset;
return MPP_OK;
}
MPP_RET mpp_service_rcb_info(void *ctx, MppDevRcbInfoCfg *cfg)
{
MppDevMppService *p = (MppDevMppService *)ctx;
RK_U32 rcb_info_disable = 0;
mpp_env_get_u32("disable_rcb_info", &rcb_info_disable, 0);
if (rcb_info_disable)
return MPP_OK;
if (!p->support_set_rcb_info)
return MPP_OK;
if (!cfg->size)
return MPP_OK;
if (p->rcb_count >= MAX_RCB_OFFSET) {
mpp_err_f("reach max offset definition\n", MAX_RCB_OFFSET);
return MPP_NOK;
}
RcbInfo *info = &p->rcb_info[p->rcb_count++];
info->reg_idx = cfg->reg_idx;
info->size = cfg->size;
return MPP_OK;
}
MPP_RET mpp_service_set_info(void *ctx, MppDevInfoCfg *cfg)
{
MppDevMppService *p = (MppDevMppService *)ctx;
if (!p->support_set_info)
return MPP_OK;
if (!p->info_count)
memset(p->info, 0, sizeof(p->info));
memcpy(&p->info[p->info_count], cfg, sizeof(MppDevInfoCfg));
p->info_count++;
return MPP_OK;
}
MPP_RET mpp_service_cmd_send(void *ctx)
{
MppDevMppService *p = (MppDevMppService *)ctx;
if (p->req_cnt <= 0 || p->req_cnt > MAX_REQ_NUM) {
mpp_err_f("ctx %p invalid request count %d\n", ctx, p->req_cnt);
return MPP_ERR_VALUE;
}
/* set fd trans info if needed */
if (p->reg_offset_count) {
MppReqV1 *mpp_req = &p->reqs[p->req_cnt];
mpp_req->cmd = MPP_CMD_SET_REG_ADDR_OFFSET;
mpp_req->flag = MPP_FLAGS_REG_OFFSET_ALONE;
mpp_req->size = p->reg_offset_count * sizeof(p->reg_offset_info[0]);
mpp_req->offset = 0;
mpp_req->data_ptr = REQ_DATA_PTR(&p->reg_offset_info[0]);
p->req_cnt++;
}
/* set rcb offst info if needed */
if (p->rcb_count) {
MppReqV1 *mpp_req = &p->reqs[p->req_cnt];
mpp_req->cmd = MPP_CMD_SET_RCB_INFO;
mpp_req->flag = 0;
mpp_req->size = p->rcb_count * sizeof(p->rcb_info[0]);
mpp_req->offset = 0;
mpp_req->data_ptr = REQ_DATA_PTR(&p->rcb_info[0]);
p->req_cnt++;
}
/* setup flag for multi message request */
if (p->req_cnt > 1) {
RK_S32 i;
for (i = 0; i < p->req_cnt; i++)
p->reqs[i].flag |= MPP_FLAGS_MULTI_MSG;
}
p->reqs[p->req_cnt - 1].flag |= MPP_FLAGS_LAST_MSG;
MPP_RET ret = mpp_service_ioctl_request(p->fd, &p->reqs[0]);
if (ret) {
mpp_err_f("ioctl MPP_IOC_CFG_V1 failed ret %d errno %d %s\n",
ret, errno, strerror(errno));
ret = errno;
}
if (p->info_count) {
if (p->support_set_info) {
MppReqV1 req;
req.cmd = MPP_CMD_SEND_CODEC_INFO;
req.flag = 0;
req.size = p->info_count * sizeof(p->info[0]);
req.offset = 0;
req.data_ptr = REQ_DATA_PTR(p->info);
ret = mpp_service_ioctl_request(p->fd, &req);
if (ret) {
p->support_set_info = 0;
ret = MPP_OK;
}
}
p->info_count = 0;
}
p->req_cnt = 0;
p->reg_offset_count = 0;
p->rcb_count = 0;
return ret;
}
MPP_RET mpp_service_cmd_poll(void *ctx)
{
MppDevMppService *p = (MppDevMppService *)ctx;
MppReqV1 dev_req;
memset(&dev_req, 0, sizeof(dev_req));
dev_req.cmd = MPP_CMD_POLL_HW_FINISH;
dev_req.flag |= MPP_FLAGS_LAST_MSG;
MPP_RET ret = mpp_service_ioctl_request(p->fd, &dev_req);
if (ret) {
mpp_err_f("ioctl MPP_IOC_CFG_V1 failed ret %d errno %d %s\n",
ret, errno, strerror(errno));
ret = errno;
}
return ret;
}
const MppDevApi mpp_service_api = {
"mpp_service",
sizeof(MppDevMppService),
mpp_service_init,
mpp_service_deinit,
mpp_service_reg_wr,
mpp_service_reg_rd,
mpp_service_reg_offset,
mpp_service_rcb_info,
mpp_service_set_info,
mpp_service_cmd_send,
mpp_service_cmd_poll,
};
Reference in New Issue View Git Blame Copy Permalink