0% found this document useful (0 votes)
26 views

Nullspace For Robot

This article proposes a new method called "null space quality" to quantify the controllability of redundant robotic manipulators when operating in the null space. The null space quality defines an ellipsoidal boundary that indicates the directions in which redundant motion is permitted while not interfering with the primary task. This provides a new way to evaluate manipulability and avoid singularities when using null space projection control. The method was tested on a robot performing two simultaneous tasks, maintaining the end effector position while moving the fourth link, and reduced tracking error compared to not using null space quality.

Uploaded by

ROBOTLAB Channel
Copyright
© © All Rights Reserved
Available Formats
Download as PDF, TXT or read online on Scribd
0% found this document useful (0 votes)
26 views

Nullspace For Robot

This article proposes a new method called "null space quality" to quantify the controllability of redundant robotic manipulators when operating in the null space. The null space quality defines an ellipsoidal boundary that indicates the directions in which redundant motion is permitted while not interfering with the primary task. This provides a new way to evaluate manipulability and avoid singularities when using null space projection control. The method was tested on a robot performing two simultaneous tasks, maintaining the end effector position while moving the fourth link, and reduced tracking error compared to not using null space quality.

Uploaded by

ROBOTLAB Channel
Copyright
© © All Rights Reserved
Available Formats
Download as PDF, TXT or read online on Scribd
You are on page 1/ 13

applied

sciences
Article
Numerical Quantification of Controllability in the Null Space
for Redundant Manipulators
Seonwoo Kim , Seongseop Yun and Dongjun Shin *

Human-Centered Robotics Lab, Department of Mechanical Engineering, Chung-Ang University,


Seoul 06974, Korea; [email protected] (S.K.); [email protected] (S.Y.)
* Correspondence: [email protected]; Tel.: +82-2-820-5072

Abstract: Redundant motion, which is possible when robotic manipulators are over-actuated, can be
used to control robot arms for a wide range of tasks. One of the best known methods for controlling
redundancy is the null space projection, which assigns a priority while executing desired tasks.
However, when the manipulator is projected into null space, its motion would be limited, since
the motion is only permitted in the direction that does not interfere with the primary task. In this
study, we have analyzed the null space projector matrix to derive the appropriate direction of the
redundant motion by quantifying the allowed motion in each direction. As a result, we have found
an ellipsoidal boundary, in which the redundant motion is permitted to move. We have named this
ellipsoidal boundary as ’null space quality’ in directions. The proposed null space quality shows
similar aspects with that of the robot manipulability, but it reveals a decisively different value when
the manipulator operates within the null space. The experimental results showed that the robotic
manipulator tracked the sinusoidal input trajectory with reduced root mean square (RMS) error by
 33.84%. Furthermore, we have demonstrated the obstacle avoidance of a robotic arm utilizing the
 null space projector while considering the null space quality.
Citation: Kim, S.; Yun, S.; Shin, D.
Numerical Quantification of Keywords: robot manipulation; redundancy; null space control; obstacle avoidance
Controllability in the Null Space for
Redundant Manipulators. Appl. Sci.
2021, 11, 6190. https://doi.org/
10.3390/app11136190 1. Introduction
Robot manipulators, which generally consist of six degrees of freedom (DoF), are
Academic Editors: Antoni Grau
widely adopted in industrial fields [1]. However, six DoF manipulators can only perform a
and Yolanda Bolea
single task at a single time in three-dimensional space, due to lack of excess DoF. Hence,
redundancy is necessary to resolve this issue. Robots are redundant when it has more
Received: 3 June 2021
Accepted: 21 June 2021
DoF than the required to perform the given task (e.g., seven DoF for six direction tasks).
Published: 3 July 2021
Redundancy is a crucial feature of robotic manipulators that can be utilized to execute a
wide range of tasks with flexibility, dexterity, and versatility. Due to these unique charac-
Publisher’s Note: MDPI stays neutral
teristics, redundant manipulators can execute several tasks simultaneously with null space
with regard to jurisdictional claims in
projection [2–4]. Applications of null space projection includes, obstacle avoidance [5–7],
published maps and institutional affil- impedance control [8–10], the joint saturation [11–13], and the posture control [14,15].
iations. Not only does the null space projection enable the robot’s capability to execute tasks
simultaneously, it also has the advantage of prioritizing the tasks.
When null space projection is used, excess DoF is utilized to prioritize the tasks into (1)
primary task and (2) secondary task. By doing so, the robotic manipulator can execute both
Copyright: © 2021 by the authors.
tasks simultaneously without disturbing the primary task (higher priority). While executing
Licensee MDPI, Basel, Switzerland.
the tasks, the null space projector plays a key role to minimize the interference. This
This article is an open access article
interference is mainly caused by the multi-DoF dynamics of the robot. Thus, a null space
distributed under the terms and projector was examined with respect to the robot dynamics to stabilize the system [2,16,17].
conditions of the Creative Commons Although the studies were focused on minimizing the interference of the primary task,
Attribution (CC BY) license (https:// a further study must be conducted to consider the controllability of the secondary task.
creativecommons.org/licenses/by/ In the past, numerous studies using self-motion as the secondary task were conducted
4.0/). within the joint space [18–20]. However, when the self-motion is conducted within the task

