Fixed transforms right to left camera transform (was inverse transform), changed everything from float to doubles, least squares solving works now, cameramodel and trajectory estimator appear to be working correctly, but distortion is disabled for the camera model