link sbpl_arm_planner against bfs3d
more scrubbing for a more minimal, documented API
add free angle parameter to kdl robot model
commenting