mirror of
https://github.com/opnsense/src.git
synced 2026-03-02 21:31:02 -05:00
6926e2699a
Add missing logic to allow in-kernel VFP usage for ARMv7 NEON. The implementation is strongly based on arm64 code. It introduces a family of fpu_kern_* functions to enable the usage of VFP instructions in kernel. Apart from that the existing armv7 VFP logic was modified, taking into account that the state of the VFP registers can now be modified in the kernel. Co-developed by: Wojciech Macek <wma@FreeBSD.org> Sponsored by: Stormshield Obtained from: Semihalf Reviewed by: andrew Differential Revision: https://reviews.freebsd.org/D37419
122 lines
3.1 KiB
C
122 lines
3.1 KiB
C
/*-
|
|
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
|
|
*
|
|
* Copyright (c) 2007 Olivier Houchard
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <sys/types.h>
|
|
#include <string.h>
|
|
#include <thread_db.h>
|
|
|
|
#include "libpthread_db.h"
|
|
|
|
void
|
|
pt_reg_to_ucontext(const struct reg *r, ucontext_t *uc)
|
|
{
|
|
mcontext_t *mc = &uc->uc_mcontext;
|
|
__greg_t *gr = mc->__gregs;
|
|
|
|
gr[_REG_R0] = r->r[0];
|
|
gr[_REG_R1] = r->r[1];
|
|
gr[_REG_R2] = r->r[2];
|
|
gr[_REG_R3] = r->r[3];
|
|
gr[_REG_R4] = r->r[4];
|
|
gr[_REG_R5] = r->r[5];
|
|
gr[_REG_R6] = r->r[6];
|
|
gr[_REG_R7] = r->r[7];
|
|
gr[_REG_R8] = r->r[8];
|
|
gr[_REG_R9] = r->r[9];
|
|
gr[_REG_R10] = r->r[10];
|
|
gr[_REG_R11] = r->r[11];
|
|
gr[_REG_R12] = r->r[12];
|
|
gr[_REG_SP] = r->r_sp;
|
|
gr[_REG_LR] = r->r_lr;
|
|
gr[_REG_PC] = r->r_pc;
|
|
gr[_REG_CPSR] = r->r_cpsr;
|
|
}
|
|
|
|
void
|
|
pt_ucontext_to_reg(const ucontext_t *uc, struct reg *r)
|
|
{
|
|
const mcontext_t *mc = &uc->uc_mcontext;
|
|
|
|
const __greg_t *gr = mc->__gregs;
|
|
|
|
r->r[0] = gr[_REG_R0];
|
|
r->r[1] = gr[_REG_R1];
|
|
r->r[2] = gr[_REG_R2];
|
|
r->r[3] = gr[_REG_R3];
|
|
r->r[4] = gr[_REG_R4];
|
|
r->r[5] = gr[_REG_R5];
|
|
r->r[6] = gr[_REG_R6];
|
|
r->r[7] = gr[_REG_R7];
|
|
r->r[8] = gr[_REG_R8];
|
|
r->r[9] = gr[_REG_R9];
|
|
r->r[10] = gr[_REG_R10];
|
|
r->r[11] = gr[_REG_R11];
|
|
r->r[12] = gr[_REG_R12];
|
|
r->r_sp = gr[_REG_SP];
|
|
r->r_lr = gr[_REG_LR];
|
|
r->r_pc = gr[_REG_PC];
|
|
r->r_cpsr = gr[_REG_CPSR];
|
|
}
|
|
|
|
void
|
|
pt_fpreg_to_ucontext(const struct fpreg *r, ucontext_t *uc)
|
|
{
|
|
mcontext_vfp_t *mc_vfp;
|
|
|
|
mc_vfp = uc->uc_mcontext.mc_vfp_ptr;
|
|
|
|
if (mc_vfp != NULL)
|
|
memcpy(mc_vfp, r, sizeof(*r));
|
|
}
|
|
|
|
void
|
|
pt_ucontext_to_fpreg(const ucontext_t *uc, struct fpreg *r)
|
|
{
|
|
mcontext_vfp_t *mc_vfp;
|
|
|
|
mc_vfp = uc->uc_mcontext.mc_vfp_ptr;
|
|
|
|
if (mc_vfp != NULL)
|
|
memcpy(r, &mc_vfp, sizeof(*r));
|
|
}
|
|
|
|
void
|
|
pt_md_init(void)
|
|
{
|
|
}
|
|
|
|
int
|
|
pt_reg_sstep(struct reg *reg __unused, int step __unused)
|
|
{
|
|
|
|
/* XXX */
|
|
return (0);
|
|
}
|