Implemented least squares solver
Moved sixense stuff to property sheet and fixed hydra bug