Bug-fix: using the current depth image
Merge branch 'master' into LieAlgebraTest

* master:
  Bug-fix: using the current depth image