Added support for true differential integration of pose variables