added vector() to Vector class
added const to parameter of Pose::transform(...)
added Pose::setIdentity() and PoseDiff::setZero() with tests
added small test
Merge pull request #10 from ethz-asl/develop

Develop