Professional Documents
Culture Documents
1 4032777 PDF
1 4032777 PDF
engagement. More specifically, the arms were assumed to have lateral climbing toward the right side as the demonstration. If the
the same motion profile but with a 180 deg phase difference. The arm sprawl angle moves to its maximum when the right arm
switching time is set to activate when the arms reach their maxi- extends to its extreme, the right hand can grab the position, which
mum/minimum length states. In a complete climbing stride with is further toward the right side in comparison with the condition
an actuation period tp , the robot is pulled up by the left arm and without the arm sprawl motion. Next, the arm sprawl angle moves
right arm in a sequence. When the model switches from the left- to its minimum when the left arm retracts to its extreme, and the
arm to the right-arm at t ¼ tp =2 (i.e., the final state of the left-arm left hand can grab the position, which is also further toward the
model and the initial state of the right-arm model), the coordinate right side. Therefore, by repeating the motion, the robot can per-
system also switches, and the configuration relations of the two form a lateral climbing motion. The described planning trajectory
coordinate systems (i.e., the relation of the two hands) can be requires the periodic motion of the arm length and the sprawl
defined by a vector h as shown in Fig. 1 motion to be synchronized and in phase where both arms reach
the extreme simultaneously.
h ¼ rL ðcos hL f i^ þ sin hL f jÞ
^ rR ðcos hR i i^ þ sin hR i jÞ
^ (9)
3 Dynamic Behavior of the Model
where the subscripts f and i represent the final and initial states,
respectively. At this point, the orientation configuration of the In addition to the model formulation described in Sec. 2, the
COM with respect to the new origin (hR i ) is a function of that of active DOFs ðuL ; uR ; hm Þ should also be clearly defined before
the old origin (hL f ) and the robot configuration, and it can be the performance analysis of the model. Because these 3DOFs in
expressed as the physical robot are controlled by the actuators, empirical con-
siderations should be incorporated to make the defined motion
hR i ¼ hL f ð2hm þ wL þ wR Þ (10) feasible. The arms of the model ðuL ; uR Þ are assumed to stretch
and retract alternately and periodically. Though a linear motor
In addition, the COM velocity perpendicular to the rL direction may fit the motion requirement from a mechanism aspect, it is not
when the model switches remains unchanged, so the initial angu- empirically suitable for the following reasons. First, it is designed
lar speed h_ R i can be expressed as to have a high-speed and low-force motion profile, which did not
fulfill the low-speed and high-force demand for this application.
1 Second, in this application, the linear motor had to accelerate and
h_ R i ¼ r_ L sin hL f hR i þ rL h_ L f cos hL f hR i (11)
rR decelerate to achieve an arm reciprocating extend/retract motion.
This would cause the motor to operate in the energy inefficient
Similarly, when the model switches from the right-arm to the left- region where nontrivial joule heat generates, and it may even
arm, the initial angular speed h_ L i can be expressed as damage the motor. Thus, as in the previous design [9], a rotational
actuator with a crank-and-slider mechanism is utilized to generate
1
h_ L i ¼ r_ R sin hR f hL i þ rR h_ R f cos hR f hL i (12) the reciprocating motion, as shown in Fig. 1(b). In this case, the
rL actuator continues to rotate in the same direction, so the motor
can be operated nearly constant speed. In contrast, though the arm
Finally, by importing the initial conditions (hL i , h_ L i ) or (hR i , sprawl motion of the robot is also reciprocal, its motion requires
h_ R i ) shown in Eqs. (10)–(12) into the left-arm model shown in less torque because of a lower gravity effect. Thus, a rotational
Eq. (7) or the right-arm model shown in Eq. (8), the dynamic actuator can be utilized to move reciprocally.
response of the model can be numerically simulated. In addition, The formulation of the active DOFs is described as follows.
by using Eq. (9), the dynamic responses of the model in multiple The arm sprawl angle (hm ) is parameterized as
strides can be sequentially composed. As a result, by giving
the initial conditions of the model in its first stride, the COM tra- hm ¼ Am cos ð2pt=tp þ /m Þ þ Om (13)
jectory of the model during the entire climbing motion can be
quantitatively computed. where Am is the swing amplitude, and Om and /m are two offset
In addition to the vertical-climbing motion, the sequential com- angles with different purposes. The offset angle Om determines
position of the model behavior shown in Eqs. (9)–(12) can be uti- the offset of the swing central line with respect to the body’s
lized for the lateral climbing motion by incorporating its sprawl fore–aft direction, as shown in Fig. 1(b). The offset phase /m
DOF (hm ) with the arm length DOFs (uL , uR ). Figure 2(b) shows determines the relative phase between the arm sprawl angle (hm )
m 5 kg
Rg 0.11547 m
(a,a) (0.117 m, 52.64 deg)
ln 0.111 m
l1 0.06 m
l2 0.105 m
N 54
Ns 540
Body size 0.142 m 0.215 m
and the arm length ðuL ; uR Þ, and its nominal value is set to p.
Because both the arm DOFs and the sprawl DOF should reach the
extreme simultaneously for effective vertical and lateral climbing
motions, the arm length uL is set as
uL ¼ ln þ l1 cosð2pt=tp ðhm Om ÞÞ
þ ðl22 l21 sin2 ð2pt=tp ðhm Om ÞÞ1=2 (14)
first paragraph of Sec. 3. The right arm has a mechanism symmet- our work was also designed to perform lateral motion, so the
rical to that of the left arm with respect to the sagittal plane of the passive claw was no longer a feasible solution. Therefore, two
robot. For the arm sprawl DOF (hm ), the rail of the slider (i.e., the attachment/detachment-active claws on each hand were adopted,
ground link of the four-bar linkage) is rotated by the sprawl motor and the claws were driven by a servo motor through a four-bar
through a shaft coupler, a worm and worm gear pair, and a pulley- linkage mechanism, as shown in Fig. 6(c), for two purposes: To
and-belt system. Note that the worm gears of the two arms are amplify the torque for attachment/detachment and to use the link-
driven by the same worm, so they have synchronized and opposite age mechanism to support the body weight, avoiding passing the
rotations, as designed in the model. load through the small servo motors. In addition, as shown in
The mapping from the left-arm motor, the right-arm motor, and Fig. 6(c), a perforated plastic sheet was used as the wall material
the sprawl motor, ð/L ; /R ; /S Þ, to the model inputs ðuL ; uR ; hm Þ for the claw to attach and detach to the wall as well as to preserve
can then be quantitatively formulated based on the mechanism the rotational freedom of the hand with respect to the wall.
details as shown in Fig. 6(a). The arm sprawl angle (hm ) is a func- Figure 7 shows the photos of the robot, and its specifications
tion of /S are listed in Table 1. The robot has a real-time embedded control
system (sbRIO-9602, National Instruments, Austin, TX). The
h_ m ¼ NS /_ S (15) left-arm, right-arm, and sprawl motors are brushed DC motors
(IG-36PGM TYPE1, Shayang, Taiwan) with encoders (HS-302-
where NS is the summation of the gear ratio of the motor gearbox, 512P-3A, Honest Sensor Corp., Taiwan), and the motors for claw
the worm and worm gear pair, and the pulley-and-belt system. motion are servomotors (HS-645MG, Hitec RCD, Poway, CA).
In contrast, the left-arm length (uL ) is a function of both /S and Hall-effect sensors (SS443A, Honeywell, Morris Plains, NJ) were
/L . The former one links to the uL by hm , as shown in Eq. (14), utilized for the initial configuration calibration of the arm with
and the latter one links to the uL in Eq. (14) by tp ¼ 2pN=/_ L . The respect to the robot’s body.
symbol N is the rotation speed ratio from the motor to the crank
of the four-bar linkage, and it is determined by the summation of
the gear ratio of the motor gearbox and the bevel gear pair. 5 Experiment Evaluation
The attachment/detachment mechanism of the hand to the wall The development of the model and the robot is tightly coupled.
is also an important issue to address. The hand of the model was On the one hand, the model was utilized to analyze and predict
assumed to have a rigid but rotatable contact to the wall, and in the dynamic behavior of the robot. On the other hand, the robot
the previous design, this was achieved by using passive claws to was also utilized to evaluate the effectiveness of the model. Most
engage the carpet wall [9]; however, the passive claw was only of the parameters (such as mass, inertia, and geometrical dimen-
functional when the robot climbed up because its attachment/ sions) of the model and robot were easy to map. The actuation
detachment mechanism was based on the unsymmetrical period tp selected for experimental evaluation was 1, 1.5, and 2 s.
“hooklike” design as shown in Fig. 6(b). In contrast, the robot in When the actuation period of the robot increased beyond 2 s, the
motion of the robot gradually changed from dynamic behavior to swing motion of the robot also deteriorated the engagement qual-
quasi-static behavior. The resistant force of the model was deter- ity of the hand to the wall, and the claw often slid on the wall
mined based on the vertical-climbing behaviors of the model and before it could firmly attach to the wall. This phenomenon was
the robot. The trajectories of the model with different resistant observed when the robot climbed with the settings Om ¼ 0 (i.e.,
forces were generated and matched to the robot’s trajectory. the vertical segments of the COM trajectories), and this phenom-
Because the resistant force was designed to be applied to the enon was severe when the robot climbed with the settings Om ¼ 5
swing direction, the model with the least-squared trajectory error in which the robot could not climb up but maintained the swing at
to the robot trajectory in the lateral direction was selected as the the same position.
correct model setting, which yielded the resultant Coulomb fric- Figure 9 shows the COM trajectories of the two-arm model (a)
tion force F ¼ 2:5 (N) and the coefficient of the resultant damping and the robot (b) with three different actuation periods, tp ¼ 2,
force C ¼ 17:5. 1:5, and 1s. The three experiments were all conducted in eight
Figure 8 shows the COM trajectories of the two-arm model (a) total steps with the settings Om ¼ 5 and Am ¼ 0 . When the
and the robot (b) with different offset angles, Om ¼ 5, 0, and period decreased, the robot COM trajectories of the model and the
5deg. Three experiments were all conducted in eight total steps robot become sharper. This phenomenon resulted from the fact
with the settings T ¼ 2 and Am ¼ 0 . The robot motion trajectory that the arm motion was faster than the swing dynamics of the
was computed based on the sequential snapshots taken by a sta- model, so the former one dominated the COM trajectory, which
tionary HD camcorder (HDR-SR11, Sony) viewing the wall pulled the robot toward the engaged hand. Note that though the
where the robot climbed (i.e., “top view” of the robot). The robot zig–zag COM trajectories have similar sizes, because the actua-
showed the same motion trend as the model predicted. When the tion periods were different, the speed of the robot increased when
swing motion increased, the climbing speed decreased because the period decreased. The robot with tp ¼ 1 had a speed of about
the vertical displacement between the engaged hand positions in 0.16 m/s, which is twice as the speed of the robot with tp ¼ 2. The
consecutive swing steps decreased. The robot with Om ¼ 5 had speed of the robot was 7% faster than the model prediction of
the smallest swing motion, and its climbing speed was about 0.15 m/s.
0.087 m/s, 6% slower than the model prediction of 0.093 m/s. Figure 10 shows the COM trajectory of the robot with three
When Om ¼ 0, the swing motion of the model increased, and the different combinations of the swing amplitudes (Am ) and the
speed decreased to 0.062 m/s, 20% slower than the model predic- offset angles (Om ), Om ¼ 5; Am ¼ 10, Om ¼ 10; Am ¼ 15, and
tion of 0.078 m/s. The discrepancy between the model and the Om ¼ 15; Am ¼ 20. Unlike the results shown in Figures 8 and 9
robot increased because, empirically, we found that the large where the arm sprawl angle hm of the robot was not varied, the
Fig. 6 The detailed CAD drawings of the robot arm (a) and the
claw (c), and (b) the CAD drawing of the passive claw utilized in
Ref. [9]
Acknowledgment
The authors would like to thank the undergraduate students of
the Bio-inspired Robotics Laboratory for their help in building the
prototype of the robot.
This work was supported by the National Science Council
(NSC), Taiwan, under Contract Nos. NSC 101-2815-C-002-103-
E, NSC 102-2815-C-002-074-E, and NSC 102-2221-E-002-214-
Fig. 9 The COM trajectories of the two-arm model (a) and the MY3.
robot (b) with three different actuation periods (tp )
Nomenclature
Am ¼ swing amplitude of the sprawl DOF
C ¼ coefficient of the resultant damping force acting on
the model COM
F ¼ resultant Coulomb friction acting on the model
COM
g ¼ gravity constant
h ¼ relative position vector between the two hands at
hand switching
I ¼ moment of inertia of the two-arm model, and
I ¼ mR2g , where Rg is the radius of gyration
l1 , l2 , ln ¼ geometrical parameters of the arm mechanism
m ¼ mass of the two-arm model
Fig. 10 The COM trajectories of the two-arm model (a) and the
N ¼ gear ratio between the motor rotation and the arm
robot (b) with three different combinations of the offset angles sprawl motion
(Om ) and the swing amplitudes (Am ) NS ¼ gear ratio between the motor rotation and the arm
crank rotation
Om ¼ offset angle of the sprawl DOF
viscous damping (C) acting on the model COM have very similar ri ¼ distance between the hand and the COM, and
effects on the model dynamics. When the values of these two i ¼ R or L indicates right or left
terms increase, the model has less swing motion and faster climb- t ¼ time
ing speed. (iii) The swing amplitude (Am ) has a critical effect on T, V ¼ kinetic energy and potential energy of the two-arm
the motion direction of the model. When the swing amplitude model
increases, the model has a more lateral climbing motion. (iv) The tp ¼ actuation period of the arm and sprawl DOFs
offset angle (Om ) has a critical effect on the motion speed of the ui ¼ arm length of the two-arm model, and i ¼ R or L
model. When the offset angle increases, the model has a slower indicates right or left
climbing speed. hb ¼ body orientation of the two-arm model with respect
The robot was then built and controlled based on the findings of to the inertia frame
the model dynamics. Three motors were installed to provide arm hi ¼ orientation configuration of the COM with respect
stretch/retract and sprawl motions. The experimental results of the to the hand, and i ¼ R or L indicates right or left
robot reveal that the climbing speed of the robot decreases when hm ¼ arm sprawl angle
the swing magnitude increases, which was the same trend in the wi ¼ angle included by the ui and the ri vectors
model. In addition, the large swing of the robot may also result in v ¼ climbing speed, including lateral and vertical
the slip behavior when the hands try to engage to the wall. When components ðvx ; vy Þ
the arm sprawl motion was introduced, the robot could indeed per- /m ¼ offset angle between the sprawl DOF and the arm
form a lateral climbing motion, as predicted by the model. The length DOF
qualitative behaviors between the model and the robot match quite /L ; /R ; /S ¼ rotation of the left-arm motor, the right-arm motor,
well, and this further suggests that the behavior development of and the sprawl motor
the robot can indeed be explored and evaluated using a simple ða; aÞ ¼ geometrical parameters defining the relative position
reduced-order model in the simulation environment, which of the shoulder joint (Si ) and the COM