/*	$NetBSD: fenv.c,v 1.3 2017/12/30 17:59:24 martin Exp $	*/

/*-
 * Copyright (c) 2004-2005 David Schultz <das@FreeBSD.ORG>
 * 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.
 *
 * $FreeBSD: src/lib/msun/alpha/fenv.c,v 1.2 2005/03/16 19:03:44 das Exp $
 */
#include <sys/cdefs.h>
__RCSID("$NetBSD: fenv.c,v 1.3 2017/12/30 17:59:24 martin Exp $");

#include "namespace.h"

#include <machine/sysarch.h>
#include <fenv.h>

#ifdef __weak_alias
__weak_alias(fegetenv,_fegetenv)
__weak_alias(feholdexcept,_feholdexcept)
__weak_alias(fesetenv,_fesetenv)
__weak_alias(feupdateenv,_feupdateenv)
__weak_alias(feenableexcept,_feenableexcept)
__weak_alias(fedisableexcept,_fedisableexcept)
__weak_alias(fegetexcept,_fegetexcept)
#endif

const fenv_t __fe_dfl_env = 0x680e000000000000ULL;

/*
 * The lower 49 bits of the FPCR are unused by the hardware, so we use
 * the lower order bits to store the kernel's idea of the FP mask as
 * described in the Alpha Architecture Manual.
 */
int
fegetenv(fenv_t *envp)
{
	struct alpha_fp_except_args p;
	union __fpcr r;

	/*
	 * The syscall acts as an implicit exception barrier, so we
	 * only need to issue an excb after the mf_fpcr to ensure that
	 * the read is executed before any subsequent FP ops.
	 */
	p.mask = sysarch(ALPHA_FPGETMASK, 0);
	__mf_fpcr(&r.__d);
	*envp = r.__bits | p.mask;
	__excb();
	return 0;
}

int
feholdexcept(fenv_t *envp)
{
	struct alpha_fp_except_args p;
	union __fpcr r;

	p.mask = sysarch(ALPHA_FPGETMASK, 0);
	__mf_fpcr(&r.__d);
	*envp = r.__bits | p.mask;
	r.__bits &= ~((fenv_t)FE_ALL_EXCEPT << _FPUSW_SHIFT);
	__mt_fpcr(r.__d);
	if (p.mask & FE_ALL_EXCEPT) {
		p.mask = 0;
		sysarch(ALPHA_FPSETMASK, &p);
	}
	__excb();
	return 0;
}

int
fesetenv(const fenv_t *envp)
{
	struct alpha_fp_except_args p;
	union __fpcr r;

	p.mask = *envp & FE_ALL_EXCEPT;
	sysarch(ALPHA_FPSETMASK, &p);
	r.__bits = *envp & ~FE_ALL_EXCEPT;
	__mt_fpcr(r.__d);
	__excb();
	return 0;
}

int
feupdateenv(const fenv_t *envp)
{
	struct alpha_fp_except_args p;
	union __fpcr oldr, newr;

	p.mask = *envp & FE_ALL_EXCEPT;
	sysarch(ALPHA_FPSETMASK, &p);
	__mf_fpcr(&oldr.__d);
	newr.__bits = *envp & ~FE_ALL_EXCEPT;
	__excb();
	__mt_fpcr(newr.__d);
	feraiseexcept((oldr.__bits >> _FPUSW_SHIFT) & FE_ALL_EXCEPT);
	return 0; 
}

int
feenableexcept(int mask)
{
	struct alpha_fp_except_args p;

	p.mask = sysarch(ALPHA_FPGETMASK, 0);
	p.mask |= (mask & FE_ALL_EXCEPT);
	sysarch(ALPHA_FPSETMASK, &p);
	return p.mask;
}

int
fedisableexcept(int mask)
{
	struct alpha_fp_except_args p;

	p.mask = sysarch(ALPHA_FPGETMASK, 0);
	p.mask &= ~(mask & FE_ALL_EXCEPT);
	sysarch(ALPHA_FPSETMASK, &p);
	return p.mask;
}

int
fegetexcept(void)
{

	return sysarch(ALPHA_FPGETMASK, 0);
}