mirror of
https://github.com/gbdev/rgbds.git
synced 2025-11-20 18:22:07 +00:00
5c24de3dc4
This should help make RGBDS portable to systems with 16-bit integers, like DOS. For kicks, use the macros for 16-bit and 8-bit integers. Fix other miscellaneous things, like #include ordering and other printf-format related things. Reduce repitition in math.c while I'm there.
148 lines
2.1 KiB
C
148 lines
2.1 KiB
C
/*
|
|
* This file is part of RGBDS.
|
|
*
|
|
* Copyright (c) 1997-2018, Carsten Sorensen and RGBDS contributors.
|
|
*
|
|
* SPDX-License-Identifier: MIT
|
|
*/
|
|
|
|
/*
|
|
* Fixedpoint math routines
|
|
*/
|
|
|
|
#include <inttypes.h>
|
|
#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)
|
|
{
|
|
uint32_t u = i;
|
|
const char *sign = "";
|
|
|
|
if (i < 0) {
|
|
u = -u;
|
|
sign = "-";
|
|
}
|
|
|
|
printf("%s%" PRIu32 ".%05" PRIu32, sign, u >> 16,
|
|
((uint32_t)(fx2double(u) * 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)));
|
|
}
|