cross_product.h

Go to the documentation of this file.

#ifndef FUSED_ALGORITHMS_CROSS_PRODUCT_H
#define FUSED_ALGORITHMS_CROSS_PRODUCT_H
 
#include "config.h" // for my_size_t
#include "fused/fused_vector.h"
 
namespace matrix_algorithms
{
 
    template <typename T, my_size_t N>
    FusedVector<T, N> cross(const FusedVector<T, N> &a,
                            const FusedVector<T, N> &b)
    {
        static_assert(N == 3,
                      "cross product is only defined for 3-vectors");
 
        FusedVector<T, 3> result(T(0));
 
        result(0) = a(1) * b(2) - a(2) * b(1);
        result(1) = a(2) * b(0) - a(0) * b(2);
        result(2) = a(0) * b(1) - a(1) * b(0);
 
        return result;
    }
 
} // namespace matrix_algorithms
 
#endif // FUSED_ALGORITHMS_CROSS_PRODUCT_H