• 沒有找到結果。

Study on the characteristics of a homemade differential-velocity-type compliant joint for robotic manipulators

N/A
N/A
Protected

Academic year: 2021

Share "Study on the characteristics of a homemade differential-velocity-type compliant joint for robotic manipulators"

Copied!
16
0
0

加載中.... (立即查看全文)

全文

(1)

Advances in Mechanical Engineering 2015, Vol. 7(9) 1–16

Ó The Author(s) 2015 DOI: 10.1177/1687814015603668 aime.sagepub.com

Study on the characteristics of a

homemade differential-velocity–type

compliant joint for robotic

manipulators

Jwu-Sheng Hu

1

, Cheng-Hua Wu

1

, Yi-Jeng Tsai

2

and Chung-Hsien Kuo

3

Abstract

Design of a new differential-velocity–type compliant joint with two motors is proposed for robotic manipulators. The speed/output torque of the differential-velocity–type joint is synthesized by controlling the differential speeds of a pair of actuators. Descriptions of the design concept, theoretical analysis, and the experiments are presented in this article. The experimental results showed that (1) the stiffness of the differential-velocity–type joint can be regulated by changing the speeds of both motors, (2) the differential-velocity–type joint actually reduced 7.9%–15.7% time compared with the single-drive joint when performing five cycles of reciprocation, and (3) a new design of delta-type robot with differential-velocity–type driving modules was developed for verification. The experimental results showed that the differential-velo-city–type delta robot can perform flexible assembly operations within a 0.028-mm tolerance.

Keywords

Compliant joint, robot, differential velocity

Date received: 15 December 2014; accepted: 2 August 2015

Academic Editor: Seiichiro Katsura

Introduction

While robots deal with tasks, not only the precision positioning of robot manipulators but also the safety issue of the human–machine interaction should be con-sidered. Concerning on the safety issues of preventing human operators or objects from damages by the robotic manipulators, there have been more and more researches and developments focused on the compliance issues of manipulators recently. To control the contact force of the robotic manipulators, elastic actuators with a motor and a spring were designed.1,2 Researches on using variable stiffness actuators with two motors and one elastic element have also been carried out in previ-ous studies.3–9 However, because the performance of the elastic element is similar to the function of a low-pass filter, the bandwidth of the elastic actuator is

limited. Therefore, some designs of the joints driven by dual actuators and a gear transmission mechanism have been studied for robotic manipulator. A dual actuator unit (DAU) has been studied in Kim et al.,10,11 where the position control of the DAU is adopted by a high-torque and low-speed motor, and the stiffness of the

1

Department of Electrical Engineering, National Chiao Tung University, Hsinchu, Taiwan, R.O.C

2

Mechanical and Systems Research Laboratories, Industrial Technology Research Institute, Hsinchu, Taiwan, R.O.C

3

Department of Electrical Engineering, National Taiwan University of Science and Technology, Taipei, Taiwan, R.O.C

Corresponding author:

Cheng-Hua Wu, Department of Electrical Engineering, National Chiao Tung University, 300 Hsinchu, Taiwan, R.O.C.

Email: [email protected]

