Camera positions

Camera positions are now correct, there are still problems with
calculating the position of 3d points.