src/slam/core.py
@@ -67,6 +67,12 @@ return rotation_matrix def get_origin_coordinates(): """ 获取毫米波设备数据中心相对舵机原点的坐标 """ pass def transferTo(current,delta_x,delta_y,delta_z,alpha,beta,gamma,reverse=False): # Notice: 假定当前坐标系为右手系 # step 1: 平移；current_coor + delta(delta_x, delta_y, delta_z) = target_coor