Creative Commons CC-BY: This article is distributed under the terms of the Creative Commons Attribution 3.0 License (http://www.creativecommons.org/licenses/by/3.0/) which permits any use, reproduction and distribution of the work without

(2)

DAU is modulated by a low-torque and high-speed motor. When an unexpected collision occur, the joint stiffness of DAU could be adjusted rapidly by the low-torque and high-speed motor. Similarly, a hybrid vari-able stiffness actuator (HVSA) with two operation modes was developed in Kim and Song.12 One mode was a rigid mode as a conventional stiff joint. The other mode can provide a wide range of stiffness and rapid responses according to the change in the stiffness under varying loads. Also, another type of variable stiffness actuator (VSA) by controlling the ball screw mechan-ism to vary the stiffness of actuator was discussed in Sardellitti et al.13The effectiveness of the controller in terms of tracking performance and stiffness adjustment was verified. Moreover, in addition to control the stiff-ness of actuators, a dual motor system using a planetary gear (DuPG) was developed to improve the speed– torque performance in Lee and Choi.14 The DuPG combined two motors with one planetary gear, in which one motor was designed for high speed and the other for high torque. The DuPG could generate high speed or high torque according to the environmental or driv-ing conditions.

Referring to these related researches, two important issues of designing the compliant joint of robotic manipulators can be concluded. The first is that the stiffness of the joint should be variable, that is, the tor-que of the joint can be adjusted at the same angular speed. The other is that the output performance of the joint is expected to be enhanced, especially when the joint is designed with multi-actuators. Due to the two issues, a differential-velocity–type (DVT) joint was pro-posed to perform the variable stiffness feature and high-speed reciprocation ability. Furthermore, the

DVT joint was implemented to delta robot to perform rapid reciprocation and flexible assembly in this study.

This article is organized as follows: the design con-cept of the DVT joint is described in section ‘‘Design concept of the DVT joint,’’ the theoretical output per-formance of the DVT joint is discussed in section ‘‘Theoretical analysis,’’ the experiments to verify the performance of the DVT joint are discussed in section ‘‘Experiments and discussions on the DVT joint,’’ the DVT delta robot constructed with three DVT driving modules is designed for a practical application of flex-ible assembly in section ‘‘Delta robot with the DVT joints,’’ and the summary and conclusions are given in section ‘‘Conclusion.’’

Design concept of the DVT joint

The DVT joint presented in this article is a 1-degree-of-freedom joint which is driven by two motors. The major components of the DVT joint are shown in Figure 1. Two driving sets are adopted to drive the DVT joint. Driving set 1 consists of encoder 1, motor 1, reducer 1, and bevel gear 1 mounted on housing 1. The components of driving set 2 are the same as driving set 1. Housings 1 and 2 are pivoted to each other through shaft. In addition, differential velocity gear is also pivoted through shaft and is engaged with bevel gears 1 and 2 of driving sets 1 and 2, respectively. Thus, driving set 2 relatively rotates about driving set 1. In this design, bevel gears 1 and 2 have the same gear modulus and number of teeth. Differential velocity gear has twice the number of teeth and the same gear modu-lus of bevel gear 1.

(3)

The main components used in this design are listed in Table 1. The other structures are manufactured using aluminum alloy A6061-T6. The total weight of the DVT joint is 1.89 kg. Figure 2 shows the characteristic curves of the motor sets from the manufacturer. These curves are estimated under a maximum voltage of 32 V and a maximum current of 7.2 A. The relation between torque and speed can be formulated by equation (1), where v is the speed of the driving set and T is the tor-que of the driving set

v=  23:47T + 169 ð1Þ

As shown in Figure 1, link 1 connects to driving set 1 and pivots on the differential velocity gear. A link 2 connects to driving set 2 and pivots on the differential velocity gear. According to the rotating directions of the two driving sets, the DVT joint can be operated in two modes, output enhanced mode and differential velocity mode. When the two driving sets rotate in the same direction as shown in Figure 3(a), the joint is operated in the differential velocity mode. Link 1 rotates about the axis of the differential velocity gear with the speed which is the difference between the speeds of the two driving sets. The speed of the DVT can be stated by equation (2)

vj= v1 v2 ð2Þ

Table 1. Component specification of the DVT joint.

Component Specification

Motors 1 and 2 Faulhaber 2657W024CR; maximum efficiency: 85% Reducers 1 and 2 Faulhaber 30/1, 43:1; maximum efficiency: 70%

Encoders 1 and 2 Faulhaber IE2-512

Encoder 3 MTL, MES-12-2048; square wave/incremental

Bevel gears 1 and 2 KHK, SBS1.5-2040L

Differential velocity gear KHK, SBS1.5-4020R

DVT: differential-velocity–type.

Figure 2. Main characteristic curves of the motor set of Faulhaber 2657W024CR + 30/1, 43:1.

Figure 3. Two operation modes of the DVT joint: (a) differential velocity mode and (b) output enhanced mode.

(4)

where v1is the speed of driving set 1, v2is the speed of driving set 2, and vj is the speed of the DVT joint. When the two driving sets rotate in the opposite direc-tion as shown in Figure 3(b), the joint is operated in the output enhanced mode. Link 1 rotates about the axis of the differential velocity gear with the speed which is the sum of the speeds of the two driving sets. Moreover, the torque of the DVT joint is the sum of the torques of the two driving sets

vj= v1+ v2 ð3Þ

In this article, the characteristics of the DVT joint in the differential velocity mode were studied. Furthermore, a DVT delta robot was designed by implementing the special features of the DVT joint.

Theoretical analysis

Since the speed/output torque of the DVT joint can be regulated by controlling the speeds of the two driving sets in the differential velocity mode, it is advantageous to perform a motion with different stiffness or different motions with the same stiffness. The relation between the speed/output torque of the DVT joint and the speeds of the two driving sets is analyzed in the following.

In differential velocity mode, both motors of the DVT joint are operated by velocity control. The speed of the DVT joint is equal to the difference between the speeds of the two driving sets. For example, if the speed of driving set 1 is higher than driving set 2, the DVT joint will rotate clockwise, and the speed is stated by equation (4)

vj= v1(x) v2(y)= x y.0 as x.y ð4Þ where vi(q) is driving set i rotating with the speed of q (r/min).

The output torque of the DVT joint is different from that of the traditional joint and is discussed in the fol-lowing. If an external torque is applied to make the DVT joint from rotation to stationary, the external tor-que should be large enough to slow down the speed of the higher speed motor. The current of the higher speed motor will increase to the maximum tolerant current depending on the capacity of the motor. It means that the external torque should be larger than the maximum output torque of driving set 1 as stated in equation (5)

Tjext T1(x).0) v1(x)! v1(x) ð5Þ

