35 : ivState(
State(x, y, z, roll, pitch, yaw, leg))
39 , ivpPredState(pred_state)
40 , ivpSuccState(succ_state)
43 unsigned int hash_pred = pred_state ? pred_state->
getHashTag() : 0u;
44 unsigned int hash_succ = succ_state ? succ_state->
getHashTag() : 0u;
59 unsigned int hash_pred = pred_state ? pred_state->
getHashTag() : 0u;
60 unsigned int hash_succ = succ_state ? succ_state->
getHashTag() : 0u;
75 unsigned int hash_pred = pred_state ? pred_state->
getHashTag() : 0u;
76 unsigned int hash_succ = succ_state ? succ_state->
getHashTag() : 0u;
89 unsigned int hash_pred = pred_state ? pred_state->
getHashTag() : 0u;
90 unsigned int hash_succ = succ_state ? succ_state->
getHashTag() : 0u;
TFSIMD_FORCE_INLINE const tfScalar & y() const
TFSIMD_FORCE_INLINE const tfScalar & x() const
def normalize_angle(angle)