FastLED 3.9.15
Loading...
Searching...
No Matches

◆ swap_by_copy()

template<typename T>
void fl::fl::swap_by_copy ( T & a,
T & b )

Definition at line 883 of file s16x16x4.h.

894 {
895
896// Forward declaration for cross-type operations
897struct s0x32x4;
898
901struct s16x16x4 {
902 simd::simd_u32x4 raw; // 4× i32 values in Q16 format
903
904 // ---- Construction ------------------------------------------------------
905
908 result.raw = r;
909 return result;
910 }
911
912 // Load 4 s16x16 values from memory (unaligned access supported)
913 static FASTLED_FORCE_INLINE s16x16x4 load(const s16x16* ptr) {
914 return from_raw(simd::platforms::load_u32_4(reinterpret_cast<const u32*>(ptr))); // ok reinterpret cast
915 }
916
917 // Store 4 s16x16 values to memory (unaligned access supported)
918 FASTLED_FORCE_INLINE void store(s16x16* ptr) const {
919 simd::platforms::store_u32_4(reinterpret_cast<u32*>(ptr), raw); // ok reinterpret cast
920 }
921
922 // Broadcast single s16x16 value to all 4 lanes
923 static FASTLED_FORCE_INLINE s16x16x4 set1(s16x16 value) {
924 return from_raw(simd::platforms::set1_u32_4(static_cast<u32>(value.raw())));
925 }
926
927 // ---- SIMD arithmetic (s16x16x4 OP s16x16x4 → s16x16x4) -----------------
928
929 FASTLED_FORCE_INLINE s16x16x4 operator+(s16x16x4 b) const {
930 return from_raw(simd::add_i32_4(raw, b.raw));
931 }
932
933 FASTLED_FORCE_INLINE s16x16x4 operator-(s16x16x4 b) const {
934 return from_raw(simd::sub_i32_4(raw, b.raw));
935 }
936
937 FASTLED_FORCE_INLINE s16x16x4 operator*(s16x16x4 b) const {
938 // Q16 × Q16 = Q32 → shift right 16 → Q16
939 return from_raw(simd::mulhi_i32_4(raw, b.raw));
940 }
941
942 FASTLED_FORCE_INLINE s16x16x4 operator-() const {
943 // Unary negation: -x = 0 - x
944 auto zero = simd::set1_u32_4(0);
945 return from_raw(simd::sub_i32_4(zero, raw));
946 }
947
948 FASTLED_FORCE_INLINE s16x16x4 operator>>(int shift) const {
949 return from_raw(simd::sra_i32_4(raw, shift));
950 }
951
952 FASTLED_FORCE_INLINE s16x16x4 operator<<(int shift) const {
953 return from_raw(simd::sll_u32_4(raw, shift));
954 }
955
956 // Cross-type multiply: s16x16x4 × s0x32x4 → s16x16x4 (commutative)
957 // Implemented after s0x32x4 is defined
958 FASTLED_FORCE_INLINE s16x16x4 operator*(s0x32x4 b) const;
959
960 // ---- Math functions -------------------------------------------------------
961
963 FASTLED_FORCE_INLINE s16x16x4 abs() const {
964 // mask = -1 if negative (sign extended), 0 if positive
965 auto mask = simd::sra_i32_4(raw, 31);
966 // flip bits if negative, then add 1 (two's complement)
967 auto flipped = simd::xor_u32_4(raw, mask);
968 return from_raw(simd::sub_i32_4(flipped, mask));
969 }
970
972 FASTLED_FORCE_INLINE s16x16x4 min(s16x16x4 b) const {
973 return from_raw(simd::min_i32_4(raw, b.raw));
974 }
975
977 FASTLED_FORCE_INLINE s16x16x4 max(s16x16x4 b) const {
978 return from_raw(simd::max_i32_4(raw, b.raw));
979 }
980
982 FASTLED_FORCE_INLINE s16x16x4 clamp(s16x16x4 lo, s16x16x4 hi) const {
983 return max(lo).min(hi);
984 }
985
988 FASTLED_FORCE_INLINE s16x16x4 lerp(s16x16x4 b, s16x16 t) const {
989 auto t_vec = s16x16x4::set1(t);
990 auto diff = b - (*this);
991 return (*this) + (diff * t_vec);
992 }
993
996 FASTLED_FORCE_INLINE void sincos(s16x16x4& out_sin, s16x16x4& out_cos) const {
997 // Convert radians to 24-bit angle units (same as scalar s16x16)
998 // RAD_TO_24 = 2^24 / (2π) in Q16
999 static constexpr i32 RAD_TO_24 = 2670177; // from s16x16.h
1000
1001 // Convert 4 angles: mulhi_i32_4 does (i64*i64) >> 16
1002 auto angles_u32 = simd::mulhi_su32_4(raw, simd::set1_u32_4(static_cast<u32>(RAD_TO_24)));
1003
1004 // Call vectorized sincos
1005 auto sc = sincos32_simd(angles_u32);
1006
1007 // Shift results right by 15 to convert from raw sin32 output to Q16.16
1008 out_sin = from_raw(simd::sra_i32_4(sc.sin_vals, 15));
1009 out_cos = from_raw(simd::sra_i32_4(sc.cos_vals, 15));
1010 }
1011
1013 FASTLED_FORCE_INLINE s16x16x4 sin() const {
1014 s16x16x4 sin_out, cos_out;
1015 sincos(sin_out, cos_out);
1016 return sin_out;
1017 }
1018
1020 FASTLED_FORCE_INLINE s16x16x4 cos() const {
1021 s16x16x4 sin_out, cos_out;
1022 sincos(sin_out, cos_out);
1023 return cos_out;
1024 }
1025};
1026
1027// Include simd_ops.h to implement cross-type operations
1028// Must come after all types are defined
1029#include "fl/math/fixed_point/simd_ops.h" // allow-include-after-namespace
1030
1031} // namespace fl
FL_DISABLE_WARNING_PUSH U constexpr common_type_t< T, U > min(T a, U b) FL_NOEXCEPT
Memory functions are available in fl:: namespace via fl/stl/cstring.h Using declarations cannot work ...
Definition math.h:71
constexpr common_type_t< T, U > max(T a, U b) FL_NOEXCEPT
Definition math.h:75
constexpr enable_if< is_fixed_point< T >::value, T >::type abs(T x) FL_NOEXCEPT
static uint32_t t
Definition Luminova.h:55
FASTLED_FORCE_INLINE CRGB * operator+(const CRGBSet &pixels, int offset)
Retrieve a pointer to a CRGB array, using a CRGBSet and an LED offset.
Definition pixelset.h:488
platforms::simd_u32x4 simd_u32x4
Definition s16x16x4.h:27
ostream & operator<<(ostream &os, const hex_t &) FL_NOEXCEPT
FASTLED_FORCE_INLINE SinCos32_simd sincos32_simd(simd::simd_u32x4 angles) FL_NOEXCEPT
Process 4 angles simultaneously, returning vectorized sin/cos values SIMD-optimized: vectorized angle...
Definition sin32.h:145
enable_if< is_fixed_point< T >::value, void >::type sincos(T angle, T &out_sin, T &out_cos) FL_NOEXCEPT
FASTLED_FORCE_INLINE CRGB operator*(const CRGB &p1, u8 d) FL_NOEXCEPT
Multiply each of the channels by a constant, saturating each channel at 0xFF.
Definition crgb.hpp:198
FASTLED_FORCE_INLINE CRGB operator-(const CRGB &p1, const CRGB &p2) FL_NOEXCEPT
Subtract one CRGB from another, saturating at 0x00 for each channel.
Definition crgb.hpp:190
expected< T, E > result
Alias for expected (Rust-style naming)
Definition result.h:31
enable_if< is_fixed_point< T >::value, T >::type cos(T angle) FL_NOEXCEPT
enable_if< is_fixed_point< T >::value, T >::type sin(T angle) FL_NOEXCEPT
constexpr enable_if< is_fixed_point< T >::value, T >::type clamp(T x, T lo, T hi) FL_NOEXCEPT
FASTLED_FORCE_INLINE float lerp(float t, float a, float b)
#define FASTLED_FORCE_INLINE
Cross-type SIMD fixed-point operations (implemented after all types are defined)
4-wide s0x32 vector (normalized values [-1, 1]) Backed by 128-bit SIMD register (4× i32 in Q31 format...
Definition s16x16x4.h:17
4-wide s16x16 vector (general fixed-point) Backed by 128-bit SIMD register (4× i32 in Q16 format)
Definition s16x16x4.h:19