Change camera intrinsics into config file

[herrvonregen]

Change the saved camera intrinsics from npz into a yaml config file. The config file should be an optional paramter for node launch.