functionselectBranch

Determine branch which is closest to initial angle=0

Inputs

TypeNameDefaultDescription
SI.LengthLLength of length constraint
Real[3]eUnit vector along axis of translation, resolved in frame_a (= same in frame_b)
SI.Positiond_guessSelect the configuration such that at initial time |d-d_guess|is minimal (d: distance between origin of frame_a and origin of frame_b)
SI.Position[3]r_aPosition vector from frame_a to frame_a side of length constraint, resolved in frame_a of prismatic joint
SI.Position[3]r_bPosition vector from frame_b to frame_b side of length constraint, resolved in frame_b of prismatic joint

Outputs

TypeNameDefaultDescription
BooleanpositiveBranchBranch of the initial solution