Finished new version of VUKF