Added set(orocos_kdl_DIR) to get around the fail orocos_kdl package, will not work if orocos is being installed from src since it looks in /opt/ros/hydro/share/orocos_kdl
FIxed orocos_kdl and visual_pose not found by putting them after catkin_package()