实体从一个坐标转换到另一个坐标

double GG_mtx[16];

int 实现坐标到坐标变换(tag_t obj1, tag_t obj2)
{ /*obj1=前一个坐标;obj2=当前预览坐标*/

    tag_t matrix_id = NULL_TAG;
    double mtx0[9] = { 1,0,0,0,1,0,0,0,1 };
    double mtx1[9] = { 1,0,0,0,1,0,0,0,1 };
    double from_origin[3] = { 0,0,0 };
    UF_CSYS_ask_csys_info(obj1, &matrix_id, from_origin);
    UF_CSYS_ask_matrix_values(matrix_id, mtx0);
    double from_x_axis[3] = { mtx0[0],mtx0[1],mtx0[2] };
    double from_y_axis[3] = { mtx0[3],mtx0[4],mtx0[5] };
    double to_origin[3] = { 0,0,0 };
    UF_CSYS_ask_csys_info(obj2, &matrix_id, to_origin);
    UF_CSYS_ask_matrix_values(matrix_id, mtx1);
    double to_x_axis[3] = { mtx1[0],mtx1[1],mtx1[2] };<