本論文提出一種急動度限制下之定位控制及其干擾補償法，以改善系統輸出響應。在機械系統裡，急動度(加速度對時間的微分)若是太大可能會對系統造成不良的影響。故提出一急動度限制下之最佳時間定位控制法(Jerk-constrained time-optimal control, JCTOC)，此控制法不僅可限制最大急動度，又可達到最佳時間控制的效果。JCTOC是利用最佳時間控制器結合一積分器與受控體，直接控制系統的急動度來做其限制。
但由於提出的JCTOC是一種高度依賴受控體模型又俱備控制法則切換的控制法，故很容易受到系統不確定性以及系統干擾的影響。故在此加入一干擾補償器(Disturbance observer, DOB)以補償干擾並降低對系統的影響。本論文主要探討的干擾估測器以積分器的方式呈現，故在此稱為積分型干擾估測器(integral disturbance observer, IDOB)。在此IDOB加入一動態補償器或內部模型原理(Internal model principle, IMP)補償器，可讓干擾估測對於不同階數的干擾有更優越的抑制效果。
本文實驗平台以一裝對稱性負載之無刷伺服馬達為受控體，並以一DSP/FPGA結合之單元為控制器，分別以C語言及VHDL撰寫。以此機台為實驗系統並實現本文提出之干擾補償及急動度限制下之最佳時間控制法，並由實驗結果證實其控制法的可行及實用性。

This paper presents an improved disturbance rejection method added to a model based time-optimal control method, in order to assure the correct system output response. In mechanical systems, the jerk (the time derivative of acceleration) may cause many unwanted results when too high. Thus, a jerk-constrained time-optimal control (JCTOC) method is proposed to not only constrain the jerk of the system, but also have a time-optimal characteristic. The JCTOC uses a time-optimal controller paired with an integrator and the system to directly constrain the jerk of the system.
But, due to the JCTOC being a highly model based control method with switching characteristics, the system uncertainties and disturbance can have an adverse effect on the output response. Thus, a disturbance observer (DOB) is added for the compensation of the disturbance. The DOB used in this paper is in an integral form, thus called an integral disturbance observer (IDOB). The IDOB is further enhanced with a dynamic compensator to provide better noise immunity and asymptotic compensation for disturbances of various orders.
This paper uses a symmetrically loaded servo motor as an experimental setup for the proposed control methods. The control kernel is a DSP/FPGA system separately programmed with C language and VHDL. Experiments of the disturbance rejection method have been conducted and proven to have better transient and steady-state responses than past approaches while fulfilling the time-optimal characteristic of the JCTOC.