where Tjext is the external torque applied to the DVT joint; Ti(q) is the output torque of driving set i that rotates with the speed of q (r/min); v1(x)is the speed of

driving set 1 that starts to decrease from x (r/min).

In other words, the output torque of the DVT joint which is operated with the differential velocity mode equals the maximum output torque of the higher speed driving set at the desired speed as stated in equation (6)

Tj(xy)= T1(x), as v1(x)! v1(x) ð6Þ

where Tj(xy)is the output torque of the DVT joint that rotates with the speed of (x 2 y) (r/min).

Until the speed of the higher speed driving set decreases to be equal to the speed of the lower speed one, the DVT joint will remain stationary as stated in equation (7). In this status, the external torque is equal to the maximum output torque of driving set 1 where the speeds of both driving sets are the same as stated in equation (8)

vj= v1(xD) v2(y)= 0, as x D = y ð7Þ Tjext T1(xD = y)= 0) v1(x)! v1(xD)= v2(y) ð8Þ Therefore, the output torque of the DVT joint can be considered as the torque against the external torque as stated in equation (9)

Tj(0)= Tjext= T1(xD = y)= T2(y) ð9Þ Due to the characteristic of motor, the motor gener-ates higher torque with lower speed at the saturated output power. Thus, the DVT joint provides higher output torque when the speed of the lower speed driv-ing set is lower as stated in equation (10)

v1(xD = y).v1(xD = z)) T1(xD = z).T1(xD = y) ð10Þ According to equations (6) and (9), the output tor-que of the DVT joint depends on the speed of the higher speed driving set when the DVT joint rotates but depends on the speed of the lower speed driving set when the DVT joint is at stationary status. Thus, the output torque of the DVT joint operated in differential velocity mode can be expressed by equations (11) and (12)

Tj(xy)= T1(x), as v1(x).v2(y) ð11Þ Tj(0)= T1(xD)= T2(y), as v1(xD)= v2(y) ð12Þ Since the speed of the DVT joint equals the differ-ence between the speeds of the two driving sets, the DVT joint can rotate with the same speed but can gen-erate different output torques. Moreover, the DVT joint can generate the same output torque with differ-ent speeds. Three cases are given to be an illustration. Comparing cases A and B, the DVT joint rotates with the same speed but generates different output torques. Comparing cases B and C, the DVT joint generates the same output torque with different speeds:

(5)

Case A vj= v1(350) v2(300)= 50 Tj(350300)= T1(350) Case B vj= v1(100) v2(50)= 50 Tj(10050)= T1(100) Case C vj= v1(200D) v2(100)= 0 Tj(0)= T1(200D)= T1(100)= T2(100)

Moreover, an external torque is applied to rotate the DVT joint clockwise from stationary when the speed of driving set 1 equals the speed of driving set 2 as stated in equation (13)

vj= v1(x) v2(x)= vj(0 + ) ð13Þ

where vj(0 + )is the speed of the DVT joint that starts to increase from 0 r/min.

The external torque should be large enough to slow down the speed of driving set 2 as stated in equation (14). It means that the external torque should be larger than the output torque of driving set 2

Tjext T2(x)! 0 + ) v2! v2(x) ð14Þ

Therefore, the output torque of the DVT joint that rotates at the speed of 0 r/min is equal to the output tor-que of driving set 2 at the current speed

