1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3 *
4 * Copyright (c) 2017 Michal Meloun <[email protected]>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 *
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
31
32 #include <sys/types.h>
33 #include <sys/ucontext.h>
34 #include <errno.h>
35 #include <stdlib.h>
36 #include <machine/sysarch.h>
37
38 struct ucontextx {
39 ucontext_t ucontext;
40 mcontext_vfp_t mcontext_vfp;
41 };
42
43 int
__getcontextx_size(void)44 __getcontextx_size(void)
45 {
46
47 return (sizeof(struct ucontextx));
48 }
49
50 int
__fillcontextx2(char * ctx)51 __fillcontextx2(char *ctx)
52 {
53 struct ucontextx *ucxp;
54 ucontext_t *ucp;
55 mcontext_vfp_t *mvp;
56 struct arm_get_vfpstate_args vfp_arg;
57
58 ucxp = (struct ucontextx *)ctx;
59 ucp = &ucxp->ucontext;
60 mvp = &ucxp->mcontext_vfp;
61
62 vfp_arg.mc_vfp_size = sizeof(mcontext_vfp_t);
63 vfp_arg.mc_vfp = mvp;
64 if (sysarch(ARM_GET_VFPSTATE, &vfp_arg) == -1)
65 return (-1);
66 ucp->uc_mcontext.mc_vfp_size = sizeof(mcontext_vfp_t);
67 ucp->uc_mcontext.mc_vfp_ptr = mvp;
68 return (0);
69 }
70
71 int
__fillcontextx(char * ctx)72 __fillcontextx(char *ctx)
73 {
74 struct ucontextx *ucxp;
75
76 ucxp = (struct ucontextx *)ctx;
77 if (getcontext(&ucxp->ucontext) == -1)
78 return (-1);
79 __fillcontextx2(ctx);
80 return (0);
81 }
82
83 __weak_reference(__getcontextx, getcontextx);
84
85 ucontext_t *
__getcontextx(void)86 __getcontextx(void)
87 {
88 char *ctx;
89 int error;
90
91 ctx = malloc(__getcontextx_size());
92 if (ctx == NULL)
93 return (NULL);
94 if (__fillcontextx(ctx) == -1) {
95 error = errno;
96 free(ctx);
97 errno = error;
98 return (NULL);
99 }
100 return ((ucontext_t *)ctx);
101 }
102