ensure orthogonality of arm rotation
small fix in calculation of control points for input to TrackChain Initialize()