Merge "msm: eva: Support EVA DSP clients in mult-process"

This commit is contained in:
qctecmdr
2021-08-17 19:01:17 -07:00
committed by Gerrit - the friendly Code Review server
2 changed files with 79 additions and 8 deletions

View File

@@ -248,6 +248,35 @@ static int delete_dsp_session(struct msm_cvp_inst *inst,
return rc;
}
static int eva_fastrpc_driver_get_name(
struct cvp_dsp_fastrpc_driver_entry *frpc_node)
{
int i = 0;
struct cvp_dsp_apps *me = &gfa_cv;
for (i = 0; i < MAX_FASTRPC_DRIVER_NUM; i++) {
if (me->cvp_fastrpc_name[i].status == DRIVER_NAME_AVAILABLE) {
frpc_node->driver_name_idx = i;
frpc_node->cvp_fastrpc_driver.driver.name =
me->cvp_fastrpc_name[i].name;
me->cvp_fastrpc_name[i].status = DRIVER_NAME_USED;
dprintk(CVP_DSP, "%s -> handle 0x%x get name %s\n",
__func__, frpc_node->cvp_fastrpc_driver.handle,
frpc_node->cvp_fastrpc_driver.driver.name);
return 0;
}
}
return -1;
}
static void eva_fastrpc_driver_release_name(
struct cvp_dsp_fastrpc_driver_entry *frpc_node)
{
struct cvp_dsp_apps *me = &gfa_cv;
me->cvp_fastrpc_name[frpc_node->driver_name_idx].status =
DRIVER_NAME_AVAILABLE;
}
static void cvp_dsp_rpmsg_remove(struct rpmsg_device *rpdev)
{
struct cvp_dsp_apps *me = &gfa_cv;
@@ -291,6 +320,9 @@ static void cvp_dsp_rpmsg_remove(struct rpmsg_device *rpdev)
dprintk(CVP_DSP,
"%s Unregistered fastrpc handle 0x%x\n",
__func__, frpc_node->handle);
mutex_lock(&me->driver_name_lock);
eva_fastrpc_driver_release_name(frpc_node);
mutex_unlock(&me->driver_name_lock);
kfree(frpc_node);
frpc_node = NULL;
}
@@ -814,9 +846,6 @@ static int cvp_fastrpc_callback(struct fastrpc_device *rpc_dev,
static struct fastrpc_driver cvp_fastrpc_client = {
.probe = cvp_fastrpc_probe,
.callback = cvp_fastrpc_callback,
.driver = {
.name = "qcom,fastcv",
},
};
@@ -970,6 +999,19 @@ static int eva_fastrpc_driver_register(uint32_t handle)
memset(frpc_node, 0, sizeof(*frpc_node));
/* Setup fastrpc_node */
frpc_node->handle = handle;
frpc_node->cvp_fastrpc_driver = cvp_fastrpc_client;
frpc_node->cvp_fastrpc_driver.handle = handle;
mutex_lock(&me->driver_name_lock);
rc = eva_fastrpc_driver_get_name(frpc_node);
mutex_unlock(&me->driver_name_lock);
if (rc) {
dprintk(CVP_ERR, "%s fastrpc get name fail err %d\n",
__func__, rc);
goto fail_fastrpc_driver_get_name;
}
/* Init completion */
init_completion(&frpc_node->fastrpc_probe_completion);
@@ -980,9 +1022,6 @@ static int eva_fastrpc_driver_register(uint32_t handle)
INIT_MSM_CVP_LIST(&frpc_node->dsp_sessions);
/* register fastrpc device to this session */
frpc_node->handle = handle;
frpc_node->cvp_fastrpc_driver = cvp_fastrpc_client;
frpc_node->cvp_fastrpc_driver.handle = handle;
rc = fastrpc_driver_register(&frpc_node->cvp_fastrpc_driver);
if (rc) {
dprintk(CVP_ERR, "%s fastrpc driver reg fail err %d\n",
@@ -1012,6 +1051,11 @@ fail_fastrpc_driver_register:
mutex_lock(&me->fastrpc_driver_list.lock);
list_del(&frpc_node->list);
mutex_unlock(&me->fastrpc_driver_list.lock);
mutex_lock(&me->driver_name_lock);
eva_fastrpc_driver_release_name(frpc_node);
mutex_unlock(&me->driver_name_lock);
fail_fastrpc_driver_get_name:
kfree(frpc_node);
return -EINVAL;
}
@@ -1046,6 +1090,9 @@ static void eva_fastrpc_driver_unregister(uint32_t handle, bool force_exit)
mutex_unlock(&me->fastrpc_driver_list.lock);
fastrpc_driver_unregister(&frpc_node->cvp_fastrpc_driver);
mutex_lock(&me->driver_name_lock);
eva_fastrpc_driver_release_name(frpc_node);
mutex_unlock(&me->driver_name_lock);
kfree(frpc_node);
}
}
@@ -1839,6 +1886,7 @@ int cvp_dsp_device_init(void)
char tname[16];
int rc;
int i;
char name[CVP_FASTRPC_DRIVER_NAME_SIZE] = "qcom,fastcv0\0";
mutex_init(&me->tx_lock);
mutex_init(&me->rx_lock);
@@ -1853,6 +1901,13 @@ int cvp_dsp_device_init(void)
INIT_MSM_CVP_LIST(&me->fastrpc_driver_list);
mutex_init(&me->driver_name_lock);
for (i = 0; i < MAX_FASTRPC_DRIVER_NUM; i++) {
me->cvp_fastrpc_name[i].status = DRIVER_NAME_AVAILABLE;
snprintf(me->cvp_fastrpc_name[i].name, sizeof(name), name);
name[11]++;
}
rc = register_rpmsg_driver(&cvp_dsp_rpmsg_client);
if (rc) {
dprintk(CVP_ERR,
@@ -1891,5 +1946,6 @@ void cvp_dsp_device_exit(void)
mutex_destroy(&me->tx_lock);
mutex_destroy(&me->rx_lock);
mutex_destroy(&me->driver_name_lock);
unregister_rpmsg_driver(&cvp_dsp_rpmsg_client);
}

View File

@@ -31,10 +31,11 @@
#define HIGH32 (0xFFFFFFFF00000000LL)
#define LOW32 (0xFFFFFFFFLL)
#define CVP_FASTRPC_DRIVER_NAME_SIZE 16
/* Supports up to 8 DSP sessions in 4 processes */
#define MAX_FASTRPC_DRIVER_NUM (4)
/* Supports up to 8 DSP sessions in 8 processes */
#define MAX_DSP_SESSION_NUM (8)
#define MAX_FASTRPC_DRIVER_NUM (MAX_DSP_SESSION_NUM)
int cvp_dsp_device_init(void);
void cvp_dsp_device_exit(void);
@@ -164,10 +165,22 @@ struct cvp_dsp2cpu_cmd_msg {
uint32_t data[CVP_DSP2CPU_RESERVED];
};
struct driver_name {
uint32_t status;
char name[CVP_FASTRPC_DRIVER_NAME_SIZE];
};
enum DRIVER_NAME_STATUS {
DRIVER_NAME_INVALID = 0,
DRIVER_NAME_AVAILABLE = 1,
DRIVER_NAME_USED = 2,
};
struct cvp_dsp_fastrpc_driver_entry {
struct list_head list;
uint32_t handle;
uint32_t session_cnt;
uint32_t driver_name_idx;
struct fastrpc_driver cvp_fastrpc_driver;
struct fastrpc_device *cvp_fastrpc_device;
struct completion fastrpc_probe_completion;
@@ -183,6 +196,7 @@ struct cvp_dsp_apps {
struct mutex tx_lock;
/* rx_lock for receiving DSP2CPU cmds or msgs */
struct mutex rx_lock;
struct mutex driver_name_lock;
struct rpmsg_device *chan;
uint32_t state;
uint32_t debug_mask;
@@ -197,6 +211,7 @@ struct cvp_dsp_apps {
const struct file_operations *dmabuf_f_op;
uint32_t buf_num;
struct msm_cvp_list fastrpc_driver_list;
struct driver_name cvp_fastrpc_name[MAX_FASTRPC_DRIVER_NUM];
};
extern struct cvp_dsp_apps gfa_cv;