Added in functions to replace the formulas for movement to prevent code duplication with the different modes. Also added in falling to the "ground" in the Human mode.