Updated Pose6d function names to meet camelCase code standard