|
8 | 8 | #include <asm/coco.h> |
9 | 9 | #include <asm/tdx.h> |
10 | 10 | #include <asm/vmx.h> |
| 11 | +#include <asm/insn.h> |
| 12 | +#include <asm/insn-eval.h> |
11 | 13 |
|
12 | 14 | /* TDX module Call Leaf IDs */ |
13 | 15 | #define TDX_GET_INFO 1 |
14 | 16 | #define TDX_GET_VEINFO 3 |
15 | 17 |
|
| 18 | +/* MMIO direction */ |
| 19 | +#define EPT_READ 0 |
| 20 | +#define EPT_WRITE 1 |
| 21 | + |
16 | 22 | /* |
17 | 23 | * Wrapper for standard use of __tdx_hypercall with no output aside from |
18 | 24 | * return code. |
@@ -222,6 +228,119 @@ static bool handle_cpuid(struct pt_regs *regs) |
222 | 228 | return true; |
223 | 229 | } |
224 | 230 |
|
| 231 | +static bool mmio_read(int size, unsigned long addr, unsigned long *val) |
| 232 | +{ |
| 233 | + struct tdx_hypercall_args args = { |
| 234 | + .r10 = TDX_HYPERCALL_STANDARD, |
| 235 | + .r11 = hcall_func(EXIT_REASON_EPT_VIOLATION), |
| 236 | + .r12 = size, |
| 237 | + .r13 = EPT_READ, |
| 238 | + .r14 = addr, |
| 239 | + .r15 = *val, |
| 240 | + }; |
| 241 | + |
| 242 | + if (__tdx_hypercall(&args, TDX_HCALL_HAS_OUTPUT)) |
| 243 | + return false; |
| 244 | + *val = args.r11; |
| 245 | + return true; |
| 246 | +} |
| 247 | + |
| 248 | +static bool mmio_write(int size, unsigned long addr, unsigned long val) |
| 249 | +{ |
| 250 | + return !_tdx_hypercall(hcall_func(EXIT_REASON_EPT_VIOLATION), size, |
| 251 | + EPT_WRITE, addr, val); |
| 252 | +} |
| 253 | + |
| 254 | +static bool handle_mmio(struct pt_regs *regs, struct ve_info *ve) |
| 255 | +{ |
| 256 | + char buffer[MAX_INSN_SIZE]; |
| 257 | + unsigned long *reg, val; |
| 258 | + struct insn insn = {}; |
| 259 | + enum mmio_type mmio; |
| 260 | + int size, extend_size; |
| 261 | + u8 extend_val = 0; |
| 262 | + |
| 263 | + /* Only in-kernel MMIO is supported */ |
| 264 | + if (WARN_ON_ONCE(user_mode(regs))) |
| 265 | + return false; |
| 266 | + |
| 267 | + if (copy_from_kernel_nofault(buffer, (void *)regs->ip, MAX_INSN_SIZE)) |
| 268 | + return false; |
| 269 | + |
| 270 | + if (insn_decode(&insn, buffer, MAX_INSN_SIZE, INSN_MODE_64)) |
| 271 | + return false; |
| 272 | + |
| 273 | + mmio = insn_decode_mmio(&insn, &size); |
| 274 | + if (WARN_ON_ONCE(mmio == MMIO_DECODE_FAILED)) |
| 275 | + return false; |
| 276 | + |
| 277 | + if (mmio != MMIO_WRITE_IMM && mmio != MMIO_MOVS) { |
| 278 | + reg = insn_get_modrm_reg_ptr(&insn, regs); |
| 279 | + if (!reg) |
| 280 | + return false; |
| 281 | + } |
| 282 | + |
| 283 | + ve->instr_len = insn.length; |
| 284 | + |
| 285 | + /* Handle writes first */ |
| 286 | + switch (mmio) { |
| 287 | + case MMIO_WRITE: |
| 288 | + memcpy(&val, reg, size); |
| 289 | + return mmio_write(size, ve->gpa, val); |
| 290 | + case MMIO_WRITE_IMM: |
| 291 | + val = insn.immediate.value; |
| 292 | + return mmio_write(size, ve->gpa, val); |
| 293 | + case MMIO_READ: |
| 294 | + case MMIO_READ_ZERO_EXTEND: |
| 295 | + case MMIO_READ_SIGN_EXTEND: |
| 296 | + /* Reads are handled below */ |
| 297 | + break; |
| 298 | + case MMIO_MOVS: |
| 299 | + case MMIO_DECODE_FAILED: |
| 300 | + /* |
| 301 | + * MMIO was accessed with an instruction that could not be |
| 302 | + * decoded or handled properly. It was likely not using io.h |
| 303 | + * helpers or accessed MMIO accidentally. |
| 304 | + */ |
| 305 | + return false; |
| 306 | + default: |
| 307 | + WARN_ONCE(1, "Unknown insn_decode_mmio() decode value?"); |
| 308 | + return false; |
| 309 | + } |
| 310 | + |
| 311 | + /* Handle reads */ |
| 312 | + if (!mmio_read(size, ve->gpa, &val)) |
| 313 | + return false; |
| 314 | + |
| 315 | + switch (mmio) { |
| 316 | + case MMIO_READ: |
| 317 | + /* Zero-extend for 32-bit operation */ |
| 318 | + extend_size = size == 4 ? sizeof(*reg) : 0; |
| 319 | + break; |
| 320 | + case MMIO_READ_ZERO_EXTEND: |
| 321 | + /* Zero extend based on operand size */ |
| 322 | + extend_size = insn.opnd_bytes; |
| 323 | + break; |
| 324 | + case MMIO_READ_SIGN_EXTEND: |
| 325 | + /* Sign extend based on operand size */ |
| 326 | + extend_size = insn.opnd_bytes; |
| 327 | + if (size == 1 && val & BIT(7)) |
| 328 | + extend_val = 0xFF; |
| 329 | + else if (size > 1 && val & BIT(15)) |
| 330 | + extend_val = 0xFF; |
| 331 | + break; |
| 332 | + default: |
| 333 | + /* All other cases has to be covered with the first switch() */ |
| 334 | + WARN_ON_ONCE(1); |
| 335 | + return false; |
| 336 | + } |
| 337 | + |
| 338 | + if (extend_size) |
| 339 | + memset(reg, extend_val, extend_size); |
| 340 | + memcpy(reg, &val, size); |
| 341 | + return true; |
| 342 | +} |
| 343 | + |
225 | 344 | void tdx_get_ve_info(struct ve_info *ve) |
226 | 345 | { |
227 | 346 | struct tdx_module_output out; |
@@ -276,6 +395,8 @@ static bool virt_exception_kernel(struct pt_regs *regs, struct ve_info *ve) |
276 | 395 | return write_msr(regs); |
277 | 396 | case EXIT_REASON_CPUID: |
278 | 397 | return handle_cpuid(regs); |
| 398 | + case EXIT_REASON_EPT_VIOLATION: |
| 399 | + return handle_mmio(regs, ve); |
279 | 400 | default: |
280 | 401 | pr_warn("Unexpected #VE: %lld\n", ve->exit_reason); |
281 | 402 | return false; |
|
0 commit comments