|
|
void MapAxis() //坐标映射函数
{
short rtn;
double cnt1[5]={1,0,0,0,0}; /*根据系统设置坐标映射数组(下同)*/
double cnt2[5]={0,1,0,0,0};
double cnt3[5]={0,0,1,0,0};
double cnt4[5]={0,0,0,1,0};
rtn=GT_MapAxis(1,cnt1);error(rtn); /*映射第1轴到X轴*/
rtn=GT_MapAxis(2,cnt2);error(rtn); /*映射第2轴到Y轴*/
rtn=GT_MapAxis(3,cnt3);error(rtn); /*映射第3轴到Z轴*/
rtn=GT_MapAxis(4,cnt4);error(rtn); /*映射第4轴到A轴*/
}
介绍:
GT_MapAxis(unsigned short Axis_Num,double*map_array) 用来映射坐标系,
Axis_Num 为控制轴号(1,2,3,4)
参数*map_array作为指针,指向一个包括五个元素的数组,顺次记为Cx,Cy,Cz,Ca,C
坐标轴X Y Z A所对应坐标记为x y z a
上述函数描述的映射关系能表示为: Axis_N=Cx*x+Cy*y+Cz*z+Ca*a+C |
|