1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause
3 *
4 * Copyright (c) 2017 Michal Meloun <mmel@FreeBSD.org>
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/types.h>
30 #include <sys/ucontext.h>
31 #include <errno.h>
32 #include <stdlib.h>
33 #include <machine/sysarch.h>
34
35 struct ucontextx {
36 ucontext_t ucontext;
37 mcontext_vfp_t mcontext_vfp;
38 };
39
40 int
__getcontextx_size(void)41 __getcontextx_size(void)
42 {
43
44 return (sizeof(struct ucontextx));
45 }
46
47 int
__fillcontextx2(char * ctx)48 __fillcontextx2(char *ctx)
49 {
50 struct ucontextx *ucxp;
51 ucontext_t *ucp;
52 mcontext_vfp_t *mvp;
53 struct arm_get_vfpstate_args vfp_arg;
54
55 ucxp = (struct ucontextx *)ctx;
56 ucp = &ucxp->ucontext;
57 mvp = &ucxp->mcontext_vfp;
58
59 vfp_arg.mc_vfp_size = sizeof(mcontext_vfp_t);
60 vfp_arg.mc_vfp = mvp;
61 if (sysarch(ARM_GET_VFPSTATE, &vfp_arg) == -1)
62 return (-1);
63 ucp->uc_mcontext.mc_vfp_size = sizeof(mcontext_vfp_t);
64 ucp->uc_mcontext.mc_vfp_ptr = mvp;
65 return (0);
66 }
67
68 int
__fillcontextx(char * ctx)69 __fillcontextx(char *ctx)
70 {
71 struct ucontextx *ucxp;
72
73 ucxp = (struct ucontextx *)ctx;
74 if (getcontext(&ucxp->ucontext) == -1)
75 return (-1);
76 __fillcontextx2(ctx);
77 return (0);
78 }
79
80 __weak_reference(__getcontextx, getcontextx);
81
82 ucontext_t *
__getcontextx(void)83 __getcontextx(void)
84 {
85 char *ctx;
86 int error;
87
88 ctx = malloc(__getcontextx_size());
89 if (ctx == NULL)
90 return (NULL);
91 if (__fillcontextx(ctx) == -1) {
92 error = errno;
93 free(ctx);
94 errno = error;
95 return (NULL);
96 }
97 return ((ucontext_t *)ctx);
98 }
99