implemented, tested velocity correction