Appl. Sci. 2021, 11, 6190. https://doi.org/10.3390/app11136190 https://www.mdpi.com/journal/applsci


Appl. Sci. 2021, 11, 6190 2 of 13

space, singularity of robot joints become an issue. Thus, controllability of a robot manipula-
tor must be evaluated while controlling the manipulator within the task space. In a general
situation, evaluation of the controllability in task space can be substituted by evaluating
the robot manipulability [21]. The robot manipulability refers to the manipulating ability of
a robot within the task space, and it is used as an indicator to avoid robot singularity [22].
However, robot manipulability does not account for the changed movable direction of
motion due to null space projection. For example, once the null space projector is applied
to the robot motion, a new type of singularity occurs. Therefore, a new indicator that deals
with this type of singularity is required to evaluate the controllability of a robot within the
null space.
In order to address this issue, we propose a new indicator named ’null space quality’,
which evaluates the manipulability of a robot with null space projection. Conventional
manipulability measures the capacity of a robot to move in a certain direction while
considering every single joint. However, it is not possible to evaluate the manipulability in
its standard form when the null space projection is used due to the priority of the tasks.
This is because the movable direction of motion of a robot changes with the null space
projector, in contrast to the movable direction of motion of a robot that considers every
single joint. Thus, it is crucial to consider both the null space projector and the Jacobian
matrix to deal with the extra capacity of joints.
When the null space projection method is used, it is crucial to consider the controllable
direction of a robot. Generally, when the tasks controlled within the null space are under a
relatively low DoF situation (i.e., under-actuated), the DoF in task space are usually coupled
to one another. Thus, in order to control the robot to the desired motion, it is necessary to
find and utilize the controllable direction to acquire better control performance.
The null space quality is a numerical quantification of robot controllability that can
be applied universally regardless of the null space projector matrix used. While various
null space projectors can be selected depending on the desired task, the null space quality
assures a consistent solution for robot control. In this paper, we have introduced a method
to obtain the null space quality, while considering both the kinematics and the dynamics of
the robots.
To validate the proposed method, the two tasks were controlled simultaneously. The
primary task of a robot is to utilize the six DoF to maintain the end-effector to remain
stationary, while the secondary task is to utilize the one DoF at the 4th link to move freely in
the direction shown in Figure 1. The infinite number of possible solutions of the secondary
task appears in a circular shape because the manipulator is an articulated robot that consists
of rotary joints. Hence, the simulation and experiments were performed along the path of
the infinitely possible solutions.
Appl. Sci. 2021, 11, 6190 3 of 13

Figure 1. Actual model of the 7-DoF manipulator. The infinitely possible solutions of the 1-DoF
secondary task are shown when performing the positioning and orienting at the end-effector as the
primary task.

2. Method
The manipulator can perform not just a single task, but it can also perform two
or more tasks with different priority by using null space projection. For a single task,
the relationship between the torque and force is expressed as follows [2]:

Γ = JT F (1)

where Γ ∈ Rn and F ∈ Rm denote the torque and the force vector, respectively. J T ∈ Rn×m
is the Jacobian transpose matrix of the task. If we apply this equation into two simultaneous
tasks (e.g., Γ = J1T F1 + J2T F2 ), each task will interfere with each other, because the priority
of tasks are not assigned to the excess DoF. In order to prioritize the two tasks into primary
and secondary tasks simultaneously, without interfering with the primary task, the null
space projection should be applied [3]. The corresponding equation of the torque with the
null space projection is given in (2):

Γ = JPT FP + NPT JST FS (2)

NPT = I − JPT JPT + (3)

