Add treshhold to moveToPosition in Entity class when checking if positionToMoveTo is reached