fixed a scaling problem in the one heuristic
Merge branch 'meta' of https://github.com/sid24ss/monolithic_pr2_planner into meta