shithub: rgbds

ref: 50a8bbd414d662dc0d8065eeecc37c195e760962
dir: /src/asm/math.c/

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * INCLUDES
 *
 */

#include <math.h>
#include <stdio.h>

#include "asm/types.h"
#include "asm/mymath.h"
#include "asm/symbol.h"

#define fix2double(i)	((double)(i/65536.0))
#define double2fix(d)	((SLONG)(d*65536.0))
#ifndef PI
#define PI					(acos(-1))
#endif

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Define the _PI symbol
 *
 */

void math_DefinePI(void)
{
	sym_AddEqu("_PI", double2fix(PI));
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Print a fixed point value
 *
 */

void math_Print(SLONG i)
{
	if (i >= 0)
		printf("%ld.%05ld", i >> 16,
		       ((SLONG) (fix2double(i) * 100000 + 0.5)) % 100000);
	else
		printf("-%ld.%05ld", (-i) >> 16,
		       ((SLONG) (fix2double(-i) * 100000 + 0.5)) % 100000);
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Calculate sine
 *
 */

SLONG math_Sin(SLONG i)
{
	return (double2fix(sin(fix2double(i) * 2 * PI / 65536)));
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Calculate cosine
 *
 */

SLONG math_Cos(SLONG i)
{
	return (double2fix(cos(fix2double(i) * 2 * PI / 65536)));
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Calculate tangent
 *
 */

SLONG math_Tan(SLONG i)
{
	return (double2fix(tan(fix2double(i) * 2 * PI / 65536)));
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Calculate sine^-1
 *
 */

SLONG math_ASin(SLONG i)
{
	return (double2fix(asin(fix2double(i)) / 2 / PI * 65536));
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Calculate cosine^-1
 *
 */

SLONG math_ACos(SLONG i)
{
	return (double2fix(acos(fix2double(i)) / 2 / PI * 65536));
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Calculate tangent^-1
 *
 */

SLONG math_ATan(SLONG i)
{
	return (double2fix(atan(fix2double(i)) / 2 / PI * 65536));
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Calculate atan2
 *
 */

SLONG math_ATan2(SLONG i, SLONG j)
{
	return (double2fix
		(atan2(fix2double(i), fix2double(j)) / 2 / PI * 65536));
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Multiplication
 *
 */

SLONG math_Mul(SLONG i, SLONG j)
{
	return (double2fix(fix2double(i) * fix2double(j)));
}

/*
 * RGBAsm - MATH.C (Fixedpoint math routines)
 *
 * Division
 *
 */

SLONG math_Div(SLONG i, SLONG j)
{
	return (double2fix(fix2double(i) / fix2double(j)));
}