I think this will only work for free orientation forward solutions, right? Can probably skip the SVD for fixed...