Home | History | Annotate | Line # | Download | only in hardfloat
fpsetmask.S revision 1.6 
      1  1.6      matt /*	$NetBSD: fpsetmask.S,v 1.6 2013/01/11 13:55:26 matt Exp $	*/
      2  1.1     bjh21 
      3  1.6      matt /*-
      4  1.6      matt  * Copyright (c) 2013 The NetBSD Foundation, Inc.
      5  1.1     bjh21  * All rights reserved.
      6  1.1     bjh21  *
      7  1.6      matt  * This code is derived from software contributed to The NetBSD Foundation
      8  1.6      matt  * by Matt Thomas of 3am Software Foundry.
      9  1.6      matt  *
     10  1.1     bjh21  * Redistribution and use in source and binary forms, with or without
     11  1.1     bjh21  * modification, are permitted provided that the following conditions
     12  1.1     bjh21  * are met:
     13  1.1     bjh21  * 1. Redistributions of source code must retain the above copyright
     14  1.1     bjh21  *    notice, this list of conditions and the following disclaimer.
     15  1.1     bjh21  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1     bjh21  *    notice, this list of conditions and the following disclaimer in the
     17  1.1     bjh21  *    documentation and/or other materials provided with the distribution.
     18  1.1     bjh21  *
     19  1.6      matt  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  1.6      matt  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  1.6      matt  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  1.6      matt  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  1.6      matt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  1.6      matt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  1.6      matt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  1.6      matt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  1.6      matt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  1.6      matt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  1.6      matt  * POSSIBILITY OF SUCH DAMAGE.
     30  1.1     bjh21  */
     31  1.1     bjh21 
     32  1.6      matt #ifndef __VFP_FP__
     33  1.6      matt #error FPA is not supported anymore
     34  1.6      matt #endif
     35  1.6      matt 
     36  1.6      matt #include <arm/asm.h>
     37  1.6      matt #include <arm/vfpreg.h>
     38  1.1     bjh21 
     39  1.1     bjh21 /*
     40  1.1     bjh21  * Set the current FP exception enable mask
     41  1.1     bjh21  */
     42  1.1     bjh21 
     43  1.2   thorpej #ifdef WEAK_ALIAS
     44  1.2   thorpej WEAK_ALIAS(fpsetmask, _fpsetmask)
     45  1.6      matt #define	fpsetmask	_fpsetmask
     46  1.6      matt #endif
     47  1.6      matt 
     48  1.1     bjh21 ENTRY(fpsetmask)
     49  1.6      matt 	and	r2, r0, #VFP_FPSCR_CSUM
     50  1.6      matt 	vmrs	r1, fpscr
     51  1.6      matt 	mov	r0, r1, lsr #8		/* Return old mask */
     52  1.6      matt 	bic	r1, r1, #VFP_FPSCR_ESUM
     53  1.6      matt 	orr	r1, r1, r2, lsl #8
     54  1.6      matt 	vmsr	fpscr, r1
     55  1.6      matt 	mcr	p10, 7, r1, c1, c0, 0
     56  1.6      matt 	and	r0, r0, #VFP_FPSCR_CSUM
     57  1.4  rearnsha 	RET
     58  1.6      matt END(fpsetmask)
     59