UG二次开发，UFUN点到点移动

int P2PMove(int n_obj,tag_t rotaBody[], double fromOri[3], double tarOri[3], int moveOrCopy)
{    
    double translation[3];
    double matrix[12];   
    int move_cope = moveOrCopy;
    int dest_layer = 0;
    int  trace_curves = 1;
    int status = 0;
    tag_t moveTag = NULL_TAG;
    tag_t trace_curve_group = NULL_TAG;
    translation[0] = tarOri[0] - fromOri[0] ;
    translation[1] = tarOri[1] - fromOri[1];
    translation[2] = tarOri[2] - fromOri[2];
    FTN(uf5943)(translation,matrix);
    FTN(uf5947)(matrix, rotaBody, &n_obj, &move_cope, &dest_layer, &trace_curves, &moveTag, &trace_curve_group, &status);
    return 0;
}