Tj(0)= T2(x), as v1(x)= v2(x) ð15Þ Due to the characteristic of motor, the motor gener-ates higher torque with lower speed at the saturated output power. The output torque of the DVT joint at stationary can be regulated by adjusting the speeds of both the driving sets simultaneously. For example, the output torque of the DVT joint increases when the speeds of the two motors decrease simultaneously and vice versa.

According to equations (11), (12), and (15), the out-put torque of the DVT joint in the differential velocity mode can be expressed by equation (16)

Tj= T1(v1)3 u vð 1 v2Þ T2(v2)3 u vð 2 v1Þ , where u vi vj   = 1 as vi vj 0 as vi\vj   ð16Þ Based on the derivation, the theoretical speed– torque curves of the DVT joint are shown in Figure 4. The vertical line (red line) denotes the speed of the DVT versus constant output torque. The horizontal line (black dash line) denotes the output torque versus constant output speed. The oblique line (blue line) denotes the torque versus the speed of motor set 1 (higher speed motor set) with constant speed of motor set 2 (lower speed motor set). Point a (169, 0) denotes that the DVT joint is operated at the speed of 169 r/min when the speeds of the two motor sets are 169 and 0 r/min, respectively. On this chart, the overall speed versus output torque of the DVT joint can be found. Furthermore, some control strategy for safety

(6)

issue could be generated from this chart. For example, there are two robot arms which are constructed with the DVT joint and single-motor-driven (SD) joint. Both of them are operated at the speed of 31 r/min. The operation points of these two robot arms can be represented as points b and c, respectively. When an object appears in the desired trajectory of the robot arms, the robot arms will be blocked by the object after hitting it. According to the characteristics of motor, the robot arm with SD joint will change its status to point c# and may generate a torque up to 7.2 N m. The robot arm with the DVT joint will change its status to point b# and may generate a torque up to 4.26 N m. It can be observed that the potential damage from the robot arm with the DVT joint is less than that from the robot arm with SD joint.

Besides the feature on variable stiffness, the DVT joint can achieve rapid reciprocation by accelerating the lower speed motor set and decelerating the higher speed motor simultaneously. Figure 5 shows that there exists dead time interval when the SD joint performs recipro-cation but no dead time interval in the reciprorecipro-cation of the DVT joint. Thus, the damage from collision men-tioned in the previous paragraph can be further miti-gated by these control strategies. The status of the

robot arm with the DVT joint will change to point b$. The robot arm with the DVT joint will stop by spend-ing half the time. Especially, the output torque is fur-ther mitigated down to 3.6 N m.

Also, when the robot arm contacts the object, there exists an angular displacement in transient. Thus, the equivalent stiffness of the DVT joint could be defined by equation (17)

Kj= Tj Duj

ð17Þ

where Duj is the transient angular displacement of the DVT joint.

Experiments and discussions on the DVT

joint

Control system architecture

To verify the characteristics of the DVT joint, a control system architecture which is shown in Figure 6 was established. A PC-based motion controller was devel-oped to control the DVT joint. The motors of the DVT joint are controlled by Faulhaber motion controller MCDC 3003C. MCDC 3003C communicated to the PC-based motion controller via a controller area net-work (CAN) bus interface card, PCM-CAN200P-D. With dsPIC digital signal controller, encoder 3 is used to send the absolute angular displacement of the DVT joint back to the PC-based motion controller. Then, the relative speed commands of the two motors are computed with the PC-based motion controller based on the speed or stiffness requirements. In order to mea-sure the torque of the DVT joint, a force gauge, FG-5000A, is employed to measure the contact force when the free end of the DVT joint rotates and contacts the force gauge. Then, the equivalent torque of the DVT joint can be determined.

Figure 5. Reciprocation ability comparison of the DVT joint with the SD joint.

(7)

Experiment on variable stiffness

To verify the characteristics of variable stiffness, the experiment on the differential velocity mode is shown in Figure 7. One link of the DVT joint is fixed, and the free end of the DVT joint rotates to point A until con-tacting the force gauge.

Then, the contact force can be measured by FG-5000A. Therefore, the torque of the DVT joint can be estimated where the DVT joint is placed horizontally to eliminate the gravity effect.

The speeds of each motor are commanded by the PC-based motion controller. When the speed of motor set 1 is 116.28 r/min (the speed of motor 1 is 5000 r/ min), and the speed of motor set 2 is 104.65 r/min (the speed of motor 2 is 4500 r/min), the DVT joint will rotate counterclockwise with the speed of 11.63 r/min. Figure 8 shows the motor speeds with respect to time during the contacting process. When the DVT joint contacts the force gauge, the speed of motor 1 descends to the speed of motor 2. When both speeds of the two driving motors are in the steady state, that is, after 3 s, the force gauge can measure the torque generated by the DVT joint.

