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