24 lines
713 B
Python
24 lines
713 B
Python
import numpy as np
|
|
import matplotlib.pyplot as plt
|
|
from mpl_toolkits.mplot3d import Axes3D
|
|
import copy
|
|
from scipy.spatial.transform import Rotation as R
|
|
import math
|
|
|
|
|
|
print(math.sin(math.atan2(0.4,0.84))*0.93)
|
|
|
|
# point = np.array([0.3670603416735574, -0.36714597755113015, -0.8546756909720299])
|
|
|
|
|
|
# temp_point = copy.deepcopy(point)
|
|
# if point[2]<= 0:
|
|
# temp_point[0] = -math.atan2(point[1],-np.sqrt(1-point[1]*point[1]))
|
|
# else:
|
|
# temp_point[0] = -math.atan2(point[1],np.sqrt(1-point[1]*point[1]))
|
|
# temp_point[1] = -math.atan2(point[0], -point[2])
|
|
# temp_point[2] = 0
|
|
# # temp_point[0] = -math.asin(point[1])
|
|
# # temp_point[1] = -math.atan2(-point[0],point[2])
|
|
# # temp_point[2] = 0
|
|
# print(temp_point) |