There are several combinations of motors’ speeds to be tested under the conditions with which the speeds of motor set 1 and motor set 2 are controlled such as 11.63, 23.26, 34.88, 46.51, 58.14, 69.77, 81.40, 93.02, 104.65, and 116.28 r/min. The torque of the DVT joint is estimated with different combinations of the motor speeds. Figure 9 shows the torque generated by the DVT joint versus the motor speeds. The A–A# profile

in Figure 9 is drawn as Figure 10. It shows that the tor-que of the DVT joint decreases as the motor speeds increase when the DVT joint remains stationary. The torque of the DVT joint varies from 0.06 to 7.8 N m as the motor sets speed up from 11.63 to 116.28 r/min. In other words, the stiffness of the DVT joint can be regu-lated by changing the speed of both motors. Figure 11 is the A–B profile in Figure 9. The torque of the DVT joint decreases slightly as the speed of motor 1 increases. It shows that the DVT joint can generate almost the same torque with different joint speeds.

Experiment on reciprocation ability

For the reciprocation ability, as shown in Figure 5, the DVT joint has no dead time interval, but the SD joint must stop and change the operating direction to per-form reciprocation. To prove this idea, a series of experiments are tested. In these tests, one of the motor sets of the DVT joint is locked by a mechanical blocker to simulate the behavior of the SD joint. The other motor is driven to rotate the DVT joint from 45° to 135° with a positive speed and then reversing with a negative speed for five cycles. Also, the DVT joint is laid horizontally, so that the gravity effect can be ignored. For the reciprocation ability of the DVT joint, the DVT joint rotates from 45° to 135° with the desired speeds as listed in Table 2. The DVT joint is reversed from 135° to 45° by exchanging the speeds of the two motors. The time histories of the joint angle in these tests are plotted in Figure 12, and the results are listed in Table 3. From these results, an index, time saving percentage (Tsave), is defined as stated in equation (18)

Tsave= ðTSD TDVTÞ 3 100 TSD

 

% ð18Þ

where TSDis the total time spent using the SD joint and TDVTis the total time spent using the DVT joint.

The percentage of time saving is further plotted as shown in Figure 13. Figure 13 shows that the DVT joint Figure 7. Experiment setup of variable stiffness.

(8)

saves 7.9%–15.7% time compared with the SD joint. It is because the motor has to spend more time to stop and reverse at high speed than at low speed under the same acceleration or deceleration capability. There are two motors in the DVT joint to achieve the accelerating or decelerating task simultaneously. So, the effect is more obvious at high speed. So, it can be concluded that the DVT joint has better reciprocation ability than the SD joint, especially at high-speed condition.

Delta robot with the DVT joints

Delta robots are used in food industry widely since the feature of high-speed reciprocation. A soft delta robot was developed to manipulate onions and artichokes with the customized vacuum suction cup.15But it is not popular to implement on other processes, for example, inserting parts into metal materials. In order to demon-strate the features of the DVT joint on compliance and high-speed reciprocation, a new type of delta robot constructed with the DVT joints, called as DVT delta robot, is designed to perform the flexible assembly as shown in Figure 14. To reduce the rotating inertia, a new type of the DVT joint is also designed as shown in Figure 15. Low-cost DC motors are used in the new driving sets. The specification and parameters of the motor and the encoder where some are provided by the manufacturer and some are identified from experiments are listed in Table 4. Aluminum alloy is used to con-struct most parts of the delta robot, and the carbon-fiber rods are used as the lower limbs for lightweight Figure 9. Torque of the DVT joint versus speeds of motors 1 and 2.

Figure 10. Torque of the DVT joint versus the speeds of motors 1 and 2 when the DVT joint remains stationary.

Figure 11. Torque of the DVT joint versus the speed of motor 1 when the speed of motor 2 is 500 r/min.

(9)

design. The maximum payload of the DVT delta robot is up to 0.7 kg.

In order to control the DVT delta robot, the kine-matics is necessary to derive first. The coordinates of

the DVT delta robot are defined as shown in Figure 16, where ui is the angular displacement of the DVT joint and OP(x, y, z) is the end point of the DVT delta robot. The angles between the upper limbs and the base plat-form can be calculated by equation (19)

