base commit from changes -- openni2 support and changes odometry changes for hexapod