<!DOCTYPE article PUBLIC "-//NLM//DTD JATS (Z39.96) Journal Archiving and Interchange DTD v1.0 20120330//EN" "JATS-archivearticle1.dtd">
<article xmlns:xlink="http://www.w3.org/1999/xlink">
  <front>
    <journal-meta />
    <article-meta>
      <title-group>
        <article-title>GMM-based Spatial Change Detection from Bimanual Tracking and Point Cloud Differences</article-title>
      </title-group>
      <contrib-group>
        <aff id="aff0">
          <label>0</label>
          <institution>Robotics and Intelligent Machines Laboratory, Department of Information Engineering, University of Parma</institution>
          ,
          <country country="IT">Italy</country>
        </aff>
      </contrib-group>
      <abstract>
        <p>Robots that detect changes in the environment can attain better context awareness and increased autonomy. In this work, a spatial change detection approach is presented which uses a single fixed depth camera to identify environment changes caused by human activities. The proposed method combines hand tracking and the difference between organized point clouds. Bimanual movements are recorded in real-time and encoded in Gaussian Mixture Models (GMMs). We show that GMMs enable change detection in presence of occlusions. We also show that the GMM analysis narrows down potential salient regions of space where manipulation actions are carried out. Experiments have been performed in an indoor environment for object placement, object removal and object repositioning tasks.</p>
      </abstract>
      <kwd-group>
        <kwd>Gaussian Mixture Models</kwd>
        <kwd>range sensing</kwd>
        <kwd>human motion tracking</kwd>
      </kwd-group>
    </article-meta>
  </front>
  <body>
    <sec id="sec-1">
      <title>-</title>
      <p>
        In this work, a method for spatial change detection is presented that identifies
environment changes due to human activities. The experimental setup includes
a single fixed depth camera (Kinect V2). Detection of the salient regions of the
environment, where human actions have been carried out, is achieved by
computing the difference between two organized point clouds, that are acquired at
the beginning and at the end of each experimental session. Moreover, bimanual
movements are tracked in real-time and encoded using GMMs. GMM analysis
enables change detection in presence of occlusions and it reduces the number
of false positives. Spatial change detection has mainly been investigated with
object-based approaches by exploiting cameras or depth sensors [
        <xref ref-type="bibr" rid="ref1 ref13 ref2 ref3 ref6 ref7 ref8 ref9">2, 9, 1, 6, 8, 13,
3, 7</xref>
        ]. Petsch et al. [
        <xref ref-type="bibr" rid="ref15">15</xref>
        ] presented a framework for sensor-based detection of
unexpected (surprising) events where manipulation events are detected from human
observation and by placing markers on objects. In [
        <xref ref-type="bibr" rid="ref4">4</xref>
        ] GMMs were investigated
for 3D data segmentation and novelty detection in the context of mobile robotics.
Several authors proposed advanced approaches for segmentation of human hand
trajectories [
        <xref ref-type="bibr" rid="ref10 ref11 ref12 ref16 ref5">11, 12, 5, 10, 16</xref>
        ]. In particular, in [
        <xref ref-type="bibr" rid="ref11">11</xref>
        ] Gaussian Mixture Models have
been applied for automatic segmentation of full-body motion trajectories.
2
2.1
      </p>
      <p>GMM-based spatial change detection</p>
    </sec>
    <sec id="sec-2">
      <title>Depth image processing</title>
      <p>The proposed approach operates on two depth frames acquired automatically
from a fixed Kinect V2, when no human motion is detected by the skeletal
tracker: one (frame P ) when the user has not yet entered the area, and the
other (frame N ) after the user left the scene. A difference depth image Duv is
computed (Eq. 1) given the one-to-one pixel correspondence in the two frames
at coordinates (u, v).</p>
      <p>NaN if |Nuv − Puv| ≤ Th

Duv = Nuv if Puv − Nuv &gt; Th
Puv
if Nuv − Puv &gt; Th
(1)</p>
      <p>Iuv =