ui= sin1 ci ffiffiffiffiffiffiffiffiffiffiffiffiffiffiffiffi a2 i + b2i p !  tan1 ai bi  ð19Þ

where ai= 2zLa, bi= 2La(x cos ((1=2) + (2(i 1)=3)) p+ y sin ((1=2) + (2(i 1)=3))p +r  R), and ci= x2 + y2+ (r + R)2+ 2x(r R)cos((1=2)+(2(i  1)=3))p + 2y(r R)sin((1=2) +(2(i  1)=3))p +z2+ L2

a L2b Also, the working space should be analyzed consid-ering the interference angle of the connection joint. In this design, the interference angle is 45°. Thus, the Table 2. Motor set speeds of the reciprocation tests.

Case Single-motor-driven joint DVT joint

Speed of motor set (r/min) Speed of motor set 1 (r/min) Speed of motor set 2 (r/min)

1 11.63 11.63 23.26

2 23.26 23.26 46.51

3 34.88 34.88 69.78

4 46.51 46.51 93.04

DVT: differential velocity–type.

Figure 12. Time histories of the reciprocation tests: (a) case 1, (b) case 2, (c) case 3, and (d) case 4.

Table 3. Time spent for five cycles of the reciprocation tests. Case Time spent by

one-motor-driven joint (s)

Time spent by the DVT joint (s) 1 14.28 13.14 2 8.28 7.35 3 5.79 5.04 4 4.95 4.17 DVT: differential velocity–type.

(10)

working space can be solved by iteration method with the geometric constraints of the interference angle of the connection joint. The working space is illustrated as shown in Figure 17 with the parameters of R = 0:23 m, r = 0:07 m, La= 0:26 m, and Lb= 0:48 m. From the simulation result, we can find that the workable radius is around 0.25–0.4 m. It is at least 25% enhancement than the design with ball-socket joint which is about 0.2 m.

The control architecture of the DVT delta robot is shown in Figure 18. Two types of micro-controller are used in this study. One is AVR which dominates the trajectory planning, inverse kinematics, the joint com-mand generation, and the stiffness regulation. The other is dsPIC which is used to control the velocity of motors of each DVT driving module. The velocity con-trol algorithm of each DVT driving module is shown in Figure 19. One of the motors in the DVT driving mod-ule is chosen to be the base motor whose velocity is set according to the stiffness requirement. For the stiffness of the DVT driving module, it is varied with the velo-city of the base motor.

Furthermore, the control gain effects on the velocity response are studied as shown in Figure 20. The results show that different control gains do not affect the velo-city response obviously. When an external force is applied on the output shaft, the control gain affects the velocity response violently as shown in Figure 21. The results show that high P gain restrains the variation of velocity. In other words, high P gain makes the driving module stiffer. Therefore, the compliance of the driving module is not only designed with base velocity but also with the control gains.

For practical application, such as pick-and-place, the vibration is sometime accompanied by high-speed reciprocation. To verify the capability of the DVT delta robot, a test standard for industrial robot is used in this study. The mobility of the DVT delta robot is tested with a trajectory where the end-effector is moving 25 Figure 13. Time saving percentage of the DVT joint versus

different joint speeds.

(11)

mm upward, moving 200 mm horizontally, moving 25 mm downward, and then moving back along the com-ing trajectory. In the movcom-ing progress, the vibration will be measured by a three-axis accelerometer. Figure 22 shows the time history of the vibration of the end-effector with different cycle times of 0.3 s, and the max-imum vibrations are listed in Table 5. For industrial applications, the highest standard of vibration of the end-effector is less than 0.5 G. In Figure 22, the maxi-mum vibration with cycle time is obviously unaccepta-ble. The vibration with cycle times higher than 0.5 s would be acceptable for the industrial application.

To demonstrate the capability of the flexible assem-bly, a set of standard workpieces made by Misumi Corporation is used to test. The standard workpieces are the locating pin of the model number R-FNNA5-P10-B15-L5 and the bushing of the model number JBHN10-6. The geometric tolerance of these two work-pieces are 20.005 to 20.014 mm and + 0.005 to + 0.014 mm, respectively. The assembly tolerance is 0.01–0.028 mm. The DVT delta robot holds the locat-ing pin to put in the bushlocat-ing as shown in Figure 23. The position histories of the end-effector are calculated from the information of the absolute encoders. Figure 24 shows the z-direction displacement of the center of the end-effector. It can be found that there are obvious forces generated when the pin is taken out from the bushing in the z-direction, and overshot occurred in the z-direction because of the compliance of the DVT driv-ing modules.

