An Adaptive Robust Controller for Hydraulic Robotic Manipulators with a Flow-Mapping Compensator

Fu Zhang, Junhui Zhang*, Bing Xu and Huizhou Zong

State Key Laboratory of Fluid Power & Mechatronic Systems, Zhejiang University, Hangzhou, 310027, China

E-mail: zhangfu@zju.edu.cn; benzjh@zju.edu.cn; bxu@zju.edu.cn; hzzong@zju.edu.cn

*Corresponding Author

Received 29 November 2020; Accepted 02 March 2021; Publication 29 May 2021

Abstract

Proportional directional control valves have flexible control functions for the control of various hydraulic manipulators. It is foreseeable that the application of proportional directional control valves will be further expanded. However, due to its own structure, its important parameter, flow gain, is complex, and it has a complex functional relationship with valve opening and temperature. The variable flow gain reduces the performance of a strictly derived nonlinear controller. Therefore, it is necessary to consider the nonlinearity of flow gain in the controller design. In order to solve the above problems, this paper proposes an adaptive robust controller for a hydraulic manipulator with a flow-mapping compensator, which takes into account the nonlinear flow gain and improves the performance of the nonlinear controller. First, we established an adaptive robust controller of the hydraulic manipulator to obtain the load flow of the control input valve. Then, the function of flow gain, input voltage, and temperature are calibrated offline using cubic polynomial, and the flow-mapping compensator is obtained. Finally, we calculate the input voltage based on the flow-mapping compensator and load flow. The flow-mapping compensator further reduces the uncertainty of the model and improves the robustness of the system. By using the proposed controller, the control accuracy of the hydraulic manipulator is significantly improved.

Keywords: Hydraulic manipulators, nonlinear control, motion control.

1 Introduction

Proportional directional control (PDC) valves are often used in casting robots, rescue robots, and underwater robots, which require a high power-to-weight ratio [1–4]. However, it is not easy to achieve high-precision control using PDC valves. The high-precision control of the hydraulic manipulator faces three challenges: the complex nonlinearity of system dynamics, the uncertainty of system parameters, and the flow gain affected by valve opening and temperature. Firstly, rigid body dynamics and pressure dynamics are highly nonlinear, and hydraulic cylinder-driven joints introduce nonlinearity. Secondly, the system has very uncertain parameters, such as load mass, friction, and oil viscosity. Thirdly, the flow gain is variable, affected by the oil temperature and valve opening. Therefore, it is incredibly challenging to achieve high-precision control of a hydraulic manipulator using PDC valves.

Nonlinear controllers have been applied to hydraulic manipulators [5–9]. These methods are based on the hydraulic manipulator model and prove the stability of the controller. These controllers take into account the nonlinearity of the system model and improve the control performance. Due to the uncertainty in the system, adaptive and adaptive robust controllers have also been proposed to improve the control performance of hydraulic manipulators. These methods can estimate uncertain parameters online. Recently, some scholars have noticed the nonlinearity of flow gain, fitting the function of valve opening and flow gain through a polynomial function [10].

In order to solve the above problems, the control accuracy of the hydraulic manipulator is further improved. We propose an adaptive robust controller with a flow-mapping compensator. According to the design steps of the adaptive robust controller, we establish an adaptive robust controller to estimate the load mass, joint friction, and oil elastic modulus online. Through the adaptive robust controller, we get the load flow. Unlike previous studies, the control current is not calculated by a nonlinear function with a fixed flow gain. We fit the function of flow gain, valve opening and temperature through a binary quartic function. A more accurate control current is calculated through the flow-mapping compensator, which improves the control accuracy of the hydraulic manipulator and the robustness of the system.

images

Figure 1 Multi-joint manipulator.

2 Dynamic Models

The excavator is a typical hydraulic. It is assumed that all elements in the automatic system are rigid bodies. The manipulator angle q and cylinder displacement x are defined, as shown in Figure 1. The arm joint of the manipulator contains two connecting links and the hydraulic cylinder, which forms a triangular closed chain, as shown in Figure 1.

