import numpy as np
import cameraModel as cm
import math
dx = 0
dy = 2e3
dz = 3e3
#Euler angles??
alpha = math.radians(0)
gamma = math.radians(0)
beta = math.radians(0)
frontJoints = np.loadtxt('joints.dat', delimiter=',')
num = frontJoints.shape[0]
topJoints = np.zeros((num, 3))
for i in range(0, num):
topJoints[i] = (cm.rigidBodyMotion(frontJoints[i], dx, dy, dz, alpha, beta,
gamma)).reshape(3)
np.savetxt('topJoints.txt', topJoints, delimiter=',', newline='\n')
import numpy as np
import cameraModel as cm
frontJoints = np.loadtxt('data/joints1.dat',delimiter=',')
num = frontJoints.shape[0]
dx = 0
dy = 1.04e3
dz = 3.52e3
# unit vectors
vx = np.array([-1,0,0,0])
vy = np.array([0,0,-1,0])
vz = np.array([0,-1,0,0])
topJoints = np.zeros((num,3))
for i in range(0,num):
topJoints[i] = (cm.rigidBodyMotion(frontJoints[i][0:3],dx,dy,dz,vx,vy,vz)).reshape(3)
np.savetxt('data/topJoints2.dat',topJoints,delimiter=',',newline='\n')
import numpy as np
import cameraModel as cm
import math
dx = 0
dy = 2e3
dz = 3e3
#Euler angles??
alpha = math.radians(0)
gamma = math.radians(0)
beta = math.radians(0)
frontJoints = np.loadtxt('joints.dat',delimiter=',')
num = frontJoints.shape[0]
topJoints = np.zeros((num,3))
for i in range(0,num):
topJoints[i] = (cm.rigidBodyMotion(frontJoints[i],dx,dy,dz,alpha,beta,gamma)).reshape(3)
np.savetxt('topJoints.txt',topJoints,delimiter=',',newline='\n')
