Small changes from debug/testing. Currently works in straight line, with 1 camera.