fix hypot issues, add comments to tests from tracking this down
Merge pull request #204 from mikeferguson/fix_costmap_tests

fix hypot issues, add comments to tests from tracking this down