Add path for vis and piotr toolbox