optimisation and bug fix

ground collision checking improved