Skip to content
Snippets Groups Projects
Commit 475542b9 authored by Fabian Reister's avatar Fabian Reister
Browse files

soechting: comments

parent 2e9dfe32
No related branches found
No related tags found
No related merge requests found
......@@ -64,10 +64,12 @@ struct Soechting
soechtingTarget(0) *= -1;
}
// spherical coordinates: distance, azimuth, elevation
const float R = soechtingTarget.norm();
const float Chi = MathTools::rad2deg(std::atan2(soechtingTarget.x(), soechtingTarget.y()));
const float Psi = MathTools::rad2deg(std::atan2(soechtingTarget.z(), soechtingTarget.head<2>().norm()));
// Kondo, Koichi. “Inverse Kinematics of a Human Arm,” n.d., 16.
SoechtingAngles sa;
if (accuratePointing) {
// Angles derived from accurate pointing
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment