Motion Tracking for a 3-DOF Robotics System by Using Particles Swarm Optimization
Motion Tracking for a 3-DOF Robotics System by Using Particles Swarm Optimization
CrossMark
View Export
Online Citation
Ǥ̷ǤǤ
a)
b)
[email protected], [email protected]
c)
Corresponding author: [email protected], [email protected].
Abstract: Robotics is among the much-touted treatment and therapy solutions in modern dentistry. A unique Particle
Swarm Optimization PSO is utilized to manage the needle tip location and direction as a function of the knots along the
path between the end-effector segments in a dentistry robotics navigation system recently suggested. The innovative
"Numeric Alphabet Flow" (NAF) method may control any point-to-point surgical motions for a three-link robotic guiding
INTRODUCTION
The robotics system is employed in surgical due to its excellent quality, accuracy, efficiency, and reliability. Since
their recent improvement, high-techs such as robotics lasers and dentistry laser are now used in root canal therapy and
light bio-stimulate chemically injured cells. We examine our suggested robotics system, the continuous movement
control for avoiding obstacles for robotics control system, in this study. The dentistry robotics might assist dentist
therapists in their treatments both practically and aesthetically, since it decreases surgical times, as demonstrated by
our novel technique, and improves precision and effectiveness via the new update of the NAF-BBO technique. The
therapist's operation is essentially planned in software, and the robotics will help the doctor thru the process by
displaying every detail on a monitor. Then if the technique changes, the therapist may readily modify the program.
Supplement given by toothpaste or mouthwash might patrol entire subs and above gingival areas at minimum once
a day, converting stuck organic material into odorless, harmless vapors and performing continuous cleaning. Gingival
sickness and tooth decay could be avoided with these dentists [1-5]. Robots are mostly utilized for industrial
applications, but they can also be used mostly for medical uses. The gripper is made up of linkages that are joined
together by joints. Those joints could be prismatic or rotatory, with the prismatic having linear movement and the
rotatory having rotating movement. Every joint has only one degree of freedom (DOF) [6-7]. Minimum invasive
surgery (MIS) is viewed as a possible alternative for treatment and care in various clinical settings [8]. Due to the low
accessibility for this type of procedure, percutaneous participation is of specific importance [9]. It is mostly used with
a standard needle since doctors can presume that its activity is automatically suitable in the tissue during the inserting
operation. [10-12] demonstrate attempts to use an adjustable needle to reach a target and ignore impediments.
020030-1
Several examples include the magnetically guided needle guidance system introduced in [13], in which the needle
tip is controlled by a magnetic force in the presence of an impediment. In addition, [14] describes a lungs biopsy that
is aided by a robotics application. In this type of thinking, our research presents a dentistry robotics guiding system
using straight kinematic and inverse dynamics. The optimal path minimizes both space and time given that the
maximal preset force is not exceeded without colliding with the 'no-go' zones. With these novel techniques in
consideration, the following is the architecture of this article:
The path movement approach is shown in Section (II); the particle swarm optimization strategy is presented in
Section (III); the simulation results are presented in Section (V); and the conclusion and future work is presented in
Section (IV).
Many segments link the proposed route with continuous acceleration. This is accomplished by the use of multiple
points, as seen in Figure (1). The transitional points are the ones that must be gone by.
020030-2
The constants would be as:
ߠ ൌ ܾ …….. (14)
ߠାଵ ൌ ܾ ܾଵ ܶ ܾଶ ܶଶ ܾଷ ܶଷ ܾସ ܶସ ܾହ ܶହ …….. (15)
ߠሶ ൌ ܾଵ …….. (16)
ߠሶାଵ ൌ ܾଵ ʹܾଶ ܶ ͵ܾଷ ܶଶ Ͷܾସ ܶଷ ͷܾହ ܶସ …….. (17)
ߠሷ ൌ ʹܾଶ …….. (18)
ߠሷାଵ ൌ ʹܾଶ ܾଷ ܶ ͳʹܾସ ܶଶ ʹͲܾହ ܶଷ ….. (19)
And the solutions to these constraints are:
ܾ ൌ ߠ …….. (20)
ܾଵ ൌ ߠሶ …….. (21)
ሷ
ܾଶ ൌ ߠ Ȁʹ ……… (22)
ܾଷ ൌ ሺʹͲߠାଵ െ ሺͺߠሶାଵ ͳʹߠሶ ሻܶ െ ʹͲߠ െ ሺ͵ߠሷ െ ߠሷାଵ ሻܶଶ ሻȀሺʹܶଷ ሻ …. (23)
ܾସ ൌ ሺͳʹߠାଵ െ ͳʹߠ െ ൫ߠሶାଵ ߠሶ ൯ܶ െ ൫ߠሷ െ ߠሷାଵ ൯ܶଶ ሻȀሺʹܶହ ሻ (24)
…..
The angles, angular velocities, total duration for each section, and conclusion configuration (n-m) with each
midpoint are acquired as constructed and examined above. Considering that the solution nine variables for three
linkages robotics example, considering n = 3 and mp = 1.
020030-3
(a) (b)
(c)
020030-4
In n-dimensional space, the best previous position of the ith particle is recorded as:
ܲ௦௧ ൌ ሺܲ௦௧ǡభ ǡ ܲ௦௧ǡమ ǡ ܲ௦௧ǡయ ǥ ǥ Ǥ ܲ௦௧ǡ ሻ …..(27)
The updated location and speed of each particle may be determined using the distance and current speed from
(ܲ௦௧ǡ ) to (݃௦௧ ) as demonstrated by the equation [17, 18, 19, and 21]:
ሺூ௧Ǥାଵሻ ሺூ௧Ǥሻ ሺூ௧Ǥሻ ሺூ௧Ǥሻ
ܸǡ ൌ ܹ ܸ כǡ ܿͳ כ ݀݊ܽݎ כቀܲ௦௧ǡ െ ݔǡ ቁ ܿʹ כ ݀݊ܽݎ כሺ݃௦௧ െ ݔǡ ሻ …. (28)
ሺூ௧Ǥାଵሻ ሺூ௧Ǥሻ ሺூ௧Ǥሻ
ݔǡ ൌ ݔǡ ݒǡ ………..(29)
i=1, 2, 3….., n
m=1, 2, 3….., d
Where;
n = Particles Number.
d = Area Space Dimension.
It. = Number of Iterations.
ሺூ௧Ǥሻ
ܸǡ = Velocity of (i) particle at iteration (It).
W = Inertia factor.
c1,c2 = Acceleration Constant.
rand = Random number from 0 to 1.
ሺூ௧Ǥሻ
ݔǡ = The Current location of particle i at iteration (It).
ܲ௦௧ = Best previous location of ith particle.
݃௦௧ = Global best particle in the population.
PSO design is complicated because response of the system must be checked in position of the particle and each
020030-5
Start
Fitness Function
Calculation
Find the pest local position and the best global position
If
No Max iteration number reached?
Yes
End
020030-6
(a) (b)
(c)
Figure (7) depicts all mass placed at the trailing edge of each connection as a particle moving for simplification.
020030-7
SIMULATION RESULTS
This section shows the results of the simulation by using MATLAB/Simulink of the 3-DOF robot manipulator
with PSO case. It is illustrated on applying 3-link robot which starts and end point coordinates will be as in the table
(1)
TABLE 1. starts and end point coordinate
X (m) Y (m) ࣂg (Deg.)
Start Point 0 2.26 81
End Point -2.1 0
The table (2) displays the robotic links configurations
TABLE 2. robot links parameters
Length Mass (kg) Max. Torque
(m) (N.m)
Link1 0.8 0.9 46
Link2 0.6 0.7 21
Link3 0.5 0.6 6
The velocities and accelerations of the start-end-configuration, on the other hand, are assumed to be zeros.
Furthermore, all of the robot's joints revolve 2π. The barrier is shaped like a circle having a diameter of 0.9 m. PSO
creates the Fuzzy Logic Controller's decision rules with the below range:
െߨ ߠ ߨ Rad (i=1,2,3) ………… (34)
െߨ ߠ ߨ Rad (i=1,2,3) ………… (35)
െߨȀͶ ߠሶ ߨȀͶ Rad (i=1,2,3) ………… (36)
ͲǤͳ ݐ ͺǤͳ Sec (i=1,2) ………… (37)
Figures (8-11) show the outcomes of free space enhancement.
020030-8
FIGURE 10. Joints velocity in free areas
020030-9
FIGURE 14. Joint velocity in the existence of an obstacle
Figures (12-15) illustrate the results of PSO improvement in the presence of an obstruction with parameters x=-
0.5, y=1.8. Figure 8 depicts the journey in Cartesian coordinates. The smallest path was from start to finish point,
although it is not the best outcome from the PSO improvement. Figures (9 and 12) and (10 and 13) illustrate the
optimal mid-joint angle and velocity, respectfully. Figures 10 and 12 illustrate the torque plotted versus of the joints
in free space as black dots. In Figures 11 and 13, the torque acquired with obstacle presence is larger than the joint
orientation in available space, and in both circumstances, the preset torque is not exceeded. Figure 12 depicts the use
of NAF-PSO and the presence of obstacles along the Cartesian track. Table 3 displays the values for total time, total
journey distance, and total trajectory length.
TABLE.3 simulation results
Free workspace Obstacle
workspace
Overall time (sec) 2.75 7.24
Overall distance (rad) 1.92 5.79
Overall trajectory length (m) 3.25 3.41
Figure (16) depicts a comparison result of the suggested PSO approach and the conventional adaptation approach
of the fuzzy logic controller, based on which the following recommendations may be drawn:
1. The suggested PSO adaptation approach is extremely computationally effective in terms of eliminating
processing time, straightforward to apply, and has a basic principle. In contrast to the traditional adapting
approach, which requires a lengthy adaptation period and a difficult operation.
020030-10
2. The fuzzy system provides good system efficiency in the conventional adaptation method: maximum.
Overshot is 4% and 0% in high velocity, the rising time is 6 seconds, the system response is 6.5 seconds, and
the eSS = 0%.
3. The suggested PSO adaptation approach outperforms the competition, with maximum overshot = 0% in both
high and low velocity variations, rising time = 3 sec, response time = 3 sec, and eSS = 0%.
The suggested PSO adaptation approach achieves better speed tracking with non-sluggish performance and a more
stable control system than conventional FLC adaption.
Comparison Performance
1.2
Command Speed
0.8
Speed (p.u)
0.4
0.2
0
0 2 4 6 8 10 12 14 16 18 20
Time (sec)
020030-11
13. L. Tang, Y. Chen, and X. He, "Magnetic Force Aided Compliant Needle Navigation and Needle Performance
Analysis," in IEEE International Conference on Robotics and Biomimetics, Sanya, China, 2007, pp. 612-
616.
14. L. B. Kratchman, M. M. Rahman, J. R. Saunders, et al., "Toward Robotic Needle Steering in Lung Biopsy:
A Tendon-Actuated Approach," in Proc. of SPIE, 2011.
15. Bimal K. Bose, “ Modern Power Electronic and AC Drives”, Prentice Hall, 2002.
16. Ali Muhssen Abdul-Sadah, Kamal M. H. Raheem, and Mohammed Mahdi Salih Altufaili , "A fuzzy logic
controller for a three links robotic manipulator", AIP Conference Proceedings 2386, 050026 (2022)
https://doi.org/10.1063/5.0066871
17. B. Allaoua, B. Gasbaoui, B. Mebarki, "Setting Up PID DC Motor Speed Control Alteration Parameters
Using Particle Swarm Optimization Strategy", Leonardo Electronic Journal of Practices and Technologies,
Issue 14, P 19-32, 2009.
18. B. Nagaraj, N. Murugananth, "Soft Computing-Based Optimum Design of PID Controller for a Position
Control of DC Motor", Mediamira Science Publisher, Vol. 51, No. 1, 2010
19. Lucas Alves Dias, Roger William de Oliveira Silva, Paulo César da Silva Emanuel, André Ferrus Filho, and
Rodrigo Teixeira Bento, “Application of the Fuzzy Logic for the Development of Automnomous Robot with
Obstacles Deviation” International Journal of Control, Automation, and Systems , vol. 16, no. 2, pp.823-833,
2018
20. Ali M. A., Ameer Najm Najaf, and Nasseer K. Bachache , "Image enhancing using both interval type-2 fuzzy
sets and IT2PFCM", AIP Conference Proceedings 2386, 050025 (2022) https://doi.org/10.1063/5.0066866
21. Kamal M. H. Raheem, O. O. Hassoon, and Ali Muhssen Abdul-Sadah , "Modeling 3-Degree of freedom
robotics manipulator with PID and sliding mode controller", AIP Conference Proceedings 2386, 050011
(2022) https://doi.org/10.1063/5.0066824
22. A. Fatlawi, A. Vahedian and N. K. Bachache, "Optimal Camera Placement Using Sine-Cosine Algorithm,"
2018 8th International Conference on Computer and Knowledge Engineering (ICCKE), Mashhad, Iran, 2018,
020030-12