Next Article in Journal
Functional Self-Awareness and Metacontrol for Underwater Robot Autonomy
Next Article in Special Issue
Shape Sensing of a Complex Aeronautical Structure with Inverse Finite Element Method
Previous Article in Journal
OpenADR and Agreement Audit Architecture for a Complete Cycle of a Flexibility Solution
Previous Article in Special Issue
Shape-Sensing of Beam Elements Undergoing Material Nonlinearities
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Natural Frequencies Identification by FEM Applied to a 2-DOF Planar Robot and Its Validation Using MUSIC Algorithm

by
Salvador Martínez-Cruz
1,†,
Juan P. Amézquita-Sánchez
1,
Gerardo I. Pérez-Soto
2,
Jesús R. Rivera-Guillén
1,
Luis A. Morales-Hernández
1 and
Karla A. Camarillo-Gómez
3,*,†
1
Facultad de Ingeniería, Campus San Juan del Río, Universidad Autónoma de Querétaro, San Juan del Río, Querétaro 76807, Mexico
2
Facultad de Ingeniería, Universidad Autónoma de Querétaro, Santiago de Querétaro, Querétaro 76010, Mexico
3
Tecnológico Nacional de México/Instituto Tecnológico de Celaya, Celaya, Guanajuato 38010, Mexico
*
Author to whom correspondence should be addressed.
This author contributed equally to this work and declared no interest conflict.
Sensors 2021, 21(4), 1209; https://doi.org/10.3390/s21041209
Submission received: 29 December 2020 / Revised: 28 January 2021 / Accepted: 4 February 2021 / Published: 9 February 2021
(This article belongs to the Special Issue Shape Sensing)

Abstract

:
In this paper, the natural frequencies (NFs) identification by finite element method (FEM) is applied to a two degrees-of-freedom (2-DOF) planar robot, and its validation through a novel experimental methodology, the Multiple Signal Classification (MUSIC) algorithm, is presented. The experimental platforms are two different 2-DOF planar robots with different materials for the links and different types of actuators. The FEM is carried out using ANSYS™ software for the experiments, with vibration signal analysis by MUSIC algorithm. The advantages of the MUSIC algorithm against the commonly used fast Fourier transform (FFT) method are also presented for a synthetic signal contaminated by three different noise levels. The analytical and experimental results show that the proposed methodology identifies the NFs of a high-resolution robot even when they are very closed and when the signal is embedded in high-level noise. Furthermore, the results show that the proposed methodology can obtain a high-frequency resolution with a short sample data set. Identifying the NFs of robots is useful for avoiding such frequencies in the path planning and in the selection of controller gains that establish the bandwidth.

1. Introduction

During the last decade, robots, in particular those with servomotors, have gained momentum in diverse areas such as rehabilitation systems [1,2,3], human interaction systems [4], bio-inspired systems [5,6,7,8], and in surgery [9]. In general, their functionality depends on their performance trajectory; in this regard, an essential aspect to be considered in each programmed task is the value of the natural frequencies (NFs) of the robot, which can magnify the robot vibrations, affecting its performance [10,11,12,13,14]. Hence, it is of paramount importance to implement a method to accurately identify the NFs in order to obtain the best performance of the robot.
In literature, different strategies based on FEM and experimental procedures to estimate NFs in robots have been presented [15,16,17,18]. FEM is the most used experimental procedure for vibration measurements integrated with signal processing techniques because it can estimate the real behavior of robots [19,20,21,22,23,24]. Although FEM provides results that are very close-to-real [25], it is necessary to perform an experimental validation of the behavior of the robot to identify the NFs with accuracy [26]. An important step of the experimental procedure is the use of a signal processing technique to estimate the NFs of robots [22]. In this regard, Fourier-based methods [19,20,21,22,23] and wavelet transform (WT) [24,27] have been the most commonly employed methods for performing this task. For example, Min et al. employed the Fourier transform method to identify the NFs of an STR6-05 robotic arm, a 6-DOF heavy load manipulator, to develop a collision detection method based on vibration signals [22]. Similar work was presented by Yuan et al. [23], who applied Fourier transform to estimate the NFs of a robotic manipulator of 6 DOF in order to reduce its vibrations in a specific frequency range using a magnetorheological elastomer absorber on a spindle. Moreover, a swept sinusoidal signal for measuring the vibration response of the robot was used.
On the other hand, Chen et al. used the WT method for NFs identification of a simulated 4-DOF system subjected to forced excitations [28]. Klepka et al. applied the WT method for estimating the NFs of a simulated 2-DOF system [29]. The works presented above [19,20,21,22,23,24,27] have presented promising results for estimating the NFs of robots [19,20,21,22,23,24,27]; nevertheless, when a system or robot presents closed NFs, the methods presented are not efficient for identifying them [19]. Besides, Fourier-based methods are affected by noisy signals in complex systems and require a large number of samples [30], and an appropriate selection of the decomposition level and wavelet mother is necessary for WT to estimate the NFs appropriately [28]. For these reasons, it is essential to implement a signal processing technique for estimating the NFs of a robot under noisy signals with accuracy, especially closed NFs, using a small amount of data to avoid wear and tear on the robot during testing.
In recent years, a technique called the MUltiple Signal Classification (MUSIC) algorithm has provided promising results for analyzing induction motors [31,32], evaluating the behavior of civil structures [33,34,35], and impact-source-localization in composite structures under deformation conditions [36], among other applications. This technique presents diverse advantages such as noise immunity and high resolution and does not require a large amount of experimental information to estimate the frequencies contained in the analyzed signal with high accuracy [33]. It is also important to mention that the MUSIC algorithm provides an increased detectability of frequencies with a low amplitude as measured in robots [19,22,29], which is a significant advantage in this task. Hence, the MUSIC algorithm could provide an excellent alternative for estimating the NFs of robots.
This paper identifies the NFs of two different experimental platforms of a 2-DOF planar robot by FEM and its validation through the MUSIC algorithm. The FEM for two experimental platforms is presented. The experiment consists of an impulse-based trajectory applied to the end effector of the robot in order to excite it and obtain the response; then, the measured vibration signals are processed by the MUSIC algorithm and the fast Fourier transform (FFT) method [37] to identify the NFs. The experimental results show that the MUSIC algorithm can identify the NFs of the 2-DOF planar robot with a short sample data set and higher accuracy than the FFT method. Furthermore, the error between the MUSIC and the FEM results is lower than that obtained with FFT and the FEM results.

