|
@@ -424,7 +424,7 @@ struct qseecom_client_handle {
|
|
|
|
|
|
struct qseecom_listener_handle {
|
|
struct qseecom_listener_handle {
|
|
u32 id;
|
|
u32 id;
|
|
- bool unregister_pending;
|
|
|
|
|
|
+ bool register_pending;
|
|
bool release_called;
|
|
bool release_called;
|
|
};
|
|
};
|
|
|
|
|
|
@@ -1562,6 +1562,11 @@ static int qseecom_register_listener(struct qseecom_dev_handle *data,
|
|
struct qseecom_registered_listener_list *new_entry;
|
|
struct qseecom_registered_listener_list *new_entry;
|
|
struct qseecom_registered_listener_list *ptr_svc;
|
|
struct qseecom_registered_listener_list *ptr_svc;
|
|
|
|
|
|
|
|
+ if (data->listener.register_pending) {
|
|
|
|
+ pr_err("Already a listner registration is in process on this FD\n");
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
ret = copy_from_user(&rcvd_lstnr, argp, sizeof(rcvd_lstnr));
|
|
ret = copy_from_user(&rcvd_lstnr, argp, sizeof(rcvd_lstnr));
|
|
if (ret) {
|
|
if (ret) {
|
|
pr_err("copy_from_user failed\n");
|
|
pr_err("copy_from_user failed\n");
|
|
@@ -1571,6 +1576,12 @@ static int qseecom_register_listener(struct qseecom_dev_handle *data,
|
|
rcvd_lstnr.sb_size))
|
|
rcvd_lstnr.sb_size))
|
|
return -EFAULT;
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
+ ptr_svc = __qseecom_find_svc(data->listener.id);
|
|
|
|
+ if (ptr_svc) {
|
|
|
|
+ pr_err("Already a listener registered on this data: lid=%d\n", data->listener.id);
|
|
|
|
+ return -EINVAL;
|
|
|
|
+ }
|
|
|
|
+
|
|
ptr_svc = __qseecom_find_svc(rcvd_lstnr.listener_id);
|
|
ptr_svc = __qseecom_find_svc(rcvd_lstnr.listener_id);
|
|
if (ptr_svc) {
|
|
if (ptr_svc) {
|
|
if (!ptr_svc->unregister_pending) {
|
|
if (!ptr_svc->unregister_pending) {
|
|
@@ -1614,13 +1625,16 @@ static int qseecom_register_listener(struct qseecom_dev_handle *data,
|
|
new_entry->svc.listener_id = rcvd_lstnr.listener_id;
|
|
new_entry->svc.listener_id = rcvd_lstnr.listener_id;
|
|
new_entry->sb_length = rcvd_lstnr.sb_size;
|
|
new_entry->sb_length = rcvd_lstnr.sb_size;
|
|
new_entry->user_virt_sb_base = rcvd_lstnr.virt_sb_base;
|
|
new_entry->user_virt_sb_base = rcvd_lstnr.virt_sb_base;
|
|
|
|
+ data->listener.register_pending = true;
|
|
if (__qseecom_set_sb_memory(new_entry, data, &rcvd_lstnr)) {
|
|
if (__qseecom_set_sb_memory(new_entry, data, &rcvd_lstnr)) {
|
|
pr_err("qseecom_set_sb_memory failed for listener %d, size %d\n",
|
|
pr_err("qseecom_set_sb_memory failed for listener %d, size %d\n",
|
|
rcvd_lstnr.listener_id, rcvd_lstnr.sb_size);
|
|
rcvd_lstnr.listener_id, rcvd_lstnr.sb_size);
|
|
__qseecom_free_tzbuf(&new_entry->sglistinfo_shm);
|
|
__qseecom_free_tzbuf(&new_entry->sglistinfo_shm);
|
|
kfree_sensitive(new_entry);
|
|
kfree_sensitive(new_entry);
|
|
|
|
+ data->listener.register_pending = false;
|
|
return -ENOMEM;
|
|
return -ENOMEM;
|
|
}
|
|
}
|
|
|
|
+ data->listener.register_pending = false;
|
|
|
|
|
|
init_waitqueue_head(&new_entry->rcv_req_wq);
|
|
init_waitqueue_head(&new_entry->rcv_req_wq);
|
|
init_waitqueue_head(&new_entry->listener_block_app_wq);
|
|
init_waitqueue_head(&new_entry->listener_block_app_wq);
|