def fromDirection(self, vFrom, vTo):
vFrom = Vec(vFrom)
vTo = Vec(vTo)
epsilon = 1E-10
fromLengthSq = vFrom.normSquared()
toLengthSq = vTo.normSquared()
if (fromLengthSq < epsilon) or (toLengthSq < epsilon):
self.quaternion[0] = self.quaternion[1] = self.quaternion[2] = 0.0
self.quaternion[3] = 1.0
else:
axis = vTo.cross(vFrom)
axisLengthSq = axis.normSquared()
if axisLengthSq < epsilon:
if (math.fabs(vFrom[1]) >= math.fabs(vFrom[0])) and (math.fabs(
vFrom[2]) >= math.fabs(vFrom[0])):
axis[0] = 0.0
axis[1] = -vFrom[2]
axis[2] = vFrom[0]
elif (math.fabs(vFrom[0]) >= math.fabs(vFrom[1])) and (
math.fabs(vFrom[2]) >= math.fabs(vFrom[1])):
axis[0] = -vFrom[2]
axis[1] = 0.0
axis[2] = vFrom[0]
else:
axis[0] = -vFrom[1]
axis[1] = vFrom[0]
axis[2] = 0.0
squareroot = math.sqrt(axisLengthSq / (fromLengthSq * toLengthSq))
if squareroot > 1.0:
squareroot = 1.0
elif squareroot < -1.0:
squareroot = -1.0
angle = math.asin(squareroot)
if vFrom.dot(vTo) < 0.0:
angle = math.pi - angle
self.fromAxisAngle(axis, angle)
def fromDirection(self, vFrom, vTo):
vFrom = Vec(vFrom)
vTo = Vec(vTo)
epsilon = 1E-10
fromLengthSq = vFrom.normSquared()
toLengthSq = vTo.normSquared()
if (fromLengthSq < epsilon) or (toLengthSq < epsilon):
self.quaternion[0] = self.quaternion[1] = self.quaternion[2] = 0.0
self.quaternion[3] = 1.0
else:
axis = vTo.cross(vFrom)
axisLengthSq = axis.normSquared()
if axisLengthSq < epsilon:
if (math.fabs(vFrom[1]) >= math.fabs(vFrom[0])) and (math.fabs(vFrom[2]) >= math.fabs(vFrom[0])):
axis[0] = 0.0
axis[1] = -vFrom[2]
axis[2] = vFrom[0]
elif (math.fabs(vFrom[0]) >= math.fabs(vFrom[1])) and (math.fabs(vFrom[2]) >= math.fabs(vFrom[1])):
axis[0] = -vFrom[2]
axis[1] = 0.0
axis[2] = vFrom[0]
else:
axis[0] = -vFrom[1]
axis[1] = vFrom[0]
axis[2] = 0.0
squareroot = math.sqrt(axisLengthSq / (fromLengthSq * toLengthSq))
if squareroot > 1.0:
squareroot = 1.0
elif squareroot < -1.0:
squareroot = -1.0
angle = math.asin(squareroot)
if vFrom.dot(vTo) < 0.0:
angle = math.pi - angle
self.fromAxisAngle(axis, angle)
