Академический Документы
Профессиональный Документы
Культура Документы
2, 2009
Translated from Denki Gakkai Ronbunshi, Vol. 127-D, No. 8, August 2007, pp. 884889
(1)
(2)
(3)
(4)
30
2.2 Dynamics of the hopping robot Equation (6) is derived based. on geometrical relationships
.
as a transform from wzg to 3. From this relational expres-
In this paper, the motion equation of the hopping sion, a controller D.for 3 can be structured by deriving the
.
robot in the two-dimensional space is given by Eq. (5) [6, term wzcmd
g from wcmd
3 . This is discussed in the following
7]: section.
(5)
4. Proposed Method
3. Conventional Method
4.1 Compensation of model uncertainties
According to the Raibert method, during the thrust-
The cross mark in Fig. 5 shows the COG position of
ing phase the hip joint 2 controls the attitude and the knee
. an actual robot. Since the model shown in Fig. 4 was
joint 3 controls the vertical velocity z. Since in robots with
assumed to be massless, the COG position was assigned to
rotary joints responses of all axes generally interfere with
joint 2, but since legs of a real robot have mass, the COG
each other, the stance control and the vertical velocity
position was shifted to a location lower than joint 2. There-
control also interfere with each other. However, this inter-
fore, lleg becomes shorter than the actual leg. The problem
ference can be avoided by using a disturbance observer [8].
was that the derived value of the lift-off velocity was lower
The goal of this study is to improve robustness of the
than the desired velocity.
vertical velocity control. According to the MoritaOhnishi
In conventional methods, control in the base coordi-
method, if the hopping robot shown in Fig. 4 is considered
nates is carried out .by the feedback control by calculating
a point mass, then the vertical velocity can be controlled by
the response value res3 of the joint angle rather than using
command values of the knee joint [5]. Let us assume that
the reference command value wzcmd in the world coordi-
the center of gravity is in the point shown in this figure by
nates. However, model uncertainties appearing in the world
the cross mark, then by denoting variables in this diagram
coordinate frame cannot be compensated in the base coor-
as
dinates. On the other hand, it is possible to use the feedback
control in world coordinates by directly calculating the
response values wzres in the world coordinates. Compared
to the control in the base coordinates, control in the world
we have coordinates is more robust against model uncertainties of
the COG position. However, since the absolute location of
(6) humanoid robots is usually determined by image process-
ing or PSD (Photoshop document), observation errors are
31
greater than when control is carried out in the base coordi-
nates because the accuracy of the computer processing is
lower than that of the encoder that plays the role of the
sensor in the base coordinates.
As indicated above, control in base coordinates is
characterized by large model uncertainties requiring a high-
accuracy sensor, while the world coordinate control is
characterized by absence of model uncertainties but it is
usually accompanied by large observation errors. In other
words, these two types of control are in a trade-off relation-
ship. In this study we propose a method combining these
two control methods. Fig. 6. Block diagram.
First, the D control regarding 3 is given by the
formula
(12)
Control in the world coordinates is carried out using this
equation. Since Eq. (9) does not comprise the term lleg,
control in the world coordinates is not affected by model Transfer functions of (1 )D and N to respective re-
uncertainties of lleg associated with the modeling of the sponse values can be expressed by the equations
massless leg. By substituting Eq. (9) in Eq. (8), we obtain
(13)
(14)
(10)
(11)
32
Effect of errors depends on the selection ratio . Therefore, function having four unknown quantities. If the time when
the effect of errors on the response in the proposed control- the hopping robot is in its lowest position t = 0 and the time
ler can be expressed by when the robot achieves the desired velocity t = Tth, then
the velocity command values of the cubic function satisfy-
(15) ing the above conditions are applied in the interval of 0 t
Tth. If the robot did not lift off before the lift-off reference
time, then the velocity command in the interval Tth < t is to
One of the problems of designing the controllers is that it
maintain the velocity constant.
is usually necessary to compromise between the robustness
If the initial velocity and the initial acceleration at t
toward model uncertainties and the robustness toward ob- . ..
= 0 are given by wzres 0 and wzres0 , respectively, then the
servation errors [9]. Design of an optimal controller be-
trajectory expressed by the cubic function satisfying the
comes even more difficult when nonlinear coordinate
above-mentioned conditions can be expressed by
transform, like in Eq. (6), is involved. However, according
to Eqs. (12) and (15), in the proposed controller, transfer
function C from command values to response values and
transfer function from errors to response values can be
designed independently as two transfer functions by adjust-
ing the ratio. This means that the controller and the
trade-off arrangements can be designed separately and
since the trade-off is determined by , the system can be
optimized by easy adjustments. According to this method, (16)
an optimal trade-off can be searched even in the case of
linear control. Since it is difficult to formalize D and N, it
is impossible to determine the numerical value of . There- Figure 8 shows velocity command as a function of time. Tth
fore, the value of was found experimentally. In this study value is determined experimentally. The reference value of
..
was a constant but the selection ratio can also have band the lift-off acceleration wzcmd is 0 and the reference lift-off
. lo
33
5. Simulation Table 2. Robot parameters
(18)
During the period when the legs tip is in contact with the
floor surface (zf 0 Fext,z 0) the value of xf0 is main-
tained unchanged.
34
Table 5. Specifications for motors
6. Experiments
35
7. Conclusion Conference on Robotics and Automation, Leuven,
Belgium, p 793798.
In this paper we proposed a control system combin- 5. Morita Y, Ohnishi K. Attitude control of hopping
ing the world coordinates controller and the base coordi- robot using angular momentum. Proceedings of the
nates controller. This makes it possible to compensate for IEEE International Conference on Industrial Elec-
model errors of the thrust period and to achieve a better tronics, Maribor, Slovenia, p 173178, 2003.
following of the vertical velocity, thus implementing a 6. Paul RP. Robot manipulator. MIT Press; 1981.
highly accurate hopping height. In addition, we proposed a 7. Brady M et al. Robot motion. MIT Press; 1982.
continuous trajectory planning of the vertical velocity up to 8. Ohnishi K. Robust motion control by disturbance
the acceleration dimension. Effectiveness of these two pro- observer. J Robotics Soc Japan 1993;11:486493. (in
posed methods was confirmed by simulation and experi- Japanese)
ments. 9. Shimizu K, Ohmori H. Introduction to theory of
linear control. Baifukan Press; 2003. (in Japanese)
REFERENCES 10. Ohashi E, Ohnishi K. A hopping height control for
hopping robot. IEEJ Trans Ind Appl 2004;124:660
1. Matsuoka K. Fundamental study on hopping and 665. (in Japanese)
running mechanisms. Trans Japan Soc Mech Eng 11. Nakano E, Okubo H, Kimura H. The landing control
1977;43:45014509. (in Japanese) of a jumping machine. J Robotics Soc Japan
2. Raibert MH. Legged robots that balance. MIT Press; 1991;9:169176. (in Japanese)
1986. 12. Ohashi E, Ohnishi K. Variable compliance control
3. Ahmadi M, Buehler M. Stable control of a simulated based on soft-landing trajectory for hopping robot.
one-legged running robot with hip and leg compli- Proceedings of the 30th Annual Conference of the
ance. IEEE Trans Robotics Automation 1997;13:96 IEEE International Electronics Society, Busan, Ko-
104. rea, 2004.
4. Zeglin G, Brown B. Control of a bow leg hopping
robot. Proceedings of the 1998 IEEE International
Sho Sakaino (student member) graduated from the Department of System Design Engineering, Keio University, in 2006
and is now involved in research on hopping robots.
Kouhei Ohnishi (senior member) received his Ph.D. degree from the Department of Electrical Engineering, University
of Tokyo, in 1980 and joined the Department of Electrical Engineering, Keio University, as a research associate. He is now a
professor in the Department of System Design Engineering.
36