Abstract
Recently, a cable-driven parallel robots (CDPRs) has been applied to radio telescope as the accurate actuator, that is the five-hundred-meter aperture spherical telescope. It can be affected by the disturbances such as wind, earthquake and so on. Therefore, this paper developed a disturbance observer (DOB)-based control suitable for CDPR. The propose of the control is to reduce the effects of disturbance while the end-effectors maintains the same position even though the disturbance affects it. The key component of the DOB controller is a disturbance observer, which includes inverse nominal plant for each cable. So, a system identification test was carried out firstly. Then, the simulation and experiment were also carried out to evaluate the performance of the algorithm in CDPR. The results showed that the designed DOB algorithm could effectively reduce disturbances.
Similar content being viewed by others
Avoid common mistakes on your manuscript.
1 Introduction
Cable-driven parallel robots (CDPRs) are parallel robots that use flexible cables to guide their end-effectors (EEs) through space. Due to the large workspace and relatively simple design, CDPRs have been widely used in academia and industry (Qian et al. 2018), in applications such as modular CDPRs (Seriani et al. 2016), multiple mobile cranes (Zi et al. 2015), cable-driven cameras (Tanaka et al. 1988) and radio telescope application (Meunier et al. 2009), notably, in a five-hundred-meter aperture spherical radio telescope (FAST) (Duan 1999; Nan 2006). CDPRs that operate in harsh environments can be affected by disturbances such as wind, earthquakes and so on. According to the studies by Nan et al. (2006) and Vogiatzis et al. (2004), wind loading is one of the critical parameters influencing the performance of large telescopes. It can affect both the flexible cable and feed cabin, leading to a deterioration in the performance of the control system, eventually making it unstable. Therefore, it is important to investigate how best to reduce the effects of disturbance in CDPRs, to widen their industrial applications and stabilize such systems.
There are many aspects to consider when developing CDPRs, such as stability analysis of robots (Carricato and Merlet 2012), calculations relating to the workspace (Duan and Duan 2014; Heo et al. 2018) and trajectory planning, and the development of accurate position control algorithms (Schmidt and Pott 2017; Kang et al. 2019). However, for applicability to real robots, cable tension must be modelled accurately. There have been many studies on force control and analyses of friction in pulleys (Kraus et al. 2014; Choi et al. 2017). Kraus et al. 2014 proposed a force control method in which an impulse response was used to establish a second-order system with dead time, and obtained the correlation between dead time and cycle time. Using their system, they developed and implemented a cable force controller. However, they did not consider the effects of external disturbances such as wind, and did not apply disturbance observer based (DOB) control to reduce the effect of disturbance. It is not easy to apply DOB to CDPR systems, because they have eight cables with different features and long delay times are induced by the friction and elongation of pulleys connected in series.
However, DOB control has been successfully applied in many real industrial applications (Ohishi 1987; Umeno and Hori 1991; Natori 2012; Chen et al. 2016; Natori et al. 2008; Sariyildiz and Ohnishi 2015; Li et al. 2017; Yang et al. 2010; Zhu et al. 2005). The DOB control method was first introduced by Ohnishi in (1987), and was further developed by Umeno and Hori (1991). The basic principle of DOB control is that the lumped disturbance can be estimated and input into a feed forward model (Chen et al. 2016).
In this paper, we propose the application of a DOB algorithm to 8-cables CDPRs, with the aim of attenuating the deleterious effects of disturbances in harsh environments. We then evaluate the performance of our algorithm. First, we constructed an experimental setup for system identification, and then used it to test the CDPR system with a step response. Next, for each of the eight cables, we designed and analyzed a DOB controller for a model system with time delay. We then constructed another experimental setup with a mounted eccentric motor to create disturbance, and implemented a DOB algorithm in the CDPR via a programmable logic controller (PLC). We operated the CDPR at specific disturbance frequencies and compared the experimental results with and without the DOB algorithm.
2 CDPR system and system identification
2.1 Fully constrained CDPR system
The designed CDPR system is shown in Fig. 1. It is a six-degree of freedom (DOF) robot with eight cables connecting eight motors, winches, and EEs via pulleys. The robot uses industrial servo drives as hardware and TwinCAT3 software for real-time control. The system parameters are listed in Table 1.
2.2 System identification
For system identification, a mathematical model of a dynamical system is constructed based on observations of its inputs and outputs. The input signal used in an identification experiment can have a significant influence on the resulting parameter estimates. Based on the response of a process to a step input, a number of practical parameters can be obtained, such as the dead time and time constant.
In the first step, we set up the test system to evaluate the model parameters. The system included a motor, servo controller, winch, load cell, pulley and cable connected to a fixed point in the frame. A schematic of the system identification setup is shown in Fig. 2. The step response to the input signal depended on the cable length, \( \delta_{d} \), and was generated by the PLC and controlled via a field bus to the servo driver. The output signal was the force sensor value, \( f \), which was digitized and sent back to the PLC via the field bus.
Since the signal passes several layers of communication in discrete time, dead time arises in the control loop. Hence, we repeated the identification process with different cycle times \( T_{c} \) for the controller and field bus in the range 1 to 16 ms and analyzed the dead time \( T_{d} \) between the cable length and load cell value response, as shown in Fig. 3a. There was a linear correlation between cycle time and dead time, as shown in Fig. 3b. The system was a typical spring-mass-damper system with time-discrete control. Therefore, we assumed a second-order system with dead time for the transfer function (Kraus et al. 2014):
where \( K_{p} \), \( \varsigma \), \( T_{w} \) and \( T_{d} \) are the proportional gain, damping ratio, natural period, and dead time, respectively.
By sampling the input/output data every 2 ms using the Matlab System Identification Toolbox, as indicated in Fig. 4, we obtained the parameters of the transfer function. The parameters are listed in Table 2. The fit for each cable was greater than 93%.
3 DOB algorithm
3.1 Basic DOB controller structure
Consider the basic DOB controller structure shown in Fig. 5a. \( U_{c} (s) \), \( U(s) \), \( Y(s) \), \( D(s) \) and \( \mathop D\limits^{ \wedge } (s) \) are, respectively, the command, plant input, output, external disturbance and estimated lumped disturbance. \( G_{p} (s) \), \( G_{n} (s) \) and \( Q(s) \) are the transfer functions of the actual plant, nominal plant and disturbance observer filter to be designed, respectively. From Fig. 4a, the system output is represented:
where
As we can see from (2) to (4), optimal DOB control performance can be achieved with high accuracy of the nominal plant and according to the design of the filter. If the nominal plant matches the real plant and \( Q(s) \) is a low-pass filter with a steady-state gain, the disturbance can be eliminated.
3.2 DOB controller structure with dead time
It is necessary to consider dead time in real systems. Figure 5b shows a block diagram of the basic DOB controller structure shown in Fig. 5a (Li et al. 2017; Zhu et al. 2005). The transfer function of the actual plant is represented as the sum of the real minimum-phase, \( g(s) \), and the real dead time, \( e^{{ - T_{n} s}} \). The transfer function of the nominal plant can also be obtained by multiplying the nominal minimum-phase \( g_{n} (s) \) by the nominal dead time \( e^{{ - T_{d} s}} \). From Fig. 5b, the system output can be obtained as:
where
And the lumped disturbances estimation can be obtained as:
Define \( E_{d} (s) \) to be the error between the actual value \( D(s) \) and the estimated value \( \mathop D\limits^{ \wedge } (s) \) of the lumped disturbance:
According to the final-value theorem (8):
Set \( Q(s) \) to be a low-pass filter with a steady state gain of 1: \( Q(s) = \frac{1}{{(\tau s + 1)^{m} }} \)
where \( \tau \) is the filter time constant and m is the relative degree, which should not be less than the difference between the order of the denominator and the order of the numerator to conserve the proper value of \( Q(s)g_{n}^{ - 1} (s) \). From (9), we can then obtain the following (10):
According to (11) and (12), the disturbance can be rejected. Hence, the low pass filter \( Q(s) \) is important as it not only restricts the effective bandwidth of the DOB controller, but also ensures the robustness of the system.
Because the dead time transfer function cannot be handled by a control design algorithm, the first order Pade approximation described below was used:
To implement the DOB controller in the CDPR, we converted it from continuous time to discrete time based on a specific sampling time.
4 Experiment
4.1 Experimental setup
According to Vogiatzis et al. (2004), wind loading predominantly affects the frequency range of 0.5 ~ 4 Hz in the case of giant telescopes. Therefore, instead of using wind as a source of disturbance for the CDPR in this study, we used an eccentric motor system to create a 2 Hz rotating frequency, thus simulating low-frequency disturbance. This system was composed of a low-speed direct current motor with an unbalanced mass connected to the shaft. The motor was fastened to the end-effectors via a subsystem so that its vibrations could be transferred. Different vibration frequencies and intensities were created by varying the speed at which the offset mass was rotated (Fig. 6). The speed of the motor was controlled based on the input voltage. The parameters describing the vibration motor system are summarized in Table 3.
The controller was implemented as a real-time PLC, as shown in Fig. 7. The position of the CDPR was controlled by an open-loop control system, and the cable tension by a closed-loop control system. The open-loop control system used inverse kinematics with a pulley (Heo et al. 2018) to obtain the desired cable length \( l_{d} \) and move the end-effectors to the desired position. In closed-loop control, a simple P-controller is applied to control the error between the cable tension feedback \( f_{c} \) from the force sensor and the cable tension \( f_{d} \) at the desired position which can be generated by dynamic modeling (Heo et al. 2018).
Then, the output tension \( f_{O} \) from the P-controller was transformed into the cable length input \( \Delta l \). If we assume that the cable is modelled using a linear stiffness model, the cable length can be obtained as follows:
where L is the cable length from the motor winch to the end-effectors, A is the cross-sectional area, and E is the Young’s modulus of the cable.
Finally, the change in cable length, \( \Delta l \), was input to the feedback disturbance estimation, \( \mathop d\limits^{ \wedge } \), from the DOB controller structure, as mentioned above, and the desired cable length, \( l_{d} \), was used to set the cable lengths in the TwinCAT controller, as shown in Fig. 7. The force sensors in each cable were calibrated to supply the actual force \( f_{c} \) to the controller.
4.2 Experiment result
We carried out experimental studies to evaluate the practical performance of the proposed method. The input voltage of the vibration motor was 12 V. The gain of the P-controller (\( K_{p} = diag[0.22] \)), which controlled the cable tension, was tuned manually. For the DOB controller, based on the considerations outlined above, the following filter was selected: \( Q(s) = \frac{1}{{(0.178s + 1)^{2} }} \). We used fast Fourier transform (FFT) to analyze and evaluate the cable tension based on the obtained data. In Fig. 8, we compare the cable tension with P + DOB control (red) and P individual control (blue). It is clear that the performance of all cables improved significantly when the DOB controller was used. According to Fig. 8, the vibrations of cables 2, 4, 5 and 7 were larger than those of the other cables. This is because the mounting location was slightly asymmetric, which affected the tension of the diagonal cables. As shown in Fig. 8, the suspended tension varied from 0.2 to 2.5 N in the case of the DOB controller. In Table 4, we summarize the improvement in cable tension both with and without DOB control. When DOB control was applied, the reduction in cable tension improved significantly, by 40–60%, at the target frequency of 2 Hz, and the amplitude range decreased by 35–50% compared to the case in which DOB control was not applied. DOB control cannot attain perfect static accuracy due to uncertainties in the model and sensor noise.
In Fig. 9, we compare the changed encoder value of 8 motors between the cases with and without DOB control. In the case with DOB control, the changed encoder value of 8 motors was smaller than in the case without DOB control. Figure 9 also shows that, after a long period of time, the changed encoder value was larger in the case with the standard control method and external disturbance, that mean the end-effectors position will be more and more inaccurate.
5 Conclusion
In this paper, we applied the system identification method to establish a second-order system including dead time, and constructed a test setup to apply the DOB control system to CDPRs. Using the constructed experimental setup, system parameters were measured for all eight cables, and a DOB algorithm was developed based on the values obtained. The aim of this algorithm was to control a second-order system with dead time. Using the CDPR system with the DOB algorithm and a P-controller, an experiment was carried out with disturbances at frequencies of 2 Hz. When DOB control was applied, the reduction in amplitude of the cable tension improved significantly, by 40% to 60%, and the peak to peak improved by 35% to 50% compared to the case without DOB control. Thus, we validated our proposed strategy, namely the application of DOB controllers to CDPR systems.
References
Carricato M, Merlet JP (2012) Stability analysis of underconstrained cable-driven parallel robots. IEEE Trans Robot 29(1):288–296
Chen WH, Yang J, Guo L, Li S (2016) Disturbance observer based control and related methods—an overview. IEEE Trans Ind Electron 63(2):1083–1095
Choi SH, Park JO, Park KS (2017) Tension analysis of a 6-degree of freedom cable driven parallel robot considering dynamic pulley bearing friction. Adv Mech Eng 9(8):1–10
Duan BY (1999) A new design project of the line feed structure for large spherical radio telescope and its nonlinear dynamic analysis. Mechatronics 9(1):53–64
Duan QJ, Duan X (2014) Workspace classification and quantification calculations of cable-driven parallel robots. Adv Mech Eng 6:1–9
Heo JM, Park BJ, Park JO, Park KS (2018) Workspace and stability analysis of a 6-DOF cable driven parallel robot using frequency based variable constraints. J Mech Sci Technol 32(3):1345–1356
Kang JM, Choi SH, Park JW, Park KS (2019) Position error prediction using hybrid recurrent neural network algorithm for improvement of pose accuracy of cable driven parallel robots. Microsyst Technol 26:209
Kraus W, Schmidt V, Rajendra P, Pott A (2014) System identification and cable force control for cable driven parallel robot with industrial servo drives. In: 2014 IEEE international conference on robotics and automation (ICRA), Hong Kong, China, 31 May–7 June
Li S, Yang J, Chen WH, Chen X (2017) Disturbance observer based control: methods and applications. CRC Press, Boca Raton
Meunier G, Boulet B, Nahon M (2009) Control of an overactuated cable-driven parallel mechanism for a radio telescope application. IEEE Trans Control Syst Technol 17(5):1043–1054
Nan RD (2006) Five-hundred-meter aperture spherical radio telescope (FAST) project. Sci China 49(2):129–148
Natori K (2012) A design method of time-delay system with communication disturbance observer by using pade approximation. In: The 12th IEEE international workshop on advanced motion control, March 25–27
Natori K, Oboe R, Ohnishi K (2008) Stability analysis and practical design procedure of time delay control system with communication disturbance observer. IEEE Trans Ind Inform 4(3):185–197
Ohishi K (1987) Microprocessor controlled DC motor for loading insensitive position servo system. IEEE Trans Ind Electron IE-34:44
Qian S, Zi B, Shang WW et al (2018) A review on cable-driven parallel robots. Chin J Mech Eng 31(1):66
Sariyildiz E, Ohnishi K (2015) Stability and robustness of disturbance observer based motion control systems. IEEE Trans Ind Electron 62(1):414–422
Schmidt V, Pott A (2017) Increase of position accuracy for cable driven parallel robots using a model for elongation of plastic fiber ropes. In: On the workspace representation and determination of spherical parallel robotic manipulators, pp 335–343
Seriani S, Gallina P, Wedler A (2016) A modular cable robot for inspection and light manipulation on celestial bodies. Acta Astronaut 123:145–153
Tanaka M, Seguchi Y, Shimada S (1988) Kineto-statics of Skycam—type wire transport system. In: Proceedings of USA –Japan symposium on flexible automation, crossing bridges: advances in flexible automation and robotics, pp 689–694
Umeno T, Hori Y (1991) Robust speed control of DC servo motors using modern two degrees of freedom controller design. IEEE Trans Ind Electron 38:363–368
Vogiatzis K, Segurson A, Angeli GZ (2004) Estimating the effect of wind loading on extremely large telescope performance unsing computational fluid dynamics. Proc SPIE- Int Soc Opt Eng 5497:311–320
Yang J, Li SH, Chen XS, Li Q (2010) Disturbance rejection of ball mill grinding circuits using DOB and MPC. Powder Technol 198(2):219–228
Zhu HD, Zhang GH, Shao HH (2005) Control of the process with inverse response and dead time based on disturbance observer. In: Proceeding of American control conference, pp 4826–4831
Zi B, Lin J, Qian S (2015) Localization, obstacle avoidance planning and control of a cooperative CDPR for multiple mobile cranes. Robot Comput Integr Manuf 34:105–123
Acknowledgements
This research was supported by Development of Space Core Technology Program through the National Research Foundation of Korea (NRF) funded by the Ministry of Science, ICT and Future Planning (2017M1A3A3A02016340) and from Human Resource Development of the Korea Institute of Energy Technology Evaluation and Planning (KETEP) and the Ministry of Trade, Industry and Energy (MOTIE) of the Republic of Korea (20174030201530).
Author information
Authors and Affiliations
Corresponding author
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
About this article
Cite this article
Dinh, T.N., Park, J. & Park, KS. Design and evaluation of disturbance observer algorithm for cable-driven parallel robots. Microsyst Technol 26, 3377–3387 (2020). https://doi.org/10.1007/s00542-020-04883-w
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s00542-020-04883-w