Fix for velocity thrust correction (issue #4)