mce.c 5.94 KB
Newer Older
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
/*
 * Copyright (c) 2019, NVIDIA CORPORATION. All rights reserved.
 *
 * SPDX-License-Identifier: BSD-3-Clause
 */

#include <arch.h>
#include <arch_helpers.h>
#include <assert.h>
#include <common/bl_common.h>
#include <context.h>
#include <lib/el3_runtime/context_mgmt.h>
#include <common/debug.h>
#include <denver.h>
#include <mce.h>
#include <mce_private.h>
Steven Kao's avatar
Steven Kao committed
17
#include <platform_def.h>
18
#include <stdbool.h>
19
20
#include <string.h>
#include <errno.h>
Steven Kao's avatar
Steven Kao committed
21
#include <t194_nvg.h>
22
23
#include <tegra_def.h>
#include <tegra_platform.h>
24
#include <tegra_private.h>
25

26
27
28
29
30
31
32
33
34
35
36
37
/* Handler to check if MCE firmware is supported */
static bool mce_firmware_not_supported(void)
{
	bool status;

	/* these platforms do not load MCE firmware */
	status = tegra_platform_is_linsim() || tegra_platform_is_qt() ||
		 tegra_platform_is_virt_dev_kit();

	return status;
}

38
39
40
/*******************************************************************************
 * Common handler for all MCE commands
 ******************************************************************************/
41
int32_t mce_command_handler(uint64_t cmd, uint64_t arg0, uint64_t arg1,
42
43
			uint64_t arg2)
{
Steven Kao's avatar
Steven Kao committed
44
	int32_t ret = 0;
45
46

	switch (cmd) {
47
	case (uint64_t)MCE_CMD_ENTER_CSTATE:
Steven Kao's avatar
Steven Kao committed
48
49
50
51
52
		ret = nvg_enter_cstate((uint32_t)arg0, (uint32_t)arg1);
		if (ret < 0) {
			ERROR("%s: enter_cstate failed(%d)\n", __func__, ret);
		}

53
54
		break;

55
	case (uint64_t)MCE_CMD_IS_SC7_ALLOWED:
Steven Kao's avatar
Steven Kao committed
56
57
58
59
		ret = nvg_is_sc7_allowed();
		if (ret < 0) {
			ERROR("%s: is_sc7_allowed failed(%d)\n", __func__, ret);
		}
60
61
62

		break;

63
	case (uint64_t)MCE_CMD_ONLINE_CORE:
Steven Kao's avatar
Steven Kao committed
64
65
66
67
		ret = nvg_online_core((uint32_t)arg0);
		if (ret < 0) {
			ERROR("%s: online_core failed(%d)\n", __func__, ret);
		}
68
69
70
71

		break;

	default:
72
		ERROR("unknown MCE command (%llu)\n", cmd);
73
		ret = -EINVAL;
Steven Kao's avatar
Steven Kao committed
74
		break;
75
76
77
78
79
80
81
82
	}

	return ret;
}

/*******************************************************************************
 * Handler to update carveout values for Video Memory Carveout region
 ******************************************************************************/
Steven Kao's avatar
Steven Kao committed
83
int32_t mce_update_gsc_videomem(void)
84
{
85
86
87
88
89
90
91
92
93
94
95
96
	int32_t ret;

	/*
	 * MCE firmware is not running on simulation platforms.
	 */
	if (mce_firmware_not_supported()) {
		ret = -EINVAL;
	} else {
		ret = nvg_update_ccplex_gsc((uint32_t)TEGRA_NVG_CHANNEL_UPDATE_GSC_VPR);
	}

	return ret;
97
98
99
100
101
}

/*******************************************************************************
 * Handler to update carveout values for TZDRAM aperture
 ******************************************************************************/
Steven Kao's avatar
Steven Kao committed
102
int32_t mce_update_gsc_tzdram(void)
103
{
104
105
106
107
108
109
110
111
112
113
114
115
	int32_t ret;

	/*
	 * MCE firmware is not running on simulation platforms.
	 */
	if (mce_firmware_not_supported()) {
		ret = -EINVAL;
	} else {
		ret = nvg_update_ccplex_gsc((uint32_t)TEGRA_NVG_CHANNEL_UPDATE_GSC_TZ_DRAM);
	}

	return ret;
116
117
118
119
120
}

