makes with the x
0
axis is ∠BAC + θ
AC
therefore θ
1
=
∠BAC + θ
AC
– 90 degrees. The angle θ
1
for any
point on the circle scribed by |AC| can be obtained
with this technique as can the angle on any plan
view circle within the robot arms workspace.
Step 3: Once θ
1
is determined the solution for angles
θ
2
and θ
3
become solutions for a simple two axis
robot arm in two dimensions as long as the p
wx
component is the length |BC| shown in Figure 3.
Step 4: Now that the waist, shoulder and elbow joint
angles have been identified a change of approach
will provide solutions for the pitch and tilt angles.
The forward arm matrix is made up of the
multiplication of six translation and rotation
matrices
R
T
H
= A
1
A
2
A
3
A
4
A
5
A
6
The product A
1
A
2
A
3
and its inverse can now be
calculated, therefore multiplying the given position
and orientation matrix by the inverse of A
1
A
2
A
3
will
provide a pan_tilt matrix, which is equal to A
4
A
5
A
6
.
A
6
is a constant known rotation and inspection of the
coefficients of A
4
A
5
A
6
provides solution equations
for θ
4
and θ
5
which are:
θ
4
= Atan2(pan_tilt(1,1), -1*pan_tilt(2,1))
θ
5
= Atan2(-1*pan_tilt(3,3),-1*pan_tilt(3,2)).
The solution outlined does not make use of the
360
0
continuous rotation capability of shoulder and
elbow joints as solutions will always place these
angles in the right half circle whose centre line is
along |AB| and containing the point C. However if
the shoulder and elbow joints make angles which
move point C into the opposite half of the circle then
a simple change will produce the alternative
solution; θ
1
= θ
AC
- ∠BAC – 90. The p
wx
component will be negative for this condition.
In a practical application requiring random
movement to different locations both solutions could
be tested and the one requiring the shorter travel
distance would be executed. The solution complying
with pitch and tilt limits also requires testing, as
does the elbow up and down options.
A Matlab
TM
function inv_axis_5.m has
been written which implements each of the steps
outlined for the first solution. However data to test
the code is difficult to generate. The data must be
within the operational workspace of the robot
manipulator and not cause singularities. Most robot
manipulators are pre-programmed and components
to be sprayed must be placed in exact location and
orientation, which is very time consuming. This
highlights one of the key areas for more advanced
research, that is the generation of trajectory data
using information from 3D transducers for the robot
to operate autonomously and to carry out requested
random movements efficiently. To test the code the
forward kinematic function axis_5.m was used to
generate position and orientation data as input data
to the inverse kinematics function.
Running the function using the previous
numerical example in section 2.2 where the input
angles are [ -170 50 –45 20 –30 ] provides solution
angles which are different [-170 20.7 45 -40.7 –30 ]
but with identical input and output position and
orientation arm matrices, highlighting the different
solutions outlined. The tilt and pan angles are within
range.
A significant advantage of continuous rotation
360
0
joints is the travel distance/time required. As an
example if the robot arm is in the home position and
a call is made for the shoulder joint to rotate 260
0
the
robot can move in the opposite direction by –100
0
in
a shorter time. If the same time is acceptable the
robot can move slower with less vibration. Safety is
a key issue and must be taken into consideration
with 360
0
continuous rotation calls as the torch may
hit the vertical joint.
Determining closed form inverse equations
produces a more computer efficient system than
alternative methods, which use the forward
kinematic equations, and iterative methods such as
Gaussian elimination (Niku).
2.4 Joint cabling
Joint cabling research for power and data is pointing
to the use of PTFE electroless nickel slip rings and
brushes. PTFE electroles nickel has the advantages
of low coefficient of friction, low wear and being a
good conductor. A prototype slip ring and brushes
test rig using electroless nickel coated copper
samples was set up and zero resistance was recorded
on the lowest resistance setting (200 Ω) of a
standard digital multimeter. Inclined plane tests
indicate a coefficient of friction for electroless nickel
on electroless nickel, which is 30% better than
copper on copper. PTFE electroless nickel should
provide better results than this. The slip ring and
brushes was videoed with the video signal passing
through the slip rings without any appreciable
reduction in quality.
3 LASER PATTERN CONTROL
Research is now concentrating on mapping
autonomously, complex 3D surfaces in the harsh
THERMAL SPRAYING ROBOT KINEMATICS AND LASER PATTERN CONTROL
413