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
15unsigned int OPENSSL_sparcv9cap_P[2] = { SPARCV9_TICK_PRIVILEGED, 0 };
16
17int 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
71unsigned long _sparcv9_rdtick(void);
72void _sparcv9_vis1_probe(void);
73unsigned long _sparcv9_vis1_instrument(void);
74void _sparcv9_vis2_probe(void);
75void _sparcv9_fmadd_probe(void);
76unsigned long _sparcv9_rdcfr(void);
77void _sparcv9_vis3_probe(void);
78unsigned long _sparcv9_random(void);
79size_t _sparcv9_vis1_instrument_bus(unsigned int *, size_t);
80size_t _sparcv9_vis1_instrument_bus2(unsigned int *, size_t, size_t);
81
82unsigned 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
94size_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
103size_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
122typedef di_node_t(*di_init_t) (const char *, uint_t);
123typedef void (*di_fini_t) (di_node_t);
124typedef char *(*di_node_name_t) (di_node_t);
125typedef 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
130static 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
156void 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
234static sigjmp_buf common_jmp;
235static void common_handler(int sig)
236{
237    siglongjmp(common_jmp, sig);
238}
239
240void 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
347