fixed the arm planner tests to include geo utils
Added sbpl to arm planner link libraries