123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934 |
- #ifndef __INC_LIB8TION_H
- #define __INC_LIB8TION_H
- #include <stdint.h>
- #define LIB8STATIC static inline
- #define LIB8STATIC_ALWAYS_INLINE static inline
- #if !defined(__AVR__)
- #include <string.h>
- #endif
- #if defined(__arm__)
- #if defined(FASTLED_TEENSY3)
- #define QADD8_C 0
- #define QADD7_C 0
- #define QADD8_ARM_DSP_ASM 1
- #define QADD7_ARM_DSP_ASM 1
- #else
- #define QADD8_C 1
- #define QADD7_C 1
- #endif
- #define QSUB8_C 1
- #define SCALE8_C 1
- #define SCALE16BY8_C 1
- #define SCALE16_C 1
- #define ABS8_C 1
- #define MUL8_C 1
- #define QMUL8_C 1
- #define ADD8_C 1
- #define SUB8_C 1
- #define EASE8_C 1
- #define AVG8_C 1
- #define AVG7_C 1
- #define AVG16_C 1
- #define AVG15_C 1
- #define BLEND8_C 1
- #elif defined(__AVR__)
- #define QADD8_C 0
- #define QADD7_C 0
- #define QSUB8_C 0
- #define ABS8_C 0
- #define ADD8_C 0
- #define SUB8_C 0
- #define AVG8_C 0
- #define AVG7_C 0
- #define AVG16_C 0
- #define AVG15_C 0
- #define QADD8_AVRASM 1
- #define QADD7_AVRASM 1
- #define QSUB8_AVRASM 1
- #define ABS8_AVRASM 1
- #define ADD8_AVRASM 1
- #define SUB8_AVRASM 1
- #define AVG8_AVRASM 1
- #define AVG7_AVRASM 1
- #define AVG16_AVRASM 1
- #define AVG15_AVRASM 1
- #if !defined(LIB8_ATTINY)
- #define SCALE8_C 0
- #define SCALE16BY8_C 0
- #define SCALE16_C 0
- #define MUL8_C 0
- #define QMUL8_C 0
- #define EASE8_C 0
- #define BLEND8_C 0
- #define SCALE8_AVRASM 1
- #define SCALE16BY8_AVRASM 1
- #define SCALE16_AVRASM 1
- #define MUL8_AVRASM 1
- #define QMUL8_AVRASM 1
- #define EASE8_AVRASM 1
- #define CLEANUP_R1_AVRASM 1
- #define BLEND8_AVRASM 1
- #else
- #define SCALE8_C 1
- #define SCALE16BY8_C 1
- #define SCALE16_C 1
- #define MUL8_C 1
- #define QMUL8_C 1
- #define EASE8_C 1
- #define BLEND8_C 1
- #define SCALE8_AVRASM 0
- #define SCALE16BY8_AVRASM 0
- #define SCALE16_AVRASM 0
- #define MUL8_AVRASM 0
- #define QMUL8_AVRASM 0
- #define EASE8_AVRASM 0
- #define BLEND8_AVRASM 0
- #endif
- #else
- #define QADD8_C 1
- #define QADD7_C 1
- #define QSUB8_C 1
- #define SCALE8_C 1
- #define SCALE16BY8_C 1
- #define SCALE16_C 1
- #define ABS8_C 1
- #define MUL8_C 1
- #define QMUL8_C 1
- #define ADD8_C 1
- #define SUB8_C 1
- #define EASE8_C 1
- #define AVG8_C 1
- #define AVG7_C 1
- #define AVG16_C 1
- #define AVG15_C 1
- #define BLEND8_C 1
- #endif
- typedef uint8_t fract8;
- typedef int8_t sfract7;
- typedef uint16_t fract16;
- typedef int16_t sfract15;
- typedef uint16_t accum88;
- typedef int16_t saccum78;
- typedef uint32_t accum1616;
- typedef int32_t saccum1516;
- typedef uint16_t accum124;
- typedef int32_t saccum114;
- #include "math8.h"
- #include "scale8.h"
- #include "random8.h"
- #include "trig8.h"
- LIB8STATIC float sfract15ToFloat( sfract15 y)
- {
- return y / 32768.0;
- }
- LIB8STATIC sfract15 floatToSfract15( float f)
- {
- return f * 32768.0;
- }
- #if defined(__AVR__)
- void * memmove8( void * dst, const void * src, uint16_t num );
- void * memcpy8 ( void * dst, const void * src, uint16_t num ) __attribute__ ((noinline));
- void * memset8 ( void * ptr, uint8_t value, uint16_t num ) __attribute__ ((noinline)) ;
- #else
- #define memmove8 memmove
- #define memcpy8 memcpy
- #define memset8 memset
- #endif
- LIB8STATIC uint8_t lerp8by8( uint8_t a, uint8_t b, fract8 frac)
- {
- uint8_t result;
- if( b > a) {
- uint8_t delta = b - a;
- uint8_t scaled = scale8( delta, frac);
- result = a + scaled;
- } else {
- uint8_t delta = a - b;
- uint8_t scaled = scale8( delta, frac);
- result = a - scaled;
- }
- return result;
- }
- LIB8STATIC uint16_t lerp16by16( uint16_t a, uint16_t b, fract16 frac)
- {
- uint16_t result;
- if( b > a ) {
- uint16_t delta = b - a;
- uint16_t scaled = scale16(delta, frac);
- result = a + scaled;
- } else {
- uint16_t delta = a - b;
- uint16_t scaled = scale16( delta, frac);
- result = a - scaled;
- }
- return result;
- }
- LIB8STATIC uint16_t lerp16by8( uint16_t a, uint16_t b, fract8 frac)
- {
- uint16_t result;
- if( b > a) {
- uint16_t delta = b - a;
- uint16_t scaled = scale16by8( delta, frac);
- result = a + scaled;
- } else {
- uint16_t delta = a - b;
- uint16_t scaled = scale16by8( delta, frac);
- result = a - scaled;
- }
- return result;
- }
- LIB8STATIC int16_t lerp15by8( int16_t a, int16_t b, fract8 frac)
- {
- int16_t result;
- if( b > a) {
- uint16_t delta = b - a;
- uint16_t scaled = scale16by8( delta, frac);
- result = a + scaled;
- } else {
- uint16_t delta = a - b;
- uint16_t scaled = scale16by8( delta, frac);
- result = a - scaled;
- }
- return result;
- }
- LIB8STATIC int16_t lerp15by16( int16_t a, int16_t b, fract16 frac)
- {
- int16_t result;
- if( b > a) {
- uint16_t delta = b - a;
- uint16_t scaled = scale16( delta, frac);
- result = a + scaled;
- } else {
- uint16_t delta = a - b;
- uint16_t scaled = scale16( delta, frac);
- result = a - scaled;
- }
- return result;
- }
- LIB8STATIC uint8_t map8( uint8_t in, uint8_t rangeStart, uint8_t rangeEnd)
- {
- uint8_t rangeWidth = rangeEnd - rangeStart;
- uint8_t out = scale8( in, rangeWidth);
- out += rangeStart;
- return out;
- }
- #if EASE8_C == 1
- LIB8STATIC uint8_t ease8InOutQuad( uint8_t i)
- {
- uint8_t j = i;
- if( j & 0x80 ) {
- j = 255 - j;
- }
- uint8_t jj = scale8( j, j);
- uint8_t jj2 = jj << 1;
- if( i & 0x80 ) {
- jj2 = 255 - jj2;
- }
- return jj2;
- }
- #elif EASE8_AVRASM == 1
- LIB8STATIC uint8_t ease8InOutQuad(uint8_t val) {
- uint8_t j=val;
- asm volatile (
- "sbrc %[val], 7 \n"
- "com %[j] \n"
- "mul %[j], %[j] \n"
- "add r0, %[j] \n"
- "ldi %[j], 0 \n"
- "adc %[j], r1 \n"
- "lsl r0 \n"
- "rol %[j] \n"
- "sbrc %[val], 7 \n"
- "com %[j] \n"
- "clr __zero_reg__ \n"
- : [j] "+&a" (j)
- : [val] "a" (val)
- : "r0", "r1"
- );
- return j;
- }
- #else
- #error "No implementation for ease8InOutQuad available."
- #endif
- LIB8STATIC uint16_t ease16InOutQuad( uint16_t i)
- {
- uint16_t j = i;
- if( j & 0x8000 ) {
- j = 65535 - j;
- }
- uint16_t jj = scale16( j, j);
- uint16_t jj2 = jj << 1;
- if( i & 0x8000 ) {
- jj2 = 65535 - jj2;
- }
- return jj2;
- }
- LIB8STATIC fract8 ease8InOutCubic( fract8 i)
- {
- uint8_t ii = scale8_LEAVING_R1_DIRTY( i, i);
- uint8_t iii = scale8_LEAVING_R1_DIRTY( ii, i);
- uint16_t r1 = (3 * (uint16_t)(ii)) - ( 2 * (uint16_t)(iii));
-
- uint8_t result = r1;
-
- if( r1 & 0x100 ) {
- result = 255;
- }
- return result;
- }
- #if EASE8_C == 1
- LIB8STATIC fract8 ease8InOutApprox( fract8 i)
- {
- if( i < 64) {
-
- i /= 2;
- } else if( i > (255 - 64)) {
-
- i = 255 - i;
- i /= 2;
- i = 255 - i;
- } else {
-
- i -= 64;
- i += (i / 2);
- i += 32;
- }
- return i;
- }
- #elif EASE8_AVRASM == 1
- LIB8STATIC uint8_t ease8InOutApprox( fract8 i)
- {
-
- asm volatile (
- " subi %[i], 64 \n\t"
- " cpi %[i], 128 \n\t"
- " brcc Lshift_%= \n\t"
-
- " mov __tmp_reg__, %[i] \n\t"
- " lsr __tmp_reg__ \n\t"
- " add %[i], __tmp_reg__ \n\t"
- " subi %[i], 224 \n\t"
- " rjmp Ldone_%= \n\t"
-
- "Lshift_%=: \n\t"
- " lsr %[i] \n\t"
- " subi %[i], 96 \n\t"
- "Ldone_%=: \n\t"
- : [i] "+&a" (i)
- :
- : "r0", "r1"
- );
- return i;
- }
- #else
- #error "No implementation for ease8 available."
- #endif
- LIB8STATIC uint8_t triwave8(uint8_t in)
- {
- if( in & 0x80) {
- in = 255 - in;
- }
- uint8_t out = in << 1;
- return out;
- }
- LIB8STATIC uint8_t quadwave8(uint8_t in)
- {
- return ease8InOutQuad( triwave8( in));
- }
- LIB8STATIC uint8_t cubicwave8(uint8_t in)
- {
- return ease8InOutCubic( triwave8( in));
- }
- LIB8STATIC uint8_t squarewave8( uint8_t in, uint8_t pulsewidth)
- {
- if( in < pulsewidth || (pulsewidth == 255)) {
- return 255;
- } else {
- return 0;
- }
- }
- #if (defined(ARDUINO) || defined(SPARK) || defined(FASTLED_HAS_MILLIS)) && !defined(USE_GET_MILLISECOND_TIMER)
- #define GET_MILLIS millis
- #else
- uint32_t get_millisecond_timer(void);
- #define GET_MILLIS get_millisecond_timer
- #endif
- LIB8STATIC uint16_t beat88( accum88 beats_per_minute_88, uint32_t timebase)
- {
-
-
-
-
-
-
-
-
- return (((GET_MILLIS()) - timebase) * beats_per_minute_88 * 280) >> 16;
- }
- LIB8STATIC uint16_t beat16( accum88 beats_per_minute, uint32_t timebase)
- {
-
- if( beats_per_minute < 256) beats_per_minute <<= 8;
- return beat88(beats_per_minute, timebase);
- }
- LIB8STATIC uint8_t beat8( accum88 beats_per_minute, uint32_t timebase)
- {
- return beat16( beats_per_minute, timebase) >> 8;
- }
- LIB8STATIC uint16_t beatsin88( accum88 beats_per_minute_88, uint16_t lowest, uint16_t highest, uint32_t timebase, uint16_t phase_offset)
- {
- uint16_t beat = beat88( beats_per_minute_88, timebase);
- uint16_t beatsin = (sin16( beat + phase_offset) + 32768);
- uint16_t rangewidth = highest - lowest;
- uint16_t scaledbeat = scale16( beatsin, rangewidth);
- uint16_t result = lowest + scaledbeat;
- return result;
- }
- LIB8STATIC uint16_t beatsin16(accum88 beats_per_minute, uint16_t lowest, uint16_t highest, uint32_t timebase, uint16_t phase_offset)
- {
- uint16_t beat = beat16( beats_per_minute, timebase);
- uint16_t beatsin = (sin16( beat + phase_offset) + 32768);
- uint16_t rangewidth = highest - lowest;
- uint16_t scaledbeat = scale16( beatsin, rangewidth);
- uint16_t result = lowest + scaledbeat;
- return result;
- }
- LIB8STATIC uint8_t beatsin8( accum88 beats_per_minute, uint8_t lowest, uint8_t highest, uint32_t timebase, uint8_t phase_offset)
- {
- uint8_t beat = beat8( beats_per_minute, timebase);
- uint8_t beatsin = sin8( beat + phase_offset);
- uint8_t rangewidth = highest - lowest;
- uint8_t scaledbeat = scale8( beatsin, rangewidth);
- uint8_t result = lowest + scaledbeat;
- return result;
- }
- LIB8STATIC uint16_t seconds16(void)
- {
- uint32_t ms = GET_MILLIS();
- uint16_t s16;
- s16 = ms / 1000;
- return s16;
- }
- LIB8STATIC uint16_t minutes16(void)
- {
- uint32_t ms = GET_MILLIS();
- uint16_t m16;
- m16 = (ms / (60000L)) & 0xFFFF;
- return m16;
- }
- LIB8STATIC uint8_t hours8(void)
- {
- uint32_t ms = GET_MILLIS();
- uint8_t h8;
- h8 = (ms / (3600000L)) & 0xFF;
- return h8;
- }
- #endif
|