以史都華平台機構為基礎所開發之六維運動量測裝置(Six-Degree Motion Measuring Device, MMD)是具有六個量測維度之測量裝置，將此六維運動量測裝置之上板安裝於六軸機械手臂末端的工具端，下板固定於工件端時，可直接回授六軸機械手臂之姿態，進行六軸機械手臂之伺服運動控制。
本研究提出六軸機械手臂之直接姿態回授控制(Direct Pose Feedback Control, DPFC)，在其運動過程中，利用六維運動量測裝置量測工具之姿態，經機械手臂理想機構逆轉換得出各關節之實際機械座標，此實際機械座標與機械手臂關節編碼器所量出之機械座標間之差值來自機械手臂之連結誤差，將此差值回授至馬達伺服控制迴路做誤差補償，可消除機械手臂關節編碼器無法觀測到之連結誤差。
本論文提出之六軸機械手臂直接姿態回授運動控制由各馬達之伺服控制及整機之連結誤差補償控制構成，由於此方法完整保留原始之馬達伺服控制，因此極易整合於既有之機械手臂控制系統中，本論文另外實現六軸機械手臂之雙設定點運動控制(Twin-Setting-Points Motion Control, TPMC)，配合直接姿態回授控制，大幅提升了六軸機械手臂之定位及軌跡精度。

The Six-Degree Motion Measuring Device (MMD) is based on the Stewart platform mechanism and provides six measuring degrees of freedom. The pose of the manipulator can be directly measured by the MMD and be fed back for the servo motion control, when the upper plate of the MMD is mounted on the end of the manipulator and the base is fixed on the workpiece side.
This research proposes a Direct Pose Feedback Control (DPFC) for a six-axis manipulator. During its motion control, the MMD is used to measure the pose of the tool. The actual machine coordinates are calculated after the ideal backward kinematic transform. The differences between actual machine coordinates and the machine coordinates measured by joint encoders are resulted from link errors of the manipulator. Feeding them back to the servo control loop of motors, the link errors not observable by the joint encoders can be eliminated.
Presented by this thesis, the direct pose feedback control of the six-axis manipulator consists of the servo control of each motor and link errors compensation control of the six-axis manipulator. Since this method keeps the original servo control loop intact, therefore, it is easy to integrate the method in the existing control system. Additionally, The Twin-Setting-Points Motion Control (TPMC) for the six-axis manipulator is also implemented in this thesis. Together with the direct pose feedback control, the positioning and contour accuracy of the six-axis manipulator are dramatically improved.

[1] "Toshiba Machine Co.," Toshiba, [Online]. Available: http://www.toshiba machine.com/CSProductDetails.aspx?dept=4&machine_id=106.
[2] "庫卡工業機器人," [Online]. Available: http://www.kuka robotics.com/taiwan/tw/products/industrial_robots/low/kr5_arc/start.htm.
[3] 余志中, "Delta 機械手臂研究開發," 國立清華大學機械工程學系碩士論文, 2012.
[4] 彭達仁, 丁純乾, 陳俊皓, 黃淵勇, "六軸垂直關節型機器手臂之荷重變形引起的定位誤差研究," 機械工業雜誌, no. 337, pp. 119-127, 2011.
[5] C. Gong, J. Yuan, J. Ni, "Nongeometric error identification and compensation for robotic system by inverse calibration," International Journal of Machine Tools & Manufacture, vol. 40, pp. 2119-2137, 2000.
[6] J. Wang, H. Zhang, T. Fuhlbrigge, "Improving Machining Accuracy with Robot Deformation Compensation," The 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems, pp. 3826-3831, 2009.
[7] "Renishaw-Dual Signal interface now available with leading range of incremental encoders," [Online]. Available: http://www.renishaw.com.tw/tw/dual-signal-interface-now-available-with-leading-range-of-incremental-encoders--12184.
[8] A. Nubiola, I. A. Bonev, "Absolute calibration of an ABB IRB 1600 robot using a laser tracker," Robotics and Computer-Integrated Manufacturing, vol. 29, pp. 236-245, 2013.
[9] "FARO," [Online]. Available: http://www.faroasia.com/products/laser tracker/sea/trackarm.html.
[10] 余志文, "六維運動量測系統," 國立清華大學動力機械工程學系碩士論文, 2008.
[11] 薛淳方, "閉機構鏈工具機研究與開發," 國立清華大學動力機械工程學系碩士論文, 2013.
[12] 許維中, "六維運動量測裝置量測五軸工具機之誤差," 國立清華大學動力機械工程學系碩士論文, 2009.
[13] 杜峯杰, "六維運動量測系統," 國立清華大學動力機械工程學系碩士論文, 2011.
[14] 林杰, "六維運動與誤差量測系統研發," 國立清華大學動力機械工程學系碩士論文, 2012.
[15] 張誠瑋, "6D-MMD應用於機械手臂之機構參數校正," 國立清華大學動力機械工程學系碩士論文, 2009.
[16] K. Liu, J. M. Fitzgerald, F. L. Lewis, "Kinematic analysis of a Stewart platform manipulator," IEEE Transactions on Industrial Electronics, vol. 40, pp. 282-293, 1993.
[17] 羅偉彰, "平台球桿量測裝置設計分析," 國立清華大學動力機械工程學系碩士論文, 2002.
[18] "Six-axis robot technology," [Online]. Available: http://www.robots.com/articles/viewing/six-axis-robot-technology.
[19] S. Kucuk, Z. Bingul, "The Inverse Kinematics Solutions of Industrial Robot Manipulators," Proceedings of the IEEE International Conference on Mechatronics, 2004. ICM '04., pp. 274 - 279, 2004.
[20] "Possible Combinations of Robot Shoulder, Elbow, and Wrist Figures," [Online]. Available: http://www.ccarafa.it/RC8/001954.html.
[21] C.C. Lo, C.Y. Chung, "Tangential-Contouring Controller for Biaxial Motion Control," ASME Journal of Dynamic Systems, Measurement, and Control, no. 121, pp. 126-129, 1999.
[22] H.Y. Chuang, C.H. Liu, "A model-referenced adaptive control strategy for improving contour accuracy of multiaxis machine tools," IEEE Transactions on Industry Applications, vol. 28, pp. 221-227, 1992.
[23] 張淑頻, "CNC工具機之雙設定點運動控制," 國立清華大學動力機械工程學系碩士論文, 2012.
[24] "先達工控 - R1-EC5621," [Online]. Available: http://www.syn tek.com.tw/index.php/tw/product/ethercatseries/egs/motion-e/r1-ec5621.
[25] Renishaw Inc. "Portable laser measurement and calibration," XL-80 Laser System Brochure.
[26] Renishaw Inc. "QC20-W wireless ballbar system description and specifications," QC20-W Wireless Ballbar Brochure.