Professional Documents
Culture Documents
Learning Spatial Constraints Using Gaussian Process For Shared Control of Semi-Autonomous Mobile Robots
Learning Spatial Constraints Using Gaussian Process For Shared Control of Semi-Autonomous Mobile Robots
Keywords: Mobile Robot, Gaussian Process, Shared control, Semi-autonomous, Wi-Fi Signal Strength.
Abstract: In this paper, a novel human-robot shared control approach is proposed to solve the problem of semi-
autonomous mobile robot navigation with the spatial constraints of maintaining reliable Wi-Fi connection.
In particular, the presented approach benefits from using Gaussian Process Regression method to learn the
distribution of indoor Wi-Fi signal strength (WSS) and to fuse it with the environmental occupancy probabil-
ity. The resulting WSS-Occupancy hybrid map is further utilized for generating paths that prevent the robot
from violating the spatial restriction. A shared control strategy is designed to implement the WSS-aware nav-
igation behaviour. The approach is evaluated by both simulation and real-world experiments, in which the
results validate the practicability and effectiveness of the approach.
201
Qian, K., Niu, D., Fang, F. and Ma, X.
Learning Spatial Constraints using Gaussian Process for Shared Control of Semi-autonomous Mobile Robots.
DOI: 10.5220/0006382902010208
In Proceedings of the 14th International Conference on Informatics in Control, Automation and Robotics (ICINCO 2017) - Volume 2, pages 201-208
ISBN: Not Available
Copyright © 2017 by SCITEPRESS – Science and Technology Publications, Lda. All rights reserved
ICINCO 2017 - 14th International Conference on Informatics in Control, Automation and Robotics
x Localization x SLAM
gation problem. x Navigation x WSS mapping
In this paper, we propose a practical problem Browser
client
called WSS-aware navigation of a tele-operated mo- Internet LAN
202
Learning Spatial Constraints using Gaussian Process for Shared Control of Semi-autonomous Mobile Robots
Based on this a decision making module is proposed interval t the robot encapsulates the WSS data as each
to select or combine the commands from human in- data packet:
puts and the robots autonomous control inputs gener-
ated from a navigation controller based on the WSS- D = (xi , yi )|i = 1, 2, ..., n (1)
Occupancy hybrid map. The shared control frame- in which xi is the positions of sample points, and yi
work is shown in Figure 3. is the WSS measured at the corresponding position
timestamp ti .
203
ICINCO 2017 - 14th International Conference on Informatics in Control, Automation and Robotics
X = {xi |i = 1, 2, ..., n} and their corresponding Equation (9). The resulting grey value GB of the cor-
WSS values y = {yi |i = 1, 2, ..., n}, a GP model is responding pixel in the WSS-Occupancy hybrid grid
trained. Based on the trained GP model the posterior map is given in Equation (12):
distribution can be computed. For a new input x∗
that represents a position where WSS at this position GW GW < min(Gaccept , GW )
GB = { . (12)
is never measured, the joint conditional distribution GI else
of the estimated target value y∗ can be estimated by
the prediction distribution p(y∗ |x∗ , D). The posterior
over function values, conditioned on the training 4 SHARED CONTROL
data X and y is Gaussian with mean µx∗ and variance STRATEGY
σ2x∗ (Deisenroth et al., 2014):
Using the WSS-Occupancy hybrid grid map de-
p( f (x∗ )|x∗ , X, y) = N(µx∗ , σ2x∗ ) (6) scribed in Section 3, a desired trajectory can be com-
where puted by a regular navigation controller that is com-
µx∗ = k∗ T (K + σ2ε I)−1 y (7) prised of a global path planner and a reactive local
planner. The path will ensure goal-directed naviga-
−1
σ2x∗ = k (x∗ , x∗ ) − k∗T K + σ2ε I k∗ (8) tion while avoid the robot to pass through the areas
with low WSS, so that continuous network connec-
The chosen kernel function determines the perfor- tion will be strictly ensured.
mance of the GP regression. The hyper-parameters Using a local path planner such as VFH or ND
of a GP with Gaussian kernel for a particular dataset algorithm(Minguez and Montano, 2005), the au-
can be learned from the training data, in which the tonomous control set ur is obtained. Given the hu-
hyper-parameters are derived by maximizing the log man direct control uh = [vh , wh ]T and the output of the
marginal likelihood using empirical Baysian infer- reactive local planner ur = [vr , wr ]T , in which v and
ence(Rasmussen and Williams, 2006). w represent the translational speed and the rotational
speed of the robot, respectively, the shared controller
3.3 Fusion of Grid Map with Wi-Fi adopted in this work can be formulated as a combi-
Signal Strength Distribution nation of both two sources of command as shown in
Equation (12). ρ is the allocation weight with domain
The learned WSS distribution map models the spa- 0 ≤ ρ ≤ 1.
tial distribution of WSS within a given indoor context. us = (1 − ρ)uh + ρur (13)
We use Equation (9) to transfer raw WSS data S into Since a robot control command will not exactly
GW that takes similar value as a grey image pixel: cause ideal movement but introducing certain uncer-
tainties, we roughly predict the distribution of the
GW = 255(S + Smin)/(Smax − Smin ) (9)
robot’s possible future positions in a small time inter-
, in which Smin and Smax are the lower bound and the val ∆t ahead by adding Gaussian noises to the transla-
upper bound of transformation, which are set as: tional and rotational velocity. Firstly we assume that
the robot’s heading is constant but the translational
Smin = −113dBm (10) velocity is v, thus the robot’s possible movements are
−→
Smax = 0dBm (11) placed along a vector OA after ∆t. Then we assume
that the robot’s rotational velocity changes randomly
, according to our inspection of the range of sam- within [−∆w, ∆w] in ∆t. The result is a fan-shaped
ple WSS values in typical indoor environments. We area as shown in Figure 4 that contains all possible
define the minimal value of WSS that ensures reli- ur .
able network connection in the environment is Saccept
and thus the corresponding value after the transform Let the feasible autonomous control input set as Ur
is Gaccept . Furthermore, since the Wi-Fi distribution and feasible human input set as Uh . Four types of rela-
map is learned on actual sensor readings recorded at tionships between Ur and Uh as shown in Figure 5 are
locations in the world coordinate that is consistent considered. If Uh is a subset of Ur , i.e.,Uh ⊆ Ur , the
with the occupancy grid map of the environment, the tele-operation command is regarded safe for ensuring
WSS distribution map can be fused with the occu- both goal-reaching and obstacle avoidance. In this
pancy grid map, resulting in a WSS-Occupancy hy- case, any ρ that satisfies 0 ≤ ρ ≤ 0.5 can be taken to
brid grid map. Denote GI as the grey value of a pixel generate a synthetic control command. In three other
in the occupancy grid map and GW are defined in situations such as Ur ⊆ Uh , Uh ∩Ur 6= {O,Uh ,Ur } and
204
Learning Spatial Constraints using Gaussian Process for Shared Control of Semi-autonomous Mobile Robots
205
ICINCO 2017 - 14th International Conference on Informatics in Control, Automation and Robotics
WSS/dBm
WSS-aware path
-40
-60
-80
- 100
- 120
Non WSS-
0 8 aware path
2 6
4
6 4
8 2
rx /m
10 0 ry /m Area with low
WSS
Figure 8: Learned WSS distribution.
Full autonomous to
Path avoid the area with low
B WIFI signal
The shared control performance was further validated Scenario 2 validates the effectiveness of human
in two other real world environment scenarios. The supervision for assisting robot’s autonomy. The task
206
Learning Spatial Constraints using Gaussian Process for Shared Control of Semi-autonomous Mobile Robots
P3
P2
C
B
P2
Pass through the
narrow corridor by
B human supervision
A B C
Wireless
Access Point A
P1 Part A: Full autonomous
Part B: Tele-operation only
Part C: Full autonomous
x
(a) Translational Velocity
Figure 13: Shared control result in scenario2.
Autonomous control input
* Tele-operation input
Rotational velocity - Shared control result
mode, the robot utilizes the WSS-Occupancy hybrid
map in a shared control framework to generate paths
that prevent itself from entering areas with low Wi-
Fi signal strength. A series of experimental stud-
ies have been performed, where promising results are
obtained. The presented approach can be extended
A B C to solve other similar problem of spatially restricted
navigation of a tele-operated mobile robot to reduce
the risk of violating the constraints while reaching the
goal.
207
ICINCO 2017 - 14th International Conference on Informatics in Control, Automation and Robotics
208