The kinematic relationship between the hydraulic cylinder and the joint can be written as

L1+L2-x22L1L2=cosq (1)

where L1 is the distance between the head-side chamber joint and the manipulator joint, L2 is the distance between the rod side chamber joint and the manipulator joint, {O} is the local coordinate fixed with the manipulator.

We can convert the joint speed and hydraulic cylinder speed through a nonlinear function. The joint speed of the hydromechanical arm can be expressed as

q˙=qxx˙=-xL1L2sinqx˙ (2)

where q˙ is the joint velocity, x˙ is the cylinder velocity.

We differentiate Equation (2), we can get the expression of joint acceleration as

q¨=-(xx¨+x˙2)sinq-xx˙q˙cosqL1L2(sinq)2 (3)

where q¨ is the joint acceleration, x¨ is the cylinder acceleration.

The actuator is an asymmetric hydraulic cylinder. There is a dual relationship between force and velocity. The dynamics of the manipulator can be written as

(J+ml2)q¨+G(q)+mgl=xq(P1A1-P2A2)-T (4)

where P1 is the pressure of the chamber without the rod, P2 is the pressure of the chamber with the rod, A1 is the piston area of the cylinder without the rod, A2 is the piston area of the cylinder with the rod, T is the disturbance parameter including hydraulic cylinder friction torque and joint friction torque, G is the torque due to mechanical manipulator and load gravity, J is the moment of inertia relative to the coordinates {O}, m is the end-load of the manipulator, and l is the distance between the end load and the coordinates {O}.

When the leakage is ignored, the pressure dynamics of a hydraulic cylinder can be written as

V1βeP˙1 =-A1x˙+Q1=-A1xqq˙+Q1 (5)
V2βeP˙2 =A2x˙-Q2=A2xqq˙-Q2 (6)

where V1 is the volume of the chamber without the rod, V2 is the volume of the chamber with the rod, Q1 is the supplied flow, and Q2 is the return flow.

If the valve opening and the input signal of the valve port are linear, the flow equation of the servo valve can be written as

Q=kquΔp (7)

where kq is the flow gain, u is the valve input voltage, Δp is the pressure difference of the valve port.

However, the flow gain of the valve port is very complicated. It is related to the valve opening and oil temperature, and the PDC valve contains a certain area of the dead zone. These cannot be ignored. We offline tested the relationship between the valve port flow rate and the input voltage and pressure difference, as shown in Figure 2. Further, we still test the flow under oil temperature.

images

Figure 2 Multi-joint manipulator.

Therefore, achieving high precision control with the PDC valves faces not only complex dynamics in motion control of hydraulic manipulator but also the additional challenges brought by the nonlinearity of the PDC valve.

The challenges can be summarized as follows:

• It cannot be ignored that the dynamics is due to the pipeline volume and the elastic modulus of oil. The dynamics of the system contains many complex nonlinear terms.

• In the practical application process, the flow gain of a PDC valve is extremely complicated. The dead zone and nonlinear flow gain coefficient influence the dynamic characteristics and control accuracy.

images

Figure 3 Presented electronic-hydraulic system.

To address these challenges, through the offline test data, we use a polynomial function to model the flow gain of the valve port and use the least square valve to fit the polynomial coefficient. We built a flow-mapping compensator and integrated it into the adaptive robust controller. The proposed controller first obtains the desired flow. Then flow-mapping compensator is used to generate an actual input signal considering the dead zone and nonlinearity of the flow model. The tiny model error is solved by particular robust feedback. By using the proposed controller, the control accuracy of the hydraulic manipulator has been significantly improved. The control frame is shown in Figure 3.

3 Controller Design

To estimate the uncertain parameters online, the uncertain parameters are further sorted, and they can be written as equations (8)–(11).

θ=[θ1θ2θ3]T (8)
θ1=1J+ml (9)
θ2=T+mglJ+ml (10)
θ3=βe (11)

Regression form of system dynamics equation with uncertain parameters can be written as

