Cast to a float, not an int

Otherwise, waypoint pos isn't very accurate