fix Eigen allocation problems in kinematic_constraint_aware and setting of IK from multiple tips; added a utility function to check if a constraints message is empty