Commit | Line | Data |
---|---|---|
b8eb35fd CD |
1 | /* |
2 | * Copyright (C) 2013 Broadcom Corporation | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or | |
5 | * modify it under the terms of the GNU General Public License as | |
6 | * published by the Free Software Foundation version 2. | |
7 | * | |
8 | * This program is distributed "as is" WITHOUT ANY WARRANTY of any | |
9 | * kind, whether express or implied; without even the implied warranty | |
10 | * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
11 | * GNU General Public License for more details. | |
12 | */ | |
13 | ||
14 | #include <stdarg.h> | |
15 | #include <linux/smp.h> | |
16 | #include <linux/io.h> | |
17 | #include <linux/ioport.h> | |
18 | ||
19 | #include <asm/cacheflush.h> | |
20 | #include <linux/of_address.h> | |
21 | ||
22 | #include "bcm_kona_smc.h" | |
23 | ||
c64756cc AE |
24 | static u32 bcm_smc_buffer_phys; /* physical address */ |
25 | static void __iomem *bcm_smc_buffer; /* virtual address */ | |
b8eb35fd CD |
26 | |
27 | struct bcm_kona_smc_data { | |
28 | unsigned service_id; | |
29 | unsigned arg0; | |
30 | unsigned arg1; | |
31 | unsigned arg2; | |
32 | unsigned arg3; | |
33 | }; | |
34 | ||
35 | static const struct of_device_id bcm_kona_smc_ids[] __initconst = { | |
aea237bf CD |
36 | {.compatible = "brcm,kona-smc"}, |
37 | {.compatible = "bcm,kona-smc"}, /* deprecated name */ | |
b8eb35fd CD |
38 | {}, |
39 | }; | |
40 | ||
c64756cc | 41 | /* Map in the args buffer area */ |
3a76b351 | 42 | int __init bcm_kona_smc_init(void) |
b8eb35fd CD |
43 | { |
44 | struct device_node *node; | |
5c4cee2f | 45 | const __be32 *prop_val; |
c64756cc AE |
46 | u64 prop_size = 0; |
47 | unsigned long buffer_size; | |
48 | u32 buffer_phys; | |
b8eb35fd CD |
49 | |
50 | /* Read buffer addr and size from the device tree node */ | |
51 | node = of_find_matching_node(NULL, bcm_kona_smc_ids); | |
3a76b351 CD |
52 | if (!node) |
53 | return -ENODEV; | |
b8eb35fd | 54 | |
c64756cc | 55 | prop_val = of_get_address(node, 0, &prop_size, NULL); |
5c4cee2f AE |
56 | if (!prop_val) |
57 | return -EINVAL; | |
58 | ||
c64756cc AE |
59 | /* We assume space for four 32-bit arguments */ |
60 | if (prop_size < 4 * sizeof(u32) || prop_size > (u64)ULONG_MAX) | |
5c4cee2f | 61 | return -EINVAL; |
c64756cc | 62 | buffer_size = (unsigned long)prop_size; |
b8eb35fd | 63 | |
c64756cc AE |
64 | buffer_phys = be32_to_cpup(prop_val); |
65 | if (!buffer_phys) | |
66 | return -EINVAL; | |
b8eb35fd | 67 | |
c64756cc AE |
68 | bcm_smc_buffer = ioremap(buffer_phys, buffer_size); |
69 | if (!bcm_smc_buffer) | |
70 | return -ENOMEM; | |
71 | bcm_smc_buffer_phys = buffer_phys; | |
b8eb35fd | 72 | |
3a76b351 CD |
73 | pr_info("Kona Secure API initialized\n"); |
74 | ||
75 | return 0; | |
b8eb35fd CD |
76 | } |
77 | ||
78 | /* __bcm_kona_smc() should only run on CPU 0, with pre-emption disabled */ | |
79 | static void __bcm_kona_smc(void *info) | |
80 | { | |
81 | struct bcm_kona_smc_data *data = info; | |
c64756cc AE |
82 | u32 *args = bcm_smc_buffer; |
83 | int rc; | |
b8eb35fd | 84 | |
b8eb35fd | 85 | BUG_ON(smp_processor_id() != 0); |
c64756cc | 86 | BUG_ON(!args); |
b8eb35fd | 87 | |
e80eef33 AE |
88 | /* Copy the four 32 bit argument values into the bounce area */ |
89 | writel_relaxed(data->arg0, args++); | |
90 | writel_relaxed(data->arg1, args++); | |
91 | writel_relaxed(data->arg2, args++); | |
92 | writel(data->arg3, args); | |
b8eb35fd CD |
93 | |
94 | /* Flush caches for input data passed to Secure Monitor */ | |
c64756cc | 95 | flush_cache_all(); |
b8eb35fd CD |
96 | |
97 | /* Trap into Secure Monitor */ | |
c64756cc | 98 | rc = bcm_kona_smc_asm(data->service_id, bcm_smc_buffer_phys); |
b8eb35fd CD |
99 | |
100 | if (rc != SEC_ROM_RET_OK) | |
101 | pr_err("Secure Monitor call failed (0x%x)!\n", rc); | |
102 | } | |
103 | ||
104 | unsigned bcm_kona_smc(unsigned service_id, unsigned arg0, unsigned arg1, | |
105 | unsigned arg2, unsigned arg3) | |
106 | { | |
107 | struct bcm_kona_smc_data data; | |
108 | ||
109 | data.service_id = service_id; | |
110 | data.arg0 = arg0; | |
111 | data.arg1 = arg1; | |
112 | data.arg2 = arg2; | |
113 | data.arg3 = arg3; | |
114 | ||
115 | /* | |
116 | * Due to a limitation of the secure monitor, we must use the SMP | |
117 | * infrastructure to forward all secure monitor calls to Core 0. | |
118 | */ | |
119 | if (get_cpu() != 0) | |
120 | smp_call_function_single(0, __bcm_kona_smc, (void *)&data, 1); | |
121 | else | |
122 | __bcm_kona_smc(&data); | |
123 | ||
124 | put_cpu(); | |
125 | ||
126 | return 0; | |
127 | } |