where NPT ∈ Rn×n and JPT + ∈ Rm×n denote the null space projector matrix and Moore–
Penrose pseudoinverse matrix of primary task Jacobian transpose, respectively. I is the
n × n identity matrix. The subscripts P and S identifies the primary and the secondary
tasks. In this paper, we deal with only two tasks, primary and secondary priorities, but for
the general situation, it could be extended further. Based on the Equation (2), the motion
generated by the secondary task force, FS , cannot interfere with the motion of the higher
Appl. Sci. 2021, 11, 6190 4 of 13

priority due to the null space projector NPT . That is because the null space projector NPT
constrains the joint motion that is available to FS due to the assigned priority.

2.1. The Null Space Projector


When using the null space projection for control, the joints of the manipulator move
simultaneously in compensation to prevent interference with the high priority task. This
compensation acts as a constraint for the secondary task. Thus, finding the controllable
joint motion is important. Since the controllable joint motion is the basis vector of the joint
space, it is equivalent to the eigenvector of the null space projector. Thus, the eigenvalue
decomposition method can be used to acquire an eigenvector. The null space projector
consists of the I and J T J T + . Because J T J T + is a hermitian matrix with real numbers, and by
the definition of the pseudo inverse, the null space projector N T is always a symmetric
matrix. Therefore we can derive the eigenvalues and eigenvectors of the null space projector
expressed in the form below:

N T = PDP−1 (where P = [ P1 · · · Pk ]) (4)

The eigenvector Pi is the n × 1 vector and the number of eigenvalue and eigenvector
are k = n − m P . m P is the DoF of primary task. By using these eigenvectors, we can notice
the joint constraints and the relationship between each joint while executing the primary
task at the end-effector. Furthermore, by projecting the input torque to this eigenvector, we
can control the extra joint DoF independently.

Γ = JPT FP + NPT ΓS (5)

Pi · (qd − q)
ΓS = K p Pi |q − q| − Kv q̇ (6)
| Pi · (qd − q)| d
Equation (5) shows torque input of a manipulator within the task space, while con-
trolling the joints with null space projector. ΓS is the projected torque vector within the
eigenvector Pi . The vector q and q̇ are the vectors representing joint angle and joint angular
velocity, respectively. qd represents the desired joint angle. K p and Kv are the diagonal
matrices containing the proportional and derivative gains, respectively. It is sufficient to
perform several tasks like posture control and singularity avoidance by joint space control
within the null space, but the tasks like obstacle avoidance, should be performed by task
space control even in the null space. We have dealt with this problem in the next section
by proposing a new index named null space quality and designating appropriate control
direction in the task space.

2.2. Null Space Quality


The ’null space quality’ is the index that numerically quantifies the manipulating
ability of the robot in the null projected task space. In the null space, the controllable
direction is changed not only in the joint space, but also in the task space. For enhanced
task space control in the null space, it is necessary to identify the controllable direction in the
null projected task space. For identification process, the components about the constrained
joint motion by null space projector and the manipulating ability of the controlled body
should be considered. The null projected Jacobian transpose with respect to the null space
projector, NPT , and Jacobian of the controlled body, JST , can be expressed as follows:

T
JN = NPT JST (7)

The null projected Jacobian contains the relationship between the joint and the task
motion in the null space. The relationship can be obtained from the singular values and
vectors by the singular value decomposition (SVD) as follow:
T
JN = USV T (8)
Appl. Sci. 2021, 11, 6190 5 of 13

where U ∈ Rn×n and V ∈ Rm×m are orthogonal unitary matrices involving singular vectors
T , and S ∈ Rn×m includes singular values, σ , in the diagonal. The rank of the J T can
of JN i N
be determined as follows:
(
n − m H if (n − m H ) ≤ m L
k= (9)
mL if (n − m H ) > m L

The relationship between δx, the infinitesimal displacements of the controlled body,
and δq, the infinitesimal joint angular displacement is defined by δx = Jδq. Next, by let-
ting the SVD of Jacobian be J = VJ S J U JT and substituting it into the equation δx = Jδq,
the following equation can be derived:

δx = Jδq
= VJ S J U JT δq (10)
0 0
= VJ δq (where δq = S J U JT δq0 )

In this scope, the matrix VJ and δx is expressed in the form of VJ = [VJ1 . . . VJN ] and
δx = δq10 VJ1 + · · · + δq0m VJm . So, the δx lies in the column space of VJ .

δq = J + δx (where J + = U J S+ T
J VJ )
= U J S+ T
J VJ δx (11)
0 0 T 0
= U J δx (where δx = S+
J VJ δx )

By repeating the derivation process above, the δq lies in the column space of U J . Based
on the equations above, one can note that the U and V in Equation (8) are the basis vectors
of the joint space and the task space, respectively. Furthermore, the singular values, σi ,
represent the manipulating abilities of a robot in each direction of the null projected space.
Finally, the null space quality can be expressed as:

k
Q= ∏ σi (12)
i =1

The null space quality is the dimensionless index. Since we have used Moore–Penrose
pseudoinverse in our work, the null space quality ranges between 0 and 1.0. Generally,
high null space quality value interprets the better controllability of the robot manipulator
within the null space.
By evaluating the null space quality, another type of singularity can be verified, which
cannot simply be verified by evaluating the manipulability. As the null space quality
includes the Jacobian matrix, the singular state of the null space quality exhibits similar
aspects with the manipulability’s singular state (Type 1 singularity). However, there is a
difference due to the null space projector which causes another type of singularity. As men-
tioned previously, the null space projector restricts the joint motion of a excess Dof, causing
singular state. When the constrained joint motion in the null space is orthogonal with the
necessary joint motion by the Jacobian, another singular state is caused (Type 2 singularity).

2.3. Null Space Quality Ellipsoid


The null space quality ellipsoid, along with the singular values and singular vectors,
represents the controllable direction of a robot in the null space. As the null space projected
system has relatively low DoF due to the constrained joint motion, the controllable direction
Appl. Sci. 2021, 11, 6190 6 of 13

and the appropriate force input should be identified. The null space quality ellipsoid could
be obtained with the singular values σ and the vectors Vi of JNT as shown in Figure 2.

 
V1x · · · Vk x
V
 1y · · · Vky 
V · · · Vkz 
 
V =  1z (13)
V1rx · · · Vkrx 

V1ry · · · Vkry 
 

V1rz · · · Vkrz

Figure 2. The comparison between the manipulability ellipsoid and the null space quality ellipsoid
are shown in green and blue, respectively. The null space quality ellipsoid is displayed while
controlling 3-DoF (x, y, and z) at the end-effector as a primary task. The controllable ellipsoid of the
secondary task is changed from the manipulability ellipsoid to the null space quality ellipsoid by the
null space projection. Furthermore, a 1-DoF of the null axis is shown in magenta.

The column vector Vi represents the controllable DoF in the null projected task space,
while the singular values represent the axis length of the ellipsoid. The directional vectors
Vix , Viy , and Viz can be normalized to express the unit vector ViX . By using this ellipsoid,
the local solution can be obtained to determine which direction the body may move along,
and how the body moves well along that direction. Furthermore, by projecting the force
vector to the ellipsoid, the appropriate force can be assigned to the null projected system to
improve the control performance.

ViX · ( xd − x )
FL = K p ViX | x − x | − Kv ẋ (14)
|ViX · ( xd − x )| d

Next, the null axis that the controlled body may rotate along can be obtained as shown
in Figure 2. The articulated manipulator with the constraint can rotate their body along the
specified axis. It is important to find the specified axis to predict the direction and the path
of the controlled body within the null space. With a rotation term of the singular vector ViR
Appl. Sci. 2021, 11, 6190 7 of 13

including Virx , Viry , and Virz , the null axis that the body rotates along can be obtained. For
example, the rotation matrix of the null axis R N using the Roll-Pitch-Yaw method can be
obtained from the z-axis as follow:
  
cos(θ ) sin(θ )sin(φ) sin(θ )cos(φ) 0
Z0 = R N Z =  0 cos(φ) −sin(φ) 0
−sin(θ ) cos(θ )sin(φ) cos(θ )cos(φ) 1
   
sin(θ )cos(φ) Virx
=  −sin(φ)  = Viry 
cos(θ )cos(φ) Virz
φ = − asin(Viry )
θ = atan2(Virx , Virz ) (15)
θ and φ are the rotation angle in the pitch and yaw direction, respectively. By using (15),
the rotation matrix of null axis R N can be obtained. Based on this method, the null space
motion that moves along the null axis can be predicted.
Even though the controllable direction has been identified, the null space projector
should be considered. Once the projecting method has been used, the motion of the con-
trolled body remains unchanged, even with or without the null space projector. However,
on the joint space level, different joints are activated, which is likely to cause interference
to the primary task without the null space projection. Therefore, we have considered the
motion of the robot not only in task space level, but also in the joint space level as well.

2.4. Null Space Quality about Dynamic Consistency


The null space quality could apply to the null space projector for other consistencies.
For the other consistencies like dynamic [2] and stiffness [23], the null space projector can
be changed. Although the joint relationship and limitation are changed by the different
null space projectors, the null space quality can be obtained with the same method. So the
null space quality could evaluate each null space projector.
The null space projector for dynamic consistency is commonly used to control the
redundancy because it guarantees not to interfere with the primary task in both the kine-
matics level and the dynamics level. The dynamically consistent null space projector N̄H T is

expressed as follows:
T T T
N̄H = I − JH J̄H (16)
J̄H = A−1 J T Λ
= A −1 J T ( J A −1 J T ) −1 (17)
J̄H is a generalized inverse to minimize the kinetic energy. A is the n × n joint space
kinetic energy matrix. By substituting the N̄H T to (7) instead of N T , the dynamically
H
consistent null projected Jacobian J̄H can be written as:
T T T
J̄N = N̄H JL (18)
T can be obtained by the same methods in
The null space quality and ellipsoid of J̄N
Sections 2.2 and 2.3.

3. Simulation and Experiment


To begin with, simulation and experiment were conducted with the 7 DoF robot
(PANDA, Franka Emika GmbH, Munchen, Germany ) consisting of the Denavit–Hartenberg
parameters shown in Table 1 to evaluate the singularities. Then, the simulation was con-
ducted to verify the proposed method by using 6 DoF for the primary task and excess 1 DoF
for the secondary task. We compared the general input and the proposed input introduced
in Equation (14) to determine the capacity of the projected force input in the proposed
Appl. Sci. 2021, 11, 6190 8 of 13

method. The magnitude of both force inputs were equal, but the direction differed for each
simulation and experiment.

Table 1. The table of the Denavit–Hartenberg parameters for PANDA derived following Craig’s
convention, further information on the PANDA can be accessed from the cited link [24].

Joint a (m) d (m) α (rad) θ (rad)


Joint 1 0 0.333 0 θ1
Joint 2 0 0 − π2 θ2
π
Joint 3 0 0.316 2 θ3
π
Joint 4 0.0825 0 2 θ4
Joint 5 −0.0825 0.384 − π2 θ5
π
Joint 6 0 0 2 θ6
π
Joint 7 0.088 0 2 θ7
Flange 0 0.107 0 0

3.1. Types of Singularity


Null space quality can identify two types of singularity, as mentioned at Section 2.2.
Type 1 singularity is same as the manipulability because the Jacobian of the control point
is dominant in this scope. As shown in Figure 3a, the manipulator moves to the singular
configuration with the step input. In this case, both manipulability and null space quality
can successfully identify a singular state. This type of singularity can be predicted because
it can be determined by the manipulability, which has been studied broadly in the past.
Type 2 singularity appears due to the joint constraint of the robot. Unlike the type 1
singularity, the manipulability remains neutral, while the null space quality decreased
with the step input, as shown in Figure 3c. To verify the state, we must obtain the joint
vector from the null space projector Jacobian. Three joint bases from the control point’s
Jacobian and the dot product with the joint bases of null space projector can be acquired, as
shown in Figure 3d. Every dot product of joint vectors is almost orthogonal when the null
space quality identifies the singular state. That means every joint vector of the Jacobian
is constrained by the null space projector. Thus, a new type of singularity that cannot be
explained solely by manipulability can be identified.

3.2. Step and Sinusoidal Response


When controlling the excessive DoF within the null space, there are situations where
the desired direction and controllable direction may coincide or differ while disregarding
the singular state of the manipulator. In order to validate the proposed method, simulations
were conducted to evaluate the response of a robot based on both step and sinusoidal input
as shown in Figure 4.
For the first case, both the z-direction input and the proposed input can be controlled
with ease (Figure 4a–d). However, the proposed input tends to converge faster, because the
proposed input considered the controllable direction in the null space. As shown in
Figure 4a, the proposed input converges faster than the z-axis direction input by the reason
above. As shown in Figure 4b, the singular vector representing the controllable directions,
Vx , Vy , and Vz , changes simultaneously in real-time with respect to the joint configuration
of the robot. The resulting motion of a robot with respect to these vectors is shown in
Figure 4a. Furthermore, it can be noted that the singular vectors Vy and Vz are relatively
larger than the Vx , which implies that the robot can be controlled with ease when moving
in the y and z directions, but with more difficulty in the x direction. The rise time and the
settling time was decreased from 0.6684 [s] to 0.3222 [s] (−51.79%) and from 1.3425 [s] to
0.6061 [s] (−54.82%), respectively. The sine wave input with a cycle per 2 s was simulated as
Appl. Sci. 2021, 11, 6190 9 of 13

shown in Figure 4c. The RMS error was decreased from 0.0109 [m] to 0.0072 [m] (−33.94%)
by using the proposed method.
For comparison, the second case shows the response of a robot moving in the y-
direction, even with Vy is low (Figure 4e–h). In Figure 4e, the y position initially cannot
follow the desired input, but later follows the desired input as the Vy increases as shown in
Figure 4f. Unlike the first case, the control performance can be significantly increased in
this case with the proposed force input. The difference here is the force direction, where the
proposed input requires greater z-direction than the y-direction at the beginning, as shown
in Figure 4f. The rise time and the settling time is decreased from 1.3187 [s] to 0.3497 [s]
(−73.48%) and from 2.2736 [s] to 0.6286 [s] (−72.35%), respectively. The sine wave input
was simulated as shown in Figure 4g. The results show that the RMS error decreased from
0.0136 [m] to 0.0083 [m] (−38.97%) by using the proposed method.

Figure 3. The two types of singular state configurations are shown. (a) shows the null space quality
vs. the manipulability of a manipulator when the manipulator moves to the type 1 singular state
by the step input. Type 1 singularity is caused by the Jacobian, which reflects the kinematics of the
controlled body. (b) shows the dot product between the joint basis of the null space projector and
the Jacobian of the secondary task. The nonzero dot product subset of the joint bases of Jacobian
forms the bases after the projection. The dot product is the dimensionless value. (c) shows the type 2
singular state caused by the joint constraints. (d) shows that the dot product of every vector is nearly
zero after the step input. This implies that the presence of subset of joint bases that forms the bases in
the null space is minimal.
Appl. Sci. 2021, 11, 6190 10 of 13

Figure 4. Simulation results with respect to the step and sinusoidal input are shown. The configuration and movement of
the secondary task are described in the left side of the figure. (a–d) are the results when the secondary task is controlled
along the z-axis. (a,b) show the response of the robot and the corresponding null space quality when the step input is
applied. (c,d) show the response of the robot and the corresponding null space quality when the sinusoidal input is applied.
When the desired task is in the z direction, the value of Vz plays a key role. In this situation, Vz is enough to control the robot
in the z direction, but the force input projected to V improves the performance. With the step input, the proposed method,
which projects the input force into V, decreases the rise time by 51.79% and the settling time by 54.82%. Furthermore,
the RMS error has been decreased by 33.94% when the sinusoidal input is applied. (e–h) are the results when the secondary
task is controlled along the y-axis. In this case, controlling to y direction is difficult because the Vy , controllability to y
direction, is relatively low. In such a situation, the proposed method is more effective. As a result, the rise time, the settling
time, and the RMS error decreased by 73.48%, 72.35%, and 38.97%, respectively.
Appl. Sci. 2021, 11, 6190 11 of 13

3.3. Obstacle Avoidance


The proposed method can be applied for obstacle avoidance. When obstacle avoidance
takes action, it creates a repulsive force with respect to the vector between the robot and
the obstacle. When the repulsive force vector points out to an infeasible direction, the ma-
nipulator is unable to avoid the obstacle. On the contrary, as the proposed method projects
the force to a feasible (movable) direction, the manipulator is able to avoid the obstacle.
Even though, the repulsive force points out to a nearby feasible direction, the proposed
method can avoid the obstacle with smaller repulsive force with shorter duration.
We have performed obstacle avoidance with the PANDA. The force was selected by a
force inducing an artificial repulsion from the surface of the obstacle [25].
(
µ( 1ρ − 1 1 ∂ρ
ρ0 ) ρ2 ∂x if ρ ≤ ρ0 ,
Fobs = (19)
0 if ρ > ρ0

The experiment was performed with and without the force projection. With the force
projection, the manipulator avoids the obstacle faster with smaller input, as shown in
Figure 5. Generally, the magnitude of torque may appear greater or lesser depending on
the controllable direction, but when the proposed is used, the magnitude of torque becomes
equivalent regardless of the controllable direction.

Figure 5. Experimental results for obstacle avoidance. The schematic of experiment is shown in the left. The primary task is
the stationary task by utilizing 6 DoF at the end-effector and the secondary task is obstacle avoidance at link 4 (yellow point)
while the obstacle approaches to link 4 from the right side of the manipulator at a speed of 5 cm/s. (a) shows the distance
between the obstacle and the control point. (b) shows the input force when the obstacle approaches. ρ0 is the distance of
the obstacle that the manipulator begins to avoid. t0 is the time when the obstacle infiltrates the radius ρ0 . The proposed
method avoids the obstacle faster with the less force input.

4. Conclusions
In this paper, we have proposed the index that quantifies the manipulating ability of
a robot in the null space. In addition, a novel control method that is more efficient in the
null space, especially under low DoF condition, has been proposed. In order to accomplish
these contributions, we analyzed the joint constraints caused by the null space projection
and the joint and task space basis with respect to the SVD of the null projected Jacobian.
Appl. Sci. 2021, 11, 6190 12 of 13

Based on these findings, one can find a controllable direction with these bases and control
the coupled DoF efficiently by projecting the force to the bases.
We conducted several simulations and experiment to validate the singularity and
improved control performances. At the first simulation, the two types of singularity that
appear in the null space was verified, one of them which cannot be explained solely with
manipulability. We have also conducted simulation to validate the proposed method with
respect to the step and sinusoidal input. As a result, the proposed method improved the
overall control performance (−51.79% and 73.48% for the rise time, −54.82% and −72.35%
for the settling time, −33.94% and −38.97% for RMS error). Furthermore, we applied the
proposed method to obstacle avoidance and observed that the task can be performed with
a smaller force input with shorter duration of response time for safety.
The null space quality proposed in this work can be a useful substitute for manipula-
bility when we control the null projected system, because it considers the properties of null
space that manipulability cannot consider. The proposed control method can be a basic task
space control strategy for the null projected system with local optimization. Furthermore,
The null space quality can be applied to wide range of applications with regards to the
consistency of the projector. In the future, we plan to further enhance the control strategy,
so that it can be integrated to redundant robots with more than twp excess DoF.

Author Contributions: Conceptualization, methodology, simulation setup, experimental setup


drafted the paper and revised the paper, S.K.; experimental setup, reviewed the paper for submission,
S.Y.; supervised overall work the paper, D.S. All authors have read and agreed to the published
version of the manuscript.
Funding: This work was supported by the National Research Foundation of Korea(NRF) grant
funded by the Korea government. (MSIT) (NRF-2021R1A2C2008379). Furthermore, this study was
supported by the Chung-Ang University Graduate Research Scholarship in 2019.
Institutional Review Board Statement: Not applicable for studies not involving humans or animals.
Informed Consent Statement: Not applicable for studies not involving humans.
Data Availability Statement: No new data were created or analyzed in this study. Data sharing is
not applicable to this article.
Acknowledgments: The authors thank to people in the Human-Centered Robotics Laboratory at
Chung-Ang University for their valuable comments and feedback.
Conflicts of Interest: The authors declare no conflict of interest.

References
1. Almurib, H.A.; Al-Qrimli, H.F.; Kumar, N. A review of application industrial robotic design. In Proceedings of the 2011 Ninth
International Conference on ICT and Knowledge Engineering, Bangkok, Thailand, 12–13 January 2012; pp. 105–112.
2. Khatib, O. A unified approach for motion and force control of robot manipulators: The operational space formulation. IEEE Trans.
Robot. Autom. 1987, 3, 43–53. [CrossRef]
3. Nakamura, Y.; Hanafusa, H.; Yoshikawa, T. Task-priority based redundancy control of robot manipulators. Int. J. Robot. Res. 1987,
6, 3–15. [CrossRef]
4. Slotine, S.B.; Siciliano, B. A general framework for managing multiple tasks in highly redundant robotic systems. In Proceedings
of the 5th International Conference on Advanced Robotics, Pisa, Italy, 19–22 June 1991; Volume 2, pp. 1211–1216.
5. Maciejewski, A.A.; Klein, C.A. Obstacle avoidance for kinematically redundant manipulators in dynamically varying environ-
ments. Int. J. Robot. Res. 1985, 4, 109–117. [CrossRef]
6. Choi, S.I.; Kim, B.K. Obstacle avoidance control for redundant manipulators using collidability measure. Robotica 2000, 18,
143–151. [CrossRef]
7. Lee, K.-K.; Buss, M. Obstacle avoidance for redundant robots using Jacobian transpose method. In Proceedings of the International
Conference on Intelligent Robots and Systems, San Diego, CA, USA, 29 October–2 November 2007; pp. 3509–3514.
8. Albu-Schaffer, A.; Ott, C.; Frese, U.; Hirzinger, G. Cartesian impedance control of redundant robots: Recent results with the DLR-
light-weight-arms. In Proceedings of the 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422),
Taipei, Taiwan, 14–19 September 2003; Volume 3, pp. 3704–3709.
9. Platt, R.; Abdallah, M.; Wampler, C. Multiple-priority impedance control. In Proceedings of the 2011 IEEE International
Conference on Robotics and Automation, Shanghai, China, 9–13 May 2011; pp. 6033–6038.
Appl. Sci. 2021, 11, 6190 13 of 13

10. Sadeghian, H.; Villani, L.; Keshmiri, M.; Siciliano, B. Task-space control of robot manipulators with null-space compliance. IEEE
Trans. Robot. 2013, 30, 493–506. [CrossRef]
11. Flacco, F.; De Luca, A.; Khatib, O. Motion control of redundant robots under joint constraints: Saturation in the null space.
In Proceedings of the IEEE International Conference on Robotics and Automation, Saint Paul, MN, USA, 14–18 May 2012;
pp. 285–292.
12. Flacco, F.; De Luca, A.; Khatib, O. Control of redundant robots under hard joint constraints: Saturation in the null space. IEEE
Trans. Robot. 2015, 31, 637–654. [CrossRef]
13. Kanoun, O.; Lamiraux, F.; Wieber, P. Kinematic control of redundant manipulators: Generalizing the task-priority framework to
inequality task. IEEE Trans. Robot. 2011, 27, 785–792. [CrossRef]
14. Bae, J.; Park, J.; Oh, Y.; Kim, D.; Choi, Y.; Yang, W. Task space control considering passive muscle stiffness for redundant robotic
arms. Intell. Serv. Robot. 2015, 8, 93–104. [CrossRef]
15. Khatib, O.; Sentis, L.; Park, J.; Warren, J. Whole-body dynamic behavior and control of human-like robots. Int. J. Humanoid. Robot.
2004, 1, 29–43. [CrossRef]
16. Park, J. Analysis and Control of Kinematically Redundant Manipulators: An Approach Based on Kinematically Decoupled Joint
Space Decomposition. Ph.D. Thesis, Pohang University of Science and Technology, Pohang-si, Korea, 2000.
17. Wang, J.; Li, Y.; Zhao, X. Inverse kinematics and control of a 7-DOF redundant manipulator based on the closed-loop algorithm.
Int. J. Adv. Robot. Syst. 2010, 7, 37–47. [CrossRef]
18. Tondu, B. A closed-form inverse kinematic modelling of a 7R anthropomorphic upper limb based on a joint parametrization.
In Proceedings of the 2006 6th IEEE-RAS International Conference on Humanoid Robots, Genova, Italy, 4–6 December 2006;
pp. 390–397.
19. An, H.H.; Clement, W.I.; Reed, B. Analytical inverse kinematic solution with self-motion constraint for the 7-DOF restore robot
arm. In Proceedings of the 2014 IEEE/ASME International Conference on Advanced Intelligent Mechatronics, Besancon, France,
8–11 July 2014; pp. 1325–1330.
20. Faria, C.; Ferreira, F.; Erlhagen, W.; Monteiro, S.; Bicho, E. Position-based kinematics for 7-DoF serial manipulators with global
configuration control, joint limit and singularity avoidance. Mech. Mach. Theory. 2018, 121, 317–334. [CrossRef]
21. Yoshikawa, T. Manipulability of robotic mechanisms. Int. J. Robot. Res. 1985, 4, 3–9. [CrossRef]
22. Marani, G.; Kim, J.; Yuh, J.; Chung, W.K. A real-time approach for singularity avoidance in resolved motion rate control of robotic
manipulators. In Proceedings of the 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292),
Washington, DC, USA, 11–15 May 2002; Volume 2, pp. 1973–1978.
23. Dietrich, A.; Ott, C.; Albu-Schaffer, A. An overview of null space projections for redundant, torque-controlled robots. Int. J. Robot.
Res. 2015, 14, 1385–1400. [CrossRef]
24. Franka Control Interface Documentation. Available online: Https://frankaemika.github.io/docs/ (accessed on 16 June 2021).
25. Khatib, O. Real-time obstacle avoidance for manipulators and mobile robots. Auton. Robot. Veh. 1986, 396–404. [CrossRef]

You might also like