/*
 * Written by J.T. Conklin <jtc@NetBSD.org>.
 * Public domain.
 */

#include <machine/asm.h>

RCSID("$NetBSD: s_floorf.S,v 1.9 2022/04/04 19:33:44 andvar Exp $")

ENTRY(floorf)
#ifdef __i386__
        pushl   %ebp
        movl    %esp,%ebp
        subl    $8,%esp

        fstcw   -4(%ebp)                /* store fpu control word */
        movw    -4(%ebp),%dx
        orw     $0x0400,%dx             /* round towards -oo */
        andw    $0xf7ff,%dx
        movw    %dx,-8(%ebp)
        fldcw   -8(%ebp)                /* load modified control word */

        flds    8(%ebp)                 /* round */
        frndint

        fldcw   -4(%ebp)                /* restore original control word */

        leave
#else
        movss   %xmm0, -4(%rsp)
        fstcw   -8(%rsp)
        movw    -8(%rsp),%dx
        orw     $0x0400,%dx
        andw    $0xf7ff,%dx  
        movw    %dx,-12(%rsp)
        fldcw   -12(%rsp)
        flds    -4(%rsp)
        frndint
        fldcw   -8(%rsp)
        fstps   -4(%rsp)
        movss   -4(%rsp),%xmm0
#endif
        ret