Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
Hitoshi Maekawa
Abstract
A new torque contro. methoi Tor DC-servo motors based
on voltage control is proposed and investigated. Through
analyzing the torque control system consisting of DCservo motor, reduction gear and torque sensor, it is
shown that torque control by voltage control is feasible. It
is also possible to eliminate the static error of the output
torque and the interference of the disturbance torque
such as the friction at the reduction gear.
According to the analysis, a prototype servo driver is
developed. Since only the voltage control capability is
needed for the servo driver, the volume and mass ofthe
developed servo driver are around 30% of the
conventional values. Through experiments using the
developed servo driver, it is conjrmed that accurate
torque control isfeasible by the proposed method,
1. Introduction
In order to achieve delicate motion by a mechanical
system such as grasping an object by fingers, contacting a
surface by a manipulator with desired force and so on,
force-torque control is indispensable. On the other hand, a
compact and light servo driver is needed for the
integration of the mechanical system providing many
degrees of freedom.
e, = R,i,
+ K,S,
K,im = I,S,
+ Z,
(1)
(2)
34 1
tg
a, and
e,(4
e,
r,(SI[ .;o(s)
- r , (41
(9)
+ '5,
(5)
Output torque
Next, considering the model of the load as a massdamper-spring system for general situations, the transfer
function of the load T,( S ) is given by:
'0
Desired
output
torque
TFque sensor
'0
Servo driver
DC-servo motor
(15)
torque
rd
342
H(0) =[l+KJT,,(0)]G(O)+KmKgKJT,(O)+RmKs
(18)
r,(s)
+-KiS
K,s + K,
--
T,(s)= K,
tor
U
T r i F o u 1n t end T r i r i o y t end
J-U-L
- -
Counter # 1, #2 output
(PWM signal)
343
. .
P W M rate (voltage)
2
28W
A. Servo driver
B. Power supply
A. Servo driver
B. Transformer
344
4. Experimental results
The proposed torque control based on voltage control is
experimentally evaluated using the developed prototype
servo driver. The experimental setup shown in Fig. 6
consists of a DC-servo motor with harmonic drive
(Harmonic Drive Systems HT-8-6006), torque sensor
(Sinmei Electric SM60-KA-TB) and prototype servo
driver. The PI-gain is set as:
1 y P = 5 2 v ~ m , K, = ~ . ~ x ~ o v / N ~ s
The static characteristics of the torque control system are
first confhned while setting the desired output torque and
measuring the corresponding output torque. Fig. 7 shows
the experimental results when the P-feedback and the PIfeedback is employed respectively.
5. Conclusion
,Desired torque
2 1.0 -
!
!
!
*
Y
20.5
CI
!
!
!
!
PI-feedback
P -feedback
0 -
+0.1s 4
Time
345
346
References
Imamura, N., M. Kaneko, K. Yokoi, and K. Tanie,
Development of a Two-Fingered Robot Hand with
Compliance Adjustment Capability, Proc. of 1990
Japan4J.S.A. Symp. on Flexible Automation, pp.
997-1004, 1990.
Maekawa, H., K. Yokoi, K. Tanie, M. Kaneko, N.
Kimura, and N. Imamura, Development of a ThreeFingered Robot Hand with Stiffness Control
Capability, Mecliatronics, vol. 2, no. 5, pp. 483-494,
1992.
Nakao, M., K. Ohnishi, and K. Miyachi, A Robust
Decentralized Joint Control Based on Interference
Estimation, Proc. of IEEE Int. Conf. on Robotics and
Automation, pp. 326-331, 1987.
Tokunaga, Y., T. Tsubouchi, and S. Yuta, A P W M
Motor Control Circuit with Low Power Consumption
for a Middle Size Robot, Proc. of Annual Conf. of
Robotics Society of Japan, pp. 669-670, 1997 (in
Japanese).
Watanabe, G., T. Tsubouchi, and S. Yuta, Feed
Forward Current Control on DC Motor by PWM
Drive Method, Proc. of Annual Cod. of Robotics
Society of Japan, pp. 667-668, 1997 (in Japanese).
Harmonic Drive Systems, DC Servo Actuator Super
Mini Type RH Series (Technical manual), no. 9507OR-RH (in Japanese).