def set_pose(self, posx, posy, posz, qw, qx, qy, qz):
# embed()
posx, posy, posz = GroundtoGraphics((posx, posy, posz))
R = rotation([qw, qx, qy, qz])
T = GraphicstoGroundRot()
self.translation_matrix = translation([posx, posy, posz])
self.rotation_matrix[0:3, 0:3] = numpy.dot(R.T, T)
def translate(self, x, y, z):
self.translation_matrix = numpy.dot(self.translation_matrix,
translation([x, y, z]))
def translate(self, x, y, z):
self.translation = numpy.dot(self.translation, translation([x, y, z]))
def translate(self, x, y, z):
self.translation_matrix = numpy.dot(
self.translation_matrix,
translation([x, y, z]))
def translate(self, x, y, z):
self.translation = numpy.dot(self.translation, translation([x, y, z]))
from transformation import transformation, rotation, scaling, translation, shear
lines = [[[50, 50], [-50, 50]], [[-50, 50], [-50, -50]], [[-50, -50],
[50, -50]],
[[50, -50], [50, 50]]]
transformation('square.svg', lines, 0)
transformation('rotation45.svg', lines, 1, rotation(45))
transformation('rotation17x10.svg', lines, 17, rotation(10))
# uloha 2
transformation('ukazka-2.svg', lines, 15, rotation(10), scaling(1.1, 0.8))
# uloha 3
transformation('ukazka-3.svg', lines, 25, shear(1.3), rotation(10),
scaling(0.9, 0.9), translation(50, 50))
# uloha 1
lines = [[[-25, 0], [25, 0]], [[25, 0], [25, 50]], [[25, 50], [-25, 50]],
[[-25, 50], [-25, 0]]]
transformation('ukazka-1.svg', lines, 10, rotation(20), scaling(1.1, 1.1),
translation(5, 10))
transformation('ukazka-1-uprava.svg', lines, 10, rotation(20),
scaling(1.1, 1.1), translation(5, 0))