Figure 16. Coordinates of the DVT delta robot. Table 4. Specification and parameters of the motor and encoder used for the DVT delta robot.

Motor + reducer BLDC90 + 10:1 Nominal voltage 24 V

Nominal current 10 A Nominal speed 2000 r/min Armature inductance 0.0038 H Armature resistance 2.84 O Torque constant 0.0384 N m/A Equivalent moment of inertia 1.8791 3 1026kg m2 Equivalent viscosity 7.8821 3 1026N m s Back EMF constant 0.00365 V/r/min

Encoder Ku¨bler 8.F3663 4123.G422

DVT: differential velocity–type; EMF: electromotive force.

(12)

Figure 18. Control architecture of the DVT delta robot.

Figure 19. Simulation velocity control algorithm of the DVT driving module. L1 is the armature inductance of motor 1, R1 is the armature resistance of motor 1, Kt1 is the torque constant of motor 1, J(eq)1 is the equivalent moment of inertia of motor 1, b(eq)1 is the equivalent viscosity of motor 1, and kb1 is the back EMF constant of motor 1; the definitions of the parameters of motor 2 are the same.

(13)

Conclusion

In this study, the characteristics of the DVT joint in terms of using a differential velocity scheme are veri-fied. The speed/output torque of a DVT joint is modu-lated by differentiating the speed commands of a pair of actuators. Moreover, a delta-type robot is designed to implement the feature of the DVT joint. Three

conclusions are made as follows: (1) for the differential velocity mode, the stiffness of the DVT joint can be controlled in the range of 0.06–7 N m by changing the speeds of both the motors; (2) due to the reciprocation ability, the DVT joint can save 7.9%–15.7% time than the SD joint when performing five cycles of reciproca-tion; and (3) a new delta-type robot is designed to implement the compliant feature of the DVT joint. The experimental results showed that the flexible assembly operations within a 0.028-mm tolerance can be achieved by the new design. From the results, the DVT delta robot can be applied to high-precision mechanical assembly operations and some tasks which need high compliance. In the future work, the high-speed response of the DVT-based delta-type robot will be studied further.

Figure 20. Control gain effects on velocity response: (a) dual motor control system with Wd = 1 (s), Wd2 = 2 (s), Kp = 10, Ki = 5, and Kd = 0.1; (b) dual motor control system with Wd1 = 1 (s), Wd2 = 2 (s), Kp = 7, Ki = 5, and Kd = 0.1; (c) dual motor control system with Wd = 1 (s), Wd2 = 2 (s), Kp = 5, Ki = 5, and Kd = 0.1; and (d) dual motor control system with Wd1 = 1 (s), Wd2 = 2 (s), Kp = 7, Ki = 0.05, and Kd = 0.1.

Table 5. Vibration test of the end-effector.

Case Cycle time (s) Maximum vibration (G)

1 0.3 1.211

2 0.5 0.636

3 1.0 0.390

(14)

Figure 21. Control gain effects on velocity response with external force: (a) with external force = 0.05 N m, Kp = 0.1, Ki = 10, and Kd = 0.003; (b) with external force = 0.05 N m, Kp = 0.7, Ki = 10, and Kd = 0.003; and (c) with external force = 0.05 N m, Kp = 1.2, Ki = 10, and Kd = 0.003.

(15)

Acknowledgements

The authors are grateful to the anonymous referees for their helpful comments and suggestions to improve the presenta-tion of this article.

Declaration of conflicting interests

The author(s) declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.

Funding

The author(s) disclosed receipt of the following financial support for the research, authorship, and/or publication of this article: This work was financially supported by the Department of Industrial Technology, Ministry of Economy, Taiwan, R.O.C.

References

1. Pratt GA and Williamson MM. Series elastic actuators. In: Proceedings of the IEEE international conference on intelligent robots and systems, Pittsburgh, PA, 5–9 August 1995, pp.399–406. New York: IEEE.

2. Kong K, Bae J and Tomizuka M. Control of rotary series elastic actuator for ideal force-mode actuation in human–robot interaction applications. IEEE: ASME T Mech2009; 14: 105–118.

3. Tonietti G, Schiavi R and Bicchi A. Design and control of a variable stiffness actuator for safe and fast physical human/robot interaction. In: Proceedings of the 2005 IEEE international conference on robotics and automation, Barcelona, 18–22 April 2005, pp.526–531. New York: IEEE.