/*******************************************************************************
 * Handler to update carveout values for TZ SysRAM aperture
 ******************************************************************************/
Steven Kao's avatar
Steven Kao committed
121
int32_t mce_update_gsc_tzram(void)
122
{
123
124
125
126
127
128
129
130
131
132
133
134
	int32_t ret;

	/*
	 * MCE firmware is not running on simulation platforms.
	 */
	if (mce_firmware_not_supported()) {
		ret = -EINVAL;
	} else {
		ret = nvg_update_ccplex_gsc((uint32_t)TEGRA_NVG_CHANNEL_UPDATE_GSC_TZRAM);
	}

	return ret;
135
136
137
138
139
}

/*******************************************************************************
 * Handler to issue the UPDATE_CSTATE_INFO request
 ******************************************************************************/
140
void mce_update_cstate_info(const mce_cstate_info_t *cstate)
141
142
{
	/* issue the UPDATE_CSTATE_INFO request */
Steven Kao's avatar
Steven Kao committed
143
144
	nvg_update_cstate_info(cstate->cluster, cstate->ccplex, cstate->system,
		cstate->wake_mask, cstate->update_wake_mask);
145
146
147
148
149
150
151
152
153
154
155
156
157
158
}

/*******************************************************************************
 * Handler to read the MCE firmware version and check if it is compatible
 * with interface header the BL3-1 was compiled against
 ******************************************************************************/
void mce_verify_firmware_version(void)
{
	uint64_t version;
	uint32_t major, minor;

	/*
	 * MCE firmware is not running on simulation platforms.
	 */
159
	if (mce_firmware_not_supported()) {
160
		return;
Steven Kao's avatar
Steven Kao committed
161
	}
162
163
164
165
166

	/*
	 * Read the MCE firmware version and extract the major and minor
	 * version fields
	 */
Steven Kao's avatar
Steven Kao committed
167
168
169
	version = nvg_get_version();
	minor = (uint32_t)version;
	major = (uint32_t)(version >> 32);
170

171
172
	INFO("MCE Version - HW=%u:%u, SW=%u:%u\n", major, minor,
		TEGRA_NVG_VERSION_MAJOR, TEGRA_NVG_VERSION_MINOR);
173
174
175
176
177

	/*
	 * Verify that the MCE firmware version and the interface header
	 * match
	 */
Steven Kao's avatar
Steven Kao committed
178
	if (major != (uint32_t)TEGRA_NVG_VERSION_MAJOR) {
179
180
181
182
		ERROR("MCE major version mismatch\n");
		panic();
	}

Steven Kao's avatar
Steven Kao committed
183
	if (minor < (uint32_t)TEGRA_NVG_VERSION_MINOR) {
184
185
186
187
		ERROR("MCE minor version mismatch\n");
		panic();
	}
}
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237

/*******************************************************************************
 * Handler to enable the strict checking mode
 ******************************************************************************/
void mce_enable_strict_checking(void)
{
	uint64_t sctlr = read_sctlr_el3();
	int32_t ret = 0;

	if (tegra_platform_is_silicon() || tegra_platform_is_fpga()) {
		/*
		 * Step1: TZ-DRAM and TZRAM should be setup before the MMU is
		 * enabled.
		 *
		 * The common code makes sure that TZDRAM/TZRAM are already
		 * enabled before calling into this handler. If this is not the
		 * case, the following sequence must be executed before moving
		 * on to step 2.
		 *
		 * tlbialle1is();
		 * tlbialle3is();
		 * dsbsy();
		 * isb();
		 *
		 */
		if ((sctlr & (uint64_t)SCTLR_M_BIT) == (uint64_t)SCTLR_M_BIT) {
			tlbialle1is();
			tlbialle3is();
			dsbsy();
			isb();
		}

		/*
		 * Step2: SCF flush - Clean and invalidate caches and clear the
		 * TR-bits
		 */
		ret = nvg_roc_clean_cache_trbits();
		if (ret < 0) {
			ERROR("%s: flush cache_trbits failed(%d)\n", __func__,
				ret);
			return;
		}

		/*
		 * Step3: Issue the SECURITY_CONFIG request to MCE to enable
		 * strict checking mode.
		 */
		nvg_enable_strict_checking_mode();
	}
}