/****************************************************************************/
/*	Copyright (c) 2009, Bendor Research Pty. Ltd. All rights reserved.		*/
/*	This software is released under the GNU General Public License, version	*/
/*	3, with the exemptions that 1) the header files installed by this 	 	*/
/*	package can be included in closed-source code and 2) the libraries		*/
/*	built by this package can be statically linked into a closed-source 	*/
/*	binary. See the file LICENSE for the details.							*/
/*	This software is provided "AS IS", without any warranty or guarantee.	*/
/*	By using this software you acknowledge that neither Bendor Research nor	*/
/*	any of its personnel or affiliates can be held liable for any damages,	*/
/*	including, but not limited to, loss of business, loss of money, loss of */
/*	life, loss of reputation, arising out of this software being faulty or	*/
/*	not performing as advertised, even if Bendor Research was aware of such	*/
/*	faults in the software. You use this software at your own risk, any and */
/*	all liabilities that arise out of your using this software are strictly	*/
/*	yours.																	*/
/****************************************************************************/

#include <chips/ARM/func.h>

/*
*	Fixpoint multiply-accumulate routine.
*/

	// R0:	multi1
	// R1:	multi2
	// R2:	add
	// R3:	shift amount

	afunc	mac32
	smull	r12,r0,r1,r0
	mov		r0,r0,lsl r3
	rsb		r3,r3,#32			// If the shift amount is 32, we must
	adds	r3,r3,#0			// <- clear the carry, because in that case
	orrs	r0,r0,r12,lsr r3	// <- this insn leaves the carry unchanged and
	adcpl	r0,r0,r2			// <- this correction step would err.
	addmi	r0,r0,r2
	bx		lr

