lib/libc/arm/gen/getcontextx.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   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/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
  44 __getcontextx_size(void)
  45 {
  46
  47         return (sizeof(struct ucontextx));
  48 }
  49
  50 int
  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
  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 *
  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 }