2. System Description

In this section, the general description of the two cases of study used in the experimentation and the dynamic model is presented.

2.1. Description of 2-DOF Planar Robot

Figure 1 shows the parameters of a 2-DOF planar robot with revolute joints that is evaluated in this work. The joint variable are represented by q i , the length of the links is l i , the link mass is m i , the moments of inertia with respect to the Z-axis are denoted by I i , for i = 1 , 2 , and the end effector is indicated by P .
The analyzed 2-DOF platforms in this work are presented in Figure 2, where the fixed reference frame has dashed lines and A x , A y , A z correspond to the accelerometer coordinate system attached to the end effector of the robot. Table 1 presents characteristics, such as the actuator models, material links, and weights of the two experimental platforms of 2-DOF. Table 2 presents the characteristics of the actuators, i.e., weight, dimension, and maximum torque, employed in the analyzed planar robots [38].

2.2. Dynamic Model

The simplified dynamic model of a 2-DOF robot is given by [39]:
M ( q ) q ¨ + C ( q , q ˙ ) q ˙ + g ( q ) = τ
where q 2 is the vector of the generalized joint coordinates, q ˙ , q ¨ 2 are the vectors of joint velocities and acceleration, respectively, M ( q ) 2 × 2 is the inertia matrix, C ( q , q ˙ ) q ˙ 2 is the vector of centrifugal and Coriolis forces, g ( q ) 2 is the vector of gravitational forces, and τ 2 is a vector of forces applied by the actuators. The C ( q , q ˙ ) q ˙ , and g ( q ) vectors are obtained as follows:
C ( q , q ˙ ) q ˙ = M ˙ ( q ) q ˙ 1 2 q [ q ˙ T M ( q ) q ˙ ]
g ( q ) = u ( q ) q
where M ˙ ( q ) 2 × 2 is the time derivative of the inertia matrix, while u ( q ) is the potential energy of the robot.

3. Natural Frequencies Identification

Figure 3 shows the block diagram of the proposed methodology for estimating the NFs of a 2-DOF planar robot using the MUSIC method and FEM.
Firstly, an impulse-based trajectory was applied to the end effector of the robot in order to excite the mechanism. The trajectory consisted of 64 impulses applied to the end effector during an 8 s time window to each robot. The produced vibration signals were then acquired using a triaxial accelerometer and sent to a personal computer (PC) through a data acquisition system (DAS). Once the vibrations were measured, they were analyzed using the MUSIC algorithm to estimate the NFs of the 2-DOF robots. The FEM was performed for both 2-DOF robots in order to compare the obtained experimental results.

3.1. Multiple Signal Classification Algorithm

The MUSIC algorithm was first introduced by [40,41]; it belongs to the family of methods based on the decomposition of the observation space into signal and noise subspaces [25]. MUSIC algorithm considers that a signal x ( t ) is a sum of R complex sinusoids with a white noise additive, that is:
x ( t ) = k = 1 R A k e j ( 2 π f k t + ϛ k ) + ω ( t )
where A k is the amplitude of the sinusoid signal, f k is the frequency of the signal, ϛ k is the phase of the k t h space vector, ω ( t ) is the white noise, and R is known as the MUSIC order. The sinusoid amplitude and frequency are not random or unknown. The phases of the sinusoids are uncorrelated random variables, uniformly distributed over the interval [ π , π ] . The power spectrum of x ( t ) consists of a set of R impulses of area 2 π | A k | at frequencies f k , for k = 1 , 2 , , R , plus the power spectrum of the additive noise ω ( t ) . Based on the orthogonality of the signal and noise subspaces, the MUSIC pseudospectrum P M U S I C of the current space, the vector, is given by the following frequency estimation function [42]:
P M U S I C ( f ) = 1 i = P + 1 M | e ¯ i H v ¯ i | 2
where e ¯ i H is the signal vector defined as e ¯ i H ( f i ) = [ 1 , e j 2 π f i , , e j 2 π f i ( M 1 ) ] , and v ¯ i is the noise eigenvector. Equation (5) shows a maximum when, for a certain f k truly present in the signal, the signal and noise subspaces are zero.

3.2. MUSIC Verification Using Simulation Signals

A numerical simulation was carried out to show the advantages of the MUSIC algorithm for identifying the frequencies of the time signal, in particular for the two closed ones, using few samples and a short sampling time. The FFT method was also employed to compare both methods to demonstrate the benefits of the proposed technique over the traditional FFT method. The analyzed signal simulates the free vibration of the robot with N modes. This is given by:
j ( t ) = i = 1 N e t A i c o s ( 2 π f i t + φ i )
where A i is the respective amplitude of the i-th mode, φ i is the phase lag, and f i is the damped natural frequency. According to Equation (6), the synthetic signal is generated with the following parameters: N = 4 , meaning that there are four natural frequencies, f 1 = 10 Hz, f 2 = 11 Hz, f 3 = 15 Hz, f 4 = 30 Hz, and A 1 = 10 , A 2 = 5 , A 3 = 1 , A 4 = 0.9 , for the amplitudes. It uses a sampling frequency of F s = 500 Hz and a time window of T = 10 s for generating a data set of 10,000 samples. Simulated proposed signals without noise, with moderate-level noise, and with high-level noise, are shown in Figure 4.
The influences of white-noise levels on identification accuracies were also considered. Figure 5 compares the NFs identification obtained by the MUSIC algorithm and that obtained by the traditional FFT method. During the analysis, two noise levels were considered in the signal: moderate-level ( 5 dB ) and high-level ( 0.01 dB ) noise, as well as a free of noise signal [43].
Furthermore, Figure 5a–c demonstrates that the FFT method is not capable of identifying the closed NFs, f 3 = 10   Hz and f 4 = 11   Hz , due to their low-frequency resolution, which depends on the number of samples analyzed. Also, the frequency components corresponding to f 3 = 15   Hz and f 4 = 30   Hz are not clearly identified because of two main reasons: (1) the nonstationary nature of the signal (as measured in a robot), and (2) the noise contained in the signal [44].
On the other hand, the MUSIC algorithm with an order of 8 can identify the four NFs with high accuracy, as shown in Figure 5d–f. It is important to mention that the MUSIC method is not susceptible to noise and presents a high resolution, allowing accurate identification of frequency components in the analyzed signal, as demonstrated in Figure 5d–f. These advantages are reliable for identifying the NFs of robots since their responses are generally contaminated with high-level noise and present non-linear and nonstationary properties, as described by [22].
Table 3 summarizes the NFs estimated by the FFT and MUSIC methods and the error generated by both methods compared to the theoretical values. Observing Table 3, the maximum errors for NFs identification using the FFT method and the proposed MUSIC algorithm method are 6.6 % and 1.66 % , respectively. Hence, these results demonstrate clearly that the MUSIC algorithm is immune to noise and can identify the NFs accurately.

