Add max velocity

modified forward thrust function
Added max velocity