allemang.d/toddcox-visualize
1
0
Fork 0
mirror of https://github.com/allemangD/toddcox-visualize.git synced 2025-11-10 12:02:47 -05:00
Code Issues Packages Projects Releases Wiki Activity

ENH: Introduce rotor() helper

Browse Source
This commit is contained in:
David Allemang
2023-02-04 13:35:52 -05:00
parent f6e4392b51
commit 6c3754a3fa
1 changed files with 18 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

18
vis/include/mirror.hpp
View File

@@ -100,3 +100,21 @@ mat<N> rot(int u, int v, float theta) {
res(v, v) = std::cos(theta);
return res;
}
template<class U, class V>
auto rotor(U const &u, V const &v) {
using Rotor = Eigen::Matrix<
typename U::Scalar,
std::min(U::RowsAtCompileTime, V::RowsAtCompileTime),
std::min(U::RowsAtCompileTime, V::RowsAtCompileTime),
U::Options,
std::max(U::MaxRowsAtCompileTime, V::MaxRowsAtCompileTime),
std::max(U::MaxRowsAtCompileTime, V::MaxRowsAtCompileTime)
>;
const auto &ident = Rotor::Identity(u.rows(), v.rows());
const auto &inner = (u + v) / (1 + u.dot(v)) * (u + v).transpose();
const auto &outer = v * u.transpose();
return ident - inner + 2 * outer;
}