Camera fixing/drivepath

Fixed camera functionality, work on drivepath