release/src/router/openssl/crypto/sparcv9cap.c

   1 #include <stdio.h>
   2 #include <stdlib.h>
   3 #include <string.h>
   4 #include <setjmp.h>
   5 #include <signal.h>
   6 #include <sys/time.h>
   7 #include <unistd.h>
   8 #include <openssl/bn.h>
   9
  10 #include "sparc_arch.h"
  11
  12 #if defined(__GNUC__) && defined(__linux)
  13 __attribute__ ((visibility("hidden")))
  14 #endif
  15 unsigned int OPENSSL_sparcv9cap_P[2] = { SPARCV9_TICK_PRIVILEGED, 0 };
  16
  17 int bn_mul_mont(BN_ULONG *rp, const BN_ULONG *ap, const BN_ULONG *bp,
  18                 const BN_ULONG *np, const BN_ULONG *n0, int num)
  19 {
  20     int bn_mul_mont_vis3(BN_ULONG *rp, const BN_ULONG *ap, const BN_ULONG *bp,
  21                          const BN_ULONG *np, const BN_ULONG *n0, int num);
  22     int bn_mul_mont_fpu(BN_ULONG *rp, const BN_ULONG *ap, const BN_ULONG *bp,
  23                         const BN_ULONG *np, const BN_ULONG *n0, int num);
  24     int bn_mul_mont_int(BN_ULONG *rp, const BN_ULONG *ap, const BN_ULONG *bp,
  25                         const BN_ULONG *np, const BN_ULONG *n0, int num);
  26
  27     if (!(num & 1) && num >= 6) {
  28         if ((num & 15) == 0 && num <= 64 &&
  29             (OPENSSL_sparcv9cap_P[1] & (CFR_MONTMUL | CFR_MONTSQR)) ==
  30             (CFR_MONTMUL | CFR_MONTSQR)) {
  31             typedef int (*bn_mul_mont_f) (BN_ULONG *rp, const BN_ULONG *ap,
  32                                           const BN_ULONG *bp,
  33                                           const BN_ULONG *np,
  34                                           const BN_ULONG *n0);
  35             int bn_mul_mont_t4_8(BN_ULONG *rp, const BN_ULONG *ap,
  36                                  const BN_ULONG *bp, const BN_ULONG *np,
  37                                  const BN_ULONG *n0);
  38             int bn_mul_mont_t4_16(BN_ULONG *rp, const BN_ULONG *ap,
  39                                   const BN_ULONG *bp, const BN_ULONG *np,
  40                                   const BN_ULONG *n0);
  41             int bn_mul_mont_t4_24(BN_ULONG *rp, const BN_ULONG *ap,
  42                                   const BN_ULONG *bp, const BN_ULONG *np,
  43                                   const BN_ULONG *n0);
  44             int bn_mul_mont_t4_32(BN_ULONG *rp, const BN_ULONG *ap,
  45                                   const BN_ULONG *bp, const BN_ULONG *np,
  46                                   const BN_ULONG *n0);
  47             static const bn_mul_mont_f funcs[4] = {
  48                 bn_mul_mont_t4_8, bn_mul_mont_t4_16,
  49                 bn_mul_mont_t4_24, bn_mul_mont_t4_32
  50             };
  51             bn_mul_mont_f worker = funcs[num / 16 - 1];
  52
  53             if ((*worker) (rp, ap, bp, np, n0))
  54                 return 1;
  55             /* retry once and fall back */
  56             if ((*worker) (rp, ap, bp, np, n0))
  57                 return 1;
  58             return bn_mul_mont_vis3(rp, ap, bp, np, n0, num);
  59         }
  60         if ((OPENSSL_sparcv9cap_P[0] & SPARCV9_VIS3))
  61             return bn_mul_mont_vis3(rp, ap, bp, np, n0, num);
  62         else if (num >= 8 &&
  63                  (OPENSSL_sparcv9cap_P[0] &
  64                   (SPARCV9_PREFER_FPU | SPARCV9_VIS1)) ==
  65                  (SPARCV9_PREFER_FPU | SPARCV9_VIS1))
  66             return bn_mul_mont_fpu(rp, ap, bp, np, n0, num);
  67     }
  68     return bn_mul_mont_int(rp, ap, bp, np, n0, num);
  69 }
  70
  71 unsigned long _sparcv9_rdtick(void);
  72 void _sparcv9_vis1_probe(void);
  73 unsigned long _sparcv9_vis1_instrument(void);
  74 void _sparcv9_vis2_probe(void);
  75 void _sparcv9_fmadd_probe(void);
  76 unsigned long _sparcv9_rdcfr(void);
  77 void _sparcv9_vis3_probe(void);
  78 unsigned long _sparcv9_random(void);
  79 size_t _sparcv9_vis1_instrument_bus(unsigned int *, size_t);
  80 size_t _sparcv9_vis1_instrument_bus2(unsigned int *, size_t, size_t);
  81
  82 unsigned long OPENSSL_rdtsc(void)
  83 {
  84     if (OPENSSL_sparcv9cap_P[0] & SPARCV9_TICK_PRIVILEGED)
  85 #if defined(__sun) && defined(__SVR4)
  86         return gethrtime();
  87 #else
  88         return 0;
  89 #endif
  90     else
  91         return _sparcv9_rdtick();
  92 }
  93
  94 size_t OPENSSL_instrument_bus(unsigned int *out, size_t cnt)
  95 {
  96     if ((OPENSSL_sparcv9cap_P[0] & (SPARCV9_TICK_PRIVILEGED | SPARCV9_BLK)) ==
  97         SPARCV9_BLK)
  98         return _sparcv9_vis1_instrument_bus(out, cnt);
  99     else
 100         return 0;
 101 }
 102
 103 size_t OPENSSL_instrument_bus2(unsigned int *out, size_t cnt, size_t max)
 104 {
 105     if ((OPENSSL_sparcv9cap_P[0] & (SPARCV9_TICK_PRIVILEGED | SPARCV9_BLK)) ==
 106         SPARCV9_BLK)
 107         return _sparcv9_vis1_instrument_bus2(out, cnt, max);
 108     else
 109         return 0;
 110 }
 111
 112 #if 0 && defined(__sun) && defined(__SVR4)
 113 /*
 114  * This code path is disabled, because of incompatibility of libdevinfo.so.1
 115  * and libmalloc.so.1 (see below for details)
 116  */
 117 # include <malloc.h>
 118 # include <dlfcn.h>
 119 # include <libdevinfo.h>
 120 # include <sys/systeminfo.h>
 121
 122 typedef di_node_t(*di_init_t) (const char *, uint_t);
 123 typedef void (*di_fini_t) (di_node_t);
 124 typedef char *(*di_node_name_t) (di_node_t);
 125 typedef int (*di_walk_node_t) (di_node_t, uint_t, di_node_name_t,
 126                                int (*)(di_node_t, di_node_name_t));
 127
 128 # define DLLINK(h,name) (name=(name##_t)dlsym((h),#name))
 129
 130 static int walk_nodename(di_node_t node, di_node_name_t di_node_name)
 131 {
 132     char *name = (*di_node_name) (node);
 133
 134     /* This is expected to catch all UltraSPARC flavors prior T1 */
 135     if (!strcmp(name, "SUNW,UltraSPARC") ||
 136         /* covers II,III,IV */
 137         !strncmp(name, "SUNW,UltraSPARC-I", 17)) {
 138         OPENSSL_sparcv9cap_P[0] |= SPARCV9_PREFER_FPU | SPARCV9_VIS1;
 139
 140         /* %tick is privileged only on UltraSPARC-I/II, but not IIe */
 141         if (name[14] != '\0' && name[17] != '\0' && name[18] != '\0')
 142             OPENSSL_sparcv9cap_P[0] &= ~SPARCV9_TICK_PRIVILEGED;
 143
 144         return DI_WALK_TERMINATE;
 145     }
 146     /* This is expected to catch remaining UltraSPARCs, such as T1 */
 147     else if (!strncmp(name, "SUNW,UltraSPARC", 15)) {
 148         OPENSSL_sparcv9cap_P[0] &= ~SPARCV9_TICK_PRIVILEGED;
 149
 150         return DI_WALK_TERMINATE;
 151     }
 152
 153     return DI_WALK_CONTINUE;
 154 }
 155
 156 void OPENSSL_cpuid_setup(void)
 157 {
 158     void *h;
 159     char *e, si[256];
 160     static int trigger = 0;
 161
 162     if (trigger)
 163         return;
 164     trigger = 1;
 165
 166     if ((e = getenv("OPENSSL_sparcv9cap"))) {
 167         OPENSSL_sparcv9cap_P[0] = strtoul(e, NULL, 0);
 168         return;
 169     }
 170
 171     if (sysinfo(SI_MACHINE, si, sizeof(si)) > 0) {
 172         if (strcmp(si, "sun4v"))
 173             /* FPU is preferred for all CPUs, but US-T1/2 */
 174             OPENSSL_sparcv9cap_P[0] |= SPARCV9_PREFER_FPU;
 175     }
 176
 177     if (sysinfo(SI_ISALIST, si, sizeof(si)) > 0) {
 178         if (strstr(si, "+vis"))
 179             OPENSSL_sparcv9cap_P[0] |= SPARCV9_VIS1 | SPARCV9_BLK;
 180         if (strstr(si, "+vis2")) {
 181             OPENSSL_sparcv9cap_P[0] |= SPARCV9_VIS2;
 182             OPENSSL_sparcv9cap_P[0] &= ~SPARCV9_TICK_PRIVILEGED;
 183             return;
 184         }
 185     }
 186 # ifdef M_KEEP
 187     /*
 188      * Solaris libdevinfo.so.1 is effectively incomatible with
 189      * libmalloc.so.1. Specifically, if application is linked with
 190      * -lmalloc, it crashes upon startup with SIGSEGV in
 191      * free(3LIBMALLOC) called by di_fini. Prior call to
 192      * mallopt(M_KEEP,0) somehow helps... But not always...
 193      */
 194     if ((h = dlopen(NULL, RTLD_LAZY))) {
 195         union {
 196             void *p;
 197             int (*f) (int, int);
 198         } sym;
 199         if ((sym.p = dlsym(h, "mallopt")))
 200             (*sym.f) (M_KEEP, 0);
 201         dlclose(h);
 202     }
 203 # endif
 204     if ((h = dlopen("libdevinfo.so.1", RTLD_LAZY)))
 205         do {
 206             di_init_t di_init;
 207             di_fini_t di_fini;
 208             di_walk_node_t di_walk_node;
 209             di_node_name_t di_node_name;
 210             di_node_t root_node;
 211
 212             if (!DLLINK(h, di_init))
 213                 break;
 214             if (!DLLINK(h, di_fini))
 215                 break;
 216             if (!DLLINK(h, di_walk_node))
 217                 break;
 218             if (!DLLINK(h, di_node_name))
 219                 break;
 220
 221             if ((root_node = (*di_init) ("/", DINFOSUBTREE)) != DI_NODE_NIL) {
 222                 (*di_walk_node) (root_node, DI_WALK_SIBFIRST,
 223                                  di_node_name, walk_nodename);
 224                 (*di_fini) (root_node);
 225             }
 226         } while (0);
 227
 228     if (h)
 229         dlclose(h);
 230 }
 231
 232 #else
 233
 234 static sigjmp_buf common_jmp;
 235 static void common_handler(int sig)
 236 {
 237     siglongjmp(common_jmp, sig);
 238 }
 239
 240 void OPENSSL_cpuid_setup(void)
 241 {
 242     char *e;
 243     struct sigaction common_act, ill_oact, bus_oact;
 244     sigset_t all_masked, oset;
 245     static int trigger = 0;
 246
 247     if (trigger)
 248         return;
 249     trigger = 1;
 250
 251     if ((e = getenv("OPENSSL_sparcv9cap"))) {
 252         OPENSSL_sparcv9cap_P[0] = strtoul(e, NULL, 0);
 253         if ((e = strchr(e, ':')))
 254             OPENSSL_sparcv9cap_P[1] = strtoul(e + 1, NULL, 0);
 255         return;
 256     }
 257
 258     /* Initial value, fits UltraSPARC-I&II... */
 259     OPENSSL_sparcv9cap_P[0] = SPARCV9_PREFER_FPU | SPARCV9_TICK_PRIVILEGED;
 260
 261     sigfillset(&all_masked);
 262     sigdelset(&all_masked, SIGILL);
 263     sigdelset(&all_masked, SIGTRAP);
 264 # ifdef SIGEMT
 265     sigdelset(&all_masked, SIGEMT);
 266 # endif
 267     sigdelset(&all_masked, SIGFPE);
 268     sigdelset(&all_masked, SIGBUS);
 269     sigdelset(&all_masked, SIGSEGV);
 270     sigprocmask(SIG_SETMASK, &all_masked, &oset);
 271
 272     memset(&common_act, 0, sizeof(common_act));
 273     common_act.sa_handler = common_handler;
 274     common_act.sa_mask = all_masked;
 275
 276     sigaction(SIGILL, &common_act, &ill_oact);
 277     sigaction(SIGBUS, &common_act, &bus_oact); /* T1 fails 16-bit ldda [on
 278                                                 * Linux] */
 279
 280     if (sigsetjmp(common_jmp, 1) == 0) {
 281         _sparcv9_rdtick();
 282         OPENSSL_sparcv9cap_P[0] &= ~SPARCV9_TICK_PRIVILEGED;
 283     }
 284
 285     if (sigsetjmp(common_jmp, 1) == 0) {
 286         _sparcv9_vis1_probe();
 287         OPENSSL_sparcv9cap_P[0] |= SPARCV9_VIS1 | SPARCV9_BLK;
 288         /* detect UltraSPARC-Tx, see sparccpud.S for details... */
 289         if (_sparcv9_vis1_instrument() >= 12)
 290             OPENSSL_sparcv9cap_P[0] &= ~(SPARCV9_VIS1 | SPARCV9_PREFER_FPU);
 291         else {
 292             _sparcv9_vis2_probe();
 293             OPENSSL_sparcv9cap_P[0] |= SPARCV9_VIS2;
 294         }
 295     }
 296
 297     if (sigsetjmp(common_jmp, 1) == 0) {
 298         _sparcv9_fmadd_probe();
 299         OPENSSL_sparcv9cap_P[0] |= SPARCV9_FMADD;
 300     }
 301
 302     /*
 303      * VIS3 flag is tested independently from VIS1, unlike VIS2 that is,
 304      * because VIS3 defines even integer instructions.
 305      */
 306     if (sigsetjmp(common_jmp, 1) == 0) {
 307         _sparcv9_vis3_probe();
 308         OPENSSL_sparcv9cap_P[0] |= SPARCV9_VIS3;
 309     }
 310 # if 0                          /* was planned at some point but never
 311                                  * implemented in hardware */
 312     if (sigsetjmp(common_jmp, 1) == 0) {
 313         (void)_sparcv9_random();
 314         OPENSSL_sparcv9cap_P[0] |= SPARCV9_RANDOM;
 315     }
 316 # endif
 317
 318     /*
 319      * In wait for better solution _sparcv9_rdcfr is masked by
 320      * VIS3 flag, because it goes to uninterruptable endless
 321      * loop on UltraSPARC II running Solaris. Things might be
 322      * different on Linux...
 323      */
 324     if ((OPENSSL_sparcv9cap_P[0] & SPARCV9_VIS3) &&
 325         sigsetjmp(common_jmp, 1) == 0) {
 326         OPENSSL_sparcv9cap_P[1] = (unsigned int)_sparcv9_rdcfr();
 327     }
 328
 329     sigaction(SIGBUS, &bus_oact, NULL);
 330     sigaction(SIGILL, &ill_oact, NULL);
 331
 332     sigprocmask(SIG_SETMASK, &oset, NULL);
 333
 334     if (sizeof(size_t) == 8)
 335         OPENSSL_sparcv9cap_P[0] |= SPARCV9_64BIT_STACK;
 336 # ifdef __linux
 337     else {
 338         int ret = syscall(340);
 339
 340         if (ret >= 0 && ret & 1)
 341             OPENSSL_sparcv9cap_P[0] |= SPARCV9_64BIT_STACK;
 342     }
 343 # endif
 344 }
 345
 346 #endif