Path: Common/Quaternion
-------------------------------------------------------------------------- Small angle errors between two quaternions. This routine gives the correct sign when both vectors transform from frame a to frame b and frame b is the body frame. If the convention is reversed you must reverse the sign. To force the positive first element convention enter any 3rd argment. -------------------------------------------------------------------------- Form: angle = QError( qRef, qMeas, pos ) -------------------------------------------------------------------------- ------ Inputs ------ qRef (4,1) Reference quaternion qMeas (4,1) Measured quaternion pos (1,1) If entered make the first element positive always ------- Outputs ------- angle (3,1) Vector of small angular errors (rad) --------------------------------------------------------------------------
Common: Quaternion/QMult Common: Quaternion/QPose
Back to the Common Module page