188 lines · c
1/*2 * Copyright 2021 Advanced Micro Devices, Inc.3 *4 * Permission is hereby granted, free of charge, to any person obtaining a5 * copy of this software and associated documentation files (the "Software"),6 * to deal in the Software without restriction, including without limitation7 * the rights to use, copy, modify, merge, publish, distribute, sublicense,8 * and/or sell copies of the Software, and to permit persons to whom the9 * Software is furnished to do so, subject to the following conditions:10 *11 * The above copyright notice and this permission notice shall be included in12 * all copies or substantial portions of the Software.13 *14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL17 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR18 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,19 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR20 * OTHER DEALINGS IN THE SOFTWARE.21 *22 *23 */24#include <linux/debugfs.h>25#include <linux/pm_runtime.h>26 27#include "amdgpu.h"28#include "amdgpu_securedisplay.h"29 30/**31 * DOC: AMDGPU SECUREDISPLAY debugfs test interface32 *33 * how to use?34 * echo opcode <value> > <debugfs_dir>/dri/xxx/securedisplay_test35 * eg. echo 1 > <debugfs_dir>/dri/xxx/securedisplay_test36 * eg. echo 2 phy_id > <debugfs_dir>/dri/xxx/securedisplay_test37 *38 * opcode:39 * 1：Query whether TA is responding used only for validation pupose40 * 2: Send region of Interest and CRC value to I2C. (uint32)phy_id is41 * send to determine which DIO scratch register should be used to get42 * ROI and receive i2c_buf as the output.43 *44 * You can refer more detail from header file ta_securedisplay_if.h45 *46 */47 48void psp_securedisplay_parse_resp_status(struct psp_context *psp,49 enum ta_securedisplay_status status)50{51 switch (status) {52 case TA_SECUREDISPLAY_STATUS__SUCCESS:53 break;54 case TA_SECUREDISPLAY_STATUS__GENERIC_FAILURE:55 dev_err(psp->adev->dev, "Secure display: Generic Failure.");56 break;57 case TA_SECUREDISPLAY_STATUS__INVALID_PARAMETER:58 dev_err(psp->adev->dev, "Secure display: Invalid Parameter.");59 break;60 case TA_SECUREDISPLAY_STATUS__NULL_POINTER:61 dev_err(psp->adev->dev, "Secure display: Null Pointer.");62 break;63 case TA_SECUREDISPLAY_STATUS__I2C_WRITE_ERROR:64 dev_err(psp->adev->dev, "Secure display: Failed to write to I2C.");65 break;66 case TA_SECUREDISPLAY_STATUS__READ_DIO_SCRATCH_ERROR:67 dev_err(psp->adev->dev, "Secure display: Failed to Read DIO Scratch Register.");68 break;69 case TA_SECUREDISPLAY_STATUS__READ_CRC_ERROR:70 dev_err(psp->adev->dev, "Secure display: Failed to Read CRC");71 break;72 case TA_SECUREDISPLAY_STATUS__I2C_INIT_ERROR:73 dev_err(psp->adev->dev, "Secure display: Failed to initialize I2C.");74 break;75 default:76 dev_err(psp->adev->dev, "Secure display: Failed to parse status: %d\n", status);77 }78}79 80void psp_prep_securedisplay_cmd_buf(struct psp_context *psp, struct ta_securedisplay_cmd **cmd,81 enum ta_securedisplay_command command_id)82{83 *cmd = (struct ta_securedisplay_cmd *)psp->securedisplay_context.context.mem_context.shared_buf;84 memset(*cmd, 0, sizeof(struct ta_securedisplay_cmd));85 (*cmd)->status = TA_SECUREDISPLAY_STATUS__GENERIC_FAILURE;86 (*cmd)->cmd_id = command_id;87}88 89#if defined(CONFIG_DEBUG_FS)90 91static ssize_t amdgpu_securedisplay_debugfs_write(struct file *f, const char __user *buf,92 size_t size, loff_t *pos)93{94 struct amdgpu_device *adev = (struct amdgpu_device *)file_inode(f)->i_private;95 struct psp_context *psp = &adev->psp;96 struct ta_securedisplay_cmd *securedisplay_cmd;97 struct drm_device *dev = adev_to_drm(adev);98 uint32_t phy_id;99 uint32_t op;100 char str[64];101 int ret;102 103 if (*pos || size > sizeof(str) - 1)104 return -EINVAL;105 106 memset(str, 0, sizeof(str));107 ret = copy_from_user(str, buf, size);108 if (ret)109 return -EFAULT;110 111 ret = pm_runtime_get_sync(dev->dev);112 if (ret < 0) {113 pm_runtime_put_autosuspend(dev->dev);114 return ret;115 }116 117 if (size < 3)118 sscanf(str, "%u ", &op);119 else120 sscanf(str, "%u %u", &op, &phy_id);121 122 switch (op) {123 case 1:124 mutex_lock(&psp->securedisplay_context.mutex);125 psp_prep_securedisplay_cmd_buf(psp, &securedisplay_cmd,126 TA_SECUREDISPLAY_COMMAND__QUERY_TA);127 ret = psp_securedisplay_invoke(psp, TA_SECUREDISPLAY_COMMAND__QUERY_TA);128 if (!ret) {129 if (securedisplay_cmd->status == TA_SECUREDISPLAY_STATUS__SUCCESS)130 dev_info(adev->dev, "SECUREDISPLAY: query securedisplay TA ret is 0x%X\n",131 securedisplay_cmd->securedisplay_out_message.query_ta.query_cmd_ret);132 else133 psp_securedisplay_parse_resp_status(psp, securedisplay_cmd->status);134 }135 mutex_unlock(&psp->securedisplay_context.mutex);136 break;137 case 2:138 if (size < 3 || phy_id >= TA_SECUREDISPLAY_MAX_PHY) {139 dev_err(adev->dev, "Invalid input: %s\n", str);140 return -EINVAL;141 }142 mutex_lock(&psp->securedisplay_context.mutex);143 psp_prep_securedisplay_cmd_buf(psp, &securedisplay_cmd,144 TA_SECUREDISPLAY_COMMAND__SEND_ROI_CRC);145 securedisplay_cmd->securedisplay_in_message.send_roi_crc.phy_id = phy_id;146 ret = psp_securedisplay_invoke(psp, TA_SECUREDISPLAY_COMMAND__SEND_ROI_CRC);147 if (!ret) {148 if (securedisplay_cmd->status == TA_SECUREDISPLAY_STATUS__SUCCESS) {149 dev_info(adev->dev, "SECUREDISPLAY: I2C buffer out put is: %*ph\n",150 TA_SECUREDISPLAY_I2C_BUFFER_SIZE,151 securedisplay_cmd->securedisplay_out_message.send_roi_crc.i2c_buf);152 } else {153 psp_securedisplay_parse_resp_status(psp, securedisplay_cmd->status);154 }155 }156 mutex_unlock(&psp->securedisplay_context.mutex);157 break;158 default:159 dev_err(adev->dev, "Invalid input: %s\n", str);160 }161 162 pm_runtime_mark_last_busy(dev->dev);163 pm_runtime_put_autosuspend(dev->dev);164 165 return size;166}167 168static const struct file_operations amdgpu_securedisplay_debugfs_ops = {169 .owner = THIS_MODULE,170 .read = NULL,171 .write = amdgpu_securedisplay_debugfs_write,172 .llseek = default_llseek173};174 175#endif176 177void amdgpu_securedisplay_debugfs_init(struct amdgpu_device *adev)178{179#if defined(CONFIG_DEBUG_FS)180 181 if (!adev->psp.securedisplay_context.context.initialized)182 return;183 184 debugfs_create_file("securedisplay_test", S_IWUSR, adev_to_drm(adev)->primary->debugfs_root,185 adev, &amdgpu_securedisplay_debugfs_ops);186#endif187}188