shithub: rgbds

ref: df065dbbcb609b2aec2c9ee718784ab8d4df90e8
dir: /src/asm/math.c/

/*
 * This file is part of RGBDS.
 *
 * Copyright (c) 1997-2018, Carsten Sorensen and RGBDS contributors.
 *
 * SPDX-License-Identifier: MIT
 */

/*
 * Fixedpoint math routines
 */

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

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

#define fx2double(i)	((double)((i) / 65536.0))
#define double2fx(d)	((int32_t)((d) * 65536.0))

#ifndef M_PI
#define M_PI 3.14159265358979323846
#endif

/*
 * Define the _PI symbol
 */
void math_DefinePI(void)
{
	sym_AddEqu("_PI", double2fx(M_PI));
}

/*
 * Print a fixed point value
 */
void math_Print(int32_t i)
{
	if (i >= 0)
		printf("%d.%05d", i >> 16,
		       ((int32_t)(fx2double(i) * 100000 + 0.5)) % 100000);
	else
		printf("-%d.%05d", (-i) >> 16,
		       ((int32_t)(fx2double(-i) * 100000 + 0.5)) % 100000);
}

/*
 * Calculate sine
 */
int32_t math_Sin(int32_t i)
{
	return double2fx(sin(fx2double(i) * 2 * M_PI / 65536));
}

/*
 * Calculate cosine
 */
int32_t math_Cos(int32_t i)
{
	return double2fx(cos(fx2double(i) * 2 * M_PI / 65536));
}

/*
 * Calculate tangent
 */
int32_t math_Tan(int32_t i)
{
	return double2fx(tan(fx2double(i) * 2 * M_PI / 65536));
}

/*
 * Calculate arcsine
 */
int32_t math_ASin(int32_t i)
{
	return double2fx(asin(fx2double(i)) / 2 / M_PI * 65536);
}

/*
 * Calculate arccosine
 */
int32_t math_ACos(int32_t i)
{
	return double2fx(acos(fx2double(i)) / 2 / M_PI * 65536);
}

/*
 * Calculate arctangent
 */
int32_t math_ATan(int32_t i)
{
	return double2fx(atan(fx2double(i)) / 2 / M_PI * 65536);
}

/*
 * Calculate atan2
 */
int32_t math_ATan2(int32_t i, int32_t j)
{
	return double2fx(atan2(fx2double(i), fx2double(j)) / 2 / M_PI * 65536);
}

/*
 * Multiplication
 */
int32_t math_Mul(int32_t i, int32_t j)
{
	return double2fx(fx2double(i) * fx2double(j));
}

/*
 * Division
 */
int32_t math_Div(int32_t i, int32_t j)
{
	return double2fx(fx2double(i) / fx2double(j));
}

/*
 * Round
 */
int32_t math_Round(int32_t i)
{
	return double2fx(round(fx2double(i)));
}

/*
 * Ceil
 */
int32_t math_Ceil(int32_t i)
{
	return double2fx(ceil(fx2double(i)));
}

/*
 * Floor
 */
int32_t math_Floor(int32_t i)
{
	return double2fx(floor(fx2double(i)));
}