Math Update

Changed the displacement constant to the height to the top of the goal
considering all of my previous maths have been slightly lower than the
actual values.