Fix normalization check
Fix typo in warning message
Rename functions according to ROS guidelines