added Pose::setIdentity() and PoseDiff::setZero() with tests