q¨=θ1[xq(P1A1-P2A2)-G(q)]-θ2 (12)
P˙1=θ3V1[-A1xqq˙+Q1+Q~1] (13)
P˙2=θ3V2[A2xqq˙-Q2-Q~2] (14)

where Q~1 is supply flow error between the system model and actual system, and Q~2 is the return flow error between the system model and the actual system.

After the system dynamics model is established, the controller is designed according to the adaptive robust controller backstepping method.

Step 1:
There is no uncertainty in the dynamic equations of angular displacement and angular velocity, and angular velocity error z2 is defined as

z2=z˙1+k1z1=q˙-q˙r (15)
q˙r=Δq˙d-k1z1,k1>0 (16)
z1=q-qd (17)

where k1>0, q is the actual joint angle, qd is the desired joint angle, q˙r is the required joint angular velocity.

The positive-semidefinite Lyapunov function V1 is defined. The function V1 and its derivatives can be written as

V1=12w1z12 (18)
V˙1=w1z1z˙1=w1z1z2-k1w1z12 (19)

where w1 is a positive constant.

If z2 is as small as possible until it converges to 0, then the function V˙1, and z1 converges to 0. Therefore, the next step is to design the control rate to make z2 converge to 0.

Step 2:
The derivative of q˙r is shown as Equation (20).

q¨r=q¨1d-k1z˙1 (20)

The derivative of z2 is shown as Equation (21).

z˙2=q¨-q¨r=θ1[xq(P1A1-P2A2)-G(q)]-θ2-q¨r (21)

FL is defined as Equation (22).

FL=A1P1-A2P2 (22)

The virtual control input FLds is defined as

FLd=FLda+FLds (23)
FLda=(xq)-1[q¨+θ^2-z1θ^1-w1z1w2θ^1+G(q)] (24)
FLds=FLds1+FLds2=-(xq)-1k21θ1minz2+FLds2 (25)

where FLda is synthesized to compensate nonlinear term according to the system model, using estimated parameters, θ^i is estimated parameter, i=1,2,3, FLds1 is used to stabilize the system with k2>0.

The vector ϕ2 and the estimated parameter error vector is defined by Equations (26)–(27).

ϕ2 =[FLda,-1,0]T (26)
θ~m =[θ~1,θ~2,θ~3]T (27)

FLds2 is used to eliminate instability caused by parameter uncertainties, which satisfy the inequalities as

z2FLds20 (28)
z2(θ1FLds2-ϕ2Tθ~)ε2 (29)

where ε2 can measure the allowable range of error, which is a positive parameter.

Define virtual input force error z3 as Equation (30).

z3=FL-FLd (30)

The positive-semidefinite Lyapunov function V2 is defined. The function V2 and its derivatives can be written as

V2 =V1+12w2z22 (31)
V˙2 =V˙1+w2z2z˙2=w2z2θ1xqz3
-w2θ1θ1mink2s1z22+w2z2(θ1FLs2-θ~Tϕ2)-k1w1z12 (32)

where w2 is a positive constant.

If z3 is as small as possible until it converges to 0, then the function V˙2 is less than 0, and z2 converges to 0. Therefore, the next step is to design the control rate to make z3 converge to 0.

Step 3:
The derivative of z3 is shown as Equation (3).

z˙3 =F˙L-F˙Ld=(P˙1A1-P˙2A2)-(F˙Ldc+F˙Ldu)
=-θ3((A12V1+A22V2)xqq˙+A1V1Q1+A2V2Q2+A1V1Q~1+A2V2Q~2)
-(F˙Ldc+F˙Ldu) (33)

where F˙Ldc represents the calculable part of F˙Ld, F˙Ldu is the incalculable part of F˙Ld.

F˙Ldc can be calculated as

F˙Ldc=FLdcqq˙+FLdcq˙q¨+FLdct (34)

QL is defined as Equation (35), and virtual control input QLd as Equation (36).

QL=A1V1Q1+A2V2Q2 (35)
QLd=QLda+QLds (36)
QLda=1θ^3[θ^3(A12V1+A22V2)xqq˙+F˙Ldc-w2w3θ^1xqz2] (37)
QLds=QLds1+QLds2=-k31θ3minz3+QLds2 (38)

where QLda is synthesized to compensate nonlinear term according to the system model using estimated parameters, QLds1 is used to stabilize the system, k3>0.

The vector ϕ3 is defined as Equation (39), and QLds2 is used to eliminate instability caused by parameter uncertainty, which satisfies the inequalities as

ϕ3=[w2w3z2-FLq˙(A1P1-A2P2)-FLq˙-[(A12V1+A22V2)xqq˙+QLda]] (39)
z3θ3QLds20 (40)
z3(θ3QLds2-ϕ3θ~T+θ3(A1V1Q~1+A2V2Q~2))ε3 (41)

where ε3 can measure the allowable range of error, which is a positive parameter.

The positive-semidefinite Lyapunov function V3 is defined. The function V3 and its derivatives can be written as

V3 =V2+12w3z32 (42)
V˙3 =V˙2|+z3=0w2z3
(-w3θ3θ3mink3z32+w3z3(θ3(QLds2+A1V1Q~1+A2V2Q~2)-ϕ3Tθ~)) (43)

where w3 is a positive constant.

A projection function is defined so that estimated parameters are bounded, which can be written as

Projθ(i)={0ifθ^i=θimaxandi>00ifθ^i=θiminandi<0iotherwise (44)

The estimated parameter vector is updated by Equation (45)

θ^˙=Projθ[Γm(w2ϕ2z2+w3ϕ3z3)] (45)

where Γm is a positive diagonal matrix.

Through the above derivation, the control input QLd is obtained.

4 Flow-Mapping Compensator and Directly Compensating Dead Zone

In this part, we introduce two methods to solve the input problem.

4.1 Flow-Mapping Compensator

To further improve the control accuracy of the hydraulic manipulator, we have established a flow-mapping compensator to calculate the input voltage according to the load flow. In this way, the problem of uncertain flow gain is solved by a flow-mapping compensator.

We test the flow of different pressure differences and different input voltages at different oil temperatures and use the least square method to fit the polynomial coefficients at this temperature. The structure of the polynomial is as Equation (46).

To calculate the valve input, a set of polynomial coefficients close to the current temperature is selected. Then the input u can be solved by the equation for finding the roots of a quartic polynomial, as Equation (47).

c(u)={T(au3+bu2+cu+d)u>udeudeudeudeT(-au3+bu2-cu+d)u<-ude (46)

where a, b, c and d are calculated by the least square method based on the offline measured valve pressure and flow characteristics, T is the Kelvin temperature of the oil, ude is the input voltage representing the dead zone.

images

Figure 4 Presented electronic-hydraulic system.

The flow gain coefficient is fitted as a cubic curve c(u), when the oil temperature in Kelvin is 313.15K, as shown in Figure 4.

u ={uc(u)u=QLd(A1V1Δp1+A2V2Δp2)|u|>ude0|u|ude (47)
Δp1 ={Ps-P1QLd>0P2-PrQLd<0 (48)
Δp2 ={Ps-P2QLd<0P2-PrQLd>0 (49)

4.2 Directly Compensating Dead Zone

It is assumed that the flow gain kq is constant, and the dead zone is directly compensated, and the compensation equation can be written as Equation (50).

u=QLdkq(A1V1Δp1+A2V2Δp2)+udesign(QLd) (50)

5 Simulation Results

In this paper, the simulation models of the mechanical part and hydraulic part are established in Simcenter AMESim, and the controller is built-in Simulink. The two software co simulate through the SimulinkCosim interface.

images

Figure 5 Tracking trajectory of hydraulic cylinder.

A trajectory is used for a comparative experiment, as shown in Figure 5, which has a maximum velocity of v= 0.08 m/s and a maximum acceleration of a = 0.3 m/s2.

In the simulation experiment, the coefficients of the feedback term are k1=15, k2=20, k3=40, ude=1. The adaptation update rate is written as Equation (51).

Γ=[2×10-80006×10-80003×10-6] (51)

The simulation results are shown in Figure 6. With the same control parameters, the transient error of the adaptive robust controller using flow-mapping compensator is smaller, and the steady-state error of the adaptive robust controller using flow-mapping compensator can faster convergence.

images

Figure 6 Tracking error of hydraulic cylinder.

images

Figure 7 Presented electronic-hydraulic system.

6 Experimental Results

The controller is evaluated on the experimental platform of the hydraulic manipulator in this paper. To facilitate empirical research, the xPC Target real-time workshop is used in the control system of the hydraulic manipulator. The test platform and control system structure are shown in Figure 7. The arm joint was used as the research object for comparative experiments.

The test bench parameters required in the experiment are shown in Table 1.

Table 1 Parameters of the test rig

Parameters Value Unit
The maximum displacement of the pump 45.6 cm3/r
The rotational speed of the motor 1500 r/min
The diameter of the arm cylinder 0.07 m
Piston diameter of the arm cylinder 0.04 m

Two controllers are tested for comparison. They have the same control parameters. The feedback gains used are k1=30, k2=25, k3=30, where ude=1. The adaptation update rate is written as Equation (52)

Γ=[1×10-80008×10-80001×10-6] (52)

6.1 ARC with Directly Compensating Dead Zone

The control voltage is generated by Equation (50). The tracking error is shown in Figure 8. During a movement, the maximum negative error is -3.76 mm, and the maximum positive error is 5.97 mm.

images

Figure 8 Tracking error with directly compensating dead zone.

6.2 ARC with Flow-mapping Compensator

A flow-mapping compensator is used to compensate for nonlinear flow gain when oil temperature in Kelvin is 313.15 K. The coefficients of the flow gain polynomial are shown as Equation (53).

a= 5.957×10-13b=-2.271×10-11
c=2.086×10-10d=-1.551×10-10 (53)

images

Figure 9 Tracking error with flow-mapping compensator.

The control voltage is generated by Equation (47). The tracking error is shown in Figure 9. During a movement, the maximum negative error is -2.45 mm, and the maximum positive error is 3.1 mm.

7 Conclusions

This paper proposed a controller with a flow-mapping compensator for a PDC valve-controlled cylinder system to improve motion control accuracy for the heavy-load mobile manipulator. The controller is experimentally investigated on a hydraulic robotic manipulator test bench driven by single-rod hydraulic actuators. The control accuracy of using the flow mapping compensator to generate the control voltage is greatly improved than the control accuracy not used. The maximum positive error is only 65.16% of the control accuracy directly compensating the dead zone, and the maximum negative error is only 51.93% of the control accuracy directly compensating the dead zone. The results demonstrate that the control strategy can achieve a higher control accuracy than directly compensating the dead zone.

In the future, we will obtain more data and use machine learning methods to improve the accuracy of the flow-mapping compensator further. Online automatic generation of the flow-mapping compensator is also our goal.

Acknowledgment

This work was supported in part by the National Natural Science Foundation of China (Grant No. 91748210), the National Outstanding Youth Science Foundation of China (Grant No. 51922093), and the National Natural Science Foundation of China (Grant No. 51835009).

References

[1] J. Mattila, J. Koivumaki, D. G. Caldwell, and C. Semini, “A survey on control of hydraulic robotic manipulators with projection to future trends,” IEEE/ASME Trans. on Mechatronics, vol. 22, no. 2. pp. 669–680, 2017.

[2] M. Cheng, J. Zhang, B. Xu, and R. Ding, “An Electrohydraulic Load Sensing System based on flow/pressure switched control for mobile machinery,” ISA Trans., vol. 96, pp. 367–375, 2020.

[3] R. Dindorf and P. Wos, “Force and position control of the integrated electro-hydraulic servo-drive,” Proc. 2019 20th Int. Carpathian Control Conf. ICCC 2019, pp. 1–6, 2019.

[4] M. Han, Y. Song, Y. Cheng, W. Zhao, J. Wei, and X. Ji, “Conceptual Design and Analysis of Water Hydraulic Manipulator for CFETR Blanket Maintenance,” J. Fusion Energy, vol. 34, no. 3, pp. 545–550, 2015.

[5] B. Yao, F. Bu, J. Reedy, and G. T. C. Chiu, “Adaptive robust motion control of single-rod hydraulic actuators: Theory and experiments,” IEEE/ASME Trans. Mechatronics, vol. 5, no. 1, pp. 79–91, 2000.

[6] A. Mohanty and B. Yao, “Indirect adaptive robust control of hydraulic manipulators with accurate parameter estimates,” IEEE Trans. Control Syst. Technol., vol. 19, no. 3, pp. 567–575, 2011.

[7] L. Lyu, Z. Chen, and B. Yao, “Energy Saving Motion Control of Independent Metering Valves and Pump Combined Hydraulic System,” IEEE/ASME Trans. Mechatronics, vol. 24, no. 5, pp. 1909–1920, 2019.

[8] L. Lyu, Z. Chen, and B. Yao, “Development of Pump and Valves Combined Hydraulic System for Both High Tracking Precision and High Energy Efficiency,” IEEE Trans. Ind. Electron., vol. 66, no. 9, pp. 7189–7198, 2019.

[9] Q. Guo, Y. Zhang, B. G. Celler, and S. W. Su, “Backstepping Control of Electro-Hydraulic System Based on Extended-State-Observer with Plant Dynamics Largely Unknown,” IEEE Trans. Ind. Electron., vol. 63, no. 11, pp. 6909–6920, 2016.

[10] J. Zhang, D. Wang, B. Xu, Q. Su, Z. Lu, and W. Wang, “Flow control of a proportional directional valve without the flow meter,” Flow Meas. Instrum., vol. 67, no. October 2018, pp. 131–141, 2019.

Biographies

images

Fu Zhang received the B.Eng. degree from Jilin University, Changchun, China, in 2018. He is currently working toward the Ph.D. degree in the College of Mechanical Engineering, Zhejiang University, Hangzhou, China. His research interests include hydraulic robots and trajectory planning.

images

Junhui Zhang received the B.S. degree in 2007 and the Ph.D. degree in 2012, both from Zhejiang University, Hangzhou, China.

He is currently a researcher at the Institute of Mechatronics and Control Engineering, Zhejiang University. His research interests include high-speed hydraulic pumps/motors, hydraulic robots. He published more than 40 papers indexed by SCI, and applied more than 20 National Invention Patents with 18 granted. He is supported by. the National Science Fund for Excellent Young Scholars. He is a technical editor of IEEE/ASME Trans Mechatron.

images

Bing Xu received the Ph.D. degree in fluid power transmission and control from Zhejiang University, Hangzhou, China, in 2001.

He is currently a Professor and a Doctoral Tutor in the Institute of Mechatronic Control Engineering, and the Director of the State Key Laboratory of Fluid Power and Mechatronic systems, Zhejiang University. He has authored or coauthored more than 200 journal and conference papers and authorized 49 patents. Prof. Xu is a Chair Professor of the Yangtze River Scholars Programme, and a science and technology innovation leader of the Ten Thousand Talent Programme.

images

Huaizhi Zong received the B.S. degree in 2017 and the M.S. degree in 2020, from Northeastern University, Shenyang and Zhejiang University, Hangzhou, China, respectively. He is currently pursuing the Ph.D. degree in the College of Mechanical Engineering, Zhejiang University, Hangzhou, China. His research interests include hydraulic robots, lightweight design of hydraulic cylinder/accumulator/system, heat transmission, energy recovery and utilization.

Abstract

1 Introduction

images

2 Dynamic Models

images

images

3 Controller Design

4 Flow-Mapping Compensator and Directly Compensating Dead Zone

4.1 Flow-Mapping Compensator

images

4.2 Directly Compensating Dead Zone

5 Simulation Results

images

images

images

6 Experimental Results

6.1 ARC with Directly Compensating Dead Zone

images

6.2 ARC with Flow-mapping Compensator

images

7 Conclusions

Acknowledgment

References

Biographies