In order to improve the trajectory tracking precision and reduce the synchronization error of a 6-DOF lightweight robot, nonlinear proportion-deviation （N-PD） cross-coupling synchronization control strategy based on...In order to improve the trajectory tracking precision and reduce the synchronization error of a 6-DOF lightweight robot, nonlinear proportion-deviation （N-PD） cross-coupling synchronization control strategy based on adjacent coupling error analysis is presented. The mathematical models of the robot, including kinematic model, dynamic model and spline trajectory planing, are established and verified. Since it is difficult to describe the real-time contour error of the robot for complex trajectory, the adjacent coupling error is analyzed to solve the problem. Combined with nonlinear control and coupling performance of the robot, N-PD cross-coupling synchronization controller is designed and validated by simulation analysis. A servo control experimental system which mainly consists of laser tracking system, the robot mechanical system and EtherCAT based servo control system is constructed. The synchronization error is significantly decreased and the maximum trajectory error is reduced from 0.33 mm to 0.1 mm. The effectiveness of the control algorithm is validated by the experimental results, thus the control strategy can improve the robot＇s trajectory tracking precision significantly.展开更多
Autonomous underwater vehicles (AUVs) navigating in complex sea conditions usually require a strong control system to keep the fastness and stability. The nonlinear trajectory tracking control system of a new AUV in c...Autonomous underwater vehicles (AUVs) navigating in complex sea conditions usually require a strong control system to keep the fastness and stability. The nonlinear trajectory tracking control system of a new AUV in complex sea conditions was presented. According to the theory of submarines,the six-DOF kinematic and dynamic models were decomposed into two mutually non-coupled vertical and horizontal plane subsystems. Then,different sliding mode control algorithms were used to study the trajectory tracking control. Because the yaw angle and yaw angle rate rather than the displacement of the new AUV can be measured directly on the horizontal plane,the sliding mode control algorithm combining cross track error method and line of sight method was used to fulfill its high-precision trajectory tracking control in the complex sea conditions. As the vertical displacement of the new AUV can be measured,in order to achieve the tracking of time-varying depth signal,a stable sliding mode controller was designed based on the single-input multi-state system,which took into account the characteristic of the hydroplane and the amplitude and rate constraints of the hydroplane angle. Moreover,the application of dynamic boundary layer can improve the robustness and control accuracy of the system. The computational results show that the designed sliding mode control systems of the horizontal and vertical planes can ensure the trajectory tracking performance and accuracy of the new AUV in complex sea conditions. The impacts of currents and waves on the sliding mode controller of the new AUV were analyzed qualitatively and quantitatively by comparing the trajectory tracking performance of the new AUV in different sea conditions,which provides an effective theoretical guidance and technical support for the control system design of the new AUV in real complex environment.展开更多
基金Project(2015AA043003)supported by National High-technology Research and Development Program of ChinaProject(GY2016ZB0068)supported by Application Technology Research and Development Program of Heilongjiang Province,ChinaProject(SKLR201301A03)supported by Self-planned Task of State Key Laboratory of Robotics and System(Harbin Institute of Technology),China
文摘In order to improve the trajectory tracking precision and reduce the synchronization error of a 6-DOF lightweight robot, nonlinear proportion-deviation （N-PD） cross-coupling synchronization control strategy based on adjacent coupling error analysis is presented. The mathematical models of the robot, including kinematic model, dynamic model and spline trajectory planing, are established and verified. Since it is difficult to describe the real-time contour error of the robot for complex trajectory, the adjacent coupling error is analyzed to solve the problem. Combined with nonlinear control and coupling performance of the robot, N-PD cross-coupling synchronization controller is designed and validated by simulation analysis. A servo control experimental system which mainly consists of laser tracking system, the robot mechanical system and EtherCAT based servo control system is constructed. The synchronization error is significantly decreased and the maximum trajectory error is reduced from 0.33 mm to 0.1 mm. The effectiveness of the control algorithm is validated by the experimental results, thus the control strategy can improve the robot＇s trajectory tracking precision significantly.
基金Project(2006AA09Z235) supported by the National High Technology Research and Development Program of ChinaProject(CX2009B003) supported by Hunan Provincial Innovation Foundation For Postgraduates,China
文摘Autonomous underwater vehicles (AUVs) navigating in complex sea conditions usually require a strong control system to keep the fastness and stability. The nonlinear trajectory tracking control system of a new AUV in complex sea conditions was presented. According to the theory of submarines,the six-DOF kinematic and dynamic models were decomposed into two mutually non-coupled vertical and horizontal plane subsystems. Then,different sliding mode control algorithms were used to study the trajectory tracking control. Because the yaw angle and yaw angle rate rather than the displacement of the new AUV can be measured directly on the horizontal plane,the sliding mode control algorithm combining cross track error method and line of sight method was used to fulfill its high-precision trajectory tracking control in the complex sea conditions. As the vertical displacement of the new AUV can be measured,in order to achieve the tracking of time-varying depth signal,a stable sliding mode controller was designed based on the single-input multi-state system,which took into account the characteristic of the hydroplane and the amplitude and rate constraints of the hydroplane angle. Moreover,the application of dynamic boundary layer can improve the robustness and control accuracy of the system. The computational results show that the designed sliding mode control systems of the horizontal and vertical planes can ensure the trajectory tracking performance and accuracy of the new AUV in complex sea conditions. The impacts of currents and waves on the sliding mode controller of the new AUV were analyzed qualitatively and quantitatively by comparing the trajectory tracking performance of the new AUV in different sea conditions,which provides an effective theoretical guidance and technical support for the control system design of the new AUV in real complex environment.
