Fixed runtime .so link issues and added vector marker visualization for velocity along path