Fix core/kinematics/util.cc You know, it turns out that fixing an illegible function to be more legible carries risks.