static int qsee_load_trustlet(struct QSEECom_handle **clnt_handle, const char *path, const char *fname, uint32_t sb_size) { int ret = 0; char* errstr; ALOGE("Starting app %s\n", fname); ret = mStartApp(&mHandle, path, fname, 1024); if (ret < 0) { errstr = qsee_error_strings(ret); ALOGE("Could not load app %s. Error: %s (%d)\n", fname, errstr, ret); } else ALOGE("TZ App loaded : %s\n", fname); return ret; }
int fpc_init() { ALOGE("INIT FPC TZ APP\n"); open_handle(); if (open_handle() < 1) { ALOGE("Qseecom Lib Not Open !\n"); return -1; } if (device_enable() < 0) { ALOGE("Error starting device\n"); return -1; } ALOGE("Starting app %s\n", FP_TZAPP_NAME); if (mStartApp(&mHandle, FP_TZAPP_PATH, FP_TZAPP_NAME, 1024) < 0) { ALOGE("Could not load app : %s\n", FP_TZAPP_NAME); return -1; } ALOGE("TZ App loaded : %s\n", FP_TZAPP_NAME); ALOGE("Starting app %s\n", KM_TZAPP_NAME); if (mStartApp(&mHdl, KM_TZAPP_PATH, KM_TZAPP_NAME, 1024) < 0) { ALOGE("Could not load app : %s\n", KM_TZAPP_NAME); return -1; } ALOGE("TZ App loaded : %s\n", KM_TZAPP_NAME); // Start creating one off command to get cert from keymaster fpc_send_std_cmd_t *req = (fpc_send_std_cmd_t *) mHdl->ion_sbuffer; req->cmd_id = 0x205; req->ret_val = 0x02; void * send_buf = mHdl->ion_sbuffer; void * rec_buf = mHdl->ion_sbuffer + 64; if (send_cmd_fn(mHdl, send_buf, 64, rec_buf, 1024-64) < 0) { return -1; } //Send command to keymaster fpc_send_std_cmd_t* ret_data = (fpc_send_std_cmd_t*) rec_buf; ALOGE("Keymaster Response Code : %u\n", ret_data->ret_val); ALOGE("Keymaster Response Length : %u\n", ret_data->length); void * data_buff = &ret_data->length + 1; if (send_modified_command_to_tz(FPC_SET_INIT_DATA,mHandle,data_buff,ret_data->length) < 0) { ALOGE("Error sending data to tz\n"); return -1; } if (send_normal_command(FPC_INIT,0,mHandle) != 0) { ALOGE("Error sending FPC_INIT to tz\n"); return -1; } if (send_normal_command(FPC_GET_INIT_STATE,0,mHandle) != 0) { ALOGE("Error sending FPC_GET_INIT_STATE to tz\n"); return -1; } if (send_normal_command(FPC_INIT_UNK_1,0,mHandle) != 12) { ALOGE("Error sending FPC_INIT_UNK_1 to tz\n"); return -1; } if (device_enable() < 0) { ALOGE("Error starting device\n"); return -1; } if (send_normal_command(FPC_INIT_UNK_2,0,mHandle) != 0) { ALOGE("Error sending FPC_INIT_UNK_2 to tz\n"); return -1; } int fpc_info = send_normal_command(FPC_INIT_UNK_0,0,mHandle); ALOGI("Got device data : %d \n", fpc_info); if (device_disable() < 0) { ALOGE("Error stopping device\n"); return -1; } set_bandwidth_fn(mHandle,true); if (send_normal_command(FPC_INIT_NEW_DB,0,mHandle) != 0) { ALOGE("Error sending FPC_INIT_NEW_DB to tz\n"); return -1; } if (send_normal_command(FPC_SET_FP_STORE,0,mHandle) != 0) { ALOGE("Error sending FPC_SET_FP_STORE to tz\n"); return -1; } set_bandwidth_fn(mHandle,false); return 1; }