void quat_make_nearest(fastf_t *q1, const fastf_t *q2) { quat_t qtemp; double d1, d2; QSCALE( qtemp, q1, -1.0 ); d1 = quat_distance( q1, q2 ); d2 = quat_distance( qtemp, q2 ); /* Choose smallest distance */ if ( d2 < d1 ) { QMOVE( q1, qtemp ); } }
void bn_quat_distance_wrapper(double *dp, mat_t q1, mat_t q2) { *dp = quat_distance(q1, q2); }