Finish "convert floats to double" PR

Here is a weird one. PR was approved then not merged. It now has conflicts and no activity for over a year. It might just need some minor updates: https://github.com/ros-planning/moveit2/pull/1578