1 /* 2 * Copyright 2013, Michael Ellerman, IBM 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 6 * as published by the Free Software Foundation; either version 7 * 2 of the License, or (at your option) any later version. 8 */ 9 10 #define pr_fmt(fmt) "powernv-rng: " fmt 11 12 #include <linux/kernel.h> 13 #include <linux/of.h> 14 #include <linux/of_address.h> 15 #include <linux/of_platform.h> 16 #include <linux/slab.h> 17 #include <linux/smp.h> 18 #include <asm/archrandom.h> 19 #include <asm/cputable.h> 20 #include <asm/io.h> 21 #include <asm/prom.h> 22 #include <asm/machdep.h> 23 #include <asm/smp.h> 24 25 #define DARN_ERR 0xFFFFFFFFFFFFFFFFul 26 27 struct powernv_rng { 28 void __iomem *regs; 29 void __iomem *regs_real; 30 unsigned long mask; 31 }; 32 33 static DEFINE_PER_CPU(struct powernv_rng *, powernv_rng); 34 35 36 int powernv_hwrng_present(void) 37 { 38 struct powernv_rng *rng; 39 40 rng = get_cpu_var(powernv_rng); 41 put_cpu_var(rng); 42 return rng != NULL; 43 } 44 45 static unsigned long rng_whiten(struct powernv_rng *rng, unsigned long val) 46 { 47 unsigned long parity; 48 49 /* Calculate the parity of the value */ 50 asm ("popcntd %0,%1" : "=r" (parity) : "r" (val)); 51 52 /* xor our value with the previous mask */ 53 val ^= rng->mask; 54 55 /* update the mask based on the parity of this value */ 56 rng->mask = (rng->mask << 1) | (parity & 1); 57 58 return val; 59 } 60 61 int powernv_get_random_real_mode(unsigned long *v) 62 { 63 struct powernv_rng *rng; 64 65 rng = raw_cpu_read(powernv_rng); 66 67 *v = rng_whiten(rng, __raw_rm_readq(rng->regs_real)); 68 69 return 1; 70 } 71 72 int powernv_get_random_darn(unsigned long *v) 73 { 74 unsigned long val; 75 76 /* Using DARN with L=1 - 64-bit conditioned random number */ 77 asm volatile(PPC_DARN(%0, 1) : "=r"(val)); 78 79 if (val == DARN_ERR) 80 return 0; 81 82 *v = val; 83 84 return 1; 85 } 86 87 static int initialise_darn(void) 88 { 89 unsigned long val; 90 int i; 91 92 if (!cpu_has_feature(CPU_FTR_ARCH_300)) 93 return -ENODEV; 94 95 for (i = 0; i < 10; i++) { 96 if (powernv_get_random_darn(&val)) { 97 ppc_md.get_random_seed = powernv_get_random_darn; 98 return 0; 99 } 100 } 101 102 pr_warn("Unable to use DARN for get_random_seed()\n"); 103 104 return -EIO; 105 } 106 107 int powernv_get_random_long(unsigned long *v) 108 { 109 struct powernv_rng *rng; 110 111 rng = get_cpu_var(powernv_rng); 112 113 *v = rng_whiten(rng, in_be64(rng->regs)); 114 115 put_cpu_var(rng); 116 117 return 1; 118 } 119 EXPORT_SYMBOL_GPL(powernv_get_random_long); 120 121 static __init void rng_init_per_cpu(struct powernv_rng *rng, 122 struct device_node *dn) 123 { 124 int chip_id, cpu; 125 126 chip_id = of_get_ibm_chip_id(dn); 127 if (chip_id == -1) 128 pr_warn("No ibm,chip-id found for %pOF.\n", dn); 129 130 for_each_possible_cpu(cpu) { 131 if (per_cpu(powernv_rng, cpu) == NULL || 132 cpu_to_chip_id(cpu) == chip_id) { 133 per_cpu(powernv_rng, cpu) = rng; 134 } 135 } 136 } 137 138 static __init int rng_create(struct device_node *dn) 139 { 140 struct powernv_rng *rng; 141 struct resource res; 142 unsigned long val; 143 144 rng = kzalloc(sizeof(*rng), GFP_KERNEL); 145 if (!rng) 146 return -ENOMEM; 147 148 if (of_address_to_resource(dn, 0, &res)) { 149 kfree(rng); 150 return -ENXIO; 151 } 152 153 rng->regs_real = (void __iomem *)res.start; 154 155 rng->regs = of_iomap(dn, 0); 156 if (!rng->regs) { 157 kfree(rng); 158 return -ENXIO; 159 } 160 161 val = in_be64(rng->regs); 162 rng->mask = val; 163 164 rng_init_per_cpu(rng, dn); 165 166 pr_info_once("Registering arch random hook.\n"); 167 168 ppc_md.get_random_seed = powernv_get_random_long; 169 170 return 0; 171 } 172 173 static __init int rng_init(void) 174 { 175 struct device_node *dn; 176 int rc; 177 178 for_each_compatible_node(dn, NULL, "ibm,power-rng") { 179 rc = rng_create(dn); 180 if (rc) { 181 pr_err("Failed creating rng for %pOF (%d).\n", 182 dn, rc); 183 continue; 184 } 185 186 /* Create devices for hwrng driver */ 187 of_platform_device_create(dn, NULL, NULL); 188 } 189 190 initialise_darn(); 191 192 return 0; 193 } 194 machine_subsys_initcall(powernv, rng_init); 195