Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 03f220d1 authored by Zhen Kong's avatar Zhen Kong
Browse files

qseecom: replace scm_call2 with scm_call2_noretry 



To avoid potential EBUSY error from scm_call2() when smcinvoke TA
requests listener and qseecom sends scm_call at the same time, change
to use scm_call2_noretry and release app_access_mutex before msleep.

Change-Id: I57103d3f5667df6ced824e51ba6555f5d6722af3
Signed-off-by: default avatarZhen Kong <zkong@codeaurora.org>
parent 83d88163

drivers/misc/qseecom.c

+59 −32
Original line number Diff line number Diff line
@@ -416,6 +416,29 @@ static int get_qseecom_keymaster_status(char *str) 
}

__setup("androidboot.keymaster=", get_qseecom_keymaster_status);





#define QSEECOM_SCM_EBUSY_WAIT_MS 30

#define QSEECOM_SCM_EBUSY_MAX_RETRY 67



static int __qseecom_scm_call2_locked(uint32_t smc_id, struct scm_desc *desc)

{

	int ret = 0;

	int retry_count = 0;



	do {

		ret = scm_call2_noretry(smc_id, desc);

		if (ret == -EBUSY) {

			mutex_unlock(&app_access_lock);

			msleep(QSEECOM_SCM_EBUSY_WAIT_MS);

			mutex_lock(&app_access_lock);

		}

		if (retry_count == 33)

			pr_warn("secure world has been busy for 1 second!\n");

	} while (ret == -EBUSY &&

			(retry_count++ < QSEECOM_SCM_EBUSY_MAX_RETRY));

	return ret;

}



static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id,

			const void *req_buf, void *resp_buf)

{
@@ -443,7 +466,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				svc_id, tz_cmd_id);

			return -EINVAL;

		}

		ret = scm_call2(smc_id, &desc);

		ret = __qseecom_scm_call2_locked(smc_id, &desc);

		break;

	}

	case SCM_SVC_ES: {
@@ -466,7 +489,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			desc.args[0] = p_hash_req->partition_id;

			desc.args[1] = virt_to_phys(tzbuf);

			desc.args[2] = SHA256_DIGEST_LENGTH;

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			kzfree(tzbuf);

			break;

		}
@@ -501,7 +524,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[2] = req_64bit->phy_addr;

			}

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_APP_SHUTDOWN_COMMAND: {
@@ -511,7 +534,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			smc_id = TZ_OS_APP_SHUTDOWN_ID;

			desc.arginfo = TZ_OS_APP_SHUTDOWN_ID_PARAM_ID;

			desc.args[0] = req->app_id;

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_APP_LOOKUP_COMMAND: {
@@ -530,7 +553,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			desc.args[0] = virt_to_phys(tzbuf);

			desc.args[1] = strlen(req->app_name);

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			kzfree(tzbuf);

			break;

		}
@@ -554,7 +577,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[1] = req_64bit->size;

			}

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_LOAD_SERV_IMAGE_COMMAND: {
@@ -578,14 +601,14 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[2] = req_64bit->phy_addr;

			}

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_UNLOAD_SERV_IMAGE_COMMAND: {

			smc_id = TZ_OS_UNLOAD_SERVICES_IMAGE_ID;

			desc.arginfo = TZ_OS_UNLOAD_SERVICES_IMAGE_ID_PARAM_ID;

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_REGISTER_LISTENER: {
@@ -610,12 +633,12 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			}

			qseecom.smcinvoke_support = true;

			smc_id = TZ_OS_REGISTER_LISTENER_SMCINVOKE_ID;

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			if (ret == -EIO) {

				/* smcinvoke is not supported */

				qseecom.smcinvoke_support = false;

				smc_id = TZ_OS_REGISTER_LISTENER_ID;

				ret = scm_call2(smc_id, &desc);

				ret = __qseecom_scm_call2_locked(smc_id, &desc);

			}

			break;

		}
