Fixed Insert Oct tree Method

No longer breaks upon build