added Pose::setIdentity() and PoseDiff::setZero() with tests
Merge branch 'origin/develop'