preliminary velocity estimation, still needs more testing