六自由度位姿相关论文