4. Numerical and Experimental Results

This section presents the numerical and experimental results for the two study cases. The numerical results were carried out by FEM using ANSYS™ software, and the experimental results were obtained by the MUSIC algorithm and the FFT method.

4.1. Finite Element Analysis

In the first case of study, the components meshed with four-node solid tetrahedral elements and the hex-dominant method contained in ANSYS™ software (shown in Figure 2a). The material properties used in this model were acrylonitrile butadiene styrene (ABS) polymer, with a mass density of ρ = 1040 kg/m3, an elastic modulus E = 2.045 GPa , and a Poisson’s ratio v = 0.35 ; and polybutylene terephthalate (PBT) polymer, with ρ = 1340 kg/m3, E = 1.93 GPa , and v = 0.3902 . The model included 196,893 elements and 532,128 nodes.
The second case of study meshed mostly with four-node solid tetrahedral elements, and also with the multizone method applied in the support and link l 1 (shown in Figure 2b). The material used for this case was aluminum 6061 with the properties ρ = 6280 kg/m3, E = 69 GPa , v = 0.33 ; and ABS polymer material was used in the DAS base with the properties mentioned above. This model had a total of 310,733 elements and 559,653 nodes. In both cases of study, the links l 1 and l 2 were joined by the bounded connection method, and the reduction gears were not considered individually due to computational complexity. However, in the finite element model, the actuators were considered as a single body whose mass and volume coincided with the real actuator.
After setting the parameters and constraints of the numerical model, a FEM is applied to each case of study with the position shown in Figure 2 to calculate the NFs for each robot. The numerical results obtained by ANSYS™ are presented in Figure 6. It should be mentioned that the path of the end effector of the robot does not reach frequencies higher than 110   Hz [20,23,24]; hence, in this paper, the first five NFs of the robot are considered, which are inside this frequency range.
Figure 6a shows the first five NFs of the 2-DOF planar robot, which corresponds to the first case of the study. The obtained NFs values are 19.765 Hz, 42.622 Hz, 63.427 Hz, 86.386 Hz, and 100.580 Hz, which correspond with the frequencies that could be excited with the commonly used trajectories in this type of robot and result in undesirable robot performance and lack of stability due to the resonance effect. Figure 6b presents the first five NFs for the second case of study, where closed frequencies can appear because of the geometrical effects of the aluminum structure, such as symmetry and similar physical properties [45,46]. The obtained NFs values are 35.987 Hz ,   38.866 Hz ,   63.736 Hz , 77.029 Hz , and 79.952   Hz . These results are subsequently validated with the proposed methodology based on the MUSIC algorithm to identify NFs in the two cases of study.
A summary from the FEM analysis results of Figure 6 for the two cases of study is shown in Table 4. As observed in Table 4, the NFs corresponding to the case of study 1 are separated from each other. However, the case of study 2 presents closed frequencies, which can be associated with the geometrical effects of the aluminum structure [45,46]. Hence, the following step in the proposed methodology is to experimentally estimate the NFs with FFT and MUSIC methods.

4.2. Experimental Setup

In the experiment, the vibration signal was acquired to identify the NFs of the robots. In both cases, an InvenSense model MPU-6050 triaxial accelerometer was used for measuring the vibration signals of robots, which was placed on the end effector of the robot (shown in Figure 7). The accelerometer had a user-selectable full scale of ± 2 g , ± 4 g , ± 8 g , and ± 16 g ( g = 9.81 m/s2), with a resolution of 5 × 10 4 g over a 100 Hz bandwidth. A DAS composed of an Atmel microcontroller and a 16-bit analog-to-digital converter was employed to acquire the vibration signals. The vibration signals measured by the accelerometer were stored in the DAS and sent to a PC using the USB protocol. The DAS used a sampling frequency of 1 kHz during a time window of 8   s for every test, obtaining 8000 samples for each test.
Figure 7 shows the overall experimental setup for estimating the NFs of both robots. In order to obtain the vibration response of the robots, they were excited using an impulse-based trajectory. The trajectory was applied to the end effector of the robots, and consisted of 64 impulses over 8   s . Figure 7a shows the first experimental setup, which consists of a 2-DOF planar robot comprised of two servomotors from Dynamixel model AX-12 as actuators. These servomotors worked with a half-duplex communication protocol, a baud-rate of 1 Mbps , a resolution of 10 bits ( 0 1023 ) , and a maximum speed of 114   RPM . The second experimental setup is shown in Figure 7b, where a 2-DOF planar robot with a different configuration is analyzed, and includes two Dynamixel model MX-28 servomotors. They also work with a half-duplex communication protocol, a baud-rate of 1   Mbps , a resolution of 12 bits ( 0 4095 ) , and a maximum speed of 116.62   RPM . For the experiments, the two robots (presented in Figure 7) were fixed to a worktable by screws to avoid undesirable vibrations that were not typical of the robot.

