Fix VFH (Too Close issue) and plus face turn point