Professional Documents
Culture Documents
ISSN No:-2456-2165
Abstract:- This paper focused on the development of low Robotic arms have been around for a long time, they are
grade robotic arm for small industries who cannot afford used in industries for tasks such as welding, assembly lines,
heavy duty and expensive arm made by most companies. material handling etc. and they serve their purpose effectively.
Most small factories in regions like Africa are in desperate As pointed out in the study of [3], the use of the industrial
need of a device to handle repetitive tasks but they cannot robot, which became identifiable as a unique device in the
meet up with the purchase and maintenance cost of 1960s along with computer-aided design (CAD) systems and
companies like KUKA, Fanuc, etc. so they rely on human computer-aided manufacturing (CAM) systems, characterizes
labour which is inaccurate and causes body pain for the the latest trends in the automation of the manufacturing
workers. In this work, a 5 degree of freedom robotic arm process.
was developed to solve this problem.
The idea to use multiple end effectors have been around
The link of the robotic arm was 3d printed using poly for some years now. A specific arm can be well equipped and
lactic acid filaments and the ATmega328P AVR designed with all types of end effectors which are fitted for
microcontroller was used to control the arm, four metal particular application. [4].
gear servo was used to actuate the arm while one servo was
used for the end effector. The critical load for the arm was In this paper, a 5 degree of freedom robotic arm was
established after running the stress analysis for each of the developed. These type of robots are used in factories for
links. And forward and inverse kinematic equations was tedious repetitive tasks that leads to body pain and
developed to track the position and rotation of the end deformation when performed by a human.
effector in 3D space. The arm can work in two modes,
sentry and user mode. A hard switch was provided to The design process taken include design stage,
switch from one mode to the other. Sentry mode was construction and testing. The mechanical and electrical design
designed for repetitive tasks. User mode allows a controller of the arm allows for different end effectors to be attached to
to operate the arm using a joystick to control the joints. perform various tasks. The robot was actuated using two types
Software stress analysis was done using Autodesk inventor of servo motors, the MG996r metal gear servo and the SG90
and physical evaluations were conducted and the arm 9g servo. The ATmega328P was used as the Micro control
performed as expected. unit(MCU) and it was powered using rechargeable batteries.
The links of the robotic arm 3D printed using Poly lactic acid
Keywords:- Robotic Arm, Industrial Robot, Robotics, Forward (PLA) and other materials such as wood and aluminium were
Kinematics, Inverse Kinematics, Automation. employed to complete the build. The arm has a base which
rotates 180 degrees around the z-axes and two links joined by
I. INTRODUCTION a rotary joint. Only one end effector was used in the test but
others can be attached depending on the task at hand.
A robot is an electro-mechanical machine, which is
guided by a computer program or electronic circuitry to carry II. MATERIALS AND METHODS
out a variety of physical tasks or actions. There have been
many definitions of a robot. According to[1] a robot arm is a The procedures employed include the design stage,
device which is to do performs automated task, either construction and testing. To track the position of the end
according to direct human supervision, pre-defined program, effector in 3D-space, it was necessary to device kinematic
set of general guideline, using (artificial intelligence) equations to do this.
techniques.
2.1 Forward Kinematic Analysis
Robots have found their way into most aspects of life To get the position of the end effector after rotating the
such as from manufacturing to our various homes. In the past joints, a forward kinematics equation was derived. Joint
few decades the robotic arm industry has experienced rotations were gotten by reading the initial and final position
exponential growth, this has made it possible for vast research of the servo motors. This angles were then injected into a
and development to occur [2]. forward kinematics equation which was used to know both the
position and rotation of the tool center position(TCP).
𝑅 ∆]
𝑇= [ (4)
0 1
Where;
𝑅11 𝑅12 𝑅13
R = rotation matrix =𝑅21 𝑅22 𝑅23 (5)
𝑅31 𝑅32 𝑅33
And
∆𝑥
FIGURE 2.0 Translation = ∆ = {∆𝑦 (6)
JOINTS IN THE ROBOTIC ARM
∆𝑧
TABLE I Hence,
az1 ax2 ay2 az2 az3 ay3 ax4 ay4 𝑅11 𝑅12 𝑅13 ∆𝑥
59 11 15.5 21 90 10 100 9.5 𝑅 𝑅22 𝑅23 ∆𝑦
𝑇 = [ 21 ] [ ] (7)
TRANSLATIONS ON THE ROBOTIC ARM 𝑅31 𝑅32 𝑅33 ∆𝑧
0 0 0 1
Where az1 is the translation along the z axis between the base
and joint 1 𝑅11 𝑅12 𝑅13 ∆𝑥
ax2 is the translation along the x axis between the joint1 and 𝑅 𝑅22 𝑅23 ∆𝑦
𝑇 = [ 21 ] (8)
joint2 𝑅31 𝑅32 𝑅33 ∆𝑧
ay2 is the translation along the y axis between the joint1 and 0 0 0 1
joint2
az2 is the translation along the z axis between the joint1 and The combined rotation and translation matrix was gotten by
joint2 moving from joint to joint.
ax3 is the translation along the x axis between the joint2 and
joint3 From the base to joint 1(J1), translation only occurs in the z-
az3 is the translation along the z axis between the joint2 and axes and rotation is around the z-axes. The translation is
joint3 denoted by az1. The matrix is shown in (9) and (10).
ay3 is the translation along the y axis between the joint2 and
joint3 cos 𝜃1 − sin 𝜃1 0 0
ax4 is the translation along the x axis between the joint3 and sin 𝜃1 cos 𝜃1 0 0 ]
𝑇1 = [ (9)
joint4 0 0 1 𝑎𝑧1
ay4 is the translation along the y axis between the joint3 and 0 0 0 1
joint4
cos 𝜃1 − sin 𝜃1 0 0
Combined rotation and translation was considered and the
sin 𝜃1 cos 𝜃1 0 0]
base of the arm served as the local coordinate system. Rotation 𝑇1 = [ (10)
matrix around each axes is given by (1), (2) and (3); 0 0 1 59
0 0 0 1
1 0 0
𝑅𝑥 (𝜃) = 0 cos 𝜃 − sin 𝜃 (1) From J1 to J2, translation occurs in all 3 axes and rotation is
around the y-axes. The translations are denoted by ax2, az2,
0 sin 𝜃 cos 𝜃
ay2. The matrix is shown in (11).
cos 𝜃 0 sin 𝜃
𝑅𝑦 (𝜃) = 0 1 0 (2) cos 𝜃2 0 𝑠𝑖𝑛 𝜃2 11
− sin 𝜃 0 cos 𝜃 𝑇2 = [ 0 1 0 15.5] (11)
−𝑠𝑖𝑛 𝜃2 0 cos 𝜃2 21
cos 𝜃 − sin 𝜃 0 0 0 0 1
𝑅𝑧 (𝜃) = sin 𝜃 cos 𝜃 0(3)
0 0 1 From J2 to J3, translation occurs in 3 axes and rotation is
around the y-axes. The translations are denoted by az3, ay3.
The matrix is shown in (12).
cos 𝜃3 0 𝑠𝑖𝑛 𝜃3 0
𝑇3 = [ 0 1 0 10] (12)
−𝑠𝑖𝑛 𝜃3 0 cos 𝜃3 90
0 0 0 1
FIGURE 2.3
LOAD DIAGRAM FOR LINK 3
FIGURE 2.5
FREE BODY DIAGRAM IN NEWTON (LINK 3)
Equilibrium condition. Summation of vertical forces must be reaction at A is gotten from (19)
equal to zero; 𝑅𝐴 = 0.4 + 0.14 + 𝑃
𝑅𝐴 = 40.4 + 14 + 𝑃 𝑅𝐴 = (0.54 + 𝑃) 𝑁
𝑅𝐴 = (54.4 + 𝑃)𝑔 (∑𝑓𝑣 = 0) (19) 𝑀𝐴 = (23.044 + 129.6𝑃)𝑁𝑚𝑚
Equilibrium condition. Summation of horizontal forces must From Euler’s equation. [6]
be equal to zero; 𝐸𝐼𝑑2 𝑦
= − 𝑀𝑥 (24)
𝐻𝐴 = 0 (∑𝐹𝐻 = 0) (20) 𝑑𝑥 2
Summing moments about point A yielded (21).
𝑀𝐴 = (2317.84 + 129.6𝑃)𝑔𝑚𝑚 (∑𝑀 = 0) (21) Where𝐸 is the elastic modulus of the material in use
𝐼 is the moment of inertia of the cross-section about the
The moment 𝑀𝐴opposed the torque produced by the actuator. bending axis
So it was necessary the actuator could produce enough torque 𝑦 is the deflection along the beam
to overcome this moment. The MG996r metal gear servo 𝑥 is any point of interest along the beam
produced a maximum stall torque (𝑇𝑆 ) of 11kgcm. [5] While 𝑀𝑥 is the bending moment.
Stall torque (𝑇𝑆 ) = 11 x 1000 x 10gmm (converting to gram Double integration of (23) yields (25) and (26) which are slope
millimeter) and deflection equation respectively.
𝐸𝐼𝑦” = − 𝑀𝑥
𝑇𝑆 = 110000𝑔𝑚𝑚 𝐸𝐼𝑦” = 𝑀𝐴 + 0.4 〈𝑥 − 33.6〉 + 0.14 〈𝑥 − 68.6 〉 − 𝑅𝐴 𝑥
𝐸𝐼𝑦 ′
Performance factor (𝐹𝑝 ) was introduced to compensate for any = 𝑀𝐴 𝑥 + 0.2 〈𝑥 − 33.6〉2 + 0.07 〈𝑥 − 68.6〉2
flaws in the servo motor. − 0.5 𝑅𝐴 𝑥 2 + 𝐶1 (25)
𝐹𝑝 = 0.8 𝐸𝐼𝑦 = 0.5𝑀𝐴 𝑥 2 + 0.0667〈 𝑥 − 33.6〉3
𝑇′𝑆 = 𝑇𝑠 𝑥 𝐹𝑝 + 0.0233〈𝑥 − 68.6〉3 − 0.1667𝑅𝐴 𝑥 3
+ 𝐶1𝑥 + 𝐶2 (26)
𝑇′𝑆 = 110000 𝑥 0.8
Boundary Condition
𝑇′𝑆 = 88000𝑔𝑚𝑚
𝐷𝑒𝑓𝑙𝑒𝑐𝑡𝑖𝑜𝑛 𝑎𝑡 𝑝𝑜𝑖𝑛𝑡 𝐴 (𝑥 = 0) = 0 (𝑎)
Equilibrium condition is shown in (22). 𝑆𝑙𝑜𝑝𝑒 𝑎𝑡 𝑝𝑜𝑖𝑛𝑡 𝐴 (𝑥 = 0) = 0 (𝑏)
𝑇𝑜𝑟𝑞𝑢𝑒 𝑝𝑟𝑜𝑑𝑢𝑐𝑒𝑑 𝑏𝑦 𝑠𝑒𝑟𝑣𝑜 𝑀𝑜𝑡𝑜𝑟 = 𝑀𝐴 (22)
Applying condition (a) to (25);
From (19) and (21);
𝐸1(0) = 0.5𝑀𝐴 (0)2 – 0.1667𝑅𝐴 (0)3 + 𝐶1(0) + 𝐶2
88000 = 2317.84 + 129.6𝑃
88000 – 2317.84 𝐶2 = 0
𝑃= (𝑔𝑚𝑚)
129.6mm Applying condition (b) to (24);
𝑷 = 𝟔𝟔𝟏. 𝟏𝟑𝒈
𝐸1(0) = 𝑀𝐴 (0) – 0.5𝑅𝐴 (0)2 + 𝐶1
For the actuator to effectively lift the load. P must not exceed 𝐶1 = 0
660g.
𝑏𝑑 3 15 (8)3
𝐼𝑥𝑥 = = = 640𝑚𝑚4
12 12
𝑁
𝐸𝐼 = 3.5 𝑥 103 𝑥 640 ( 𝑥 𝑚𝑚4 )
𝑚𝑚2
𝐸𝐼 = 2.24 𝑥 106 𝑁𝑚𝑚2
FIGURE 2.10
CROSS SECTION FOR LINK 2
FIGURE 2.11
𝑏𝑑3 8(30)3 LINK 3 (SECTIONING)
𝐼𝑥𝑥 = = = 18000𝑚𝑚4
12 12
𝐸𝐼 = 3.5 𝑥 103 𝑥 18000 = 63 𝑥 106 𝑁/𝑚𝑚2 The load diagram and free body diagram is shown in Figure
2.12 and Figure2.13 respectively
The point of minimum cross section and maximum
deformation on link 2 was at;
𝑥 = 110𝑚𝑚
Equilibrium condition;
𝑇𝑜𝑟𝑞𝑢𝑒 𝑝𝑟𝑜𝑑𝑢𝑐𝑒𝑑 𝑏𝑦 𝑠𝑒𝑟𝑣𝑜 𝑀𝑜𝑡𝑜𝑟 = 𝑀𝑈
176000 = 31181.24 + 290.6𝑃 (63)
𝑷 = 𝟒𝟗𝟖. 𝟑𝟒𝟒𝒈
For the actuator to effectively lift the arm. P must not exceed
498g. FIGURE 2.14
CROSS SECTION FOR LINK 3
Slope and deflection equation are derived as follows.
Bending moment equation using Macaulay principle. [6] 𝑏𝑑3 8(48)3
was derived as shown in (64); 𝐼𝑥𝑥 = =
12 12
𝑀𝑈 = 𝑅𝑈 𝑋 – 0.26 〈𝑥 − 45〉 – 0. 55 〈𝑥 − 90〉 𝐼𝑥𝑥 = 73728𝑚𝑚4
− 0. 38 〈𝑥 − 135〉 – 0.55 〈𝑥 𝐸𝐼 = 3.8 𝑥 103 𝑥 73728
− 161〉 – 0.40 〈𝑥 − 194.6〉 – 0.14〈 𝑥 𝐸𝐼 = 258 𝑥 106 𝑁/𝑚𝑚2
− 229.6〉 − 𝑀𝑈 (64) Substituting 𝑥 = 90𝑚𝑚into (67) gave (69);
𝐸𝐼𝜃 = 0.13 (90 − 45)2 + 𝑀𝑈 (90)– 0.5𝑅𝑈 (90)2 (69)
Introducing Euler’s equation. [6] 2.25 𝑥 106 = 263.25 + 90𝑀𝑈 − 4050𝑅𝑈 (70)
𝐸𝐼𝑦 " = – 𝑀𝑈 (65) 𝑅𝑈 and 𝑀𝑈 was substituted into (70) to give (71) as shown
𝐸𝐼𝑦 " = 0.26 〈𝑥 − 45〉 + 0.55 〈𝑥 − 90〉 + 0.38 〈𝑥 − 185〉 below;
+ 0.55 〈𝑥 − 161〉 + 0.40.4 〈𝑥 − 194.6〉 2249736.75 = 90 (311.8 + 290.6𝑃)– 4050 (2.284
+ 0.14 〈𝑥 − 229.6〉 + 𝑀𝑈 + 𝑃) (71)
− 𝑅𝑈 𝑥 (66) 𝑃 = 100.93𝑁
𝑷 = 𝟏𝟎𝟎𝟗𝟐. 𝟗𝒈
Double integration of (66) yields (67) and (68) which are our
slope and deflection equations respectively. Hence, if the maximum allowable slope in link 1 was to be
𝐸𝐼𝑦 ′ = 0.13 〈𝑥 − 45 〉2 + 0.275 〈𝑥 − 90 〉2 limited to 0.5 degrees, the load must not exceed 10092 g.
+ 0.19 〈𝑥 − 135〉2 + 0.275〈𝑥 − 161 〉2 Substituting 𝑥 = 90𝑚𝑚 into (68) gave (72);
+ 0.20〈 𝑥 − 194.6 〉2 + 0.7〈𝑥 − 229.6 〉2 𝐸𝐼𝑦
+ 𝑀𝑈 𝑥 − 0.5𝑅𝑈 𝑥 2 + 𝐶1 (67) = 0.0433 (90 − 45)3
+ 0.5𝑀𝑈 (90)2 – 0.1667𝑅𝑈 (90)3 (72)
129 𝑥 106 = 3945.7 + 4050𝑀𝑈 – 121502.43𝑅𝑈 (73)
𝑅𝑈 and 𝑀𝑈 was substituted into (73) to give (74) as shown
below;
Table 2.2 was extrapolated from the stress analysis above FIGURE 2.16
GRIPPER MECHANISM (FOUR BAR CHAIN)
TABLE 2.2
Link Critical value for P (g) Where wBC is the angular velocity at B
wAD is the angular velocity at A
1 498.3 FG is the force which the gripper exerts on the load
2 349.6
3 145.8 In other to get FG, it was necessary to get wBC. wAD is the
CRITICAL VALUES FOR P IN EACH LINK angular velocity of the servo motor and was gotten from the
datasheet as (𝑤𝐴𝐷 = 9.52 𝑟𝑎𝑑/𝑠𝑒𝑐)
Hence maximum load permissible for the robotic arm was 𝑉𝑒𝑙𝑜𝑐𝑖𝑡𝑦 @ 𝐷 (𝑉𝐷 ) = 𝑤𝐴𝐷 𝑥 𝐴𝐷 (75)
taken as 146g. 9.52 𝑥 14
=
1000
2.3.4 END EFFECTOR GRIPPER ANALYSIS = 0.1333𝑚/𝑠
It was paramount to obtain the maximum load the gripper The velocity diagram of the mechanism is shown in
could hold. If this load was exceeded, the gripper wont be able Figure2.17
to handle the load. The end effector is shown in Figure2.15 Scale: 10mm represent 0.05m/s
FIGURE 2.17
VELOCITY DIAGRAM OF THE FOUR BAR CHAIN
From measurement
FIGURE 2.15 𝑉𝐴𝐷 = 26.66𝑚𝑚 = 0.1333𝑚/𝑠
END EFFECTOR 𝑉𝐶𝐷 = 0.85𝑚𝑚 = 0.00425𝑚/𝑠
𝑉𝐵𝐶 = 35𝑚𝑚 = 0.175𝑚/𝑠
The mechanism of the griper is basically a four bar chain. Free ∴ 𝑤𝐵𝐶 = 𝑉𝐵𝐶 /𝐵𝐶
body diagram is shown below in Figure 2.16: 0.175
𝑤𝐵𝐶 = = 8.33𝑟𝑎𝑑/𝑠𝑒𝑐
0.021
FG is the force of gripper. From Figure 2.18, FG is can be The value of µ varies with the material with which the load is
gotten from (77). made.
Since 𝑷 = 146g
12.38
µ = = 8.479
1.46
FIGURE 2.21
FREE BODY DIAGRAM
FIGURE 2.19
FRICTION ANALYSIS OF GRIPPER Where 𝐴 = 177𝑚𝑚 𝐵 = 45𝑚𝑚 𝐶 = 45𝑚𝑚 𝐷 =
45𝑚𝑚
REFERENCES
FIGURE 3.2
DEFORMATION AT 50000G LOADING