merge with ipa320-groovy_dev
kinect with registration and z_offset