1*cb8bcafaSAndrew Turner/* 2*cb8bcafaSAndrew Turner * Copyright (C) 2014 Andrew Turner 3*cb8bcafaSAndrew Turner * All rights reserved. 4*cb8bcafaSAndrew Turner * 5*cb8bcafaSAndrew Turner * Redistribution and use in source and binary forms, with or without 6*cb8bcafaSAndrew Turner * modification, are permitted provided that the following conditions 7*cb8bcafaSAndrew Turner * are met: 8*cb8bcafaSAndrew Turner * 1. Redistributions of source code must retain the above copyright 9*cb8bcafaSAndrew Turner * notice, this list of conditions and the following disclaimer. 10*cb8bcafaSAndrew Turner * 2. Redistributions in binary form must reproduce the above copyright 11*cb8bcafaSAndrew Turner * notice, this list of conditions and the following disclaimer in the 12*cb8bcafaSAndrew Turner * documentation and/or other materials provided with the distribution. 13*cb8bcafaSAndrew Turner * 14*cb8bcafaSAndrew Turner * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15*cb8bcafaSAndrew Turner * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16*cb8bcafaSAndrew Turner * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17*cb8bcafaSAndrew Turner * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18*cb8bcafaSAndrew Turner * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19*cb8bcafaSAndrew Turner * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20*cb8bcafaSAndrew Turner * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21*cb8bcafaSAndrew Turner * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22*cb8bcafaSAndrew Turner * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23*cb8bcafaSAndrew Turner * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24*cb8bcafaSAndrew Turner * SUCH DAMAGE. 25*cb8bcafaSAndrew Turner * 26*cb8bcafaSAndrew Turner */ 27*cb8bcafaSAndrew Turner 28*cb8bcafaSAndrew Turner#include <machine/asm.h> 29*cb8bcafaSAndrew Turner__FBSDID("$FreeBSD$"); 30*cb8bcafaSAndrew Turner 31*cb8bcafaSAndrew Turner#define PCR_Z (1 << 30) 32*cb8bcafaSAndrew Turner#define PCR_C (1 << 29) 33*cb8bcafaSAndrew Turner 34*cb8bcafaSAndrew Turner/* 35*cb8bcafaSAndrew Turner * These functions return the result in the CPSR register. 36*cb8bcafaSAndrew Turner * 37*cb8bcafaSAndrew Turner * For __aeabi_cfcmple: 38*cb8bcafaSAndrew Turner * Z C 39*cb8bcafaSAndrew Turner * LT 0 0 40*cb8bcafaSAndrew Turner * EQ 1 1 41*cb8bcafaSAndrew Turner * else 0 1 42*cb8bcafaSAndrew Turner * 43*cb8bcafaSAndrew Turner * __aeabi_cfrcmple is the same as __aeabi_cfcmple, however the arguments 44*cb8bcafaSAndrew Turner * have been swapped. 45*cb8bcafaSAndrew Turner */ 46*cb8bcafaSAndrew TurnerENTRY(__aeabi_cfcmple) 47*cb8bcafaSAndrew Turner push {r4, r5, ip, lr} 48*cb8bcafaSAndrew Turner 49*cb8bcafaSAndrew Turner /* Backup the input registers */ 50*cb8bcafaSAndrew Turner mov r4, r0 51*cb8bcafaSAndrew Turner mov r5, r1 52*cb8bcafaSAndrew Turner /* Is it less than? */ 53*cb8bcafaSAndrew Turner bl __aeabi_fcmplt 54*cb8bcafaSAndrew Turner cmp r0, #1 55*cb8bcafaSAndrew Turner bne 1f 56*cb8bcafaSAndrew Turner /* Yes, clear Z and C */ 57*cb8bcafaSAndrew Turner msr cpsr_c, #(0) 58*cb8bcafaSAndrew Turner b 99f 59*cb8bcafaSAndrew Turner 60*cb8bcafaSAndrew Turner1: 61*cb8bcafaSAndrew Turner /* Restore the input regsters for the next function call */ 62*cb8bcafaSAndrew Turner mov r0, r4 63*cb8bcafaSAndrew Turner mov r1, r5 64*cb8bcafaSAndrew Turner /* Is it equal? */ 65*cb8bcafaSAndrew Turner bl __aeabi_fcmpeq 66*cb8bcafaSAndrew Turner cmp r0, #1 67*cb8bcafaSAndrew Turner bne 2f 68*cb8bcafaSAndrew Turner /* Yes, set Z and C */ 69*cb8bcafaSAndrew Turner msr cpsr_c, #(PCR_Z | PCR_C) 70*cb8bcafaSAndrew Turner b 99f 71*cb8bcafaSAndrew Turner 72*cb8bcafaSAndrew Turner2: 73*cb8bcafaSAndrew Turner /* Not less than or equal, set C and clear Z */ 74*cb8bcafaSAndrew Turner msr cpsr_c, #(PCR_C) 75*cb8bcafaSAndrew Turner 76*cb8bcafaSAndrew Turner99: 77*cb8bcafaSAndrew Turner pop {r4, r5, ip, pc} 78*cb8bcafaSAndrew TurnerEND(__aeabi_cfcmple) 79*cb8bcafaSAndrew Turner 80*cb8bcafaSAndrew TurnerENTRY(__aeabi_cfrcmple) 81*cb8bcafaSAndrew Turner /* Swap the arguments */ 82*cb8bcafaSAndrew Turner mov ip, r0 83*cb8bcafaSAndrew Turner mov r0, r1 84*cb8bcafaSAndrew Turner mov r1, ip 85*cb8bcafaSAndrew Turner 86*cb8bcafaSAndrew Turner b __aeabi_cfcmple 87*cb8bcafaSAndrew TurnerEND(__aeabi_cfrcmple) 88*cb8bcafaSAndrew Turner 89*cb8bcafaSAndrew Turner/* 90*cb8bcafaSAndrew Turner * This is just like __aeabi_cfcmple except it will not throw an exception 91*cb8bcafaSAndrew Turner * in the presence of a quiet NaN. If either argument is a signalling NaN we 92*cb8bcafaSAndrew Turner * will still signal. 93*cb8bcafaSAndrew Turner */ 94*cb8bcafaSAndrew TurnerENTRY(__aeabi_cfcmpeq) 95*cb8bcafaSAndrew Turner /* Check if we can call __aeabi_cfcmple safely */ 96*cb8bcafaSAndrew Turner push {r0, r1, r2, lr} 97*cb8bcafaSAndrew Turner bl __aeabi_cfcmpeq_helper 98*cb8bcafaSAndrew Turner cmp r0, #1 99*cb8bcafaSAndrew Turner pop {r0, r1, r2, lr} 100*cb8bcafaSAndrew Turner beq 1f 101*cb8bcafaSAndrew Turner 102*cb8bcafaSAndrew Turner bl __aeabi_cfcmple 103*cb8bcafaSAndrew Turner RET 104*cb8bcafaSAndrew Turner 105*cb8bcafaSAndrew Turner1: 106*cb8bcafaSAndrew Turner msreq cpsr_c, #(PCR_C) 107*cb8bcafaSAndrew Turner RET 108*cb8bcafaSAndrew TurnerEND(__aeabi_cfcmpeq) 109