1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
|
/*
* Copyright (C) 2016 Samsung Electronics, Inc.
*
* This software is licensed under the terms of the GNU General Public
* License version 2, as published by the Free Software Foundation, and
* may be copied, distributed, and modified under those terms.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include <linux/init.h>
#include <linux/ioctl.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/printk.h>
#include <linux/fs.h>
#include <linux/miscdevice.h>
#include <linux/uaccess.h>
#include <linux/mutex.h>
#include "tzirs.h"
#include "tz_cdev.h"
#include "tz_platform.h"
#include "tzdev.h"
#if defined(CONFIG_ARCH_MSM) && defined(CONFIG_MSM_SCM)
#if defined(CONFIG_ARCH_MSM8939) || defined(CONFIG_ARCH_MSM8996)
#include <soc/qcom/scm.h>
#else
#error "Unsupported target! The only MSM8996 and MSM8939 are supported for Qualcomm chipset"
#endif
#endif
MODULE_LICENSE("GPL");
MODULE_AUTHOR("Oleksii Mosolab");
#ifdef TZIRS_DEBUG
#define DBG(...) pr_info( "[tzirs] DBG : " __VA_ARGS__)
#define ERR(...) pr_alert("[tzirs] ERR : " __VA_ARGS__)
#else
#define DBG(...)
#define ERR(...) pr_alert("[tzirs] ERR : " __VA_ARGS__)
#endif
/* Set appropriate command value */
#define SMC_IRS_CMD_RAW (0x0000000B)
#ifdef CONFIG_TZDEV_USE_ARM_CALLING_CONVENTION
#define SMC_IRS_CMD CREATE_SMC_CMD(SMC_TYPE_FAST, SMC_AARCH_32, SMC_TOS0_SERVICE_MASK, SMC_IRS_CMD_RAW)
#else
#define SMC_IRS_CMD SMC_IRS_CMD_RAW
#endif
#if defined(CONFIG_ARCH_MSM) && defined(CONFIG_MSM_SCM)
#define SCM_BLOW_SW_FUSE_ID 0x01
#define SCM_IS_SW_FUSE_BLOWN_ID 0x02
static long __tzirs_smc_cmd(uint32_t p0, uint32_t *p1, uint32_t *p2, uint32_t *p3)
{
unsigned int ret;
struct scm_desc desc = {0};
desc.args[0] = *p1;
desc.arginfo = SCM_ARGS(1);
switch(*p3) {
case IRS_SET_FLAG_CMD:
ret = scm_call2(SCM_SIP_FNID(p0, SCM_BLOW_SW_FUSE_ID), &desc);
DBG("[SET_FLAG_CMD] : scm_call2 returned 0x%08x\n", ret);
break;
case IRS_GET_FLAG_VAL_CMD:
ret = scm_call2(SCM_SIP_FNID(p0, SCM_IS_SW_FUSE_BLOWN_ID), &desc);
if (ret) {
ERR("[GET_FLAG_CMD] : scm_call2 failed ret = 0x%08x\n", ret);
break;
}
DBG("[GET_FLAG_CMD] : desc.ret[0] = 0x%08x\n", (unsigned int) desc.ret[0]);
*p2 = (uint32_t) desc.ret[0];
break;
default:
ERR("Wrong SCM command ID\n");
ret = IRS_INCORRECT_FLAG_TYPE;
break;
}
return ret;
}
#else /* defined(CONFIG_ARCH_MSM) && defined(CONFIG_MSM_SCM) */
static long __tzirs_smc_cmd(unsigned long p0, unsigned long *p1, unsigned long *p2, unsigned long *p3)
{
struct tzdev_smc_data data;
data.args[0] = (uint32_t)p0;
data.args[1] = (uint32_t)*p1;
data.args[2] = (uint32_t)*p2;
data.args[3] = (uint32_t)*p3;
data.args[4] = 0;
data.args[5] = 0;
data.args[6] = 0;
tzdev_platform_smc_call(&data);
*p1 = data.args[1];
*p2 = data.args[2];
*p3 = data.args[3];
return data.args[0];
}
#endif /* defined(CONFIG_ARCH_MSM) && defined(CONFIG_MSM_SCM) */
long tzirs_smc(unsigned long *p1, unsigned long *p2, unsigned long *p3)
{
#if defined(CONFIG_ARCH_MSM) && defined(CONFIG_MSM_SCM)
return __tzirs_smc_cmd(SCM_SVC_FUSE, (uint32_t *)p1, (uint32_t *)p2 , (uint32_t *)p3);
#else
return __tzirs_smc_cmd(SMC_IRS_CMD, p1, p2, p3);
#endif
}
|