Fast and deterministic (3+1)DOF point set registration with gravity prior