More work on boundary extension algorithm
Important bugfix in CalculateClearanceAtNode