Added code to compute quaternion from two vectors
Need to test their correctness