added missing libraries
added ikfast model to repo
Merge branch 'staubli_model' of github.com:CURG/trajectory_planner into online_reachability