Function transition_costs

pub fn transition_costs(
    from: &Joints,
    to: &Joints,
    coefficients: &Joints,
) -> f64

Calculates the transition cost between two sets of joint positions, weighted by given coefficients (rotating heavy base joints is more expensive). This function returns maximum rotation