4.3. Experimental Results

This section presents the experimental results, which are compared with the FFT method to show the effectiveness of the proposed method.
According to the proposed methodology, the vibration responses of both robots were measured by applying an impulse-based trajectory, which was repeated ten times in both cases. The signals were acquired using the same conditions, i.e., the same trajectory of the end effector, the same 64 impulses, and a time window of 8   s . Figure 8a,b shows an example of the vibration responses measured by the triaxial accelerometer, A x , A y , and A z , for each 2-DOF planar robot, respectively.
Once the vibration signals were acquired, the processing was carried out using the MUSIC algorithm and the FFT method to make a comparison. Figure 9 shows the spectra for the two cases of study; Figure 9a,b corresponds to the FFT method, while Figure 9c,d corresponds to the MUSIC algorithm.
According to the obtained spectra, the FFT method cannot identify the closed NFs of a robot because it is sensitive to noise. As shown in Figure 9a,b, the FFT method presents a large number of undesirable peaks due to the amount of noise present in the signal and fails to accurately discern the frequency components corresponding to the NFs of the robot. Hence, the FFT method is susceptible to diverse problems when it is used for analyzing noisy signals with nonstationary properties as measured in the robots, such as the appearance of spurious frequencies, as observed in Figure 9a,b, because of the spectral leakage, resolution, and the high-level of noise contained in the analyzed signals (see Figure 8a,b) [47].
On the other hand, the MUSIC algorithm can identify the NFs of a robot even when the signal contains a high-level noise. Figure 9c shows that the MUSIC algorithm can accurately estimate the NFs since it is not affected by noise, which enables more accurate identification of the NFs compared with the FFT method. Additionally, Figure 9d shows that the proposed method can identify the closed frequencies in the second case of study with high accuracy. Unlike the FFT method, the proposed method can identify low-amplitude frequencies, which is advantageous because the NFs of a robot can have a small amplitude.
As shown in Figure 9c,d, the MUSIC algorithm can identify the NFs with higher frequency-resolution than the FFT method, even when the signal is embedded in a high-level noise and with a short sample data set. Table 5 shows the values of the first five identified NFs by the proposed methodology in the two cases of study.

5. Results and Discussion

Table 6 shows the values of the first five identified NFs by the FFT method and the MUSIC algorithm, as well as their corresponding analytical values obtained by FEM for the two cases of study. As it is shown, the MUSIC algorithm can identify the NFs at a very similar level when compared with the analytical calculation from FEM. Besides, the MUSIC algorithm does not require a long time window to provide a high-frequency resolution, avoiding wear on the actuators during testing through a short robot testing time. On the other hand, the FFT method presents a significant difference compared to FEM due to the noise present in the signal; this is a significant advantage of the proposed methodology because most of the real signals have a considerable noise level.
Figure 10 shows the percentages of similarity between the results of the MUSIC algorithm and FFT method against FEM. These values are obtained by:
E % = a b s ( f r ) r × 100
where f is the analytical calculation results, r is the experimental results (MUSIC or FFT), and E % is the error percentage for the corresponding modes.
Observing Figure 10, the results of the FEM analysis by ANSYS™ using the two cases of study provide an acceptable accuracy compared with experimental results obtained with the MUSIC algorithm, i.e., the results of FEM are close-to-real, with a maximum error of 9.46 % for the case of study 1 (denoted by the solid blue line) and 3.44 % error for the case of study 2 (denoted by the dotted blue line). However, if the FEM results are validated using the experimental results of the FFT method, the percentage error is more significant, at 20.22 % (denoted by the solid black line) and 11.14 % (denoted by the dotted black line) for the cases of study 1 and 2, respectively. In this regard, the proposed methodology can contribute to the planning of the trajectories of the robot. It will also be useful for the selection of controller gains to avoid exciting the robot in the NFs and assist in the correct selection of notch filters at the output of a controller.
Notice that the MUSIC algorithm requires the previous selection of the algorithm order, which is chosen according to the number of frequencies or components found in the analyzed signal. In this regard, the number of frequencies contained in the signal is unknown, but it is known that the trajectories used in this type of robot are in the range from 0   Hz to 110   Hz [20,23]. In this sense, the FEM results allow the selection of the MUSIC algorithm order because they provide the number of natural frequencies contained in the range of interest ( 0 Hz to 110 Hz ), showing that an order of 10 is the most reliable for identifying the main NFs contained in the signal. On the other hand, the MUSIC algorithm presents more computational complexity than the FFT; however, it is superior to the FFT method for identifying the NFs of both robots under noisy signals. The numbers of operations for computing the FFT ( O p F F T ) [48] and MUSIC ( O p M U S I C ) [49] are given by the following equations:
O p F F T = N l o g 2 N
O p M U S I C = N 3
where N represents the data length.

6. Conclusions

This paper presents a novel methodology to identify NFs in 2-DOF planar robots, a FEM is applied in two cases of study, and the results are validated with a vibration signal analysis through the MUSIC algorithm. Two cases of study are modeled in ANSYS™ software, and a FEM is applied to estimate the NFs of the robots. Also, a simulated signal is analyzed to show the effectiveness of the MUSIC algorithm. The experimentation consists of an impulse-based trajectory applied to the end effector of the robot to excite the mechanism; the vibration signals are measured by a triaxial accelerometer and processed by the proposed methodology and the FFT method to show the advantages of the MUSIC algorithm compared with the traditional method. The experimental results show that the MUSIC algorithm is closer to the FEM results, and it is a useful methodology for NF identification in 2-DOF planar robots because it is not affected when the signal is contaminated with a high-level noise. In this context, the MUSIC algorithm is advantageous and has a higher resolution than traditional Fourier-based methods. The experimental cases are carried out in an 8   s time window. Hence, the simulated and experimental results show that the MUSIC algorithm does not need a long sample time window to obtain a high-frequency resolution. The proposed methodology has been developed in a 2-DOF planar robot without loss of generality; that is, the instrumentation and signal acquisition process is the same for an n-DOF robot arm. The MUSIC algorithm can also contribute to path planning of the robot, the selection of gains of a controller to avoid exciting the robot in the NFs, and the correct selection of notch filters at the output of a controller.

Author Contributions

Conceptualization, S.M.-C., J.P.A.-S., G.I.P.-S., and K.A.C.-G.; methodology, S.M.-C., J.P.A.-S., G.I.P.-S., J.R.R.-G., L.A.M.-H., and K.A.C.-G.; software, S.M.-C., J.P.A.-S., and G.I.P.-S.; validation, S.M.-C., J.P.A.-S., and J.R.R.-G.; formal analysis, S.M.-C., J.P.A.-S., G.I.P.-S., and K.A.C.-G.; investigation, S.M.-C., J.P.A.-S., G.I.P.-S., J.R.R.-G., L.A.M.-H., and K.A.C.-G.; resources, G.I.P.-S., and K.A.C.-G.; writing—original draft preparation, S.M.-C., G.I.P.-S., and K.A.C.-G.; writing—review and editing, S.M.-C., J.P.A.-S., G.I.P.-S., and K.A.C.-G.; supervision, J.P.A.-S., G.I.P.-S., J.R.R.-G., L.A.M.-H., and K.A.C.-G. All authors have read and agreed to the published version of the manuscript.

Funding

Salvador Martínez-Cruz received a scholarship (no. 783323) from Consejo Nacional de Ciencia y Tecnologia (CONACyT) for this research.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Kalani, H.; Moghimi, S.; Akbarzadeh, A. Toward a bio-inspired rehabilitation aid: sEMG-CPG approach for online generation of jaw trajectories for a chewing robot. Biomed. Signal Process. Control 2019, 51, 285–295. [Google Scholar] [CrossRef]
  2. Nhon, P.N.Q.; Elamvazuthi, I.; Fayek, H.M.; Parasuraman, S.; Ahamed Khan, M.K.A. Intelligent control of rehabilitation robot: Auto tuning PIDController with interval type 2 fuzzy for DC servomotor. Procedia Comput. Sci. 2014, 42, 183–190. [Google Scholar] [CrossRef] [Green Version]
  3. Ohta, P.; Valle, L.; King, J.; Low, K.; Yi, J.; Atkeson, C.G.; Park, Y.-L. Design of a Lightweight Soft Robotic Arm Using Pneumatic Artificial Muscles and Inflatable Sleeves. Soft Robot. 2018, 5, 204–215. [Google Scholar] [CrossRef] [PubMed] [Green Version]
  4. Du, G.; Chen, M.; Liu, C.; Zhang, B.; Zhang, P. Online robot teaching with natural human-robot interaction. IEEE Trans. Ind. Electron. 2018, 65, 9571–9581. [Google Scholar] [CrossRef]
  5. Dupeyroux, J.; Viollet, S.; Serres, J.R. An ant-inspired celestial compass applied to autonomous outdoor robot navigation. Robot. Auton. Syst. 2019, 117, 40–56. [Google Scholar] [CrossRef]
  6. Hernandez-Mendez, S.; Marin-Hernandez, A.; Palacios-Hernandez, E.R.; Luna-Gallegos, K.L. A switching position/force controller for two independent finger gripper over ROS. In Proceedings of the International Conference on Electronics, Communications and Computers (CONIELECOMP), Cholula, Mexico, 22–24 February 2017; pp. 1–6. [Google Scholar] [CrossRef]
  7. Zhu, Y.; Jin, B.; Wu, Y.; Guo, T.; Zhao, X. Trajectory correction and locomotion analysis of a hexapod walking robot with semi-round rigid feet. Sensors 2016, 16, 1392. [Google Scholar] [CrossRef]
  8. Dutta, S.; Miura-Mattausch, M.; Ochi, Y.; Yorino, N.; Mattausch, H.J. Gyro-Sensor-Based Vibration Control for Dynamic Humanoid-Robot Walking on Inclined Surfaces. Sensors 2020, 20, 7139. [Google Scholar] [CrossRef]
  9. Tuvayanond, W.; Parnichkun, M. Position control of a pneumatic surgical robot using PSO based 2-DOF H∞ loop shaping structured controller. Mechatronics 2017, 43, 40–55. [Google Scholar] [CrossRef]
  10. Kim, T.-I.; Bahn, W.; Yoon, J.M.; Han, J.S.; Park, J.H.; Lee, S.S.; Lee, S.H.; Cho, D. Il Online tuning method for notch filter depth in industrial servo systems. In Proceedings of the 35th Chinese Control Conference (CCC), Chengdu, China, 27–29 July 2016; pp. 9514–9518. [Google Scholar] [CrossRef]
  11. Oh, T.-H.; Han, J.-S.; Kim, Y.-S.; Yang, D.-Y.; Lee, S.-H.; Cho, D.-I. “Dan” Deep RL Based Notch Filter Design Method for Complex Industrial Servo Systems. Int. J. Control. Autom. Syst. 2020, 18, 1–10. [Google Scholar] [CrossRef]
  12. Hoogendijk, R.; Heertjes, M.F.; Van De Molengraft, M.J.G.; Steinbuch, M. Directional notch filters for motion control of flexible structures. Mechatronics 2014, 24, 632–639. [Google Scholar] [CrossRef]
  13. Bottin, M.; Cocuzza, S.; Comand, N.; Doria, A. Modeling and identification of an industrial robot with a selective modal approach. Appl. Sci. 2020, 10, 4619. [Google Scholar] [CrossRef]
  14. Sun, J.; Zhang, W.; Dong, X. Natural Frequency Prediction Method for 6R Machining Industrial Robot. Appl. Sci. 2020, 10, 8138. [Google Scholar] [CrossRef]
  15. Palmieri, G.; Martarelli, M.; Palpacelli, M.C.; Carbonari, L. Configuration-dependent modal analysis of a Cartesian parallel kinematics manipulator: Numerical modeling and experimental validation. Meccanica 2014, 49, 961–972. [Google Scholar] [CrossRef]
  16. Siva, I.; Sangaran, D.K.; Balan, P.P.; Siddharth, P.; Sankar, I. Modal analysis on the additive manufactured robotic segments: Effect of printing densities on the vibrational properties. Mater. Today Proc. 2020. [Google Scholar] [CrossRef]
  17. He, D. Finite Element Analysis of Humanoid Robot Arm. In Proceedings of the 13th International Conference on Ubiquitous Robots and Ambient Intelligence (URAI), Xi’an, China, 19–22 August 2016; pp. 772–776. [Google Scholar]
  18. Berninger, T.F.C.; Fuderer, S.; Rixen, D.J. Modal analysis of a 7 DoF sweet pepper harvesting robot. Conf. Proc. Soc. Exp. Mech. Ser. 2020, 8, 163–170. [Google Scholar] [CrossRef]
  19. Tang, A.; Li, Y.; Kong, L.; Cheng, X. Vibration analysis of tendon-based parallel robot for processing. Adv. Mater. Res. 2013, 655–657, 1086–1091. [Google Scholar] [CrossRef]
  20. Jo, W.; Park, H.; Lee, B.; Kim, D. A study on improving sound quality of violin playing robot. In Proceedings of the 6th International Conference on Automation, Robotics and Applications (ICARA), Queenstown, New Zealand, 17–19 February 2015; pp. 185–191. [Google Scholar] [CrossRef]
  21. Kondo, N.; Taniwaki, S.; Tanihara, K.; Yata, K.; Monta, M.; Kurita, M.; Tsutumi, M. An End-Effector and Manipulator Control for Tomato Cluster Harvesting Robot; ASABE: St. Joseph, MI, USA, 2007. [Google Scholar]
  22. Min, F.; Wang, G.; Liu, N. Collision detection and identification on robot manipulators based on vibration analysis. Sensors 2019, 19, 1080. [Google Scholar] [CrossRef] [Green Version]
  23. Yuan, L.; Sun, S.; Pan, Z.; Ding, D.; Gienke, O.; Li, W. Mode coupling chatter suppression for robotic machining using semi-active magnetorheological elastomers absorber. Mech. Syst. Signal Process. 2019, 117, 221–237. [Google Scholar] [CrossRef]
  24. Dziedziech, K.; Staszewski, W.J.; Basu, B.; Uhl, T. Wavelet-based detection of abrupt changes in natural frequencies of time-variant systems. Mech. Syst. Signal Process. 2015, 64–65, 347–359. [Google Scholar] [CrossRef]
  25. Morinigo-Sotelo, D.; Romero-Troncoso, R.D.J.; Panagiotou, P.A.; Antonino-Daviu, J.A.; Gyftakis, K.N. Reliable Detection of Rotor Bars Breakage in Induction Motors via MUSIC and ZSC. IEEE Trans. Ind. Appl. 2018, 54, 1224–1234. [Google Scholar] [CrossRef]
  26. Elsayed, Y.; Vincensi, A.; Lekakou, C.; Geng, T.; Saaj, C.M.; Ranzani, T.; Cianchetti, M.; Menciassi, A. Finite Element Analysis and Design Optimization of a Pneumatically Actuating Silicone Module for Robotic Surgery Applications. Soft Robot. 2014, 1, 255–262. [Google Scholar] [CrossRef] [Green Version]
  27. Teshigawara, S.; Tsutsumi, T.; Shimizu, S.; Suzuki, Y.; Ming, A.; Ishikawa, M.; Shimojo, M. Highly sensitive sensor for detection of initial slip and its application in a multi-fingered robot hand. In Proceedings of the IEEE International Conference on Robotics and Automation, Shanghai, China, 9–13 May 2011; pp. 1097–1102. [Google Scholar] [CrossRef]
  28. Chen, S.L.; Liu, J.J.; Lai, H.C. Wavelet analysis for identification of damping ratios and natural frequencies. J. Sound Vib. 2009, 323, 130–147. [Google Scholar] [CrossRef]
  29. Klepka, A.; Uhl, T. Identification of modal parameters of non-stationary systems with the use of wavelet based adaptive filtering. Mech. Syst. Signal Process. 2014, 47, 21–34. [Google Scholar] [CrossRef]
  30. Amezquita-Sanchez, J.P.; Cabal-Yepez, E.; Romero-Troncoso, R.J.; Osornio-Rios, R.A.; Garcia-Perez, A. Determination of system frequencies in mechanical systems during shutdown transient. J. Sci. Ind. Res. 2010, 69, 415–421. [Google Scholar]
  31. Garcia–Perez, A.; Romero-Troncoso, R.J.; Cabal-Yepez, E.; A Osornio-Rios, R.; A Lucio-Martinez, J. Application of high-resolution spectral analysis for identifying faults in induction motors by means of sound. J. Vib. Control. 2012, 18, 1585–1594. [Google Scholar] [CrossRef]
  32. Zamudio-Ramirez, I.; Ramirez-Nunez, J.A.; Antonino-Daviu, J.; Osornio-Rios, R.A.; Quijano-Lopez, A.; Razik, H.; De Jesus Romero-Troncoso, R. Automatic Diagnosis of Electromechanical Faults in Induction Motors Based on the Transient Analysis of the Stray Flux via MUSIC Methods. IEEE Trans. Ind. Appl. 2020, 56, 3604–3613. [Google Scholar] [CrossRef]
  33. Amezquita-Sanchez, J.P.; Garcia-Perez, A.; Romero-Troncoso, R.J.; Osornio-Rios, R.A.; Herrera-Ruiz, G. High-resolution spectral-analysis for identifying the natural modes of a truss-type structure by means of vibrations. J. Vib. Control 2013, 19, 2347–2356. [Google Scholar] [CrossRef]
  34. Perez-Ramirez, C.A.; Machorro-Lopez, J.M.; Valtierra-Rodriguez, M.; Amezquita-Sanchez, J.P.; Garcia-Perez, A.; Camarena-Martinez, D.; Romero-Troncoso, R.D.J. Location of multiple damage types in a truss-type structure using multiple signal classification method and vibration signals. Mathematics 2020, 8, 932. [Google Scholar] [CrossRef]
  35. Gkoktsi, K.; Giaralis, A. A compressive MUSIC spectral approach for identification of closely-spaced structural natural frequencies and post-earthquake damage detection. Probabilistic Eng. Mech. 2020, 60. [Google Scholar] [CrossRef]
  36. Zhang, Z.; Zhong, Y.; Xiang, J. TAM and MUSIC Approach for Impact-Source Localization under Deformation Conditions. Sensors 2020, 20, 3151. [Google Scholar] [CrossRef]
  37. Heckbert, P. Fourier Transforms and the Fast Fourier Transform (FFT) Algorithm. Notes Comput. Graph. 1995, 3, 15–463. [Google Scholar]
  38. Nikkhah, A.; Yousefi-Koma, A.; Mirjalili, R.; Farimani, H.M. Design and Implementation of Small-sized 3D Printed Surena-Mini Humanoid Platform. In Proceedings of the 5th RSI International Conference on Robotics and Mechatronics (ICRoM), Tehran, Iran, 25–27 October 2017; pp. 132–137. [Google Scholar] [CrossRef]
  39. Kelly, R.; Davila, V.S.; Perez, J.A.L. Control of Robot Manipulators in Joint Space; Springer: London, UK, 2006. [Google Scholar]
  40. Schmidt, R.O. Multiple emitter location and signal parameter estimation. Adapt. Antennas Wirel. Commun. 2009, 776, 190–194. [Google Scholar] [CrossRef] [Green Version]
  41. Bienvenu, G.; Kopp, L. Optimality of High Resolution Array Processing Using the Eigensystem Approach. IEEE Trans. Acoust. 1983, 31, 1235–1248. [Google Scholar] [CrossRef]
  42. Kia, S.H.; Henao, H.; Capolino, G.A. A high-resolution frequency estimation method for three-phase induction machine fault detection. IEEE Trans. Ind. Electron. 2007, 54, 2305–2314. [Google Scholar] [CrossRef]
  43. Tamura, H.; Ohgami, N.; Yajima, I.; Iida, M.; Ohgami, K.; Fujii, N.; Itabe, H.; Kusudo, T.; Yamashita, H.; Kato, M. Chronic exposure to low frequency noise at moderate levels causes impaired balance in mice. PLoS ONE 2012, 7, e39807. [Google Scholar] [CrossRef]
  44. Granados-Lieberman, D.; Romero-Troncoso, R.J.; Cabal-Yepez, E.; Osornio-Rios, R.A.; Franco-Gasca, L.A. A real-time smart sensor for high-resolution frequency estimation in power systems. Sensors 2009, 9, 7412–7429. [Google Scholar] [CrossRef] [Green Version]
  45. Bao, C.; Hao, H.; Li, Z.X.; Zhu, X. Time-varying system identification using a newly improved HHT algorithm. Comput. Struct. 2009, 87, 1611–1623. [Google Scholar] [CrossRef]
  46. Chen, G.; Wang, Z. A signal decomposition theorem with Hilbert transform and its application to narrowband time series with closely spaced frequency components. Mech. Syst. Signal Process. 2012, 28, 258–279. [Google Scholar] [CrossRef]
  47. Romero-Troncoso, R.D.J. Multirate Signal Processing to Improve FFT-Based Analysis for Detecting Faults in Induction Motors. IEEE Trans. Ind. Inform. 2017, 13, 1291–1300. [Google Scholar] [CrossRef]
  48. Press, W.H.; Teukolsky, S.A.; Vettering, W.T.; Flannery, B.P. Numerical Recipes—The Art of Scientific Computing, 3rd ed.; Cambridge University Press: Cambridge, UK, 2007. [Google Scholar] [CrossRef]
  49. Li, T.; Tang, Y. Frequency estimation based on modulation FFT and MUSIC algorithm. In Proceedings of the 1st International Conference on Pervasive Computing, Signal Processing and Applications, Harbin, China, 17–19 September 2010; Volume 525, pp. 525–528. [Google Scholar] [CrossRef]
Figure 1. Simplified scheme of a 2-DOF planar robot.
Figure 1. Simplified scheme of a 2-DOF planar robot.
Sensors 21 01209 g001
Figure 2. Experimental platforms of 2-DOF: (a) Case of study 1, and (b) Case of study 2 (The second case is designed and manufactured by the Engineering Faculty of the Universidad Autónoma de Querétaro, México).
Figure 2. Experimental platforms of 2-DOF: (a) Case of study 1, and (b) Case of study 2 (The second case is designed and manufactured by the Engineering Faculty of the Universidad Autónoma de Querétaro, México).
Sensors 21 01209 g002
Figure 3. The schematic diagram for the proposed methodology.
Figure 3. The schematic diagram for the proposed methodology.
Sensors 21 01209 g003
Figure 4. Simulated proposed signal (a) without noise, (b) with moderate-level noise, and (c) with high-level noise.
Figure 4. Simulated proposed signal (a) without noise, (b) with moderate-level noise, and (c) with high-level noise.
Sensors 21 01209 g004
Figure 5. Spectra obtained by the FFT method for a signal with (a) no noise, (b) moderate-level noise, (c) high-level noise, and spectra obtained by the MUSIC method for a signal with (d) no noise, (e) moderate-level noise, and (f) high-level noise.
Figure 5. Spectra obtained by the FFT method for a signal with (a) no noise, (b) moderate-level noise, (c) high-level noise, and spectra obtained by the MUSIC method for a signal with (d) no noise, (e) moderate-level noise, and (f) high-level noise.
Sensors 21 01209 g005
Figure 6. ANSYS™ results: (a) case of study 1; (b) case of study 2.
Figure 6. ANSYS™ results: (a) case of study 1; (b) case of study 2.
Sensors 21 01209 g006
Figure 7. Experimental Setup: (a) 2-DOF planar robot with two Dynamixel AX-12 servomotors; (b) 2-DOF planar robot with two Dynamixel MX-28 servomotors.
Figure 7. Experimental Setup: (a) 2-DOF planar robot with two Dynamixel AX-12 servomotors; (b) 2-DOF planar robot with two Dynamixel MX-28 servomotors.
Sensors 21 01209 g007
Figure 8. Vibration signal: (a) Case of study 1; (b) Case of study 2.
Figure 8. Vibration signal: (a) Case of study 1; (b) Case of study 2.
Sensors 21 01209 g008
Figure 9. Signal processing results: (a) FFT spectrum for case of study 1; (b) FFT spectrum for case of study 2; (c) MUSIC spectrum for case of study 1; (d) MUSIC spectrum for case of study 2.
Figure 9. Signal processing results: (a) FFT spectrum for case of study 1; (b) FFT spectrum for case of study 2; (c) MUSIC spectrum for case of study 1; (d) MUSIC spectrum for case of study 2.
Sensors 21 01209 g009
Figure 10. Error percentage of the results from FFT and MUSIC compared to the analytical results from FEM.
Figure 10. Error percentage of the results from FFT and MUSIC compared to the analytical results from FEM.
Sensors 21 01209 g010
Table 1. Characteristics of the two experimental platforms of 2-DOF.
Table 1. Characteristics of the two experimental platforms of 2-DOF.
Case of Study 1Case of Study 2
ActuatorsDynamixel AX-12Dynamixel MX-28
Material linkPolymericAluminum 6061
Total weight0.16 kg0.7475 kg
l 1 0.093 m0.14 m
l 2 0.081 m0.081 m
m 1 0.0219 kg0.0566 kg
m 2 0.0219 kg0.0712 kg
I 1 8.317 × 10 6 kg · m2 1.11 × 10 4 kg · m2
I 2 8.317 × 10 6 kg · m2 3.59 × 10 5 kg · m2
Table 2. Properties of the actuators.
Table 2. Properties of the actuators.
Dynamixel AX-12Dynamixel MX-28
Weight0.0546 kg0.072 kg
Dimensions0.032 m × 0.05 m × 0.04 m0.0356 m × 0.0506 m × 0.0355 m
Max. torque1.52 N · m2.5 N · m
Table 3. Natural frequencies (NFs) identified by FFT and MUSIC methods.
Table 3. Natural frequencies (NFs) identified by FFT and MUSIC methods.
ModeTheoretical Frequency (Hz)FFT Method (Error %)MUSIC Method (Error %)
WNMLNHLNWNMLNHLN
11010.3 (3)10.5 (5.5)10.5 (5.5)10 (0.0)10.01 (0.1)10.01 (0.1)
211NININI11 (0.0)10.98 (0.18)10.98 (0.18)
31516 (6.6)15.8 (5.3)NI15 (0.0)15.01 (0.06)15.25 (1.66)
43031 (3.3)NINI30 (0.0)30.27 (0.9)32.34 (1.06)
NI: not identified; WN: without noise; MLN: moderate-level noise; HLN: high-level noise.
Table 4. Summary of simulation results.
Table 4. Summary of simulation results.
Natural Frequencies (Hz)
ModeCase of Study 1Case of Study 2
119.76535.987
242.62238.866
363.42763.736
486.38677.029
5100.58079.952
Table 5. Experimental results for the MUSIC algorithm and the FFT method.
Table 5. Experimental results for the MUSIC algorithm and the FFT method.
Natural Frequencies (Hz)
ModeCase of Study 1Case of Study 2
MUSICFFTMUSICFFT
119.532034.7940.5
238.943438.3340.5
363.3563.562.9961.5
486.385.577.0381.5
5101.310380.9381.5
Table 6. Comparison of natural frequencies.
Table 6. Comparison of natural frequencies.
Natural Frequencies (Hz)
Case of Study 1Case of Study 2
ModesFEMFFTMUSICFEMFFTMUSIC
119.7652019.5335.98740.534.79
242.6223438.9438.86640.538.33
363.42763.563.3563.73661.562.99
486.38685.586.377.02981.577.03
5100.580103101.379.95281.580.93
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Share and Cite

MDPI and ACS Style

Martínez-Cruz, S.; Amézquita-Sánchez, J.P.; Pérez-Soto, G.I.; Rivera-Guillén, J.R.; Morales-Hernández, L.A.; Camarillo-Gómez, K.A. Natural Frequencies Identification by FEM Applied to a 2-DOF Planar Robot and Its Validation Using MUSIC Algorithm. Sensors 2021, 21, 1209. https://doi.org/10.3390/s21041209

AMA Style

Martínez-Cruz S, Amézquita-Sánchez JP, Pérez-Soto GI, Rivera-Guillén JR, Morales-Hernández LA, Camarillo-Gómez KA. Natural Frequencies Identification by FEM Applied to a 2-DOF Planar Robot and Its Validation Using MUSIC Algorithm. Sensors. 2021; 21(4):1209. https://doi.org/10.3390/s21041209

Chicago/Turabian Style

Martínez-Cruz, Salvador, Juan P. Amézquita-Sánchez, Gerardo I. Pérez-Soto, Jesús R. Rivera-Guillén, Luis A. Morales-Hernández, and Karla A. Camarillo-Gómez. 2021. "Natural Frequencies Identification by FEM Applied to a 2-DOF Planar Robot and Its Validation Using MUSIC Algorithm" Sensors 21, no. 4: 1209. https://doi.org/10.3390/s21041209

APA Style

Martínez-Cruz, S., Amézquita-Sánchez, J. P., Pérez-Soto, G. I., Rivera-Guillén, J. R., Morales-Hernández, L. A., & Camarillo-Gómez, K. A. (2021). Natural Frequencies Identification by FEM Applied to a 2-DOF Planar Robot and Its Validation Using MUSIC Algorithm. Sensors, 21(4), 1209. https://doi.org/10.3390/s21041209

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop