docs: def axisangledottoang_vel(angle,axis, angle_dot,axis_dot):
      """Convert axis angle represetnation to angular velocity in body frame
  
      """
      
      Omega = angle_dot*axis + np.sin(angle)*axis_dot - (1-np.cos(angle))*hat_map(axis).dot(axis_dot)
      return Omega