@@ -627,7 +650,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			smc_id = TZ_OS_DEREGISTER_LISTENER_ID;

			desc.arginfo = TZ_OS_DEREGISTER_LISTENER_ID_PARAM_ID;

			desc.args[0] = req->listener_id;

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_LISTENER_DATA_RSP_COMMAND: {
@@ -640,7 +663,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				TZ_OS_LISTENER_RESPONSE_HANDLER_ID_PARAM_ID;

			desc.args[0] = req->listener_id;

			desc.args[1] = req->status;

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_LISTENER_DATA_RSP_COMMAND_WHITELIST: {
@@ -668,7 +691,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[2] = req_64->sglistinfo_ptr;

				desc.args[3] = req_64->sglistinfo_len;

			}

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_LOAD_EXTERNAL_ELF_COMMAND: {
@@ -690,14 +713,14 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[2] = req_64bit->phy_addr;

			}

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_UNLOAD_EXTERNAL_ELF_COMMAND: {

			smc_id = TZ_OS_UNLOAD_EXTERNAL_IMAGE_ID;

			desc.arginfo = TZ_OS_UNLOAD_SERVICES_IMAGE_ID_PARAM_ID;

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

			}
@@ -725,7 +748,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[3] = req_64bit->rsp_ptr;

				desc.args[4] = req_64bit->rsp_len;

			}

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_CLIENT_SEND_DATA_COMMAND_WHITELIST: {
@@ -757,7 +780,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[5] = req_64bit->sglistinfo_ptr;

				desc.args[6] = req_64bit->sglistinfo_len;

			}

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_RPMB_PROVISION_KEY_COMMAND: {
@@ -769,21 +792,21 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			desc.arginfo = TZ_OS_RPMB_PROVISION_KEY_ID_PARAM_ID;

			desc.args[0] = req->key_type;

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_RPMB_ERASE_COMMAND: {

			smc_id = TZ_OS_RPMB_ERASE_ID;

			desc.arginfo = TZ_OS_RPMB_ERASE_ID_PARAM_ID;

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_RPMB_CHECK_PROV_STATUS_COMMAND: {

			smc_id = TZ_OS_RPMB_CHECK_PROV_STATUS_ID;

			desc.arginfo = TZ_OS_RPMB_CHECK_PROV_STATUS_ID_PARAM_ID;

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_GENERATE_KEY: {
@@ -804,7 +827,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			desc.args[0] = virt_to_phys(tzbuf);

			desc.args[1] = tzbuflen;

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			kzfree(tzbuf);

			break;

		}
@@ -826,7 +849,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			desc.args[0] = virt_to_phys(tzbuf);

			desc.args[1] = tzbuflen;

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			kzfree(tzbuf);

			break;

		}
@@ -848,7 +871,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			desc.args[0] = virt_to_phys(tzbuf);

			desc.args[1] = tzbuflen;

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			kzfree(tzbuf);

			break;

		}
@@ -870,7 +893,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			desc.args[0] = virt_to_phys(tzbuf);

			desc.args[1] = tzbuflen;

			__qseecom_reentrancy_check_if_no_app_blocked(smc_id);

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			kzfree(tzbuf);

			break;

		}
@@ -896,7 +919,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[3] = req_64bit->resp_ptr;

				desc.args[4] = req_64bit->resp_len;

			}

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_TEE_OPEN_SESSION_WHITELIST: {
@@ -926,7 +949,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[5] = req_64bit->sglistinfo_ptr;

				desc.args[6] = req_64bit->sglistinfo_len;

			}

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_TEE_INVOKE_COMMAND: {
@@ -951,7 +974,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[3] = req_64bit->resp_ptr;

				desc.args[4] = req_64bit->resp_len;

			}

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_TEE_INVOKE_COMMAND_WHITELIST: {
@@ -981,7 +1004,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[5] = req_64bit->sglistinfo_ptr;

				desc.args[6] = req_64bit->sglistinfo_len;

			}

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_TEE_CLOSE_SESSION: {
@@ -1006,7 +1029,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[3] = req_64bit->resp_ptr;

				desc.args[4] = req_64bit->resp_len;

			}

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_TEE_REQUEST_CANCELLATION: {
@@ -1032,7 +1055,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
				desc.args[3] = req_64bit->resp_ptr;

				desc.args[4] = req_64bit->resp_len;

			}

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		case QSEOS_CONTINUE_BLOCKED_REQ_COMMAND: {
@@ -1047,7 +1070,7 @@ static int qseecom_scm_call2(uint32_t svc_id, uint32_t tz_cmd_id, 
			desc.arginfo =

				TZ_OS_CONTINUE_BLOCKED_REQUEST_ID_PARAM_ID;

			desc.args[0] = req->app_or_session_id;

			ret = scm_call2(smc_id, &desc);

			ret = __qseecom_scm_call2_locked(smc_id, &desc);

			break;

		}

		default: {
@@ -6431,7 +6454,7 @@ static int qseecom_mdtp_cipher_dip(void __user *argp) 
		if (ret)

			break;



		ret = scm_call2(TZ_MDTP_CIPHER_DIP_ID, &desc);

		ret = __qseecom_scm_call2_locked(TZ_MDTP_CIPHER_DIP_ID, &desc);



		__qseecom_disable_clk(CLK_QSEE);
@@ -8706,8 +8729,10 @@ static int qseecom_probe(struct platform_device *pdev) 
	qseecom.send_resp_flag = 0;



	qseecom.qsee_version = QSEEE_VERSION_00;

	mutex_lock(&app_access_lock);

	rc = qseecom_scm_call(6, 3, &feature, sizeof(feature),

		&resp, sizeof(resp));

	mutex_unlock(&app_access_lock);

	pr_info("qseecom.qsee_version = 0x%x\n", resp.result);

	if (rc) {

		pr_err("Failed to get QSEE version info %d\n", rc);
@@ -8862,9 +8887,11 @@ static int qseecom_probe(struct platform_device *pdev) 
				rc = -EIO;

				goto exit_deinit_clock;

			}

			mutex_lock(&app_access_lock);

			rc = qseecom_scm_call(SCM_SVC_TZSCHEDULER, 1,

					cmd_buf, cmd_len,

					&resp, sizeof(resp));

			mutex_unlock(&app_access_lock);

			__qseecom_disable_clk(CLK_QSEE);

			if (rc || (resp.result != QSEOS_RESULT_SUCCESS)) {

				pr_err("send secapp reg fail %d resp.res %d\n",