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 24 struct secure_bridge_data { 25 void __iomem *bounce; /* virtual address */ 26 u32 __iomem buffer_addr; /* physical address */ 27 int initialized; 28 } bridge_data; 29 30 struct bcm_kona_smc_data { 31 unsigned service_id; 32 unsigned arg0; 33 unsigned arg1; 34 unsigned arg2; 35 unsigned arg3; 36 }; 37 38 static const struct of_device_id bcm_kona_smc_ids[] __initconst = { 39 {.compatible = "bcm,kona-smc"}, 40 {}, 41 }; 42 43 /* Map in the bounce area */ 44 void __init bcm_kona_smc_init(void) 45 { 46 struct device_node *node; 47 48 /* Read buffer addr and size from the device tree node */ 49 node = of_find_matching_node(NULL, bcm_kona_smc_ids); 50 BUG_ON(!node); 51 52 /* Don't care about size or flags of the DT node */ 53 bridge_data.buffer_addr = 54 be32_to_cpu(*of_get_address(node, 0, NULL, NULL)); 55 BUG_ON(!bridge_data.buffer_addr); 56 57 bridge_data.bounce = of_iomap(node, 0); 58 BUG_ON(!bridge_data.bounce); 59 60 bridge_data.initialized = 1; 61 62 pr_info("Secure API initialized!\n"); 63 } 64 65 /* __bcm_kona_smc() should only run on CPU 0, with pre-emption disabled */ 66 static void __bcm_kona_smc(void *info) 67 { 68 struct bcm_kona_smc_data *data = info; 69 u32 *args = bridge_data.bounce; 70 int rc = 0; 71 72 /* Must run on CPU 0 */ 73 BUG_ON(smp_processor_id() != 0); 74 75 /* Check map in the bounce area */ 76 BUG_ON(!bridge_data.initialized); 77 78 /* Copy one 32 bit word into the bounce area */ 79 args[0] = data->arg0; 80 args[1] = data->arg1; 81 args[2] = data->arg2; 82 args[3] = data->arg3; 83 84 /* Flush caches for input data passed to Secure Monitor */ 85 if (data->service_id != SSAPI_BRCM_START_VC_CORE) 86 flush_cache_all(); 87 88 /* Trap into Secure Monitor */ 89 rc = bcm_kona_smc_asm(data->service_id, bridge_data.buffer_addr); 90 91 if (rc != SEC_ROM_RET_OK) 92 pr_err("Secure Monitor call failed (0x%x)!\n", rc); 93 } 94 95 unsigned bcm_kona_smc(unsigned service_id, unsigned arg0, unsigned arg1, 96 unsigned arg2, unsigned arg3) 97 { 98 struct bcm_kona_smc_data data; 99 100 data.service_id = service_id; 101 data.arg0 = arg0; 102 data.arg1 = arg1; 103 data.arg2 = arg2; 104 data.arg3 = arg3; 105 106 /* 107 * Due to a limitation of the secure monitor, we must use the SMP 108 * infrastructure to forward all secure monitor calls to Core 0. 109 */ 110 if (get_cpu() != 0) 111 smp_call_function_single(0, __bcm_kona_smc, (void *)&data, 1); 112 else 113 __bcm_kona_smc(&data); 114 115 put_cpu(); 116 117 return 0; 118 } 119