[1] R. Shieh and Y.S. Lu, “Jerk constrained time-optimal control of a positioning servo,” in Proc. International Conference on Control Automation and Systems, Gyeonggi-do, Korea, pp. 1473–1476 (2010).
[2] J.C Slaboda, J.R. Boston, T.E. Rudy, S.J. Lieber, D.M. Rasetshwane and D.K. Weiner, “Effects of pain on shoulder jerk in elderly subjects during repetitive lifting,” in Proc. 25th Annual International Conference of the IEEE, Cancun, Mexico, vol. 2, pp. 1728–1731 (2003).
[3] S. R. Venkatesh, Y. M. Cho, and B. Kim, “Robust control of vertical motions in ultra-high rise elevators,” Control Engineering Practice, vol. 10, no. 2, pp. 121–132, 2002.
[4] R. A. Osornio-Rios, R. J. Romero-Troncoso, G. Herrera-Ruiz, and R. Castañeda-Miranda, “FPGA implementation of higher degree polynomial acceleration profiles for peak jerk reduction in servomotors,” Robotics and Computer-Integrated Manufacturing, vol. 25, no. 2, pp. 379–392, 2009.
[5] A. Gasparetto and V. Zanotto, “A technique for time-jerk optimal planning of robot trajectories,” Robotics and Computer-Integrated Manufacturing, vol. 24, no. 3, pp. 415–426, 2008.
[6] A. Gasparetto, V. Zanotto, “Optimal trajectory planning for industrial robots,” Advances in Engineering Software, vol. 41, no. 4, pp. 548–556, 2010.
[7] A. Olabi, R. Béarée, O. Gibaru, and M. Damak, “Feedrate planning for machining with industrial six-axis robots,” Control Engineering Practice, vol. 18, no. 5, pp. 471–482 , 2010.
[8] J. Dong, P.M. Ferreira, J.A. Stori, “Feed-rate optimization with jerk constraints for generating minimum-time trajectories,” International Journal of Machine Tools and Manufacture, vol. 47, no. 12-13, pp. 1941–1955 , 2007.
[9] A. Piazzi and A. Visioli, “Global minimum-jerk trajectory planning of robot manipulators,” IEEE Trans. Industrial Electronics, vol. 47, no. 1, pp. 140–149 , 2000.
[10] K. Hoshijima and M. Ikeda, “Jerk reduction control of rotational mechanical systems for vibration suppression in positioning,” in Proc. Automatic Control Conference, Taipei, Taiwan, pp. 316–321 (2006).
[11] R. A. Osornio-Rios, R. J. Romero-Troncoso, G. Herrera-Ruiz, R. Castañeda-Miranda, “FPGA implementation of higher degree polynomial acceleration profiles for peak jerk reduction in servomotors,” Robotics and Computer-Integrated Manufacturing, vol. 25, no. 2, pp. 379–392 , 2009.
[12] M.C. Tsai, E.C. Tseng and M.Y. Cheng, “Design of a torque observer for detecting abnormal load,” Control Engineering Practice, vol. 8, no. 3, pp. 259–269, 2000.
[13] Y.S. Lu, “Smooth speed control of motor drives with asymptotic disturbance compensation,” Control Engineering Practice, vol. 16, no. 5, pp. 597–608, 2008.
[14] A. Mohammadi, M. Tavakoli, H.J. Marquez and F. Hashemzadeh, “Nonlinear disturbance observer design for robotic manipulators,” Control Engineering Practice, vol. 21, no. 3, pp. 253–267, 2013.
[15] L.E. Olivier, I.K. Craig, Y.Q. Chen, “Fractional order and BICO disturbance observers for a run-of-mine ore milling circuit,” Journal of Process Control, vol. 22, no. 1, pp. 3–10, 2012.
[16] T.R. Grochmal and A.F. Lynch, “Precision tracking of a rotating shaft with magnetic bearings by nonlinear decoupled disturbance observers,” IEEE Trans. Control Systems Technology, vol. 15, no. 6, pp. 1112–1121, 2007.
[17] J. Back and H. Shim, “Adding robustness to nominal output-feedback controllers for uncertain nonlinear systems: A nonlinear version of disturbance observer,” Automatica, vol. 44, no. 10, pp. 2528–2537, 2008.
[18] Y.D. Chen, P.C. Tung and C.C. Fuh, “Robust disturbance rejection method for uncertain system with disturbances of unknown frequencies,” Nonlinear Dynamics, vol. 55, no. 4, pp. 329–336, 2008.
[19] M.H. Tsai and P.C. Tung, “A disturbance reduction scheme for linear small delay systems with modeling uncertainties,” Journal of Process Control, vol. 20, no. 6, pp. 777–786, 2010.
[20] Y.D. Yoon, E. Jung and S.K. Sul, “Application of a disturbance observer for a relative position control system,” IEEE Trans. Industry Applications, vol. 46, no. 2, pp. 849–856, 2010.
[21] Y. Kakinuma, Y. Sudo and T. Aoyama, “Detection of chatter vibration in end milling applying disturbance observer,” CIRP Annals - Manufacturing Technology, vol. 60, no. 1, pp. 109-112, 2011.
[22] C.S. Kim, M.J. Kang, J.H. Kim and U.Y. Huh, “Implementation of disturbance observer for compensating backlash,” in Proc. ICROS-SICE International Joint Conference, Fukuoka, Japan, pp. 1812–1816 (2009).
[23] A. Hace, K. Jezernik and A. Sabanovic, “SMC with disturbance observer for a linear belt drive,” IEEE Trans. Industrial Electronics, vol. 54, no. 6, pp. 3402–3412, 2007.
[24] C.J. Lin and C.Y. Lee, “Observer-based robust controller design and realization of a gantry stage,” Mechatronics, vol. 21, no. 1, pp. 185-203, 2011.
[25] D. Kirk, Optimal Control Theory: an Introduction (Englewood Cliffs, New Jersey: Prentice-Hall, 1970)
[26] M. Kaylon, “Design of continuous time controllers having almost minimum time response,” Journal of Dynamic Systems, Measurement, and Control, vol. 124, no. 2, pp. 252–260, 2002.
[27] L. D. Akulenko and G. V. Kostin, “Analytical synthesis of time-optimal control in a third-order system,” Journal of Applied Mathematics and Mechanics, vol. 64, no. 4, pp. 509–519, 2000.
[28] R. Shieh and Y. S. Lu, “Design of an Integral Disturbance Observer for a Jerk Constrained Positioning Servo,” in Proc. International Conference on Automation Technology, Yunlin, Taiwan, pp. 849–856 (2011).
[29] G.F. Franklin, J.D. Powell and A. Emami-Naeini, Feedback control of dynamic systems (Upper Saddle River, New Jersey: Prentice-Hall, 2006)
[30] M. M. Abdelhameed, “Enhancement of sliding mode controller by fuzzy logic with application to robotic manipulators,” Mechatronics, vol. 15, no. 4, pp. 439–458, 2005.
[31] R. C. Dorf and R. H. Bishop, Modern Control System (Upper Saddle River, New Jersey: Prentice-Hall, 2005).