Merge pull request #40 from ayrton04/indigo-devel

Fixing sync issue with REP-105 compliant code and updated pose reset fun...