]>
Commit | Line | Data |
---|---|---|
666028fc MP |
1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | /* | |
3 | * Copyright 2018 | |
4 | * Michalis Pappas <[email protected]> | |
5 | */ | |
6 | #include <asm/psci.h> | |
7 | #include <common.h> | |
8 | #include <command.h> | |
9 | #include <linux/arm-smccc.h> | |
10 | #include <linux/compiler.h> | |
11 | #include <linux/psci.h> | |
12 | ||
09140113 SG |
13 | static int do_call(struct cmd_tbl *cmdtp, int flag, int argc, |
14 | char *const argv[]) | |
666028fc MP |
15 | { |
16 | struct arm_smccc_res res; | |
17 | ||
18 | unsigned long fid; | |
19 | ||
20 | unsigned long a1; | |
21 | unsigned long a2; | |
22 | unsigned long a3; | |
23 | unsigned long a4; | |
24 | unsigned long a5; | |
25 | unsigned long a6; | |
26 | unsigned long a7; | |
27 | ||
28 | if (argc < 2) | |
29 | return CMD_RET_USAGE; | |
30 | ||
7e5f460e | 31 | fid = hextoul(argv[1], NULL); |
666028fc | 32 | |
7e5f460e SG |
33 | a1 = argc > 2 ? hextoul(argv[2], NULL) : 0; |
34 | a2 = argc > 3 ? hextoul(argv[3], NULL) : 0; | |
35 | a3 = argc > 4 ? hextoul(argv[4], NULL) : 0; | |
36 | a4 = argc > 5 ? hextoul(argv[5], NULL) : 0; | |
37 | a5 = argc > 6 ? hextoul(argv[6], NULL) : 0; | |
38 | a6 = argc > 7 ? hextoul(argv[7], NULL) : 0; | |
39 | a7 = argc > 8 ? hextoul(argv[8], NULL) : 0; | |
666028fc MP |
40 | |
41 | if (!strcmp(argv[0], "smc")) | |
42 | arm_smccc_smc(fid, a1, a2, a3, a4, a5, a6, a7, &res); | |
43 | else | |
44 | arm_smccc_hvc(fid, a1, a2, a3, a4, a5, a6, a7, &res); | |
45 | ||
46 | printf("Res: %ld %ld %ld %ld\n", res.a0, res.a1, res.a2, res.a3); | |
47 | ||
48 | return 0; | |
49 | } | |
50 | ||
51 | #ifdef CONFIG_CMD_SMC | |
52 | U_BOOT_CMD( | |
8f20c480 | 53 | smc, 9, 2, do_call, |
666028fc MP |
54 | "Issue a Secure Monitor Call", |
55 | "<fid> [arg1 ... arg6] [id]\n" | |
56 | " - fid Function ID\n" | |
57 | " - arg SMC arguments, passed to X1-X6 (default to zero)\n" | |
58 | " - id Secure OS ID / Session ID, passed to W7 (defaults to zero)\n" | |
59 | ); | |
60 | #endif | |
61 | ||
62 | #ifdef CONFIG_CMD_HVC | |
63 | U_BOOT_CMD( | |
8f20c480 | 64 | hvc, 9, 2, do_call, |
666028fc | 65 | "Issue a Hypervisor Call", |
8f20c480 | 66 | "<fid> [arg1...arg6] [id]\n" |
666028fc MP |
67 | " - fid Function ID\n" |
68 | " - arg HVC arguments, passed to X1-X6 (default to zero)\n" | |
69 | " - id Session ID, passed to W7 (defaults to zero)\n" | |
70 | ); | |
71 | #endif | |
72 |