2022-12-24 06:14:49 -05:00
|
|
|
#pragma once
|
|
|
|
//
|
|
|
|
// FILE: fast_math.h
|
|
|
|
// AUTHOR: Rob Tillaart
|
2022-12-26 04:01:34 -05:00
|
|
|
// VERSION: 0.2.1
|
2022-12-24 06:14:49 -05:00
|
|
|
// PURPOSE: Arduino library for fast math algorithms
|
|
|
|
// DATE: 27 October 2013
|
|
|
|
// URL: https://github.com/RobTillaart/fast_math
|
|
|
|
|
|
|
|
|
|
|
|
#ifdef ESP_PLATFORM
|
|
|
|
#include <math.h>
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <stdbool.h>
|
|
|
|
#else
|
|
|
|
#include "Arduino.h"
|
|
|
|
#endif
|
|
|
|
|
2022-12-26 04:01:34 -05:00
|
|
|
#define FASTMATH_LIB_VERSION (F("0.2.1"))
|
2022-12-24 06:14:49 -05:00
|
|
|
|
|
|
|
|
|
|
|
#ifdef __cplusplus
|
|
|
|
extern "C"
|
|
|
|
{
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
//////////////////////////////////////////////////////////////////////////
|
|
|
|
//
|
|
|
|
// ROUTINE: divmod10
|
2022-12-26 04:01:34 -05:00
|
|
|
// PURPOSE: fast routine that provides both / 10 and % 10 for integer math.
|
2022-12-24 06:14:49 -05:00
|
|
|
// URL: https://forum.arduino.cc/t/divmod10-a-fast-replacement-for-10-and-10-unsigned/163586
|
|
|
|
// AUTHORS: see URL
|
|
|
|
// NOTE: assembler version for AVR exists (by Stimmer) - see URL
|
|
|
|
//
|
|
|
|
void divmod10(uint32_t in, uint32_t *div, uint8_t *mod);
|
2022-12-26 04:01:34 -05:00
|
|
|
void divmod3(uint32_t in, uint32_t *div, uint8_t *mod);
|
|
|
|
void divmod5(uint32_t in, uint32_t *div, uint8_t *mod);
|
|
|
|
// for clocks
|
|
|
|
void divmod12(uint32_t in, uint32_t *div, uint8_t *mod);
|
|
|
|
void divmod24(uint32_t in, uint32_t *div, uint8_t *mod);
|
|
|
|
void divmod60(uint32_t in, uint32_t *div, uint8_t *mod);
|
|
|
|
|
2022-12-24 06:14:49 -05:00
|
|
|
|
|
|
|
|
|
|
|
//////////////////////////////////////////////////////////////////////////
|
|
|
|
//
|
|
|
|
// ROUTINE: dec2bcd and bcd2dec
|
|
|
|
// PURPOSE: conversion
|
|
|
|
//
|
|
|
|
uint8_t dec2bcdRef(uint8_t value); // reference implementation.
|
|
|
|
uint8_t dec2bcd(uint8_t value);
|
|
|
|
uint8_t dec2bcdRTC(uint8_t value);
|
|
|
|
uint8_t bcd2decRef(uint8_t value);
|
|
|
|
uint8_t bcd2dec(uint8_t value);
|
|
|
|
|
|
|
|
|
|
|
|
//////////////////////////////////////////////////////////////////////////
|
|
|
|
//
|
|
|
|
// ROUTINE: polynome
|
|
|
|
// PURPOSE: routine to evaluate a polynome and be able to change weights runtime.
|
|
|
|
//
|
|
|
|
// assumes degree >= 1, and ar[0] exists, and could be 0.
|
|
|
|
//
|
|
|
|
// e.g y = 3x^2 + 5x + 7 ==> ar[] = { 7, 5, 3 }; degree = 2;
|
|
|
|
//
|
|
|
|
float polynome(float x, float ar[], uint8_t degree);
|
|
|
|
|
|
|
|
|
|
|
|
//////////////////////////////////////////////////////////////////////////
|
|
|
|
//
|
2022-12-26 04:01:34 -05:00
|
|
|
// 16 BIT PING MATH - for distances up to ~10 meter
|
2022-12-24 06:14:49 -05:00
|
|
|
//
|
|
|
|
//////////////////////////////////////////////////////////
|
|
|
|
//
|
|
|
|
// ROUTINE: ping2cm
|
|
|
|
// PURPOSE: fast routines to calculate the distance in cm / mm for a ping sensor
|
|
|
|
//
|
|
|
|
uint16_t ping2cm(uint16_t in);
|
2022-12-26 04:01:34 -05:00
|
|
|
uint16_t ping2mm(uint16_t in); // smaller units are more accurate.
|
|
|
|
|
2022-12-24 06:14:49 -05:00
|
|
|
uint16_t ping2inch(uint16_t in);
|
2022-12-26 04:01:34 -05:00
|
|
|
uint16_t ping2quarter(uint16_t in);
|
2022-12-24 06:14:49 -05:00
|
|
|
uint16_t ping2sixteenths(uint16_t in);
|
|
|
|
|
2022-12-26 04:01:34 -05:00
|
|
|
|
2022-12-24 06:14:49 -05:00
|
|
|
//////////////////////////////////////////////////////////
|
|
|
|
//
|
2022-12-26 04:01:34 -05:00
|
|
|
// 32 BIT PING MATH - for distances > 10 meter (gaim ~10%)
|
2022-12-24 06:14:49 -05:00
|
|
|
//
|
|
|
|
uint32_t ping2cm32(uint32_t in);
|
|
|
|
uint32_t ping2mm32(uint32_t in);
|
|
|
|
|
|
|
|
|
|
|
|
// temperature compensated speed of sound distance
|
|
|
|
float ping2cm_tempC(uint16_t duration, int Celsius);
|
|
|
|
float ping2inch_tempC(uint16_t duration, int Celsius);
|
2022-12-26 04:01:34 -05:00
|
|
|
float ping2inch_tempF(uint16_t duration, int Fahrenheit);
|
2022-12-24 06:14:49 -05:00
|
|
|
|
|
|
|
|
|
|
|
#ifdef __cplusplus
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
// -- END OF FILE --
|
|
|
|
|