Вращение произвольной плоскости вокруг данной оси приводит к противоречивым результатам - PullRequest
Новая
       73

Вращение произвольной плоскости вокруг данной оси приводит к противоречивым результатам

0 голосов
/ 24 сентября 2018

Я пытаюсь вращать и перемещать произвольные плоскости вокруг некоторой произвольной оси.Для тестирования я написал простую программу на Python, которая поворачивает случайную плоскость вокруг оси X на enter image description here градусов.

К сожалению, при проверке угла между плоскостями я получаю противоречивые результаты.Это код: 

def angle_between_planes(plane1, plane2):
    plane1 = (plane1 / np.linalg.norm(plane1))[:3]
    plane2 = (plane2/ np.linalg.norm(plane2))[:3]
    cos_a = np.dot(plane1.T, plane2) / (np.linalg.norm(plane1) * np.linalg.norm(plane2))
    print(np.arccos(cos_a)[0, 0])


def test():
    axis = np.array([1, 0, 0])
    theta = np.pi / 2
    translation = np.array([0, 0, 0])
    T = get_transformation(translation, axis * theta)
    for i in range(1, 10):
        source = np.append(np.random.randint(1, 20, size=3), 0).reshape(4, 1)
        target = np.dot(T, source)
        angle_between_planes(source, target)

Он печатает: 

1.21297144225
1.1614420953
1.48042948278
1.10098697889
0.992418096794
1.16954303911
1.04180591409
1.08015300394
1.51949177153

При отладке этого кода я вижу, что матрица преобразования верна, поскольку она показывает, что это enter image description here

Я не уверен, что не так, и хотел бы получить любую помощь здесь.

* Код, который генерирует матрицу преобразования: 

def get_transformation(translation_vec, rotation_vec):
    r_4 = np.array([0, 0, 0, 1]).reshape(1, 4)
    rotation_vec= rotation_vec.reshape(3, 1)
    theta = np.linalg.norm(rotation_vec)
    axis = rotation_vec/ theta
    R = get_rotation_mat_from_axis_and_angle(axis, theta)
    T = translation_vec.reshape(3, 1)
    R_T = np.append(R, T, axis = 1)
    return np.append(R_T, r_4, axis=0)



def get_rotation_mat_from_axis_and_angle(axis, theta):
    axis = axis / np.linalg.norm(axis)
    a, b, c = axis
    omct = 1 - np.cos(theta)
    ct = np.cos(theta)
    st = np.sin(theta)
    rotation_matrix =  np.array([a * a * omct + ct,  a * b * omct - c * st,  a * c * omct + b * st,
                                 a * b * omct + c * st, b * b * omct + ct,  b * c * omct - a * st,
                                 a * c * omct - b * st, b * c * omct + a * st, c * c * omct + ct]).reshape(3, 3)
    rotation_matrix[abs(rotation_matrix) < 1e-8] = 0
    return rotation_matrix

1 Ответ

0 голосов
/ 24 сентября 2018

source, который вы генерируете, не является вектором.Чтобы быть единица, его четвертая координата должна быть равна нулю.

Вы можете сгенерировать действительные с помощью: 

source = np.append(np.random.randint(1, 20, size=3), 0).reshape(4, 1)

Обратите внимание, что ваш код не может быть протестированкак вы вставили в свой вопрос: например, vec = vec.reshape(3, 1) в get_transformation использует vec, который ранее нигде не был определен ...

...