Measurement Method for Fine 6-DOF Displacement of Rigid Bodies

강체의 6자유도 미소 변위 측정

  • Park, Won-Shik (Dept. of Mechanical Engineering, Korea Advanced Institute of Science and Technology) ;
  • Cho, Hyung-Suck (Dept. of Mechanical Engineering, Korea Advanced Institute of Science and Technology)
  • 박원식 (한국과학기술원 기계공학과) ;
  • 조형석 (한국과학기술원 기계공학과)
  • Published : 2002.03.01


A novel measurement method to obtain the 6-DOF motions of arbitrary rigid bodies is proposed in this paper. The method adopts a specially fabricated mirror called 3-facet mirror, which looks like a triangular pyramid haying an equilateral cross-sectional shape. The mirror is mounted on the objects to be measured, illuminated by a laser beam having circular profile, and reflects the laser beam in three different directions. Three PSDs(position sensitive detector) detect the three beams reflected by the mirror, respectively. From the signals of the PSDs, we can calculate the 3-dimensional position and orientation of the 3-facet mirror, and thus enabling us to determine the 3-dimensional position and orientation of the objects. In this paper, we model the relationship between the 3-dimensional position and orientation of an object in motion and the outputs of three PSDs. A series of experiments are performed to demonstrate the effectiveness and accuracy of the proposed method. The experimental results show that the proposed sensing system can be an effective means of obtaining 3-dimensional position and orientation of arbitrary objects and provide resonable measurement accuracy.


  1. Y. Nakamura, T. Hayashi, K. Katoh, M. Miyakawa, and M. Itoh, 'Accuracy verification of an automatic head-positioning system for a normalized measurement of jaw movement by an x-ray television,' Proc. of IEEE Conference on Engineering in Medicine and Biology Society, pp. 2422-2423, Chicago, 1997
  2. W. Xu, S. Tso, and X. Wang, 'Conceptual design of an integrated laser-optical measuring system for flexible manipulator,' Proc. of IEEE Conference on Systems, Man. and Cybernetics, vol. 2, pp. 1247-1252, Beijing, Oct., 1996
  3. S. A. Kyle, 'Optical methods for calibrating and inspecting robots,' Computing & Control Eng. Journal, pp. 166-173, 1995
  4. L. Marques, F. Moita, U. Nunes, and A. Almeida, '3D laser-based sensor for robotics,' Proc. of IEEE 7th Mediterranean Electronical Conference, pp. 1328-1331, 1994
  5. 한만용, 김병화, 김국헌, 이장명, '원형 물체를 이용한 로봇/카메라 자세의 능동 보정,' 제어 자동화 시스템 공학 논문지, 제5권, 제3호, pp. 314-337, 1999
  6. C. S. Vann, 'Six degree of freedom sensor,' US patent #5883803, 1999
  7. 진병대, 우기영, 권동수, '5각 관절 병렬 구조를 이용한 6자유도 힘 반사형 마스터 콘트롤러,' 제어 ? 자동화 ? 시스템 공학 논문지, 제5권, 제3호, pp. 288-296, 1999
  8. P. E. Jones, 'Three-dimensional input device with six degrees of freedom,' Mechatronics, vol. 9, no. 7, pp. 717-729, 1999
  9. R. Sim and G. Dudek, 'Learning visual landmarkds for pose,' Proc. of IEEE Conference on Robotics and Automation, vol. 3, pp. 1972-1978, Piscataway, USA, 1999
  10. Adam, E. Rivlin, and H. Rotstein, 'Fusion of fixation and odometry for vehicle navigation,' IEEE Trans. on Systems, Man, and Cybernetics, Part A: Systems and Humans, vol. 29,no.6,pp. 593-603, 1999
  11. Barshan and H. F. Durrant-Whyte, 'Evaluation of a solidstate gyroscope for robotics applications,' IEEE Trans. on Instrumentation and Measurement, vol. 44, no. 1, 1995
  12. Ojeda and J. Borenstein, 'Precision calibration of fiber-optis gyroscopes for mobile robot navigation,' Proc. of IEEE Conf. on Robotics and Automation, vol. 3, pp. 2064-2069, Piscataway, 1999
  13. L. M. Smith and C. C. Dobson, 'Absolute displacement measurement using modulation of the spectrum of white light in a Michelson interferometer,' Applied Optics, vol. 28,pp. 3339-3342, 1989
  14. S. Hosoe, 'Laser interferometric system for displacement measurement with high precision,' Nanotechnology, vol. 2, pp. 88-95, 1991
  15. J. R. Bell and S. J. Rothberg, 'Laser vibrometers and contacting transducers, target rotation and six degree-of-freedom vibration: what do we real1y measure?' Journal of Sound & Vibration, vol. 237, no. 2, pp. 245-261, 2000
  16. N. Lee, Y. Cai, and A. Joneja, 'High-resolution multidimensional displacement monitoring system,' Optical Engineering, vol. 36, no. 8, pp. 2287-2293, 1997
  17. W. S. Park, H. S. Cho, Y. G. Byun, D. K. Jung, and N. Y. Park, 'Measurement of 6-DOF displacement of rigid bodies through splitting a laser beam: experimental investigation,' Proc. of SPIE Symposium on Intelligent Systems and Advanced Manufacturing, vol. 4190, Boston, 2000
  18. M. Bass, E. W. Stryland, D. R. Williams, and W. L. Wolfe, Handbook of Optics, 2nd Ed., vol. 1, McGraw-Hill, 1995
  19. John J. Craig, Introduction to Robotics, Addison Wesley, 1989
  20. W. H. Press, S. A. Teukolsky, W. T. Vetterling, and B. P. Flannery, Numerical Recipes in C, 2nd Ed., Cambridge University Press, 1992