8f34c2760d
project:cfg:BoardConfig_IPC: Added fastboot BoardConfig file and firmware post-scripts, distinguishing between the BoardConfigs for Luckfox Pico Pro and Luckfox Pico Max. project:app: Added fastboot_client and rk_smart_door for quick boot applications; updated rkipc app to adapt to the latest media library. media:samples: Added more usage examples. media:rockit: Fixed bugs; removed support for retrieving data frames from VPSS. media:isp: Updated rkaiq library and related tools to support connection to RKISP_Tuner. sysdrv:Makefile: Added support for compiling drv_ko on Luckfox Pico Ultra W using Ubuntu; added support for custom root filesystem. sysdrv:tools:board: Updated Buildroot optional mirror sources, updated some software versions, and stored device tree files and configuration files that undergo multiple modifications for U-Boot and kernel separately. sysdrv:source:mcu: Used RISC-V MCU SDK with RT-Thread system, mainly for initializing camera AE during quick boot. sysdrv:source:uboot: Added support for fastboot; added high baud rate DDR bin for serial firmware upgrades. sysdrv:source:kernel: Upgraded to version 5.10.160; increased NPU frequency for RV1106G3; added support for fastboot. Signed-off-by: luckfox-eng29 <eng29@luckfox.com>
177 lines
4.1 KiB
C
177 lines
4.1 KiB
C
/*
|
|
* Copyright (c) 2006-2018, RT-Thread Development Team
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Change Logs:
|
|
* Date Author Notes
|
|
*/
|
|
#include <math.h>
|
|
|
|
/*
|
|
* COPYRIGHT: See COPYING in the top level directory
|
|
* PROJECT: ReactOS CRT
|
|
* FILE: lib/crt/math/cos.c
|
|
* PURPOSE: Generic C Implementation of cos
|
|
* PROGRAMMER: Timo Kreuzer (timo.kreuzer@reactos.org)
|
|
*/
|
|
|
|
#define PRECISION 9
|
|
|
|
static double cos_off_tbl[] = {0.0, -M_PI/2., 0, -M_PI/2.};
|
|
static double cos_sign_tbl[] = {1,-1,-1,1};
|
|
|
|
static double sin_off_tbl[] = {0.0, -M_PI/2., 0, -M_PI/2.};
|
|
static double sin_sign_tbl[] = {1,-1,-1,1};
|
|
|
|
double sin(double x)
|
|
{
|
|
int quadrant;
|
|
double x2, result;
|
|
|
|
/* Calculate the quadrant */
|
|
quadrant = x * (2./M_PI);
|
|
|
|
/* Get offset inside quadrant */
|
|
x = x - quadrant * (M_PI/2.);
|
|
|
|
/* Normalize quadrant to [0..3] */
|
|
quadrant = (quadrant - 1) & 0x3;
|
|
|
|
/* Fixup value for the generic function */
|
|
x += sin_off_tbl[quadrant];
|
|
|
|
/* Calculate the negative of the square of x */
|
|
x2 = - (x * x);
|
|
|
|
/* This is an unrolled taylor series using <PRECISION> iterations
|
|
* Example with 4 iterations:
|
|
* result = 1 - x^2/2! + x^4/4! - x^6/6! + x^8/8!
|
|
* To save multiplications and to keep the precision high, it's performed
|
|
* like this:
|
|
* result = 1 - x^2 * (1/2! - x^2 * (1/4! - x^2 * (1/6! - x^2 * (1/8!))))
|
|
*/
|
|
|
|
/* Start with 0, compiler will optimize this away */
|
|
result = 0;
|
|
|
|
#if (PRECISION >= 10)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12*13*14*15*16*17*18*19*20);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 9)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12*13*14*15*16*17*18);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 8)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12*13*14*15*16);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 7)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12*13*14);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 6)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 5)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10);
|
|
result *= x2;
|
|
#endif
|
|
result += 1./(1.*2*3*4*5*6*7*8);
|
|
result *= x2;
|
|
|
|
result += 1./(1.*2*3*4*5*6);
|
|
result *= x2;
|
|
|
|
result += 1./(1.*2*3*4);
|
|
result *= x2;
|
|
|
|
result += 1./(1.*2);
|
|
result *= x2;
|
|
|
|
result += 1;
|
|
|
|
/* Apply correct sign */
|
|
result *= sin_sign_tbl[quadrant];
|
|
|
|
return result;
|
|
}
|
|
|
|
double cos(double x)
|
|
{
|
|
int quadrant;
|
|
double x2, result;
|
|
|
|
/* Calculate the quadrant */
|
|
quadrant = x * (2./M_PI);
|
|
|
|
/* Get offset inside quadrant */
|
|
x = x - quadrant * (M_PI/2.);
|
|
|
|
/* Normalize quadrant to [0..3] */
|
|
quadrant = quadrant & 0x3;
|
|
|
|
/* Fixup value for the generic function */
|
|
x += cos_off_tbl[quadrant];
|
|
|
|
/* Calculate the negative of the square of x */
|
|
x2 = - (x * x);
|
|
|
|
/* This is an unrolled taylor series using <PRECISION> iterations
|
|
* Example with 4 iterations:
|
|
* result = 1 - x^2/2! + x^4/4! - x^6/6! + x^8/8!
|
|
* To save multiplications and to keep the precision high, it's performed
|
|
* like this:
|
|
* result = 1 - x^2 * (1/2! - x^2 * (1/4! - x^2 * (1/6! - x^2 * (1/8!))))
|
|
*/
|
|
|
|
/* Start with 0, compiler will optimize this away */
|
|
result = 0;
|
|
|
|
#if (PRECISION >= 10)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12*13*14*15*16*17*18*19*20);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 9)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12*13*14*15*16*17*18);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 8)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12*13*14*15*16);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 7)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12*13*14);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 6)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10*11*12);
|
|
result *= x2;
|
|
#endif
|
|
#if (PRECISION >= 5)
|
|
result += 1./(1.*2*3*4*5*6*7*8*9*10);
|
|
result *= x2;
|
|
#endif
|
|
result += 1./(1.*2*3*4*5*6*7*8);
|
|
result *= x2;
|
|
|
|
result += 1./(1.*2*3*4*5*6);
|
|
result *= x2;
|
|
|
|
result += 1./(1.*2*3*4);
|
|
result *= x2;
|
|
|
|
result += 1./(1.*2);
|
|
result *= x2;
|
|
|
|
result += 1;
|
|
|
|
/* Apply correct sign */
|
|
result *= cos_sign_tbl[quadrant];
|
|
|
|
return result;
|
|
}
|
|
|