Page 42 - Read Online
P. 42

Wu. Intell Robot 2021;1(2):99-115  I http://dx.doi.org/10.20517/ir.2021.11          Page 107


                                          Table 2. Mass and moment of inertia of the active joints
                                       Joint i   1      2      3      4      5
                                              2  0.0210  0.0002  0.0001  0.0001  0.0002
                                            ,   [kg · mm ]
                                            ,   [kg]  −  2.2272  1.8196  2.2442  2.0053
                                           Table 3. The properties of the links and end-effector
                                          Links     Mass [kg]  Moment of inerita [kg · cm ]
                                                                             2
                                          upper link        = 4.7995  I    = diag[1.1884, 25.0670, 24.4940]
                                          lower link        = 1.7795  I    = diag[4.0802, 4.0861, 0.2345]
                                          wrist link  −      I    = diag[0.5556, 0.9154, 0.6119]
                                          end-effector        = 1.2961  I    = diag[0.4563, 0.4382, 0.2347]
               Differentiating Equation (43) with respect to time leads to

                                                               
                                                                       
                                                       
                                               ¤       (      ) = ¤   ,1 (      ) + ¤   ,2 (      ) + ¤   ,3 (      )  (45)
               with



                                         (                                     )
                                            2
                                          2   − 1              2  
                           ¤      ,1 (      ) =            Δ    √        sin         Δ   + √          cos         Δ         (     −1 )  (46a)
                                           1 −    2           1 −    2
                                    1          Δ  
                           ¤      ,2 (      ) =      (        sin         Δ   +         cos         Δ  ) ¤      (     −1 )  (46b)
                                          
                                       ∫
                                    1         
                           ¤      ,3 (      ) =          (  )    −        (      −  )  (        sin         (      −   ) −         cos         (      −   )) d    (46c)
                                          
                                             −1
               Hence,       (      ) and ¤    (      ) can be solved as long as       (     −1 ) and ¤    (     −1 ) are given, and
                                
                                                                    
                                                      
                                                                        
                                                   (0) = e Mu(0);  ¤       (0) = e M¤ u(0)            (47)
                                                                        
                                                      
               where e    is the   th column of the modal matrix. The total displacement response is calculated by the following
               addition
                                                           6
                                                          ∑
                                                   u(      ) =        (      )e    (      )           (48)
                                                            =1
               Consequently, the natural frequency and displacement response can be obtained with numerical calculations.


               4.   NUMERICAL SIMULATION

               Elastodynamic characteristics of the robotic arm are investigated in this section. The properties of the robotics
               components are listed in Tables 2 and 3, respectively. Moreover, according to the output shaft of the gearbox,
               the actuation stiffnesses are calculated and set to          ,   = 2 · 10 Nm/rad,    = 1, ..., 5, and the link stiffness
                                                                     4
               matrices given in Appendix A are derived by means of FEA with ANSYS [45] . The numerical simulation was
               carried out with Matlab.

               4.1.  Natural frequency
               To effectively measure the overall performance of the robotic arm, the distributions of natural frequencies over
               the dexterous workspace in Figure 2 are visualized, as displayed in Figures 4 and 5.

               Let the end-effector orientation follow the        Euler convention; the distributions of the first- and second-
               order natural frequencies over workspace are displayed in Figures 4 and 5 when the end-effector remains
   37   38   39   40   41   42   43   44   45   46   47