c2000ware-core-sdk/libraries/math/CLAmath/c28/source/CLAdiv.asm
2023-12-13 16:46:16 +05:30

116 lines
4.6 KiB
NASM

;;#############################################################################
;; FILE: CLAdiv.asm
;;
;; DESCRIPTION: CLA divide function using Newton Raphson Approximation
;;
;;#############################################################################
;;!
;;! Copyright: Copyright (C) 2023 Texas Instruments Incorporated -
;;! All rights reserved not granted herein.
;;! Limited License.
;;!
;;! Texas Instruments Incorporated grants a world-wide, royalty-free,
;;! non-exclusive license under copyrights and patents it now or hereafter
;;! owns or controls to make, have made, use, import, offer to sell and sell
;;! ("Utilize") this software subject to the terms herein. With respect to the
;;! foregoing patent license, such license is granted solely to the extent that
;;! any such patent is necessary to Utilize the software alone. The patent
;;! license shall not apply to any combinations which include this software,
;;! other than combinations with devices manufactured by or for TI
;;! ("TI Devices").
;;! No hardware patent is licensed hereunder.
;;!
;;! Redistributions must preserve existing copyright notices and reproduce this
;;! license (including the above copyright notice and the disclaimer and
;;! (if applicable) source code license limitations below) in the documentation
;;! and/or other materials provided with the distribution.
;;!
;;! Redistribution and use in binary form, without modification, are permitted
;;! provided that the following conditions are met:
;;!
;;! * No reverse engineering, decompilation, or disassembly of this software is
;;! permitted with respect to any software provided in binary form.
;;! * Any redistribution and use are licensed by TI for use only
;;! with TI Devices.
;;! * Nothing shall obligate TI to provide you with source code for the
;;! software licensed and provided to you in object code.
;;!
;;! If software source code is provided to you, modification and redistribution
;;! of the source code are permitted provided that the following conditions
;;! are met:
;;!
;;! * any redistribution and use of the source code, including any resulting
;;! derivative works, are licensed by TI for use only with TI Devices.
;;! * any redistribution and use of any object code compiled from the source
;;! code and any resulting derivative works, are licensed by TI for use
;;! only with TI Devices.
;;!
;;! Neither the name of Texas Instruments Incorporated nor the names of its
;;! suppliers may be used to endorse or promote products derived from this
;;! software without specific prior written permission.
;;#############################################################################
.cdecls C,LIST,"CLAmath.h"
.include "CLAeabi.asm"
;;----------------------------------------------------------------------------
;; Description: Implement division using Newton-Raphson Method
;;
;; Equation: Dest = Num/Den
;;
;; Regs Used: MR0, MR1, MR2, MR3
;;
;; Input: Num f32 value in memory
;; Den f32 value in memory
;;
;; Output: Dest f32 value in memory
;; MR0 = Dest f32 result
;;
;; Benchmark: Cycles = 13
;; Instructions = 13
;;
;; Scratchpad Usage: (Local Function Scratchpad Pointer (SP))
;;
;; |_______|<- MR1 (SP+2)
;; |_______|<- MR3 (SP+0)
;;
;;----------------------------------------------------------------------------
.def _CLAdiv
.sect "Cla1Prog:_CLAdiv"
.align 2
.def __cla_CLAdiv_sp
__cla_CLAdiv_sp .usect ".scratchpad:Cla1Prog:_CLAdiv",4,0,1
_CLAdiv:
.asmfunc
.asg __cla_CLAdiv_sp + 0, _save_MR3
.asg __cla_CLAdiv_sp + 2, _save_MR1
; Context Save
MMOV32 @_save_MR3, MR3
; MR0 = Numerator
; MR1 = Denominator
MEINVF32 MR2,MR1 ; MR2 = Ye = Estimate(1/Den)
MMPYF32 MR3,MR2,MR1 ; MR3 = Ye*Den
|| MMOV32 @_save_MR1, MR1 ; save off denominator
MSUBF32 MR3,#2.0,MR3 ; MR3 = 2.0 - Ye*Den
MMPYF32 MR2,MR2,MR3 ; MR2 = Ye = Ye*(2.0 - Ye*Den)
MMPYF32 MR3,MR2,MR1 ; MR3 = Ye*Den
MSUBF32 MR3,#2.0,MR3 ; MR3 = 2.0 - Ye*Den
MMPYF32 MR2,MR2,MR3 ; MR2 = Ye = Ye*(2.0 - Ye*Den)
|| MMOV32 MR1, @_save_MR1 ; Reload denominator to set sign
MNEGF32 MR0,MR0,EQ ; Optional: if(Den == 0.0) Change Sign Of Num
; Context Restore and Final Operations
MRCNDD UNC
MMPYF32 MR0,MR2,MR0 ; MR0 = Y = Ye*Num
MMOV32 MR0,MR0 ; Optional: Set/Clear MSTF NF and ZF flags
MMOV32 MR3,@_save_MR3
.unasg _save_MR3
.unasg _save_MR1
.endasmfunc
;; End of File