Added angle/distance based path simplfication