4. Huh S, Tonietti G and Bicchi A. Neural network based robust adaptive control for a variable stiffness actuator. In: Proceedings of the 16th Mediterranean conference on control and automation, Ajaccio, 25–27 June 2008, pp.1028–1034. New York: IEEE.

5. Ikegami Y, Nagai K, Loureiro RCV, et al. Design of redundant drive joint with adjustable stiffness and damp-ing mechanism to improve joint admittance. In: Proceed-ings of the 2009 IEEE 11th international conference on rehabilitation robotics, Kyoto, Japan, 23–26 June 2009, pp.202–210. New York: IEEE.

6. Nagai K, Shiigi Y, Ikegami Y, et al. Impedance control of redundant drive joints with double actuation. In: Pro-ceedings of the 2009 IEEE international conference on robotics and automation, Kobe, Japan, 12–17 May 2009, pp.1528–1534. New York: IEEE.

7. Wang RJ and Huang HP. Active variable stiffness elastic actuator: design and application for safe physical human-robot interaction. In: Proceedings of the 2010 IEEE international conference on robotics and biomi-metics, Tianjin, China, 14–18 December 2010, pp.1417– 1422. New York: IEEE.

8. Wang RJ and Huang HP. An active-passive variable stiffness elastic actuator for safety robot systems. In: Pro-ceedings of the 2010 IEEE international conference on robotics and systems, Taipei, Taiwan, 18–22 October 2010, pp.3664–3669. New York: IEEE.

9. Nagai K, Dake Y, Shiigi Y, et al. Design of redundant drive joints with double actuation using springs in the second actuator to avoid excessive active torques. In: Proceedings of the 2010 IEEE international conference on robotics and automation, Anchorage, AK, 3–7 May 2010, pp.805–812. New York: IEEE.

Figure 23. Experimental photograph of the flexible assembly.

(16)

10. Kim BS, Park JJ and Song JB. Double actuator unit with planetary gear train for a safe manipulator. In: Proceed-ings of the 2007 IEEE international conference on robotics and automation, Roma, 10–14 April 2007, pp.1146–1151. New York: IEEE.

11. Kim BS, Song JB and Park JJ. A serial-type dual actua-tor unit with planetary gear train: basic design and appli-cations. IEEE: ASME T Mech 2010; 15: 108–116. 12. Kim BS and Song JB. Design and control of a variable

stiffness actuator based on adjustable moment arms. IEEE T Robot2012; 28: 1145–1151.

13. Sardellitti I, Medrano-Cerda G, Tsagarakis NG, et al. A position and stiffness control strategy for variable stiff-ness actuators. In: Proceedings of the 2012 IEEE interna-tional conference on robotics and automation, Saint Paul, MN, 14–18 May 2012, pp.2785–2791. New York: IEEE. 14. Lee H and Choi Y. A new actuator system using

dual-motors and a planetary gear. IEEE: ASME T Mech 2012; 17: 192–197.

15. Morales R, Badesa FJ, Garcia-Aracil N, et al. Soft robotic manipulation of onions and artichokes in the food industry. Adv Mech Eng 2014; 6: 345291 (9 pp.).

數據

Figure 1. Components of the DVT joint.
Table 1. Component specification of the DVT joint.
Figure 4. Theoretical speed–torque curves of the DVT joint.
Figure 5. Reciprocation ability comparison of the DVT joint with the SD joint.
+7

參考文獻

相關文件

For pedagogical purposes, let us start consideration from a simple one-dimensional (1D) system, where electrons are confined to a chain parallel to the x axis. As it is well known

The observed small neutrino masses strongly suggest the presence of super heavy Majorana neutrinos N. Out-of-thermal equilibrium processes may be easily realized around the

incapable to extract any quantities from QCD, nor to tackle the most interesting physics, namely, the spontaneously chiral symmetry breaking and the color confinement.. 

(1) Determine a hypersurface on which matching condition is given.. (2) Determine a

• Formation of massive primordial stars as origin of objects in the early universe. • Supernova explosions might be visible to the most

The difference resulted from the co- existence of two kinds of words in Buddhist scriptures a foreign words in which di- syllabic words are dominant, and most of them are the

(Another example of close harmony is the four-bar unaccompanied vocal introduction to “Paperback Writer”, a somewhat later Beatles song.) Overall, Lennon’s and McCartney’s

DVDs, Podcasts, language teaching software, video games, and even foreign- language music and music videos can provide positive and fun associations with the language for