Gravity Energy Storage Algorithm