Tracker

temp.py

import endo_transform
import numpy as np


data = np.loadtxt(r'N:\GTx\ToBill\20170822_NUDGE_TEST\Nudge Test - Sheet1.csv', skiprows=2, delimiter=',')

tracker1 = data[:, (1, 2, 3, 5, 6, 7, 8)]
tracker2 = data[:, np.array((1, 2, 3, 5, 6, 7, 8)) + 8]

for i, (t1, t2) in enumerate(zip(tracker1, tracker2)):
    t1_matrix = endo_transform.translation_quaternion_matrix(t1, quat_seq='wxyz')
    t2_matrix = endo_transform.translation_quaternion_matrix(t2, quat_seq='wxyz')
#    print(t1_matrix)
#    print(t2_matrix)
    print('-' * 70)
    print(t1)
    print(t2)
    print(np.linalg.solve(t1_matrix, t2_matrix))
    print(np.linalg.solve(t1_matrix.T, t2_matrix.T).T)
    

`# -- coding: utf-8 --
"""
Created on Tue Aug 22 11:15:17 2017

@author: Souzan
"""

import endo_transform
import numpy as np

data = np.loadtxt(r'C:\Users\Souzan\Desktop\Grad School\Thesis\Software Development\Data\Nudge Test - Sheet2.csv', skiprows=2, delimiter=',')

tracker1 = np.concatenate((data[:, (1, 2, 3)], np.ones((data.shape[0],1)), np.zeros((data.shape[0],3))),axis=1)
tracker2 = np.concatenate((data[:, (9,10,11)], np.ones((data.shape[0],1)), np.zeros((data.shape[0],3))),axis=1)

for i, (t1, t2) in enumerate(zip(tracker1, tracker2)):
t1_matrix = endo_transform.translation_quaternion_matrix(t1, quat_seq='wxyz')
t2_matrix = endo_transform.translation_quaternion_matrix(t2, quat_seq='wxyz')

print(t1_matrix)

print(t2_matrix)

print('-' * 30 + str(data[i,0]) + '-' * 30)

print(t1)

print(t2)

print(np.linalg.solve(t1_matrix, t2_matrix))
print(np.linalg.solve(t1_matrix.T, t2_matrix.T).T)`