1.全站仪多方位坐标测量方法,其特征在于:所述方法包括:
在多体机械结构上建立全局坐标系和局部坐标系,并选定全局坐标系下的至少三个第一坐标点以及局部坐标系下的至少三个第二坐标点;
将单台全站仪分多个方位放置,保持各个第一坐标点和各个第二坐标点的位置不变,利用该全站仪测量每个方位的各个第一坐标点和各个第二坐标点的位置,以及测量每个方位的各个第一坐标点和各个第二坐标点的斜距、水平角和垂直角,并将斜距、水平角和垂直角转化为全站仪坐标;
在每个方位测量时,根据各个第一坐标点的全站仪坐标和全局坐标,求解从全站仪坐标系到全局坐标系的第一转换矩阵;将各个第二坐标点的全站仪坐标代入第一转换矩阵,求解得到各个第二坐标点的全局坐标;根据各个第二坐标点的全局坐标和局部坐标,求解从全局坐标到局部坐标的第二转换矩阵;
在局部坐标系下选取一个第二坐标点,将该第二坐标点的全局坐标代入各个方位的第二转换矩阵,求解得到该第二坐标点的理论局部坐标,并与该第二坐标点的实际局部坐标进行比较,选择误差最小的一个方位对应的第一转换矩阵和第二转换矩阵;
所述根据各个第一坐标点的全站仪坐标和全局坐标,求解从全站仪坐标系到全局坐标系的第一转换矩阵,具体包括:将各个第一坐标点的全站仪坐标和全局坐标代入坐标转换公式,求解从全站仪坐标系到全局坐标系的第一转换矩阵;
当第一坐标点为三个时,直接采用求解出的从全站仪坐标系到全局坐标系的第一转换矩阵;当第一坐标点为四个或以上时,选定其中三个从全站仪坐标系到全局坐标系的第一转换矩阵误差较小的第一坐标点,重新求解从全站仪坐标系到全局坐标系的第一转换矩阵;
所述根据各个第二坐标点的全局坐标和局部坐标,求解从全局坐标到局部坐标的第二转换矩阵,具体包括:将各个第二坐标点的全局坐标和局部坐标代入坐标转换公式,求解从全局坐标到局部坐标的第二转换矩阵;
当第二坐标点为三个时,直接采用求解出的从全局坐标到局部坐标的第二转换矩阵;
当第二坐标点为四个或以上时,选定其中三个从全站仪坐标系到全局坐标系的第二转换矩阵误差较小的第二坐标点,重新求解从全局坐标到局部坐标的第二转换矩阵。
2.根据权利要求1所述的全站仪多方位坐标测量方法,其特征在于:所述求解从全站仪坐标系到全局坐标系的第一转换矩阵,具体包括:求解从全站仪坐标系到全局坐标系的第一旋转矩阵和第一平移矩阵,引入齐次坐标,将第一旋转矩阵和第一平移矩阵合并成第一转换矩阵。
3.根据权利要求2所述的全站仪多方位坐标测量方法,其特征在于:所述将第一旋转矩阵和第一平移矩阵合并成第一转换矩阵,如下式:其中,R表示第一旋转矩阵,T表示第一平移矩阵,P表示第一转换矩阵,(x,y,z)表示第一坐标点的全站仪坐标,(xc,yc,zc)表示第一坐标点的全局坐标,(x,y,z,1)表示第二坐标点的全站仪坐标,(xc,yc,zc,1)表示第二坐标点的全局坐标。
4.根据权利要求1所述的全站仪多方位坐标测量方法,其特征在于:所述求解从全局坐标到局部坐标的第二转换矩阵,具体包括:求解从全局坐标到局部坐标的第二旋转矩阵和第二平移矩阵,引入齐次坐标,将第二旋转矩阵和第二平移矩阵合并成第二转换矩阵。
5.根据权利要求4所述的全站仪多方位坐标测量方法,其特征在于:所述将第二旋转矩阵和第二平移矩阵合并成第二转换矩阵,如下式:其中,R1表示第二旋转矩阵,T1表示第二平移矩阵,Q表示第二转换矩阵,(xo,yo,zo,1)表示第二坐标点的局部坐标,(xc,yc,zc,1)表示第二坐标点的全局坐标。
6.根据权利要求1-5任一项所述的全站仪多方位坐标测量方法,其特征在于:所述将斜距、水平角和垂直角转化为全站仪坐标,具体包括:将斜距、水平角和垂直角分别记为S、α和β,以及将全站仪上的三个基本坐标系分别记为XYZ、X1Y1Z1和X2Y2Z2;其中,水平角α为X轴与X1轴之间的夹角,或Y轴与Y1轴之间的夹角,垂直角β为Z1轴与Z2轴之间的夹角,或Y1轴与Y2轴之间的夹角;
根据全站仪上的三个坐标系XYZ、X1Y1Z1和X2Y2Z2中各坐标轴与水平角α、垂直角β的关系,绘制矢量图;其中,Z轴与Z1轴始终重合,X1轴与X2轴始终重合;
根据矢量图绘制配置图,并得到坐标变换表达式;
根据坐标变换表达式,将斜距S、水平角α、垂直角β转化为全站仪坐标。
7.根据权利要求6所述的全站仪多方位坐标测量方法,其特征在于:所述坐标变换表达式包括坐标系X1Y1Z1到XYZ的坐标变换表达式以及坐标系X2Y2Z2到X1Y1Z1的坐标变换表达式;
所述根据矢量图绘制配置图,并获得坐标关系表达式,具体包括:
矢量图的对应配置图中,两空心点用水平连线表示两个坐标轴重合,两空心点用斜线连接表示两个坐标轴为内部矢量,两空心点不用任何线连接的表示两个坐标轴为外部矢量;
对于坐标系X1Y1Z1到XYZ的坐标变换表达式,当两个坐标轴为同一性质时,坐标系X1Y1Z1的相应坐标前面系数为+cosα,当两个坐标轴为不同性质时,坐标系X1Y1Z1的相应坐标前面系数为±sinα,当两个坐标轴在矢量图中为内部矢量时,坐标系X1Y1Z1的相应坐标前面系数为+sinα,当两个坐标轴在矢量图中为外部矢量时,坐标系X1Y1Z1的相应坐标前面系数为-sinα;
对于坐标系X2Y2Z2到X1Y1Z1的坐标变换表达式,当两个坐标轴为同一性质时,坐标系X2Y2Z2的相应坐标前面系数为+cosβ,当两个坐标轴为不同性质时,坐标系X2Y2Z2的相应坐标前面系数为±sinβ,当两个坐标轴在矢量图中为内部矢量时,坐标系X2Y2Z2的相应坐标前面系数为+sinβ,当两个坐标轴在矢量图中为外部矢量时,坐标系X2Y2Z2的相应坐标前面系数为-sinβ。
8.根据权利要求7所述的全站仪多方位坐标测量方法,其特征在于:
所述坐标系X1Y1Z1到XYZ的坐标变换表达式如下:
x=cosαx1+sinαy1,y=cosαy1-sinαx1,z=z1则坐标系X1Y1Z1到XYZ的转换矩阵如下:
所述坐标系X2Y2Z2到X1Y1Z1的坐标变换表达式如下:
x1=x2,y1=cosβy2+sinβz2,z1=cosβz2-sinβy2则坐标系X2Y2Z2到X1Y1Z1的转换矩阵如下:
则坐标(x2,y2,z2)到坐标(x,y,z)的转换过程如下: