ALL Metrics
-
Views
-
Downloads
Get PDF
Get XML
Cite
Export
Track
Research Article

2-DOF robot modelling by SimMechanics and PD-FL integrated controller for position control and trajectory tracking

[version 1; peer review: 1 approved with reservations]
PUBLISHED 15 Oct 2021
Author details Author details
OPEN PEER REVIEW
REVIEWER STATUS

This article is included in the Research Synergy Foundation gateway.

Abstract

Background Due to the high demand of robots to perform several industrial tasks, such as welding, machining, pick and place, position control in robotics has attracted high attention recently. Controllers’ improvement is also continuous specifically in terms of design simplicity and performance accuracy. This research plans to obtain the SimMechanics model of a two-degree of freedom (DOF) robot and to propose an integrated controller of a proportional–derivative (PD) controller and a fuzzy logic (FL) controller.
Methodology The SimMechanics model of the 2-DOF robot is obtained using MATLAB SimMechanics toolbox from a CAD assembly design of the 2-DOF robot. Then, the proposed PD-FL integrated controller is designed and simulated in MATLAB Simulink. The PD controller is widely used for its simplicity, but it doesn’t have a satisfactory performance in difficult tasks. Furthermore, the FL controller is also easy for design and implementation even by non-experts in control theory, but it has the disadvantage of long computational time for multi-input systems due to the increased fuzzy rules.
Results The FL controller is integrated with the PD controller for enhanced performance of the 2-DOF robot. The PD-FL integrated controller is developed and tested to control the 2-DOF robot for point-to-point position control and also tip trajectory tracking (TTT) such as triangular TTT and rhombic TTT.
Conclusion The PD-FL integrated controller demonstrates enhanced performance compared to the conventional PD controller in both point-to-point position control and TTT. Furthermore, the PD-FL integrated controller has the advantage of less fuzzy rules which helps to overcome the computational time issue of the FL controller.

Keywords

2-DOF robot, SimMechanics model, PD-FL integrated controller, position control, tip trajectory tracking.

Introduction

There is a wide use of planar robots in industries to achieve several required tasks, such as welding, handling, machining, polishing, pick and place, etc. Meanwhile, there is a high demand of fast and precise position control for such robots in industries1. A dynamic model is required for several types of controllers in order to obtain the optimal parameters of a controller for satisfactory performance. There are many mathematical modelling methods, such as the kinematics method2, Newtonian method3, Lagrange’s equation4,5, and Hamilton's principle6. However, mathematical modelling is difficult and requires long calculations especially for nonlinear systems; critical and deep discussion of mathematical modelling methods is given in reference7. A numerical modelling method was used to obtain SimMechanics models of robots using Simulink and Simscape toolboxes from CAD assemblies810. SimMechanics models are easily obtained and can be simulated and controlled, so they are preferable.

A proportional–derivative (PD) controller was tuned using root locus11,12 and manually tuned13,14 for position control of such robots. The manual tuning method helps to dispense about the mathematical model of a system which one of its advantages. However, the PD controller is not perfect for nonlinear and complex systems. A 2-DOF robot was controlled by a proportional–integral–derivative controller (PID) due to its simple structure, but it is not easy to obtain optimal PID parameters to give a satisfactory performance15. The linear quadratic regulator (LQR) is an optimal classical control technique and was utilized to control a planar robot with the necessity of a system mathematical model in order to calculate the controller gain16,17. The fuzzy logic controller (FLC) is a common control technique in robotics and has continuous increasing interest due to its robustness performance for nonlinear systems and does not require a mathematical model to tune its membership functions and rules18. FLC has the disadvantage of computational time due to the fuzzy rules explosion for controlling multi-input systems19,20.

Neural network (NN) is an intelligent control technique and can be developed with simple knowledge of the system behavior without a need for a dynamic model which assists to avert the complexity of the mathematical modelling21. NN was used to control a 2-DOF robot in terms of links’ position22. However, NN require many hidden layers in its network to provide an accurate position control which needs long time for training23. Sliding mode controller (SMC) is a robust controller and was employed for position control of a 2-DOF robot24,25. However, sliding mode controller has the chattering issue which is a serious disadvantage26,27. Integrated controllers which consist of more than on control technique were also used for position control of 2-DOF robots such as FLC-SMC28,29, FLC-PID30, and FLC-NN31. There are many other control techniques were critically discussed in the literature32.

Based on the discussed previous studies, the mathematical modelling of robots is a serious problem faces researchers and control engineers either the difficulty of mathematical operations or the challenge of obtaining accurate models. Therefore, the first objective is to obtain the SimMechanics model of the 2-DOF robot from the CAD assembly design via SimMechanics environment in MATLAB (RRID:SCR_001622); an open access alternative is GNU Octave (RRID:SCR_014398). The second objective is to design the PD-FL integrated controller to control the 2-DOF robot in terms of point-to-point position control of the links, triangular TTT and rhombic TTT. The remaining sections of this paper are as follows: section 2 describes the system and the SimMechanics model. Section 3 explains the proposed controller design. Section 4 presents the results and discussion. Section 5 is the conclusion.

System and the SimMechanics model

A schematic diagram of the 2-DOF robot is shown in Figure 1 which consists of two links with 50-cm length of each link and a 4.5 cm2 cross-sectional area. The movement of this robot is only on the horizontal plane. The tip position of the robot is computed based on Equation 1.

[PxPy]=[cosθ1sinθ1cos(θ1+θ2)sin(θ1+θ2)][L1L2](1)

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure1.gif

Figure 1. Schematic diagram of the 2-DOF robot.

The CAD assembly of the 2-DOF is designed as shown in Figure 2. The CAD assembly is used to generate the SimMechanics model of the 2-DOF robot. The SimMechanics model is obtained starting by building the CAD assembly design of the robot and export the CAD assembly and save it in the format of ‘XML’ file. Then, the assembly ‘XML’ file is imported to the MATLAB SimMechanics toolbox using the ‘smimport’ function. The steps of generation the SimMechanics model is explained in detail in Figure 3. The SimMechanics model of the 2-DOF robot is presented in Figure 4. The SimMechanics model was generated and used in previous research such as in reference 9 and reference 10.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure2.gif

Figure 2. CAD assembly of the 2-DOF robot.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure3.gif

Figure 3. Steps of SimMechanics model generation.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure4.gif

Figure 4. SimMechanics model of the 2-DOF robot.

Control design

The 2-DOF robot is controlled by the PD-FL integrated controller. The PD controller is selected due to its simplicity of design and it is widely used. The PD parameters can be easily tuned based on trial and error13,14, Equation 2 shown the PD control transfer function. Two PD controllers are designed as the PD controller is single input single output. The parameters of the two PD controllers are manually tuned and the better performance is achieved by the parameters tabulated in Table 1.

Table 1. Parameters of PD controllers.

ControllerKPKD
PD 154.5
PD 216.21.5

GC=KP+KDs(2)

FL controller is an intelligence control technique that depends on expressing the system behaviour. FL uses errors as its input variables and assigns the input into partial degrees of membership functions (MFs)33. The MF amplitude varies between 0 and 1. The fuzzy rules are expressed in the form of IF-THEN to describe the relation between inputs and outputs depended on the MFs. The MFs are designed and tuned in terms of range, numbers, and shape as shown in Figure 5 for the two inputs and outputs, they are described by “positive big” (PB), “positive medium” (PM), “positive small” (PS), “zero” (ZE), “negative big” (NB), “negative medium” (NM), and “negative small” (NS). Then, the fuzzy rules are tuned to describe the system errors depended on the MFs and to decide what fuzzy output should be, Table 2 describes the fuzzy rule-base. Table 2 shows the fuzzy rules reduction from 49 rules to 25 rules. The fuzzy rules reduction improves the computational time and simplifies the FL controller design.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure5.gif

Figure 5. Membership function of FL controller for the 2-DOF robot.

Table 2. Fuzzy rules of FL controller for the 2-DOF robot based on error 1 (e1), error 2 (e2), output 1 (u1), and output 2 (u2).

e1PBPMPSZENSNMNB
e2u1u2u1u2u1u2u1u2u1u2u1u2u1u2
PBPBPMPBPMPBPMZEPMNSPMNon-effective
PMPBPSPBPSZEPSZEPSNSPS
PSPBPSPBPSPBPSZEPSNSPS
ZEPBZEPBZEPBZEZEZENSZE
NSPBNSPBNSPBNSZENSNSNS
NMNon-effective
NB

The 2-DOF robot model and proposed PD-FL controller is shown in Figure 6. The outputs of the two PD controllers are the fuzzy inputs, and the fuzzy outputs are the robot inputs. The first PD controller controls link 1 and the second PD controller control link 2. The two PD controllers initially control the robot and minimize the errors, which do not reach NM and NB regions. Thus, there is no effectiveness of the fuzzy rules for NM and NB of errors which helps to minimize the fuzzy rules number from 49 to 25. This fuzzy rules’ reduction solves the issue of the computational time and also simplifies the FL controller design. The proposed PD-FL integrated controller

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure6.gif

Figure 6. SimMechanics model with PD-FL integrated controller.

Results and discussion

This section presents and discusses the results of point-to-point position control and the TTT.

Point-to-point position control

The performance of the PD-FL integrated controller and the conventional PD controller is shown in Figure 7 for the first link of the 2-DOF robot by the blue line and the red line, respectively. The PD-FL integrated controller demonstrated great improvement in terms of “rise time” (Tr), “settling time” (Ts), “overshoot” (OS), and “steady state error” (ess) compared with the PD controller alone as analyzed in Table 3.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure7.gif

Figure 7. Point-to-point position control of link 1.

Table 3. Performance analysis for position control of link 1.

ControllerTr (ms)Ts (s)OS %ess (rad)
PD-FL129.4710.1960.5050.00
PD153.9071.7329.3410.00

The PD controller has better performance for link 2 than link 1 as shown in Figure 8, this is because link 2 is a load to link 1 which makes the control of link 2 easier than control link 1 for the PD controller. However, the PD-FL integrated controller has better performance than the PD controller for link 2 as it has shorter rise time (Tr) and settling time (Ts), also it has less overshoot as described in Table 4. Based on the results of point-to-point position control of the 2-DOF robot, it is obvious that the PD-FL integrated controller is better than the conventional PD controller as it has shorter rise time (Tr), shorter settling time (Ts), and less overshoot for link 1 and link 2.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure8.gif

Figure 8. Point-to-point position control of link 2.

Table 4. Performance analysis for position control of link 2.

ControllerTr (ms)Ts (s)OS %ess (rad)
PD-FL99.4440.30112.5770.00
PD104.1880.49510.5560.00

Tip trajectory tracking

The PD-FL integrated controller is tested for TTT of the 2-DOF robot for triangular TTT and rhombic TTT as follows.

Triangular tip trajectory tracking

The triangular TTT of the 2-DOF is shown in Figure 9 for the PD-FL controller and the PD controller, The triangular TTT starts and ends based on the following trajectory points (X,Y): (1.0,0.0), (0.9,−0.1), (0.9,0.1), (1.0,0.0). It can be seen that the TTT of the PD-FL controller trajectory is nearer to the reference than the TTT of the PD controller. Based on the X and Y errors of both controllers in Figure 10, the improvement of the PD-FL integrated controller for the triangular TTT is also noticeable. The maximum Y error of the PD-FL integrated controller is less than 6 millimeters, but it is more than 9 millimeters for the PD controller. The X error of the PD-FL integrated controller is also smaller than the X error of the PD controller as presented in Figure 10.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure9.gif

Figure 9. Triangular TTT performance of the 2-DOF robot.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure10.gif

Figure 10. X and Y error of the triangular TTT.

Rhombic tip trajectory tracking

The rhombic TTT starts and ends based on the following trajectory points (X,Y): (1.0,0.0), (0.9,−0.1), (0.8,0.0), (0.9,0.1), (1.0,0.0). Figure 11 shows the rhombic TTT of the 2-DOF robot. It is clearly shown that the PD-FL integrated controller is better than the PD controller in tracking the tip of the 2-DOF robot as it is closer to the tip reference trajectory. Furthermore, the maximum Y error of the PD controller tracking is about 8 millimeters while the maximum Y error of the PD-FL controller is less than 4 millimeters as shown in Figure 12. The X error of the PD controller is also larger than the X error of the PD-FL integrated controller as presented in Figure 12. Thus, the PD-FL integrated controller performance for the rhombic TTT of the 2-DOF robot is better than the PD controller.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure11.gif

Figure 11. Rhombic TTT performance of the 2-DOF robot.

c7d20eef-dfda-4dc4-8d1c-947ec0ee10a2_figure12.gif

Figure 12. X and Y error of the rhombic TTT.

The discussed results of the point-to-point position control and the TTT demonstrate the improvement of the proposed controller in terms of fast response and accuracy. Normally, the faster response is the more overshoot and larger tip position error. However, the proposed PD-FL integrated controller has a faster response and reduces the overshoot and the tip position error of the 2-DOF robot. Furthermore, the proposed controller has the advantage of design simplicity compared with other integrated controllers.

Conclusion

The aim of this research was to obtain the SimMechanics model of the 2-DOF robot using MATLAB SimMechanics Toolbox from the CAD assembly design. Then, the PD-FL integrated controller was designed to control the 2-DOF robot in terms of point-to-point position control and TTT. This proposed integration technique of the PD controller and the FL controller improves the position control performance and reduces the fuzzy rules which results in avoiding the computational time drawback. The PD-FL integrated controller was used to control the 2-DOF robot for point-to-point position control which demonstrates enhanced performance compared with the conventional PD controller. Moreover, the 2-DOF robot was controlled for triangular TTT and rhombic TTT by the PD-FL integrated controller which has better performance than the PD controller.