(NaN if |Nuv − Puv| &gt; Th</p>
      <p>Nuv
otherwise
(2)
Th is a threshold set from to the noise model of the sensor. According to Eq.
1, in case of a significant change between the depth values the nearest point is
selected. Indeed, if the user performs an object placement task in direct sight
of the camera depth image N contains relevant information about the newly
placed object, while depth image P contains information about the background.
The opposite occurs if an object is removed in direct sight of the camera. An
invariant image is also computed as in Eq. 2, containing the pixels that do not
change significantly. Both Duv and Iuv are converted into point clouds called
difference point cloud and invariant point cloud respectively.
2.2</p>
    </sec>
    <sec id="sec-3">
      <title>Modeling of bimanual movements</title>
      <p>
        Motion tracking of both hands is performed in real-time during the execution
of the experiment using the Kinect V2 skeletal tracker. The trajectory of each
hand is represented as a set of 3D points with time stamp, i.e. {xk, yk, zk, tk}.
The proposed approach first generates two separate GMMs, ML and MR, one for
each 4D hand trajectory using Expectation Maximization (EM). The number of
Gaussians of ML and MR was chosen to minimize the BIC index [
        <xref ref-type="bibr" rid="ref11 ref14">11, 14</xref>
        ] as shown
in Alg. 1. The two GMMs are then fused in a single GMM M . In particular,
the priors wi of the Gaussian components in M are computed as the original
priors wLi and wRi in ML and MR weighted by the ratio between the number
of Gaussian components in ML and MR and the total number of Gaussians in
M , i.e.: wi = wLi · |ML|/|M | and wi = wRi · |MR|/|M |. The weighting factor
gives more importance to long trajectories. It turns out that isotropic (circularly
symmetric) Gaussian components are likely to correspond to regions of space
where salient manipulation activities are carried out. This fact can be explained
by observing that user’s actions are usually performed at slow speed and involve
Algorithm 1 Iterative Expectation Maximization
Input: S: set of points, with timestamp;
Output: BestGM M : the GMM model;
1: M inBIC ← +∞; GC ← 1;
2: repeat
3: GM M ← EM(S,GC);
4: BIC ← ComputeBIC(GM M ,S);
5: if BIC &lt; M inBIC then
6: M inBIC ← BIC;
7: BestGM M ← GM M ;
8: end if
9: GC ← GC + 1;
10: until BIC &gt; M inBIC + BICT h;
changes of hand direction, hence more points are sampled without a dominant
direction. Thus, a Gaussian saliency value δi is computed as follows:
δi =
minj∈{1,2,3}σi,j
maxj∈{1,2,3}σi,j
(3)
where σi,j is the j-th eigenvalue of the covariance matrix. A Gaussian is
considered salient if its prior wi and its saliency δi are both greater than their average
values in M , i.e.: wi &gt; w¯ ∧ δi &gt; δ¯ .
2.3
      </p>
    </sec>
    <sec id="sec-4">
      <title>Region of Interest extraction</title>
      <p>Information extracted from depth image processing and GMMs is exploited to
compute regions of interests (ROIs) corresponding to human activities as
illustrated in Fig. 1. First, a set of salient spheres of fixed radius r is generated, each
centered at the mean position of a salient Gaussian component in M . Then, a
salient point cloud is computed as the part of the difference point cloud inside
any of the salient spheres. Clusters of connected components in the salient point
cloud (defined as salient clusters) are extracted. Salient clusters are likely to
represent ROIs for manipulated objects in direct sight of the camera, i.e. objects
that have been placed in the environment, moved or removed, as both human
trajectory analysis and the difference point cloud agree. Each salient cluster
generates a spherical ROI, centered at the cluster centroid with radius equal to the
distance between the center and the farthest point of the cluster.</p>
      <p>Salient spheres that contain at least TI points of the invariant point cloud
are also added to the list of the regions of interest. In fact, such spheres are
likely to represent regions of space where user activity was detected from motion
trajectory analysis although the Kinect depth frame could not locate any changes
due to occlusions. Points of the invariant point cloud within a distance of r′
from any salient cluster centroid (rejection region) are not counted to prevent
duplicate ROI detections.
The proposed approach was evaluated by different users in an environment of
size 5 by 4 meters. In each experiment the user entered the workspace, performed
multiple manipulation actions and then left the scene. Fig. 2 shows an example
experiment. Results of the spatial change detection algorithm are shown in Fig.
3. Fig. 4 illustrates, in a simpler experiment for clarity, the benefit of the GMM
trajectory analysis when an action is performed in direct sight: the sensor noise at
the depth image borders is filtered out. A quantitative evaluation was carried out
on a dataset consisting of three experiments, with 10 trials for each experiment.
Experiments of the first type consist of a sequence of three actions, two performed
in direct sight of the sensor and one in an occluded region. The second type
involves two relevant actions, both in occluded areas. Experiments of the third
type consist again of three actions, all in direct sight of the sensor. Experiments
have been performed with r = 80 cm, r′ = 40 cm, Th = 10 cm and TI = 50.
Results are summarized in table 3. Precision and recall are above 87% for actions
in direct sight of the sensor and above 80% for actions in occluded regions.</p>
    </sec>
  </body>
  <back>
    <ref-list>
      <ref id="ref1">
        <mixed-citation>
          1.
          <string-name>
            <given-names>E. E.</given-names>
            <surname>Aksoy</surname>
          </string-name>
          ,
          <string-name>
            <given-names>A.</given-names>
            <surname>Abramov</surname>
          </string-name>
          , J. Do¨rr,
          <string-name>
            <given-names>K.</given-names>
            <surname>Ning</surname>
          </string-name>
          ,
          <string-name>
            <given-names>B.</given-names>
            <surname>Dellen</surname>
          </string-name>
          , and
          <string-name>
            <given-names>F.</given-names>
            <surname>Wo</surname>
          </string-name>
          <article-title>¨rg¨otter. Learning the semantics of object-action relations by observation</article-title>
          .
          <source>Int. J. Rob. Res.</source>
          ,
          <volume>30</volume>
          (
          <issue>10</issue>
          ):
          <fpage>1229</fpage>
          -
          <lpage>1249</lpage>
          ,
          <year>September 2011</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref2">
        <mixed-citation>
          2.
          <string-name>
            <given-names>P.</given-names>
            <surname>Alimi</surname>
          </string-name>
          ,
          <string-name>
            <given-names>D.</given-names>
            <surname>Meger</surname>
          </string-name>
          , and
          <string-name>
            <given-names>J.J.</given-names>
            <surname>Little</surname>
          </string-name>
          .
          <article-title>Object persistence in 3D for home robots</article-title>
          .
          <source>In The Semantic Perception</source>
          , Mapping, and
          <string-name>
            <surname>Exploration</surname>
          </string-name>
          (SPME) workshop,
          <year>2012</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref3">
        <mixed-citation>
          3.
          <string-name>
            <given-names>R.</given-names>
            <surname>Ambrus</surname>
          </string-name>
          ,
          <string-name>
            <given-names>N.</given-names>
            <surname>Bore</surname>
          </string-name>
          ,
          <string-name>
            <given-names>J.</given-names>
            <surname>Folkesson</surname>
          </string-name>
          , and
          <string-name>
            <given-names>P.</given-names>
            <surname>Jensfelt</surname>
          </string-name>
          .
          <article-title>Meta-rooms: Building and maintaining long term spatial models in a dynamic world</article-title>
          .
          <source>In IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS)</source>
          , pages
          <fpage>1854</fpage>
          -
          <lpage>1861</lpage>
          ,
          <year>Sept 2014</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref4">
        <mixed-citation>
          4.
          <string-name>
            <given-names>P.</given-names>
            <surname>Drews</surname>
          </string-name>
          , P. Nu´n˜ez, R. Rocha,
          <string-name>
            <given-names>M.</given-names>
            <surname>Campos</surname>
          </string-name>
          , and
          <string-name>
            <given-names>J.</given-names>
            <surname>Dias</surname>
          </string-name>
          .
          <article-title>Novelty detection and segmentation based on gaussian mixture models: A case study in 3d robotic laser mapping</article-title>
          .
          <source>Robotics and Autonomous Systems</source>
          ,
          <volume>61</volume>
          (
          <issue>12</issue>
          ):
          <fpage>1696</fpage>
          -
          <lpage>1709</lpage>
          ,
          <year>2013</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref5">
        <mixed-citation>
          5.
          <string-name>
            <given-names>D. R.</given-names>
            <surname>Faria</surname>
          </string-name>
          ,
          <string-name>
            <given-names>R.</given-names>
            <surname>Martins</surname>
          </string-name>
          ,
          <string-name>
            <given-names>J.</given-names>
            <surname>Lobo</surname>
          </string-name>
          , and
          <string-name>
            <given-names>J.</given-names>
            <surname>Dias</surname>
          </string-name>
          .
          <article-title>Extracting data from human manipulation of objects towards improving autonomous robotic grasping</article-title>
          .
          <source>Robotics and Autonomous Systems</source>
          ,
          <volume>60</volume>
          (
          <issue>3</issue>
          ):
          <fpage>396</fpage>
          -
          <lpage>410</lpage>
          ,
          <year>2012</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref6">
        <mixed-citation>
          6.
          <string-name>
            <given-names>A.</given-names>
            <surname>Fathi</surname>
          </string-name>
          and
          <string-name>
            <given-names>J.M.</given-names>
            <surname>Rehg</surname>
          </string-name>
          .
          <article-title>Modeling actions through state changes</article-title>
          .
          <source>In IEEE Conference on Computer Vision and Pattern Recognition (CVPR)</source>
          ,
          <year>2013</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref7">
        <mixed-citation>
          7. T. F¨aulhammer,
          <string-name>
            <given-names>R.</given-names>
            <surname>Ambrus</surname>
          </string-name>
          ,
          <string-name>
            <given-names>C.</given-names>
            <surname>Burbridge</surname>
          </string-name>
          ,
          <string-name>
            <given-names>M.</given-names>
            <surname>Zillich</surname>
          </string-name>
          ,
          <string-name>
            <given-names>J.</given-names>
            <surname>Folkesson</surname>
          </string-name>
          ,
          <string-name>
            <given-names>N.</given-names>
            <surname>Hawes</surname>
          </string-name>
          ,
          <string-name>
            <given-names>P.</given-names>
            <surname>Jensfelt</surname>
          </string-name>
          , and
          <string-name>
            <given-names>M.</given-names>
            <surname>Vincze</surname>
          </string-name>
          .
          <article-title>Autonomous learning of object models on a mobile robot</article-title>
          .
          <source>IEEE Robotics and Automation Letters</source>
          ,
          <volume>2</volume>
          (
          <issue>1</issue>
          ):
          <fpage>26</fpage>
          -
          <lpage>33</lpage>
          ,
          <year>Jan 2017</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref8">
        <mixed-citation>
          8.
          <string-name>
            <given-names>R.</given-names>
            <surname>Finman</surname>
          </string-name>
          ,
          <string-name>
            <given-names>T.</given-names>
            <surname>Whelan</surname>
          </string-name>
          ,
          <string-name>
            <given-names>M.</given-names>
            <surname>Kaess</surname>
          </string-name>
          , and
          <string-name>
            <given-names>J. J.</given-names>
            <surname>Leonard</surname>
          </string-name>
          .
          <article-title>Toward lifelong object segmentation from change detection in dense RGB-D maps</article-title>
          .
          <source>In 2013 European Conference on Mobile Robots (ECMR)</source>
          , pages
          <fpage>178</fpage>
          -
          <lpage>185</lpage>
          ,
          <year>Sept 2013</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref9">
        <mixed-citation>
          9.
          <string-name>
            <given-names>E.</given-names>
            <surname>Herbst</surname>
          </string-name>
          , Xiaofeng Ren, and
          <string-name>
            <given-names>D.</given-names>
            <surname>Fox</surname>
          </string-name>
          .
          <article-title>RGB-D object discovery via multi-scene analysis</article-title>
          .
          <source>In IEEE/RSJ Intl Conference on Intelligent Robots and Systems (IROS)</source>
          , pages
          <fpage>4850</fpage>
          -
          <lpage>4856</lpage>
          , Sept.
          <year>2011</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref10">
        <mixed-citation>
          10. Sing Bing Kang and
          <string-name>
            <given-names>K.</given-names>
            <surname>Ikeuchi</surname>
          </string-name>
          .
          <article-title>Toward Automatic Robot Instruction from Perception-Temporal Segmentation of Tasks from Human Hand Motion</article-title>
          .
          <source>IEEE Transactions on Robotics and Automation</source>
          ,
          <volume>11</volume>
          (
          <issue>5</issue>
          ):
          <fpage>670</fpage>
          -
          <lpage>681</lpage>
          ,
          <year>Oct 1995</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref11">
        <mixed-citation>
          11.
          <string-name>
            <surname>Sang Hyoung</surname>
            <given-names>Lee</given-names>
          </string-name>
          , Il Hong Suh,
          <string-name>
            <given-names>S.</given-names>
            <surname>Calinon</surname>
          </string-name>
          , and
          <string-name>
            <given-names>R.</given-names>
            <surname>Johansson</surname>
          </string-name>
          .
          <article-title>Learning Basis Skills by Autonomous Segmentation of Humanoid Motion Trajectories</article-title>
          .
          <source>In IEEE-RAS Intl Conference on Humanoid Robots</source>
          ,
          <year>2012</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref12">
        <mixed-citation>
          12.
          <string-name>
            <surname>J.F.-S. Lin</surname>
            and
            <given-names>D.</given-names>
          </string-name>
          <string-name>
            <surname>Kulic</surname>
          </string-name>
          .
          <article-title>Online Segmentation of Human Motion for Automated Rehabilitation Exercise Analysis</article-title>
          .
          <source>IEEE Transactions on Neural Systems and Rehabilitation Engineering</source>
          ,
          <volume>22</volume>
          (
          <issue>1</issue>
          ):
          <fpage>168</fpage>
          -
          <lpage>180</lpage>
          ,
          <year>2014</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref13">
        <mixed-citation>
          13.
          <string-name>
            <surname>J. Mason</surname>
            ,
            <given-names>B.</given-names>
          </string-name>
          <string-name>
            <surname>Marthi</surname>
            , and
            <given-names>R.</given-names>
          </string-name>
          <string-name>
            <surname>Parr</surname>
          </string-name>
          .
          <article-title>Object disappearance for object discovery</article-title>
          .
          <source>In IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS)</source>
          , pages
          <fpage>2836</fpage>
          -
          <lpage>2843</lpage>
          ,
          <year>Oct 2012</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref14">
        <mixed-citation>
          14.
          <string-name>
            <given-names>R.</given-names>
            <surname>Monica</surname>
          </string-name>
          ,
          <string-name>
            <given-names>J.</given-names>
            <surname>Aleotti</surname>
          </string-name>
          , and
          <string-name>
            <given-names>S.</given-names>
            <surname>Caselli</surname>
          </string-name>
          .
          <article-title>A kinfu based approach for robot spatial attention and view planning</article-title>
          .
          <source>Robotics and Autonomous Systems</source>
          ,
          <volume>75</volume>
          ,
          <string-name>
            <surname>Part</surname>
            <given-names>B</given-names>
          </string-name>
          :
          <fpage>627</fpage>
          -
          <lpage>640</lpage>
          ,
          <year>2016</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref15">
        <mixed-citation>
          15.
          <string-name>
            <given-names>S.</given-names>
            <surname>Petsch</surname>
          </string-name>
          and
          <string-name>
            <given-names>D.</given-names>
            <surname>Burschka</surname>
          </string-name>
          .
          <article-title>Representation of manipulation-relevant object properties and actions for surprise-driven exploration</article-title>
          .
          <source>In IEEE/RSJ Intl Conference on Intelligent Robots and Systems (IROS)</source>
          ,
          <year>2011</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref16">
        <mixed-citation>
          16.
          <string-name>
            <given-names>M.</given-names>
            <surname>Yeasin</surname>
          </string-name>
          and
          <string-name>
            <given-names>S.</given-names>
            <surname>Chaudhuri</surname>
          </string-name>
          .
          <article-title>Toward automatic robot programming: learning human skill from visual data</article-title>
          .
          <source>IEEE Transactions on Systems, Man, and Cybernetics</source>
          ,
          <string-name>
            <surname>Part</surname>
            <given-names>B</given-names>
          </string-name>
          : Cybernetics,
          <volume>30</volume>
          (
          <issue>1</issue>
          ):
          <fpage>180</fpage>
          -
          <lpage>185</lpage>
          ,
          <year>Feb 2000</year>
          .
        </mixed-citation>
      </ref>
    </ref-list>
  </back>
</article>