GitHub-Proxy/eigen
1
0
Fork 0
mirror of https://gitlab.com/libeigen/eigen.git synced 2025-04-20 08:39:37 +08:00
Code Issues Packages Projects Releases Wiki Activity

Update file Geometry_SIMD.h

Browse Source
This commit is contained in:
Charles Schlosser 2024-04-05 18:30:39 +00:00 committed by Rasmus Munk Larsen
parent b2c9ba2bee
commit 2620cb930b
1 changed files with 9 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
Eigen/src/Geometry/arch/Geometry_SIMD.h
View File

@ -62,16 +62,19 @@ struct quat_conj<Architecture::Target, Derived, float> {
template <typename VectorLhs, typename VectorRhs>
struct cross3_impl<Architecture::Target, VectorLhs, VectorRhs, float, true> {
enum { ResAlignment = traits<typename plain_matrix_type<VectorLhs>::type>::Alignment };
static inline typename plain_matrix_type<VectorLhs>::type run(const VectorLhs& lhs, const VectorRhs& rhs) {
using DstPlainType = typename plain_matrix_type<VectorLhs>::type;
static constexpr int DstAlignment = evaluator<DstPlainType>::Alignment;
static constexpr int LhsAlignment = evaluator<VectorLhs>::Alignment;
static constexpr int RhsAlignment = evaluator<VectorRhs>::Alignment;
static inline DstPlainType run(const VectorLhs& lhs, const VectorRhs& rhs) {
evaluator<VectorLhs> lhs_eval(lhs);
evaluator<VectorRhs> rhs_eval(rhs);
Packet4f a = lhs_eval.template packet<traits<VectorLhs>::Alignment, Packet4f>(0);
Packet4f b = rhs_eval.template packet<traits<VectorRhs>::Alignment, Packet4f>(0);
Packet4f a = lhs_eval.template packet<LhsAlignment, Packet4f>(0);
Packet4f b = rhs_eval.template packet<RhsAlignment, Packet4f>(0);
Packet4f mul1 = pmul(vec4f_swizzle1(a, 1, 2, 0, 3), vec4f_swizzle1(b, 2, 0, 1, 3));
Packet4f mul2 = pmul(vec4f_swizzle1(a, 2, 0, 1, 3), vec4f_swizzle1(b, 1, 2, 0, 3));
typename plain_matrix_type<VectorLhs>::type res;
pstoret<float, Packet4f, ResAlignment>(&res.x(), psub(mul1, mul2));
DstPlainType res;
pstoret<float, Packet4f, DstAlignment>(&res.x(), psub(mul1, mul2));
return res;
}
};