ref: ca6149abcfd089393388ec7b83029d98b82966fc
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))); }