已知六个固定点P0（2+2+2），过固定点向量v1，动点到固定点距离L，被测基准块坐标系在并联机构动系中的位姿，并联机构定系在测量系中的位姿，求解动系在测量系中位姿Q的程序