Home | History | Annotate | Line # | Download | only in hardfloat
fpsetmask.S revision 1.4.50.3 
      1  1.4.50.3      yamt /*	$NetBSD: fpsetmask.S,v 1.4.50.3 2014/05/22 11:36:46 yamt Exp $	*/
      2       1.1     bjh21 
      3  1.4.50.2      yamt /*-
      4  1.4.50.2      yamt  * Copyright (c) 2013 The NetBSD Foundation, Inc.
      5       1.1     bjh21  * All rights reserved.
      6       1.1     bjh21  *
      7  1.4.50.2      yamt  * This code is derived from software contributed to The NetBSD Foundation
      8  1.4.50.2      yamt  * by Matt Thomas of 3am Software Foundry.
      9  1.4.50.2      yamt  *
     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.4.50.2      yamt  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  1.4.50.2      yamt  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  1.4.50.2      yamt  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  1.4.50.2      yamt  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  1.4.50.2      yamt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  1.4.50.2      yamt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  1.4.50.2      yamt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  1.4.50.2      yamt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  1.4.50.2      yamt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  1.4.50.2      yamt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  1.4.50.2      yamt  * POSSIBILITY OF SUCH DAMAGE.
     30       1.1     bjh21  */
     31       1.1     bjh21 
     32  1.4.50.2      yamt #ifndef __VFP_FP__
     33  1.4.50.2      yamt #error FPA is not supported anymore
     34  1.4.50.2      yamt #endif
     35  1.4.50.2      yamt 
     36  1.4.50.2      yamt #include <arm/asm.h>
     37  1.4.50.2      yamt #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.4.50.2      yamt #define	fpsetmask	_fpsetmask
     46       1.2   thorpej #endif
     47  1.4.50.2      yamt 
     48  1.4.50.2      yamt ENTRY(fpsetmask)
     49  1.4.50.2      yamt 	and	r2, r0, #VFP_FPSCR_CSUM
     50  1.4.50.2      yamt 	vmrs	r1, fpscr
     51  1.4.50.2      yamt 	mov	r0, r1, lsr #8		/* Return old mask */
     52  1.4.50.2      yamt 	bic	r1, r1, #VFP_FPSCR_ESUM
     53  1.4.50.2      yamt 	orr	r1, r1, r2, lsl #8
     54  1.4.50.2      yamt 	vmsr	fpscr, r1
     55  1.4.50.2      yamt 	and	r0, r0, #VFP_FPSCR_CSUM
     56       1.4  rearnsha 	RET
     57  1.4.50.2      yamt END(fpsetmask)
     58