Data availability

Figshare: Data are available under the term of the ‘2-DOF robot data of position control and tip trajectory tracking’ and has the following DOI: https://doi.org/10.6084/m9.figshare.16706458.

Figshare: The model of the 2-DOF robot and control is available under the term of the ‘2-DOF robot model’ and has the following DOI: https://doi.org/10.6084/m9.figshare.16714324.

Comments on this article Comments (0)

Version 2
VERSION 2 PUBLISHED 15 Oct 2021
Comment
Author details Author details
Competing interests
Grant information
Copyright
Download
 
Export To
metrics
Views Downloads
F1000Research - -
PubMed Central
Data from PMC are received and updated monthly.
- -
Citations
CITE
how to cite this article
Lee TS, Alandoli EA and Vijayakumar V. 2-DOF robot modelling by SimMechanics and PD-FL integrated controller for position control and trajectory tracking [version 1; peer review: 1 approved with reservations]. F1000Research 2021, 10:1045 (https://doi.org/10.12688/f1000research.72912.1)
NOTE: If applicable, it is important to ensure the information in square brackets after the title is included in all citations of this article.
track
receive updates on this article
Track an article to receive email alerts on any updates to this article.

Open Peer Review

Current Reviewer Status: ?
Key to Reviewer Statuses VIEW
ApprovedThe paper is scientifically sound in its current form and only minor, if any, improvements are suggested
Approved with reservations A number of small changes, sometimes more significant revisions are required to address specific details and improve the papers academic merit.
Not approvedFundamental flaws in the paper seriously undermine the findings and conclusions
Version 1
VERSION 1
PUBLISHED 15 Oct 2021
Views
31
Cite
Reviewer Report 02 Nov 2021
Xuan Bien Duong, Advanced Technology Center, Le Quy Don Technical University, Hanoi, Vietnam 
Approved with Reservations
VIEWS 31
Reviewer Comment for Authors
1. Comment No. 1
  • This paper implements modeling a planar two links robot with rotational joints based on 3D CAD model and SIMMECHANICS Toolbox in MATLAB software. This model retains the
... Continue reading
CITE
CITE
HOW TO CITE THIS REPORT
Duong XB. Reviewer Report For: 2-DOF robot modelling by SimMechanics and PD-FL integrated controller for position control and trajectory tracking [version 1; peer review: 1 approved with reservations]. F1000Research 2021, 10:1045 (https://doi.org/10.5256/f1000research.76525.r97077)
NOTE: it is important to ensure the information in square brackets after the title is included in all citations of this article.
  • Author Response 17 Nov 2021
    tian lee, Faculty of Engineering and Technology, Multimedia University, 75450 Ayer Keroh, Malaysia
    17 Nov 2021
    Author Response
    The following points are the comments from Dr. Xuan Bien Duong and the authors' responses.

    Reviewer Comment No. 1

    This paper implements modeling a planar two links robot with ... Continue reading
COMMENTS ON THIS REPORT
  • Author Response 17 Nov 2021
    tian lee, Faculty of Engineering and Technology, Multimedia University, 75450 Ayer Keroh, Malaysia
    17 Nov 2021
    Author Response
    The following points are the comments from Dr. Xuan Bien Duong and the authors' responses.

    Reviewer Comment No. 1

    This paper implements modeling a planar two links robot with ... Continue reading

Comments on this article Comments (0)

Version 2
VERSION 2 PUBLISHED 15 Oct 2021
Comment
Alongside their report, reviewers assign a status to the article:
Approved - the paper is scientifically sound in its current form and only minor, if any, improvements are suggested
Approved with reservations - A number of small changes, sometimes more significant revisions are required to address specific details and improve the papers academic merit.
Not approved - fundamental flaws in the paper seriously undermine the findings and conclusions
Sign In
If you've forgotten your password, please enter your email address below and we'll send you instructions on how to reset your password.

The email address should be the one you originally registered with F1000.

Email address not valid, please try again

You registered with F1000 via Google, so we cannot reset your password.

To sign in, please click here.

If you still need help with your Google account password, please click here.

You registered with F1000 via Facebook, so we cannot reset your password.

To sign in, please click here.

If you still need help with your Facebook account password, please click here.

Code not correct, please try again
Email us for further assistance.
Server error, please try again.