Force Control of one pair of 6-Link Electro-Hydraulic Manipulators

한 쌍의 6축 전기유압 매니퓰레이터의 힘제어

Hydraulically driven manipulators are superior to electrically driven ones in the power density and electrical insulation. But an electro-hydraulic manipulator using hydraulic actuators has many nonlinear elements, and this parameter fluctuations are greater than those of electrically driven manipulator. So this is relatively difficult to realize not only stable contact work but also accurate force control for the autonomous field task such as the maintenance task of high voltage active electric line or the automatic excavation task by hydraulic excavator. In this report, we propose robust force control algorithm, which can be applied to there real field task such as the construction field, nuclear plant and so on. Proposed force controller has the same structure as that of disturbance observe for position control. The difference between force and position disturbance observer is that the input and output of disturbance observer are forces in the case force disturbance observer and the plant varies much compared to the case of position control. In the design of force disturbance observer, generalized plant is derived and the stabilized filter is designed by H infinity control theory to ensure the robuts t stability even though the stiffness of environment changes from sponge to steel, and the contact surface also changes from flat to round shape. Experimental results show that highly robust force tracking by a 6-link electro-hydraulic manipulator could be achieved under various environment conditions.